X-Git-Url: http://www.chiark.greenend.org.uk/ucgi/~ianmdlvl/git?a=blobdiff_plain;f=libsysfs%2Fsysfs_bus.c;h=921ef32094e1139f281040994cabfe3a96d9e938;hb=86eeb30e0c349ea7aab1713b0ede29029043ca54;hp=87318c0029c99336ce41720f6954d75e7b4a1792;hpb=0bad3406c1e8eba6d5af2cbfd44d8a61231fa2bb;p=elogind.git diff --git a/libsysfs/sysfs_bus.c b/libsysfs/sysfs_bus.c index 87318c002..921ef3209 100644 --- a/libsysfs/sysfs_bus.c +++ b/libsysfs/sysfs_bus.c @@ -3,7 +3,7 @@ * * Generic bus utility functions for libsysfs * - * Copyright (C) IBM Corp. 2003 + * Copyright (C) IBM Corp. 2003-2005 * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public @@ -20,7 +20,7 @@ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA * */ -#include "sysfs/libsysfs.h" +#include "libsysfs.h" #include "sysfs.h" static void sysfs_close_dev(void *dev) @@ -34,35 +34,19 @@ static void sysfs_close_drv(void *drv) } /* - * compares devices' bus ids. - * @a: device id looking for + * compares names. + * @a: name looked for * @b: sysfs_device comparing being compared - * returns 1 if a==b->bus_id or 0 not equal - */ -static int bus_device_id_equal(void *a, void *b) -{ - if (a == NULL || b == NULL) - return 0; - - if (strcmp(((unsigned char *)a), ((struct sysfs_device *)b)->bus_id) - == 0) - return 1; - return 0; -} - -/* - * compares drivers' names. - * @a: driver name looking for - * @b: sysfs_driver comparing being compared * returns 1 if a==b->name or 0 not equal */ -static int bus_driver_name_equal(void *a, void *b) +static int name_equal(void *a, void *b) { - if (a == NULL || b == NULL) + if (!a || !b) return 0; - if (strcmp(((unsigned char *)a), ((struct sysfs_driver *)b)->name) == 0) + if (strcmp(((char *)a), ((struct sysfs_device *)b)->name) == 0) return 1; + return 0; } @@ -72,9 +56,9 @@ static int bus_driver_name_equal(void *a, void *b) */ void sysfs_close_bus(struct sysfs_bus *bus) { - if (bus != NULL) { - if (bus->directory != NULL) - sysfs_close_directory(bus->directory); + if (bus) { + if (bus->attrlist) + dlist_destroy(bus->attrlist); if (bus->devices) dlist_destroy(bus->devices); if (bus->drivers) @@ -99,93 +83,103 @@ static struct sysfs_bus *alloc_bus(void) */ struct dlist *sysfs_get_bus_devices(struct sysfs_bus *bus) { - struct sysfs_device *bdev = NULL; - struct sysfs_directory *devdir = NULL; - struct sysfs_link *curl = NULL; - unsigned char path[SYSFS_PATH_MAX]; + struct sysfs_device *dev; + struct dlist *linklist; + char path[SYSFS_PATH_MAX], devpath[SYSFS_PATH_MAX]; + char target[SYSFS_PATH_MAX]; + char *curlink; - if (bus == NULL) { + if (!bus) { errno = EINVAL; return NULL; } memset(path, 0, SYSFS_PATH_MAX); - strcpy(path, bus->path); - strcat(path, "/"); - strcat(path, SYSFS_DEVICES_NAME); - devdir = sysfs_open_directory(path); - if (devdir == NULL) - return NULL; - - if (sysfs_read_dir_links(devdir) != 0) { - sysfs_close_directory(devdir); - return NULL; - } - - if (devdir->links != 0) { - dlist_for_each_data(devdir->links, curl, struct sysfs_link) { - bdev = sysfs_open_device_path(curl->target); - if (bdev == NULL) { + safestrcpy(path, bus->path); + safestrcat(path, "/"); + safestrcat(path, SYSFS_DEVICES_NAME); + + linklist = read_dir_links(path); + if (linklist) { + dlist_for_each_data(linklist, curlink, char) { + if (bus->devices) { + dev = (struct sysfs_device *) + dlist_find_custom(bus->devices, + (void *)curlink, name_equal); + if (dev) + continue; + } + safestrcpy(devpath, path); + safestrcat(devpath, "/"); + safestrcat(devpath, curlink); + if (sysfs_get_link(devpath, target, SYSFS_PATH_MAX)) { + dprintf("Error getting link - %s\n", devpath); + continue; + } + dev = sysfs_open_device_path(target); + if (!dev) { dprintf("Error opening device at %s\n", - curl->target); + target); continue; } - if (bus->devices == NULL) + if (!bus->devices) bus->devices = dlist_new_with_delete (sizeof(struct sysfs_device), sysfs_close_dev); - dlist_unshift(bus->devices, bdev); + dlist_unshift_sorted(bus->devices, dev, sort_list); } + sysfs_close_list(linklist); } - sysfs_close_directory(devdir); - return (bus->devices); } /** - * sysfs_get_bus_drivers: get all pci drivers - * @bus: pci bus to add drivers to - * returns dlist of drivers with success and NULL with error + * sysfs_get_bus_drivers: gets all drivers for bus + * @bus: bus to get devices for + * returns dlist of devices with success and NULL with failure */ struct dlist *sysfs_get_bus_drivers(struct sysfs_bus *bus) { - struct sysfs_driver *driver = NULL; - struct sysfs_directory *drvdir = NULL; - struct sysfs_directory *cursub = NULL; - unsigned char path[SYSFS_PATH_MAX]; + struct sysfs_driver *drv; + struct dlist *dirlist; + char path[SYSFS_PATH_MAX], drvpath[SYSFS_PATH_MAX]; + char *curdir; - if (bus == NULL) { + if (!bus) { errno = EINVAL; return NULL; } memset(path, 0, SYSFS_PATH_MAX); - strcpy(path, bus->path); - strcat(path, "/"); - strcat(path, SYSFS_DRIVERS_NAME); - drvdir = sysfs_open_directory(path); - if (drvdir == NULL) - return NULL; - - if (sysfs_read_dir_subdirs(drvdir) != 0) { - sysfs_close_directory(drvdir); - return NULL; - } - if (drvdir->subdirs != NULL) { - dlist_for_each_data(drvdir->subdirs, cursub, - struct sysfs_directory) { - driver = sysfs_open_driver_path(cursub->path); - if (driver == NULL) { + safestrcpy(path, bus->path); + safestrcat(path, "/"); + safestrcat(path, SYSFS_DRIVERS_NAME); + + dirlist = read_dir_subdirs(path); + if (dirlist) { + dlist_for_each_data(dirlist, curdir, char) { + if (bus->drivers) { + drv = (struct sysfs_driver *) + dlist_find_custom(bus->drivers, + (void *)curdir, name_equal); + if (drv) + continue; + } + safestrcpy(drvpath, path); + safestrcat(drvpath, "/"); + safestrcat(drvpath, curdir); + drv = sysfs_open_driver_path(drvpath); + if (!drv) { dprintf("Error opening driver at %s\n", - cursub->path); + drvpath); continue; } - if (bus->drivers == NULL) + if (!bus->drivers) bus->drivers = dlist_new_with_delete (sizeof(struct sysfs_driver), sysfs_close_drv); - dlist_unshift(bus->drivers, driver); + dlist_unshift_sorted(bus->drivers, drv, sort_list); } + sysfs_close_list(dirlist); } - sysfs_close_directory(drvdir); return (bus->drivers); } @@ -193,38 +187,38 @@ struct dlist *sysfs_get_bus_drivers(struct sysfs_bus *bus) * sysfs_open_bus: opens specific bus and all its devices on system * returns sysfs_bus structure with success or NULL with error. */ -struct sysfs_bus *sysfs_open_bus(const unsigned char *name) +struct sysfs_bus *sysfs_open_bus(const char *name) { - struct sysfs_bus *bus = NULL; - unsigned char buspath[SYSFS_PATH_MAX]; + struct sysfs_bus *bus; + char buspath[SYSFS_PATH_MAX]; - if (name == NULL) { + if (!name) { errno = EINVAL; return NULL; } memset(buspath, 0, SYSFS_PATH_MAX); - if ((sysfs_get_mnt_path(buspath, SYSFS_PATH_MAX)) != 0) { + if (sysfs_get_mnt_path(buspath, SYSFS_PATH_MAX)) { dprintf("Sysfs not supported on this system\n"); return NULL; } - strcat(buspath, "/"); - strcat(buspath, SYSFS_BUS_NAME); - strcat(buspath, "/"); - strcat(buspath, name); - if ((sysfs_path_is_dir(buspath)) != 0) { + safestrcat(buspath, "/"); + safestrcat(buspath, SYSFS_BUS_NAME); + safestrcat(buspath, "/"); + safestrcat(buspath, name); + if (sysfs_path_is_dir(buspath)) { dprintf("Invalid path to bus: %s\n", buspath); return NULL; } bus = alloc_bus(); - if (bus == NULL) { + if (!bus) { dprintf("calloc failed\n"); return NULL; } - strcpy(bus->name, name); - strcpy(bus->path, buspath); - if ((sysfs_remove_trailing_slash(bus->path)) != 0) { + safestrcpy(bus->name, name); + safestrcpy(bus->path, buspath); + if (sysfs_remove_trailing_slash(bus->path)) { dprintf("Incorrect path to bus %s\n", bus->path); sysfs_close_bus(bus); return NULL; @@ -240,21 +234,44 @@ struct sysfs_bus *sysfs_open_bus(const unsigned char *name) * returns struct sysfs_device reference or NULL if not found. */ struct sysfs_device *sysfs_get_bus_device(struct sysfs_bus *bus, - unsigned char *id) + const char *id) { - if (bus == NULL || id == NULL) { + struct sysfs_device *dev = NULL; + char devpath[SYSFS_PATH_MAX], target[SYSFS_PATH_MAX]; + + if (!bus || !id) { errno = EINVAL; return NULL; } - if (bus->devices == NULL) { - bus->devices = sysfs_get_bus_devices(bus); - if (bus->devices == NULL) + if (bus->devices) { + dev = (struct sysfs_device *)dlist_find_custom + (bus->devices, (void *)id, name_equal); + if (dev) + return dev; + } + safestrcpy(devpath, bus->path); + safestrcat(devpath, "/"); + safestrcat(devpath, SYSFS_DEVICES_NAME); + safestrcat(devpath, "/"); + safestrcat(devpath, id); + if (sysfs_path_is_link(devpath)) { + dprintf("No such device %s on bus %s?\n", id, bus->name); + return NULL; + } + if (!sysfs_get_link(devpath, target, SYSFS_PATH_MAX)) { + dev = sysfs_open_device_path(target); + if (!dev) { + dprintf("Error opening device at %s\n", target); return NULL; + } + if (!bus->devices) + bus->devices = dlist_new_with_delete + (sizeof(struct sysfs_device), + sysfs_close_dev); + dlist_unshift_sorted(bus->devices, dev, sort_list); } - - return (struct sysfs_device *)dlist_find_custom(bus->devices, id, - bus_device_id_equal); + return dev; } /** @@ -263,184 +280,38 @@ struct sysfs_device *sysfs_get_bus_device(struct sysfs_bus *bus, * @drvname: name of driver * returns struct sysfs_driver reference or NULL if not found. */ -struct sysfs_driver *sysfs_get_bus_driver(struct sysfs_bus *bus, - unsigned char *drvname) -{ - if (bus == NULL || drvname == NULL) { - errno = EINVAL; - return NULL; - } - - if (bus->drivers == NULL) { - bus->drivers = sysfs_get_bus_drivers(bus); - if (bus->drivers == NULL) - return NULL; - } - - return (struct sysfs_driver *)dlist_find_custom(bus->drivers, drvname, - bus_driver_name_equal); -} - -/** - * sysfs_get_bus_attributes: returns bus' dlist of attributes - * @bus: bus to get attributes for. - * returns dlist of attributes or NULL if there aren't any. - */ -struct dlist *sysfs_get_bus_attributes(struct sysfs_bus *bus) -{ - if (bus == NULL) - return NULL; - - if (bus->directory == NULL) { - bus->directory = sysfs_open_directory(bus->path); - if (bus->directory == NULL) - return NULL; - } - if (bus->directory->attributes == NULL) { - if ((sysfs_read_dir_attributes(bus->directory)) != 0) - return NULL; - } - return bus->directory->attributes; -} - -/** - * sysfs_refresh_bus_attributes: refreshes the bus's list of attributes - * @bus: sysfs_bus whose attributes to refresh - * - * NOTE: Upon return, prior references to sysfs_attributes for this bus - * _may_ not be valid - * - * Returns list of attributes on success and NULL on failure - */ -struct dlist *sysfs_refresh_bus_attributes(struct sysfs_bus *bus) -{ - if (bus == NULL) { - errno = EINVAL; - return NULL; - } - - if (bus->directory == NULL) - return (sysfs_get_bus_attributes(bus)); - - if ((sysfs_refresh_dir_attributes(bus->directory)) != 0) { - dprintf("Error refreshing bus attributes\n"); - return NULL; - } - - return (bus->directory->attributes); -} - -/** - * sysfs_get_bus_attribute: gets a specific bus attribute, if buses had - * attributes. - * @bus: bus to retrieve attribute from - * @attrname: attribute name to retrieve - * returns reference to sysfs_attribute if found or NULL if not found - */ -struct sysfs_attribute *sysfs_get_bus_attribute(struct sysfs_bus *bus, - unsigned char *attrname) +struct sysfs_driver *sysfs_get_bus_driver(struct sysfs_bus *bus, + const char *drvname) { - struct dlist *attrlist = NULL; - - if (bus == NULL) { - errno = EINVAL; - return NULL; - } - attrlist = sysfs_get_bus_attributes(bus); - if (attrlist == NULL) - return NULL; + struct sysfs_driver *drv; + char drvpath[SYSFS_PATH_MAX]; - return sysfs_get_directory_attribute(bus->directory, attrname); -} - -/** - * sysfs_open_bus_device: locates a device on a bus and returns it. Device - * must be closed using sysfs_close_device. - * @busname: Name of bus to search - * @dev_id: Id of device on bus. - * returns sysfs_device if found or NULL if not. - */ -struct sysfs_device *sysfs_open_bus_device(unsigned char *busname, - unsigned char *dev_id) -{ - struct sysfs_device *rdev = NULL; - char path[SYSFS_PATH_MAX]; - - if (busname == NULL || dev_id == NULL) { + if (!bus || !drvname) { errno = EINVAL; return NULL; } - memset(path, 0, SYSFS_PATH_MAX); - if (sysfs_get_mnt_path(path, SYSFS_PATH_MAX) != 0) { - dprintf("Error getting sysfs mount point\n"); - return NULL; + if (bus->drivers) { + drv = (struct sysfs_driver *)dlist_find_custom + (bus->drivers, (void *)drvname, name_equal); + if (drv) + return drv; } - - strcat(path, "/"); - strcat(path, SYSFS_BUS_NAME); - strcat(path, "/"); - strcat(path, busname); - strcat(path, "/"); - strcat(path, SYSFS_DEVICES_NAME); - strcat(path, "/"); - strcat(path, dev_id); - - rdev = sysfs_open_device_path(path); - if (rdev == NULL) { - dprintf("Error getting device %s on bus %s\n", - dev_id, busname); + safestrcpy(drvpath, bus->path); + safestrcat(drvpath, "/"); + safestrcat(drvpath, SYSFS_DRIVERS_NAME); + safestrcat(drvpath, "/"); + safestrcat(drvpath, drvname); + drv = sysfs_open_driver_path(drvpath); + if (!drv) { + dprintf("Error opening driver at %s\n", drvpath); return NULL; } - - return rdev; + if (!bus->drivers) + bus->drivers = dlist_new_with_delete + (sizeof(struct sysfs_driver), + sysfs_close_drv); + dlist_unshift_sorted(bus->drivers, drv, sort_list); + return drv; } -/** - * sysfs_find_driver_bus: locates the bus the driver is on. - * @driver: name of the driver to locate - * @busname: buffer to copy name to - * @bsize: buffer size - * returns 0 with success, -1 with error - */ -int sysfs_find_driver_bus(const unsigned char *driver, unsigned char *busname, - size_t bsize) -{ - unsigned char subsys[SYSFS_PATH_MAX], *bus = NULL, *curdrv = NULL; - struct dlist *buslist = NULL, *drivers = NULL; - - if (driver == NULL || busname == NULL) { - errno = EINVAL; - return -1; - } - - memset(subsys, 0, SYSFS_PATH_MAX); - strcat(subsys, "/"); - strcpy(subsys, SYSFS_BUS_NAME); - buslist = sysfs_open_subsystem_list(subsys); - if (buslist != NULL) { - dlist_for_each_data(buslist, bus, char) { - memset(subsys, 0, SYSFS_PATH_MAX); - strcat(subsys, "/"); - strcpy(subsys, SYSFS_BUS_NAME); - strcat(subsys, "/"); - strcat(subsys, bus); - strcat(subsys, "/"); - strcat(subsys, SYSFS_DRIVERS_NAME); - drivers = sysfs_open_subsystem_list(subsys); - if (drivers != NULL) { - dlist_for_each_data(drivers, curdrv, char) { - if (strcmp(driver, curdrv) == 0) { - strncpy(busname, bus, bsize); - sysfs_close_list(drivers); - sysfs_close_list(buslist); - return 0; - } - } - sysfs_close_list(drivers); - } - } - sysfs_close_list(buslist); - } - return -1; -}