From e7fade3ac4559214ab0508dc54a71a3d1f522afb Mon Sep 17 00:00:00 2001 From: Daniel Hellstrom Date: Mon, 28 Nov 2011 09:52:03 +0100 Subject: DRVMGR: added driver manager to cpukit/libdrvmgr --- cpukit/libdrvmgr/drvmgr_func.c | 42 ++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 42 insertions(+) create mode 100644 cpukit/libdrvmgr/drvmgr_func.c (limited to 'cpukit/libdrvmgr/drvmgr_func.c') diff --git a/cpukit/libdrvmgr/drvmgr_func.c b/cpukit/libdrvmgr/drvmgr_func.c new file mode 100644 index 0000000000..e02a4446cb --- /dev/null +++ b/cpukit/libdrvmgr/drvmgr_func.c @@ -0,0 +1,42 @@ +/* Driver Manager optional dynamic function interface + * + * COPYRIGHT (c) 2011. + * Cobham Gaisler AB. + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.com/license/LICENSE. + */ + +#include + +/* Get Function from Function ID */ +int drvmgr_func_get(void *obj, int funcid, void **func) +{ + int objtype; + struct drvmgr_func *f; + + if (!obj) + return DRVMGR_FAIL; + objtype = *(int *)obj; + + if (objtype == DRVMGR_OBJ_BUS) + f = ((struct drvmgr_bus *)obj)->funcs; + else if (objtype == DRVMGR_OBJ_DRV) + f = ((struct drvmgr_drv *)obj)->funcs; + else + return DRVMGR_FAIL; + + if (f == NULL) + return DRVMGR_FAIL; + + while (f->funcid != DRVMGR_FUNCID_NONE) { + if (f->funcid == funcid) { + *func = f->func; + return DRVMGR_OK; + } + f++; + } + + return DRVMGR_FAIL; +} -- cgit v1.2.3