-static int match_name_and_get_number(const char *base, const char *devname)
-{
- size_t baselen;
- char *endptr;
- int num;
-
- baselen = strlen(base);
- if (strncmp(base, devname, baselen) != 0)
- return -1;
- if (devname[baselen] == '\0')
- return 0;
- if (!isdigit(devname[baselen]))
- return -1;
- num = strtoul(&devname[baselen], &endptr, 10);
- if (endptr[0] != '\0')
- return -1;
- return num;
-}
-
-/* finds the lowest positive device number such that <name>N isn't present in the udevdb
- * if <name> doesn't exist, 0 is returned, N otherwise */
-static int find_free_number(const char *base, const char *devpath)
-{
- char db_devpath[PATH_SIZE];
- char filename[PATH_SIZE];
- struct udevice udev_db;
- int num = 0;
-
- /* check if the device already owns a matching name */
- udev_init_device(&udev_db, NULL, NULL, NULL);
- if (udev_db_get_device(&udev_db, devpath) == 0) {
- struct name_entry *name_loop;
- int devnum;
-
- devnum = match_name_and_get_number(base, udev_db.name);
- if (devnum >= 0) {
- num = devnum;
- dbg("device '%s', already has the node '%s' with num %u, use it", devpath, base, num);
- goto out;
- }
- list_for_each_entry(name_loop, &udev_db.symlink_list, node) {
- devnum = match_name_and_get_number(base, name_loop->name);
- if (devnum >= 0) {
- num = devnum;
- dbg("device '%s', already has a symlink '%s' with num %u, use it", devpath, base, num);
- goto out;
- }
- }
- }
-
- /* just search the database again and again until a free name is found */
- strlcpy(filename, base, sizeof(filename));
- while (1) {
- dbg("look for existing node '%s'", filename);
- if (udev_db_lookup_name(filename, db_devpath, sizeof(db_devpath)) != 0) {
- dbg("free num=%d", num);
- break;
- }
-
- num++;
- if (num > 100000) {
- err("find_free_number aborted at num=%d", num);
- num = -1;
- break;
- }
- snprintf(filename, sizeof(filename), "%s%d", base, num);
- filename[sizeof(filename)-1] = '\0';
- }
-
-out:
- udev_cleanup_device(&udev_db);
- return num;
-}
-
-static int find_sysfs_attribute(struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device,
- const char *name, char *value, size_t len)
-{
- struct sysfs_class_device *class_dev_parent;
- struct sysfs_attribute *tmpattr;
-
- dbg("look for device attribute '%s'", name);
- if (class_dev) {
- dbg("look for class attribute '%s/%s'", class_dev->path, name);
- tmpattr = sysfs_get_classdev_attr(class_dev, name);
- if (tmpattr)
- goto attr_found;
- class_dev_parent = sysfs_get_classdev_parent(class_dev);
- if (class_dev_parent) {
- tmpattr = sysfs_get_classdev_attr(class_dev_parent, name);
- if (tmpattr)
- goto attr_found;
- }
- }
- if (sysfs_device) {
- dbg("look for devices attribute '%s/%s'", sysfs_device->path, name);
- tmpattr = sysfs_get_device_attr(sysfs_device, name);
- if (tmpattr)
- goto attr_found;
- }
- return -1;
-
-attr_found:
- strlcpy(value, tmpattr->value, len);
- remove_trailing_chars(value, '\n');
-
- dbg("found attribute '%s'", tmpattr->path);
- return 0;
-}
-