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_for_each_list_dev.c | 44 +++++++++++++++++++++++++++++ 1 file changed, 44 insertions(+) create mode 100644 cpukit/libdrvmgr/drvmgr_for_each_list_dev.c (limited to 'cpukit/libdrvmgr/drvmgr_for_each_list_dev.c') diff --git a/cpukit/libdrvmgr/drvmgr_for_each_list_dev.c b/cpukit/libdrvmgr/drvmgr_for_each_list_dev.c new file mode 100644 index 0000000000..9e1b95b8ff --- /dev/null +++ b/cpukit/libdrvmgr/drvmgr_for_each_list_dev.c @@ -0,0 +1,44 @@ +/* Iterate over one list of devices used internally by driver manager + * + * COPYRIGHT (c) 2009. + * 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 +#include +#include "drvmgr_internal.h" + +int drvmgr_for_each_listdev( + struct drvmgr_list *devlist, + unsigned int state_set_mask, + unsigned int state_clr_mask, + int (*func)(struct drvmgr_dev *dev, void *arg), + void *arg + ) +{ + struct drvmgr_dev *dev; + int ret = 0; + + DRVMGR_LOCK_READ(); + + /* Get First Device */ + dev = DEV_LIST_HEAD(devlist); + while (dev) { + if (((state_set_mask != 0) && ((dev->state & state_set_mask) == state_set_mask)) || + ((state_clr_mask != 0) && ((dev->state & state_clr_mask) == 0)) || + ((state_set_mask == 0) && (state_clr_mask == 0))) { + ret = func(dev, arg); + if (ret != 0) + break; + } + dev = dev->next; + } + + DRVMGR_UNLOCK(); + + return ret; +} -- cgit v1.2.3