Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Industrial I/O utilities - lsiio.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright (c) 2010 Manuel Stahl <manuel.stahl@iis.fraunhofer.de>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <dirent.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <stdio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <stdint.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <stdlib.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <unistd.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <sys/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <sys/stat.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <sys/dir.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include "iio_utils.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) static enum verbosity {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 	VERBLEVEL_DEFAULT,	/* 0 gives lspci behaviour */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 	VERBLEVEL_SENSORS,	/* 1 lists sensors */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) } verblevel = VERBLEVEL_DEFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) const char *type_device = "iio:device";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) const char *type_trigger = "trigger";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) static inline int check_prefix(const char *str, const char *prefix)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	return strlen(str) > strlen(prefix) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	       strncmp(str, prefix, strlen(prefix)) == 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) static inline int check_postfix(const char *str, const char *postfix)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	return strlen(str) > strlen(postfix) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	       strcmp(str + strlen(str) - strlen(postfix), postfix) == 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) static int dump_channels(const char *dev_dir_name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	DIR *dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	const struct dirent *ent;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	dp = opendir(dev_dir_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	if (!dp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 		return -errno;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	while (ent = readdir(dp), ent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 		if (check_prefix(ent->d_name, "in_") &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 		   (check_postfix(ent->d_name, "_raw") ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 		    check_postfix(ent->d_name, "_input")))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 			printf("   %-10s\n", ent->d_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	return (closedir(dp) == -1) ? -errno : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) static int dump_one_device(const char *dev_dir_name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	char name[IIO_MAX_NAME_LENGTH];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	int dev_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	ret = sscanf(dev_dir_name + strlen(iio_dir) + strlen(type_device), "%i",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 		     &dev_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	if (ret != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	ret = read_sysfs_string("name", dev_dir_name, name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	printf("Device %03d: %s\n", dev_idx, name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	if (verblevel >= VERBLEVEL_SENSORS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 		return dump_channels(dev_dir_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) static int dump_one_trigger(const char *dev_dir_name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	char name[IIO_MAX_NAME_LENGTH];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	int dev_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	ret = sscanf(dev_dir_name + strlen(iio_dir) + strlen(type_trigger),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 		     "%i", &dev_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	if (ret != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	ret = read_sysfs_string("name", dev_dir_name, name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	printf("Trigger %03d: %s\n", dev_idx, name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) static int dump_devices(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	const struct dirent *ent;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	DIR *dp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	dp = opendir(iio_dir);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	if (!dp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 		fprintf(stderr, "No industrial I/O devices available\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	while (ent = readdir(dp), ent) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 		if (check_prefix(ent->d_name, type_device)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 			char *dev_dir_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 			if (asprintf(&dev_dir_name, "%s%s", iio_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 				     ent->d_name) < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 				ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 				goto error_close_dir;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 			ret = dump_one_device(dev_dir_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 			if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 				free(dev_dir_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 				goto error_close_dir;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 			free(dev_dir_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 			if (verblevel >= VERBLEVEL_SENSORS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 				printf("\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	rewinddir(dp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	while (ent = readdir(dp), ent) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 		if (check_prefix(ent->d_name, type_trigger)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 			char *dev_dir_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 			if (asprintf(&dev_dir_name, "%s%s", iio_dir,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 				     ent->d_name) < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 				ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 				goto error_close_dir;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 			ret = dump_one_trigger(dev_dir_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 			if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 				free(dev_dir_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 				goto error_close_dir;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 			free(dev_dir_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	return (closedir(dp) == -1) ? -errno : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) error_close_dir:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	if (closedir(dp) == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 		perror("dump_devices(): Failed to close directory");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) int main(int argc, char **argv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	int c, err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	while ((c = getopt(argc, argv, "v")) != EOF) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 		switch (c) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 		case 'v':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 			verblevel++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 		case '?':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 		default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 			err++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	if (err || argc > optind) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		fprintf(stderr, "Usage: lsiio [options]...\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 			"List industrial I/O devices\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 			"  -v  Increase verbosity (may be given multiple times)\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 		exit(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	return dump_devices();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) }