diff options
author | Daniel Hellstrom <daniel@gaisler.com> | 2011-11-28 09:52:03 +0100 |
---|---|---|
committer | Daniel Hellstrom <daniel@gaisler.com> | 2015-04-17 01:10:16 +0200 |
commit | e7fade3ac4559214ab0508dc54a71a3d1f522afb (patch) | |
tree | 13e32728a3b6adccd3f435db73091a8233d5dadf /cpukit/libdrvmgr/drvmgr_func.c | |
parent | LIBPCI: added PCI shell command (diff) | |
download | rtems-e7fade3ac4559214ab0508dc54a71a3d1f522afb.tar.bz2 |
DRVMGR: added driver manager to cpukit/libdrvmgr
Diffstat (limited to 'cpukit/libdrvmgr/drvmgr_func.c')
-rw-r--r-- | cpukit/libdrvmgr/drvmgr_func.c | 42 |
1 files changed, 42 insertions, 0 deletions
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 <drvmgr/drvmgr.h> + +/* 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; +} |