chiark / gitweb /
[PATCH] udev - drop all methods :)
[elogind.git] / libsysfs / sysfs_bus.c
index b2e2b2d..d9da0f8 100644 (file)
@@ -3,7 +3,7 @@
  *
  * Generic bus utility functions for libsysfs
  *
  *
  * Generic bus utility functions for libsysfs
  *
- * Copyright (C) 2003 International Business Machines, Inc.
+ * Copyright (C) IBM Corp. 2003
  *
  *  This library is free software; you can redistribute it and/or
  *  modify it under the terms of the GNU Lesser General Public
  *
  *  This library is free software; you can redistribute it and/or
  *  modify it under the terms of the GNU Lesser General Public
 #include "libsysfs.h"
 #include "sysfs.h"
 
 #include "libsysfs.h"
 #include "sysfs.h"
 
+static void sysfs_close_dev(void *dev)
+{
+        sysfs_close_device((struct sysfs_device *)dev);
+}
+
+static void sysfs_close_drv(void *drv)
+{
+        sysfs_close_driver((struct sysfs_driver *)drv);
+}
+
+/*
+ * compares devices' bus ids.
+ * @a: device id looking 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)
+{
+       if (a == NULL || b == NULL)
+               return 0;
+
+       if (strcmp(((unsigned char *)a), ((struct sysfs_driver *)b)->name) == 0)
+               return 1;
+       return 0;
+}
+
 /**
  * sysfs_close_bus: close single bus
  * @bus: bus structure
  */
 void sysfs_close_bus(struct sysfs_bus *bus)
 {
 /**
  * sysfs_close_bus: close single bus
  * @bus: bus structure
  */
 void sysfs_close_bus(struct sysfs_bus *bus)
 {
-       struct sysfs_device *curdev = NULL, *nextdev = NULL;
-       struct sysfs_driver *curdrv = NULL, *nextdrv = NULL;
-
        if (bus != NULL) {
                if (bus->directory != NULL)
                        sysfs_close_directory(bus->directory);
        if (bus != NULL) {
                if (bus->directory != NULL)
                        sysfs_close_directory(bus->directory);
-               for (curdev = bus->devices; curdev != NULL;
-                    curdev = nextdev) {
-                       nextdev = curdev->next;
-                       sysfs_close_device(curdev);
-               }
-               for (curdrv = bus->drivers; curdrv != NULL;
-                    curdrv = nextdrv) {
-                       nextdrv = curdrv->next;
-                       sysfs_close_driver(curdrv);
-               }
+               if (bus->devices)
+                       dlist_destroy(bus->devices);
+               if (bus->drivers)
+                       dlist_destroy(bus->drivers);
                free(bus);
        }
 }
                free(bus);
        }
 }
@@ -59,243 +93,335 @@ static struct sysfs_bus *alloc_bus(void)
 }
 
 /**
 }
 
 /**
- * open_bus_dir: opens up sysfs bus directory
- * returns sysfs_directory struct with success and NULL with error
+ * sysfs_get_bus_devices: gets all devices for bus
+ * @bus: bus to get devices for
+ * returns dlist of devices with success and NULL with failure
  */
  */
-static struct sysfs_directory *open_bus_dir(const char *name)
+struct dlist *sysfs_get_bus_devices(struct sysfs_bus *bus)
 {
 {
-       struct sysfs_directory *busdir = NULL, *cur = NULL, *next = NULL;
-       char buspath[SYSFS_PATH_MAX];
+       struct sysfs_device *bdev = NULL;
+       struct sysfs_directory *devdir = NULL;
+       struct sysfs_link *curl = NULL;
+       unsigned char path[SYSFS_PATH_MAX];
 
 
-       if (name == NULL) {
+       if (bus == NULL) {
                errno = EINVAL;
                return NULL;
        }
                errno = EINVAL;
                return NULL;
        }
-
-       memset(buspath, 0, SYSFS_PATH_MAX);
-       if ((sysfs_get_mnt_path(buspath, SYSFS_PATH_MAX)) != 0) {
-               dprintf(stderr, "Sysfs not supported on this system\n");
+       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;
                return NULL;
-       }
 
 
-       strcat(buspath, SYSFS_BUS_DIR);
-       strcat(buspath, "/");
-       strcat(buspath, name);
-       busdir = sysfs_open_directory(buspath);
-       if (busdir == NULL) {
-               errno = EINVAL;
-               dprintf(stderr,"Bus %s not supported on this system\n",
-                       name);
-               return NULL;
-       }
-       if ((sysfs_read_directory(busdir)) != 0) {
-               dprintf(stderr, "Error reading %s bus dir %s\n", name, 
-                       buspath);
-               sysfs_close_directory(busdir);
+       if (sysfs_read_dir_links(devdir) != 0) {
+               sysfs_close_directory(devdir);
                return NULL;
        }
                return NULL;
        }
-       /* read in devices and drivers subdirs */
-       for (cur = busdir->subdirs; cur != NULL; cur = next) {
-               next = cur->next;
-               if ((sysfs_read_directory(cur)) != 0)
-                       continue;
+
+       if (devdir->links != 0) {
+               dlist_for_each_data(devdir->links, curl, struct sysfs_link) {
+                       bdev = sysfs_open_device_path(curl->target);
+                       if (bdev == NULL) {
+                               dprintf("Error opening device at %s\n", 
+                                                               curl->target);
+                               continue;
+                       }
+                       if (bus->devices == NULL)
+                               bus->devices = dlist_new_with_delete
+                                       (sizeof(struct sysfs_device), 
+                                                       sysfs_close_dev);
+                       dlist_unshift(bus->devices, bdev);
+               }
        }
        }
+       sysfs_close_directory(devdir);
 
 
-       return busdir;
+       return (bus->devices);
 }
 
 /**
 }
 
 /**
- * add_dev_to_bus: adds a bus device to bus device list
- * @bus: bus to add the device
- * @dev: device to add
+ * 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
  */
  */
-static void add_dev_to_bus(struct sysfs_bus *bus, struct sysfs_device *dev)
+struct dlist *sysfs_get_bus_drivers(struct sysfs_bus *bus)
 {
 {
-       if (bus != NULL && dev != NULL) {
-               dev->next = bus->devices;
-               bus->devices = dev;
+       struct sysfs_driver *driver = NULL;
+       struct sysfs_directory *drvdir = NULL;
+       struct sysfs_directory *cursub = NULL;
+       unsigned char path[SYSFS_PATH_MAX];
+
+       if (bus == NULL) {
+               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) {
+                               dprintf("Error opening driver at %s\n", 
+                                                               cursub->path);
+                               continue;
+                       }
+                       if (bus->drivers == NULL)
+                               bus->drivers = dlist_new_with_delete
+                                       (sizeof(struct sysfs_driver), 
+                                                       sysfs_close_drv);
+                       dlist_unshift(bus->drivers, driver);
+               }
+       }
+       sysfs_close_directory(drvdir);
+       return (bus->drivers);
 }
 
 /**
 }
 
 /**
- * add_driver_to_bus: adds a bus driver to bus driver list
- * @bus: bus to add driver to
- * @driver: driver to add
+ * sysfs_open_bus: opens specific bus and all its devices on system
+ * returns sysfs_bus structure with success or NULL with error.
  */
  */
-static void add_driver_to_bus(struct sysfs_bus *bus, 
-                               struct sysfs_driver *driver)
+struct sysfs_bus *sysfs_open_bus(const unsigned char *name)
 {
 {
-       if (bus != NULL && driver != NULL) {
-               driver->next = bus->drivers;
-               bus->drivers = driver;
+       struct sysfs_bus *bus = NULL;
+       unsigned char buspath[SYSFS_PATH_MAX];
+
+       if (name == NULL) {
+               errno = EINVAL;
+               return NULL;
        }
        }
+
+       memset(buspath, 0, SYSFS_PATH_MAX);
+       if ((sysfs_get_mnt_path(buspath, SYSFS_PATH_MAX)) != 0) {
+               dprintf("Sysfs not supported on this system\n");
+               return NULL;
+       }
+
+       if (sysfs_trailing_slash(buspath) == 0)
+               strcat(buspath, "/");
+
+       strcat(buspath, SYSFS_BUS_NAME);
+       strcat(buspath, "/");
+       strcat(buspath, name);
+       if ((sysfs_path_is_dir(buspath)) != 0) {
+               dprintf("Invalid path to bus: %s\n", buspath);
+               return NULL;
+       }
+       bus = alloc_bus();
+       if (bus == NULL) {
+               dprintf("calloc failed\n");
+               return NULL;
+       }
+       strcpy(bus->name, name);        
+       strcpy(bus->path, buspath);
+
+       return bus;
 }
 
 /**
 }
 
 /**
- * get_all_bus_devices: gets all devices for bus
- * @bus: bus to get devices for
- * returns 0 with success and -1 with failure
+ * sysfs_get_bus_device: Get specific device on bus using device's id
+ * @bus: bus to find device on
+ * @id: bus_id for device
+ * returns struct sysfs_device reference or NULL if not found.
  */
  */
-static int get_all_bus_devices(struct sysfs_bus *bus)
+struct sysfs_device *sysfs_get_bus_device(struct sysfs_bus *bus, 
+                                                       unsigned char *id)
 {
 {
-       struct sysfs_device *bdev = NULL;
-       struct sysfs_directory *cur = NULL;
-       struct sysfs_dlink *curl = NULL, *nextl = NULL;
-       char dirname[SYSFS_NAME_LEN];
-
-       if (bus == NULL || bus->directory == NULL) {
+       if (bus == NULL || id == NULL) {
                errno = EINVAL;
                errno = EINVAL;
-               return -1;
+               return NULL;
        }
        }
-       for (cur = bus->directory->subdirs; cur != NULL; cur = cur->next) {
-               memset(dirname, 0, SYSFS_NAME_LEN);
-               if ((sysfs_get_name_from_path(cur->path, dirname,
-                   SYSFS_NAME_LEN)) != 0)
-                       continue;
-               if (strcmp(dirname, SYSFS_DEVICES_NAME) != 0)
-                       continue;
-               for (curl = cur->links; curl != NULL; curl = nextl) {
-                       nextl = curl->next;
-                       bdev = sysfs_open_device(curl->target->path);
-                       if (bdev == NULL) {
-                               dprintf(stderr, "Error opening device at %s\n",
-                                       curl->target->path);
-                               continue;
-                       }
-                       add_dev_to_bus(bus, bdev);
-               }
+
+       if (bus->devices == NULL) {
+               bus->devices = sysfs_get_bus_devices(bus);
+               if (bus->devices == NULL)
+                       return NULL;
        }
        }
-                       
-       return 0;
+               
+       return (struct sysfs_device *)dlist_find_custom(bus->devices, id,
+               bus_device_id_equal);
 }
 
 /**
 }
 
 /**
- * get_all_bus_drivers: get all pci drivers
- * @bus: pci bus to add drivers to
- * returns 0 with success and -1 with error
+ * sysfs_get_bus_driver: Get specific driver on bus using driver name
+ * @bus: bus to find driver on
+ * @drvname: name of driver
+ * returns struct sysfs_driver reference or NULL if not found.
  */
  */
-static int get_all_bus_drivers(struct sysfs_bus *bus)
+struct sysfs_driver *sysfs_get_bus_driver(struct sysfs_bus *bus, 
+                                                       unsigned char *drvname)
 {
 {
-       struct sysfs_driver *driver = NULL;
-       struct sysfs_directory *cur = NULL, *next = NULL;
-       struct sysfs_directory *cursub = NULL, *nextsub = NULL;
-       char dirname[SYSFS_NAME_LEN];
-
-       if (bus == NULL || bus->directory == NULL) {
+       if (bus == NULL || drvname == NULL) {
                errno = EINVAL;
                errno = EINVAL;
-               return -1;
+               return NULL;
        }
        }
-       for (cur = bus->directory->subdirs; cur != NULL; cur = next) {
-               next = cur->next;
-               memset(dirname, 0, SYSFS_NAME_LEN);
-               if ((sysfs_get_name_from_path(cur->path, dirname,
-                   SYSFS_NAME_LEN)) != 0)
-                       continue;
-               if (strcmp(dirname, SYSFS_DRIVERS_NAME) != 0)
-                       continue;
-               for (cursub = cur->subdirs; cursub != NULL; cursub = nextsub) {
-                       nextsub = cursub->next;
-                       driver = sysfs_open_driver(cursub->path);
-                       if (driver == NULL) {
-                               dprintf(stderr, "Error opening driver at %s\n",
-                                       cursub->path);
-                               continue;
-                       }
-                       add_driver_to_bus(bus, driver);
-               }
+
+       if (bus->drivers == NULL) {
+               bus->drivers = sysfs_get_bus_drivers(bus);
+               if (bus->drivers == NULL)
+                       return NULL;
        }
        
        }
        
-       return 0;
+       return (struct sysfs_driver *)dlist_find_custom(bus->drivers, drvname,
+               bus_driver_name_equal);
 }
 
 /**
 }
 
 /**
- * match_bus_device_to_driver: returns 1 if device is bound to driver
- * @driver: driver to match
- * @busid: busid of device to match
- * returns 1 if found and 0 if not found
+ * 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.
  */
  */
-static int match_bus_device_to_driver(struct sysfs_driver *driver, char *busid)
+struct dlist *sysfs_get_bus_attributes(struct sysfs_bus *bus)
 {
 {
-       struct sysfs_dlink *cur = NULL, *next = NULL;
-       int found = 0;
+       if (bus == NULL)
+               return NULL;
 
 
-       if (driver == NULL || driver->directory == NULL || busid == NULL) {
-               errno = EINVAL;
-               return found;
+       if (bus->directory == NULL) {
+               bus->directory = sysfs_open_directory(bus->path);
+               if (bus->directory == NULL)
+                       return NULL;
        }
        }
-       for (cur = driver->directory->links; cur != NULL && found == 0;
-            cur = next) {
-               next = cur->next;
-               if ((strcmp(cur->name, busid)) == 0)
-                       found++;
+       if (bus->directory->attributes == NULL) {
+               if ((sysfs_read_dir_attributes(bus->directory)) != 0) 
+                       return NULL;
+       } else {
+               if ((sysfs_path_is_dir(bus->path)) != 0) {
+                       dprintf("Bus at %s no longer exists\n", bus->path);
+                       return NULL;
+               }
+               if ((sysfs_refresh_attributes
+                                       (bus->directory->attributes)) != 0) {
+                       dprintf("Error refreshing bus attributes\n");
+                       return NULL;
+               }
        }
        }
-       return found;
+       return bus->directory->attributes;
 }
 
 /**
 }
 
 /**
- * link_bus_devices_to_drivers: goes through and links devices to drivers
- * @bus: bus to link
+ * 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
  */
  */
-static void link_bus_devices_to_drivers(struct sysfs_bus *bus)
+struct sysfs_attribute *sysfs_get_bus_attribute(struct sysfs_bus *bus,
+                                               unsigned char *attrname)
 {
 {
-       struct sysfs_device *dev = NULL, *nextdev = NULL;
-       struct sysfs_driver *drv = NULL, *nextdrv = NULL;
+       struct dlist *attrlist = NULL;
        
        
-       if (bus != NULL && bus->devices != NULL && bus->drivers != NULL) {
-               for (dev = bus->devices; dev != NULL; dev = nextdev) {
-                       nextdev = dev->next;
-
-                       for (drv = bus->drivers; drv != NULL; drv = nextdrv) {
-                               nextdrv = drv->next;
-                               if ((match_bus_device_to_driver(drv, 
-                                   dev->bus_id)) != 0) {
-                                       dev->driver = drv;
-                                       drv->device = dev;
-                               }
-                       }
-               }
+       if (bus == NULL) {
+               errno = EINVAL;
+               return NULL;
        }
        }
+       attrlist = sysfs_get_bus_attributes(bus);
+       if (attrlist == NULL)
+               return NULL;
+       
+       return sysfs_get_directory_attribute(bus->directory, attrname);
 }
 
 /**
 }
 
 /**
- * sysfs_open_bus: opens specific bus and all its devices on system
- * returns sysfs_bus structure with success or NULL with error.
+ * 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_bus *sysfs_open_bus(const char *name)
+struct sysfs_device *sysfs_open_bus_device(unsigned char *busname, 
+                                                       unsigned char *dev_id)
 {
 {
-       struct sysfs_bus *bus = NULL;
-       struct sysfs_directory *busdir = NULL;
+       struct sysfs_device *rdev = NULL;
+       char path[SYSFS_PATH_MAX];
 
 
-       if (name == NULL) {
+       if (busname == NULL || dev_id == NULL) {
                errno = EINVAL;
                return NULL;
        }
 
                errno = EINVAL;
                return NULL;
        }
 
-       bus = alloc_bus();
-       if (bus == NULL) {
-               perror("malloc");
-               return NULL;
-       }
-       strcpy(bus->name, name);        
-       busdir = open_bus_dir(name);
-       if (busdir == NULL) {
-               dprintf(stderr,"Invalid bus, %s not supported on this system\n",
-                       name);
-               sysfs_close_bus(bus);
+       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;
        }
                return NULL;
        }
-       bus->directory = busdir;
-       if ((get_all_bus_devices(bus)) != 0) {
-               dprintf(stderr, "Error reading %s bus devices\n", name);
-               sysfs_close_bus(bus);
+
+       if (sysfs_trailing_slash(path) == 0)
+               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);
                return NULL;
        }
                return NULL;
        }
-       if ((get_all_bus_drivers(bus)) != 0) {
-               dprintf(stderr, "Error reading %s bus drivers\n", name);
-               sysfs_close_bus(bus);
-               return NULL;
+       
+       return rdev;
+}
+
+/**
+ * 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;
        }
        }
-       link_bus_devices_to_drivers(bus);
 
 
-       return bus;
+       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;
 }
 }