1 files changed, 129 insertions, 1 deletions

diff --git a/v4l2-apps/util/v4l2-sysfs-path.c b/v4l2-apps/util/v4l2-sysfs-path.c
index e3f3e63e8..4f0817017 100644
--- a/v4l2-apps/util/v4l2-sysfs-path.c
+++ b/v4l2-apps/util/v4l2-sysfs-path.c
@@ -23,6 +23,7 @@
 #include <stdio.h>
 #include <string.h>
 #include <dirent.h>
+#include <sys/stat.h>
 
 #define USB_ID "usb-"
 #define PCI_ID "PCI:"
@@ -135,6 +136,131 @@ err:
 	return NULL;
 }
 
+char *seek_name(char *path, char *match)
+{
+	DIR             *dir;
+	struct dirent   *entry;
+	struct stat	st;
+	char		*p;
+	static char     name[1024];
+	int		major, minor;
+
+	dir = opendir(path);
+	if (!dir)
+		return NULL;
+
+	strcpy(name, path);
+	strcat(name, "/");
+	p = name + strlen(name);
+
+	entry = readdir(dir);
+	while (entry) {
+		if (!strncmp(entry->d_name, match, strlen(match))) {
+
+			strcpy(name, entry->d_name);
+			closedir(dir);
+			return name;
+		}
+		entry = readdir(dir);
+	}
+	closedir(dir);
+	return NULL;
+}
+
+int get_dev(char *class, int *major, int *minor, char *extra)
+{
+	char            path[1024];
+	char		*name;
+	FILE		*fp;
+
+	name = strchr(class,':');
+	if (!name)
+		return -1;
+	*name = 0;
+	name++;
+
+	*extra = 0;
+
+	if (!strcmp(class, "input")) {
+		char *event;
+
+		sprintf(path, "/sys/class/%s/%s/", class, name);
+		event = seek_name(path, "event");
+		if (!event)
+			return -1;
+
+		strcpy(extra, event);
+
+		sprintf(path, "/sys/class/%s/%s/%s/dev", class, name, event);
+
+	} else
+		sprintf(path, "/sys/class/%s/%s/dev", class, name);
+
+	fp = fopen(path, "r");
+	if (!fp)
+		return -1;
+
+	fscanf(fp, "%d:%d", major, minor);
+
+	return 0;
+}
+
+/*
+ Examples of subdevs:
+	sound:audio1
+	sound:controlC1
+	sound:dsp1
+	sound:mixer1
+	sound:pcmC1D0c
+	dvb:dvb0.demux0
+	dvb:dvb0.dvr0
+	dvb:dvb0.frontend0
+	dvb:dvb0.net0
+	i2c-adapter:i2c-4
+	input:input8
+*/
+
+void get_subdevs(char *path)
+{
+	DIR             *dir;
+	struct dirent   *entry;
+	struct stat	st;
+	char            *p, name[1024], extra[20];
+	int		major, minor;
+
+	dir = opendir(path);
+	if (!dir)
+		return;
+
+	strcpy(name, path);
+	strcat(name, "/");
+	p = name + strlen(name);
+
+	printf("Associated devices:\n");
+	entry = readdir(dir);
+	while (entry) {
+		strcpy(p, entry->d_name);
+		if ((lstat(name, &st) == 0) &&
+			!S_ISDIR(st.st_mode)) {
+			char *s = strchr(entry->d_name, ':');
+			if (s) {
+				printf("\t%s", entry->d_name);
+				if (!get_dev(entry->d_name, &major, &minor, extra)) {
+					if (*extra)
+						printf(":%s (dev %d,%d)",
+							extra, major, minor);
+					else
+						printf(" (dev %d,%d)",
+							major, minor);
+				}
+				printf("\n");
+			}
+		}
+		entry = readdir(dir);
+	}
+	closedir(dir);
+}
+
 void get_sysfs(char *fname)
 {
 	struct v4l2_driver drv;
@@ -148,9 +274,11 @@ void get_sysfs(char *fname)
 	printf("bus info   = %s\n", drv.cap.bus_info);
 	path = obtain_bus_sysfs_path((char *)drv.cap.bus_info);
 	if (path) {
-		printf("sysfs path = %s\n\n", path);
+		printf("sysfs path = %s\n", path);
+		get_subdevs(path);
 		free(path);
 	}
+	printf("\n");
 
 	v4l2_close(&drv);
 }