/** * @file me_slist.c * * @brief Implements the subdevice list class. * @note Copyright (C) 2007 Meilhaus Electronic GmbH (support@meilhaus.de) * @author Guenter Gebhardt */ /* * Copyright (C) 2007 Meilhaus Electronic GmbH (support@meilhaus.de) * * This file is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include "meerror.h" #include "medefines.h" #include "meslist.h" #include "medebug.h" int me_slist_query_number_subdevices(struct me_slist *slist, int *number) { PDEBUG_LOCKS("called.\n"); *number = slist->n; return ME_ERRNO_SUCCESS; } unsigned int me_slist_get_number_subdevices(struct me_slist *slist) { PDEBUG_LOCKS("called.\n"); return slist->n; } me_subdevice_t *me_slist_get_subdevice(struct me_slist * slist, unsigned int index) { struct list_head *pos; me_subdevice_t *subdevice = NULL; unsigned int i = 0; PDEBUG_LOCKS("called.\n"); if (index >= slist->n) { PERROR("Index out of range.\n"); return NULL; } list_for_each(pos, &slist->head) { if (i == index) { subdevice = list_entry(pos, me_subdevice_t, list); break; } ++i; } return subdevice; } int me_slist_get_subdevice_by_type(struct me_slist *slist, unsigned int start_subdevice, int type, int subtype, int *subdevice) { me_subdevice_t *pos; int s_type, s_subtype; unsigned int index = 0; PDEBUG_LOCKS("called.\n"); if (start_subdevice >= slist->n) { PERROR("Start index out of range.\n"); return ME_ERRNO_NOMORE_SUBDEVICE_TYPE; } list_for_each_entry(pos, &slist->head, list) { if (index < start_subdevice) { // Go forward to start subdevice. ++index; continue; } pos->me_subdevice_query_subdevice_type(pos, &s_type, &s_subtype); if (subtype == ME_SUBTYPE_ANY) { if (s_type == type) break; } else { if ((s_type == type) && (s_subtype == subtype)) break; } ++index; } if (index >= slist->n) { return ME_ERRNO_NOMORE_SUBDEVICE_TYPE; } *subdevice = index; return ME_ERRNO_SUCCESS; } void me_slist_add_subdevice_tail(struct me_slist *slist, me_subdevice_t * subdevice) { PDEBUG_LOCKS("called.\n"); list_add_tail(&subdevice->list, &slist->head); ++slist->n; } me_subdevice_t *me_slist_del_subdevice_tail(struct me_slist *slist) { struct list_head *last; me_subdevice_t *subdevice; PDEBUG_LOCKS("called.\n"); if (list_empty(&slist->head)) return NULL; last = slist->head.prev; subdevice = list_entry(last, me_subdevice_t, list); list_del(last); --slist->n; return subdevice; } int me_slist_init(me_slist_t * slist) { PDEBUG_LOCKS("called.\n"); INIT_LIST_HEAD(&slist->head); slist->n = 0; return 0; } void me_slist_deinit(me_slist_t * slist) { struct list_head *s; me_subdevice_t *subdevice; PDEBUG_LOCKS("called.\n"); while (!list_empty(&slist->head)) { s = slist->head.next; list_del(s); subdevice = list_entry(s, me_subdevice_t, list); subdevice->me_subdevice_destructor(subdevice); } slist->n = 0; }