162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* IIO - useful set of util functionality 362306a36Sopenharmony_ci * 462306a36Sopenharmony_ci * Copyright (c) 2008 Jonathan Cameron 562306a36Sopenharmony_ci */ 662306a36Sopenharmony_ci#include <string.h> 762306a36Sopenharmony_ci#include <stdlib.h> 862306a36Sopenharmony_ci#include <stdio.h> 962306a36Sopenharmony_ci#include <stdint.h> 1062306a36Sopenharmony_ci#include <dirent.h> 1162306a36Sopenharmony_ci#include <errno.h> 1262306a36Sopenharmony_ci#include <ctype.h> 1362306a36Sopenharmony_ci#include "iio_utils.h" 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ciconst char *iio_dir = "/sys/bus/iio/devices/"; 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_cistatic char * const iio_direction[] = { 1862306a36Sopenharmony_ci "in", 1962306a36Sopenharmony_ci "out", 2062306a36Sopenharmony_ci}; 2162306a36Sopenharmony_ci 2262306a36Sopenharmony_ci/** 2362306a36Sopenharmony_ci * iioutils_break_up_name() - extract generic name from full channel name 2462306a36Sopenharmony_ci * @full_name: the full channel name 2562306a36Sopenharmony_ci * @generic_name: the output generic channel name 2662306a36Sopenharmony_ci * 2762306a36Sopenharmony_ci * Returns 0 on success, or a negative error code if string extraction failed. 2862306a36Sopenharmony_ci **/ 2962306a36Sopenharmony_ciint iioutils_break_up_name(const char *full_name, char **generic_name) 3062306a36Sopenharmony_ci{ 3162306a36Sopenharmony_ci char *current; 3262306a36Sopenharmony_ci char *w, *r; 3362306a36Sopenharmony_ci char *working, *prefix = ""; 3462306a36Sopenharmony_ci int i, ret; 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(iio_direction); i++) 3762306a36Sopenharmony_ci if (!strncmp(full_name, iio_direction[i], 3862306a36Sopenharmony_ci strlen(iio_direction[i]))) { 3962306a36Sopenharmony_ci prefix = iio_direction[i]; 4062306a36Sopenharmony_ci break; 4162306a36Sopenharmony_ci } 4262306a36Sopenharmony_ci 4362306a36Sopenharmony_ci current = strdup(full_name + strlen(prefix) + 1); 4462306a36Sopenharmony_ci if (!current) 4562306a36Sopenharmony_ci return -ENOMEM; 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci working = strtok(current, "_\0"); 4862306a36Sopenharmony_ci if (!working) { 4962306a36Sopenharmony_ci free(current); 5062306a36Sopenharmony_ci return -EINVAL; 5162306a36Sopenharmony_ci } 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci w = working; 5462306a36Sopenharmony_ci r = working; 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci while (*r != '\0') { 5762306a36Sopenharmony_ci if (!isdigit(*r)) { 5862306a36Sopenharmony_ci *w = *r; 5962306a36Sopenharmony_ci w++; 6062306a36Sopenharmony_ci } 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci r++; 6362306a36Sopenharmony_ci } 6462306a36Sopenharmony_ci *w = '\0'; 6562306a36Sopenharmony_ci ret = asprintf(generic_name, "%s_%s", prefix, working); 6662306a36Sopenharmony_ci free(current); 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_ci return (ret == -1) ? -ENOMEM : 0; 6962306a36Sopenharmony_ci} 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_ci/** 7262306a36Sopenharmony_ci * iioutils_get_type() - find and process _type attribute data 7362306a36Sopenharmony_ci * @is_signed: output whether channel is signed 7462306a36Sopenharmony_ci * @bytes: output how many bytes the channel storage occupies 7562306a36Sopenharmony_ci * @bits_used: output number of valid bits of data 7662306a36Sopenharmony_ci * @shift: output amount of bits to shift right data before applying bit mask 7762306a36Sopenharmony_ci * @mask: output a bit mask for the raw data 7862306a36Sopenharmony_ci * @be: output if data in big endian 7962306a36Sopenharmony_ci * @device_dir: the IIO device directory 8062306a36Sopenharmony_ci * @buffer_idx: the IIO buffer index 8162306a36Sopenharmony_ci * @name: the channel name 8262306a36Sopenharmony_ci * @generic_name: the channel type name 8362306a36Sopenharmony_ci * 8462306a36Sopenharmony_ci * Returns a value >= 0 on success, otherwise a negative error code. 8562306a36Sopenharmony_ci **/ 8662306a36Sopenharmony_cistatic int iioutils_get_type(unsigned int *is_signed, unsigned int *bytes, 8762306a36Sopenharmony_ci unsigned int *bits_used, unsigned int *shift, 8862306a36Sopenharmony_ci uint64_t *mask, unsigned int *be, 8962306a36Sopenharmony_ci const char *device_dir, int buffer_idx, 9062306a36Sopenharmony_ci const char *name, const char *generic_name) 9162306a36Sopenharmony_ci{ 9262306a36Sopenharmony_ci FILE *sysfsfp; 9362306a36Sopenharmony_ci int ret; 9462306a36Sopenharmony_ci DIR *dp; 9562306a36Sopenharmony_ci char *scan_el_dir, *builtname, *builtname_generic, *filename = 0; 9662306a36Sopenharmony_ci char signchar, endianchar; 9762306a36Sopenharmony_ci unsigned padint; 9862306a36Sopenharmony_ci const struct dirent *ent; 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_ci ret = asprintf(&scan_el_dir, FORMAT_SCAN_ELEMENTS_DIR, device_dir, buffer_idx); 10162306a36Sopenharmony_ci if (ret < 0) 10262306a36Sopenharmony_ci return -ENOMEM; 10362306a36Sopenharmony_ci 10462306a36Sopenharmony_ci ret = asprintf(&builtname, FORMAT_TYPE_FILE, name); 10562306a36Sopenharmony_ci if (ret < 0) { 10662306a36Sopenharmony_ci ret = -ENOMEM; 10762306a36Sopenharmony_ci goto error_free_scan_el_dir; 10862306a36Sopenharmony_ci } 10962306a36Sopenharmony_ci ret = asprintf(&builtname_generic, FORMAT_TYPE_FILE, generic_name); 11062306a36Sopenharmony_ci if (ret < 0) { 11162306a36Sopenharmony_ci ret = -ENOMEM; 11262306a36Sopenharmony_ci goto error_free_builtname; 11362306a36Sopenharmony_ci } 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci dp = opendir(scan_el_dir); 11662306a36Sopenharmony_ci if (!dp) { 11762306a36Sopenharmony_ci ret = -errno; 11862306a36Sopenharmony_ci goto error_free_builtname_generic; 11962306a36Sopenharmony_ci } 12062306a36Sopenharmony_ci 12162306a36Sopenharmony_ci ret = -ENOENT; 12262306a36Sopenharmony_ci while (ent = readdir(dp), ent) 12362306a36Sopenharmony_ci if ((strcmp(builtname, ent->d_name) == 0) || 12462306a36Sopenharmony_ci (strcmp(builtname_generic, ent->d_name) == 0)) { 12562306a36Sopenharmony_ci ret = asprintf(&filename, 12662306a36Sopenharmony_ci "%s/%s", scan_el_dir, ent->d_name); 12762306a36Sopenharmony_ci if (ret < 0) { 12862306a36Sopenharmony_ci ret = -ENOMEM; 12962306a36Sopenharmony_ci goto error_closedir; 13062306a36Sopenharmony_ci } 13162306a36Sopenharmony_ci 13262306a36Sopenharmony_ci sysfsfp = fopen(filename, "r"); 13362306a36Sopenharmony_ci if (!sysfsfp) { 13462306a36Sopenharmony_ci ret = -errno; 13562306a36Sopenharmony_ci fprintf(stderr, "failed to open %s\n", 13662306a36Sopenharmony_ci filename); 13762306a36Sopenharmony_ci goto error_free_filename; 13862306a36Sopenharmony_ci } 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_ci ret = fscanf(sysfsfp, 14162306a36Sopenharmony_ci "%ce:%c%u/%u>>%u", 14262306a36Sopenharmony_ci &endianchar, 14362306a36Sopenharmony_ci &signchar, 14462306a36Sopenharmony_ci bits_used, 14562306a36Sopenharmony_ci &padint, shift); 14662306a36Sopenharmony_ci if (ret < 0) { 14762306a36Sopenharmony_ci ret = -errno; 14862306a36Sopenharmony_ci fprintf(stderr, 14962306a36Sopenharmony_ci "failed to pass scan type description\n"); 15062306a36Sopenharmony_ci goto error_close_sysfsfp; 15162306a36Sopenharmony_ci } else if (ret != 5) { 15262306a36Sopenharmony_ci ret = -EIO; 15362306a36Sopenharmony_ci fprintf(stderr, 15462306a36Sopenharmony_ci "scan type description didn't match\n"); 15562306a36Sopenharmony_ci goto error_close_sysfsfp; 15662306a36Sopenharmony_ci } 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci *be = (endianchar == 'b'); 15962306a36Sopenharmony_ci *bytes = padint / 8; 16062306a36Sopenharmony_ci if (*bits_used == 64) 16162306a36Sopenharmony_ci *mask = ~(0ULL); 16262306a36Sopenharmony_ci else 16362306a36Sopenharmony_ci *mask = (1ULL << *bits_used) - 1ULL; 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_ci *is_signed = (signchar == 's'); 16662306a36Sopenharmony_ci if (fclose(sysfsfp)) { 16762306a36Sopenharmony_ci ret = -errno; 16862306a36Sopenharmony_ci fprintf(stderr, "Failed to close %s\n", 16962306a36Sopenharmony_ci filename); 17062306a36Sopenharmony_ci goto error_free_filename; 17162306a36Sopenharmony_ci } 17262306a36Sopenharmony_ci 17362306a36Sopenharmony_ci sysfsfp = 0; 17462306a36Sopenharmony_ci free(filename); 17562306a36Sopenharmony_ci filename = 0; 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_ci /* 17862306a36Sopenharmony_ci * Avoid having a more generic entry overwriting 17962306a36Sopenharmony_ci * the settings. 18062306a36Sopenharmony_ci */ 18162306a36Sopenharmony_ci if (strcmp(builtname, ent->d_name) == 0) 18262306a36Sopenharmony_ci break; 18362306a36Sopenharmony_ci } 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_cierror_close_sysfsfp: 18662306a36Sopenharmony_ci if (sysfsfp) 18762306a36Sopenharmony_ci if (fclose(sysfsfp)) 18862306a36Sopenharmony_ci perror("iioutils_get_type(): Failed to close file"); 18962306a36Sopenharmony_ci 19062306a36Sopenharmony_cierror_free_filename: 19162306a36Sopenharmony_ci if (filename) 19262306a36Sopenharmony_ci free(filename); 19362306a36Sopenharmony_ci 19462306a36Sopenharmony_cierror_closedir: 19562306a36Sopenharmony_ci if (closedir(dp) == -1) 19662306a36Sopenharmony_ci perror("iioutils_get_type(): Failed to close directory"); 19762306a36Sopenharmony_ci 19862306a36Sopenharmony_cierror_free_builtname_generic: 19962306a36Sopenharmony_ci free(builtname_generic); 20062306a36Sopenharmony_cierror_free_builtname: 20162306a36Sopenharmony_ci free(builtname); 20262306a36Sopenharmony_cierror_free_scan_el_dir: 20362306a36Sopenharmony_ci free(scan_el_dir); 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_ci return ret; 20662306a36Sopenharmony_ci} 20762306a36Sopenharmony_ci 20862306a36Sopenharmony_ci/** 20962306a36Sopenharmony_ci * iioutils_get_param_float() - read a float value from a channel parameter 21062306a36Sopenharmony_ci * @output: output the float value 21162306a36Sopenharmony_ci * @param_name: the parameter name to read 21262306a36Sopenharmony_ci * @device_dir: the IIO device directory in sysfs 21362306a36Sopenharmony_ci * @name: the channel name 21462306a36Sopenharmony_ci * @generic_name: the channel type name 21562306a36Sopenharmony_ci * 21662306a36Sopenharmony_ci * Returns a value >= 0 on success, otherwise a negative error code. 21762306a36Sopenharmony_ci **/ 21862306a36Sopenharmony_ciint iioutils_get_param_float(float *output, const char *param_name, 21962306a36Sopenharmony_ci const char *device_dir, const char *name, 22062306a36Sopenharmony_ci const char *generic_name) 22162306a36Sopenharmony_ci{ 22262306a36Sopenharmony_ci FILE *sysfsfp; 22362306a36Sopenharmony_ci int ret; 22462306a36Sopenharmony_ci DIR *dp; 22562306a36Sopenharmony_ci char *builtname, *builtname_generic; 22662306a36Sopenharmony_ci char *filename = NULL; 22762306a36Sopenharmony_ci const struct dirent *ent; 22862306a36Sopenharmony_ci 22962306a36Sopenharmony_ci ret = asprintf(&builtname, "%s_%s", name, param_name); 23062306a36Sopenharmony_ci if (ret < 0) 23162306a36Sopenharmony_ci return -ENOMEM; 23262306a36Sopenharmony_ci 23362306a36Sopenharmony_ci ret = asprintf(&builtname_generic, 23462306a36Sopenharmony_ci "%s_%s", generic_name, param_name); 23562306a36Sopenharmony_ci if (ret < 0) { 23662306a36Sopenharmony_ci ret = -ENOMEM; 23762306a36Sopenharmony_ci goto error_free_builtname; 23862306a36Sopenharmony_ci } 23962306a36Sopenharmony_ci 24062306a36Sopenharmony_ci dp = opendir(device_dir); 24162306a36Sopenharmony_ci if (!dp) { 24262306a36Sopenharmony_ci ret = -errno; 24362306a36Sopenharmony_ci goto error_free_builtname_generic; 24462306a36Sopenharmony_ci } 24562306a36Sopenharmony_ci 24662306a36Sopenharmony_ci ret = -ENOENT; 24762306a36Sopenharmony_ci while (ent = readdir(dp), ent) 24862306a36Sopenharmony_ci if ((strcmp(builtname, ent->d_name) == 0) || 24962306a36Sopenharmony_ci (strcmp(builtname_generic, ent->d_name) == 0)) { 25062306a36Sopenharmony_ci ret = asprintf(&filename, 25162306a36Sopenharmony_ci "%s/%s", device_dir, ent->d_name); 25262306a36Sopenharmony_ci if (ret < 0) { 25362306a36Sopenharmony_ci ret = -ENOMEM; 25462306a36Sopenharmony_ci goto error_closedir; 25562306a36Sopenharmony_ci } 25662306a36Sopenharmony_ci 25762306a36Sopenharmony_ci sysfsfp = fopen(filename, "r"); 25862306a36Sopenharmony_ci if (!sysfsfp) { 25962306a36Sopenharmony_ci ret = -errno; 26062306a36Sopenharmony_ci goto error_free_filename; 26162306a36Sopenharmony_ci } 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_ci errno = 0; 26462306a36Sopenharmony_ci if (fscanf(sysfsfp, "%f", output) != 1) 26562306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 26662306a36Sopenharmony_ci 26762306a36Sopenharmony_ci fclose(sysfsfp); 26862306a36Sopenharmony_ci break; 26962306a36Sopenharmony_ci } 27062306a36Sopenharmony_cierror_free_filename: 27162306a36Sopenharmony_ci if (filename) 27262306a36Sopenharmony_ci free(filename); 27362306a36Sopenharmony_ci 27462306a36Sopenharmony_cierror_closedir: 27562306a36Sopenharmony_ci if (closedir(dp) == -1) 27662306a36Sopenharmony_ci perror("iioutils_get_param_float(): Failed to close directory"); 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_cierror_free_builtname_generic: 27962306a36Sopenharmony_ci free(builtname_generic); 28062306a36Sopenharmony_cierror_free_builtname: 28162306a36Sopenharmony_ci free(builtname); 28262306a36Sopenharmony_ci 28362306a36Sopenharmony_ci return ret; 28462306a36Sopenharmony_ci} 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_ci/** 28762306a36Sopenharmony_ci * bsort_channel_array_by_index() - sort the array in index order 28862306a36Sopenharmony_ci * @ci_array: the iio_channel_info array to be sorted 28962306a36Sopenharmony_ci * @cnt: the amount of array elements 29062306a36Sopenharmony_ci **/ 29162306a36Sopenharmony_ci 29262306a36Sopenharmony_civoid bsort_channel_array_by_index(struct iio_channel_info *ci_array, int cnt) 29362306a36Sopenharmony_ci{ 29462306a36Sopenharmony_ci struct iio_channel_info temp; 29562306a36Sopenharmony_ci int x, y; 29662306a36Sopenharmony_ci 29762306a36Sopenharmony_ci for (x = 0; x < cnt; x++) 29862306a36Sopenharmony_ci for (y = 0; y < (cnt - 1); y++) 29962306a36Sopenharmony_ci if (ci_array[y].index > ci_array[y + 1].index) { 30062306a36Sopenharmony_ci temp = ci_array[y + 1]; 30162306a36Sopenharmony_ci ci_array[y + 1] = ci_array[y]; 30262306a36Sopenharmony_ci ci_array[y] = temp; 30362306a36Sopenharmony_ci } 30462306a36Sopenharmony_ci} 30562306a36Sopenharmony_ci 30662306a36Sopenharmony_ci/** 30762306a36Sopenharmony_ci * build_channel_array() - function to figure out what channels are present 30862306a36Sopenharmony_ci * @device_dir: the IIO device directory in sysfs 30962306a36Sopenharmony_ci * @buffer_idx: the IIO buffer for this channel array 31062306a36Sopenharmony_ci * @ci_array: output the resulting array of iio_channel_info 31162306a36Sopenharmony_ci * @counter: output the amount of array elements 31262306a36Sopenharmony_ci * 31362306a36Sopenharmony_ci * Returns 0 on success, otherwise a negative error code. 31462306a36Sopenharmony_ci **/ 31562306a36Sopenharmony_ciint build_channel_array(const char *device_dir, int buffer_idx, 31662306a36Sopenharmony_ci struct iio_channel_info **ci_array, int *counter) 31762306a36Sopenharmony_ci{ 31862306a36Sopenharmony_ci DIR *dp; 31962306a36Sopenharmony_ci FILE *sysfsfp; 32062306a36Sopenharmony_ci int count = 0, i; 32162306a36Sopenharmony_ci struct iio_channel_info *current; 32262306a36Sopenharmony_ci int ret; 32362306a36Sopenharmony_ci const struct dirent *ent; 32462306a36Sopenharmony_ci char *scan_el_dir; 32562306a36Sopenharmony_ci char *filename; 32662306a36Sopenharmony_ci 32762306a36Sopenharmony_ci *counter = 0; 32862306a36Sopenharmony_ci ret = asprintf(&scan_el_dir, FORMAT_SCAN_ELEMENTS_DIR, device_dir, buffer_idx); 32962306a36Sopenharmony_ci if (ret < 0) 33062306a36Sopenharmony_ci return -ENOMEM; 33162306a36Sopenharmony_ci 33262306a36Sopenharmony_ci dp = opendir(scan_el_dir); 33362306a36Sopenharmony_ci if (!dp) { 33462306a36Sopenharmony_ci ret = -errno; 33562306a36Sopenharmony_ci goto error_free_name; 33662306a36Sopenharmony_ci } 33762306a36Sopenharmony_ci 33862306a36Sopenharmony_ci while (ent = readdir(dp), ent) 33962306a36Sopenharmony_ci if (strcmp(ent->d_name + strlen(ent->d_name) - strlen("_en"), 34062306a36Sopenharmony_ci "_en") == 0) { 34162306a36Sopenharmony_ci ret = asprintf(&filename, 34262306a36Sopenharmony_ci "%s/%s", scan_el_dir, ent->d_name); 34362306a36Sopenharmony_ci if (ret < 0) { 34462306a36Sopenharmony_ci ret = -ENOMEM; 34562306a36Sopenharmony_ci goto error_close_dir; 34662306a36Sopenharmony_ci } 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_ci sysfsfp = fopen(filename, "r"); 34962306a36Sopenharmony_ci free(filename); 35062306a36Sopenharmony_ci if (!sysfsfp) { 35162306a36Sopenharmony_ci ret = -errno; 35262306a36Sopenharmony_ci goto error_close_dir; 35362306a36Sopenharmony_ci } 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_ci errno = 0; 35662306a36Sopenharmony_ci if (fscanf(sysfsfp, "%i", &ret) != 1) { 35762306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 35862306a36Sopenharmony_ci if (fclose(sysfsfp)) 35962306a36Sopenharmony_ci perror("build_channel_array(): Failed to close file"); 36062306a36Sopenharmony_ci 36162306a36Sopenharmony_ci goto error_close_dir; 36262306a36Sopenharmony_ci } 36362306a36Sopenharmony_ci if (ret == 1) 36462306a36Sopenharmony_ci (*counter)++; 36562306a36Sopenharmony_ci 36662306a36Sopenharmony_ci if (fclose(sysfsfp)) { 36762306a36Sopenharmony_ci ret = -errno; 36862306a36Sopenharmony_ci goto error_close_dir; 36962306a36Sopenharmony_ci } 37062306a36Sopenharmony_ci 37162306a36Sopenharmony_ci } 37262306a36Sopenharmony_ci 37362306a36Sopenharmony_ci *ci_array = malloc(sizeof(**ci_array) * (*counter)); 37462306a36Sopenharmony_ci if (!*ci_array) { 37562306a36Sopenharmony_ci ret = -ENOMEM; 37662306a36Sopenharmony_ci goto error_close_dir; 37762306a36Sopenharmony_ci } 37862306a36Sopenharmony_ci 37962306a36Sopenharmony_ci seekdir(dp, 0); 38062306a36Sopenharmony_ci while (ent = readdir(dp), ent) { 38162306a36Sopenharmony_ci if (strcmp(ent->d_name + strlen(ent->d_name) - strlen("_en"), 38262306a36Sopenharmony_ci "_en") == 0) { 38362306a36Sopenharmony_ci int current_enabled = 0; 38462306a36Sopenharmony_ci 38562306a36Sopenharmony_ci current = &(*ci_array)[count++]; 38662306a36Sopenharmony_ci ret = asprintf(&filename, 38762306a36Sopenharmony_ci "%s/%s", scan_el_dir, ent->d_name); 38862306a36Sopenharmony_ci if (ret < 0) { 38962306a36Sopenharmony_ci ret = -ENOMEM; 39062306a36Sopenharmony_ci /* decrement count to avoid freeing name */ 39162306a36Sopenharmony_ci count--; 39262306a36Sopenharmony_ci goto error_cleanup_array; 39362306a36Sopenharmony_ci } 39462306a36Sopenharmony_ci 39562306a36Sopenharmony_ci sysfsfp = fopen(filename, "r"); 39662306a36Sopenharmony_ci free(filename); 39762306a36Sopenharmony_ci if (!sysfsfp) { 39862306a36Sopenharmony_ci ret = -errno; 39962306a36Sopenharmony_ci count--; 40062306a36Sopenharmony_ci goto error_cleanup_array; 40162306a36Sopenharmony_ci } 40262306a36Sopenharmony_ci 40362306a36Sopenharmony_ci errno = 0; 40462306a36Sopenharmony_ci if (fscanf(sysfsfp, "%i", ¤t_enabled) != 1) { 40562306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 40662306a36Sopenharmony_ci count--; 40762306a36Sopenharmony_ci goto error_cleanup_array; 40862306a36Sopenharmony_ci } 40962306a36Sopenharmony_ci 41062306a36Sopenharmony_ci if (fclose(sysfsfp)) { 41162306a36Sopenharmony_ci ret = -errno; 41262306a36Sopenharmony_ci count--; 41362306a36Sopenharmony_ci goto error_cleanup_array; 41462306a36Sopenharmony_ci } 41562306a36Sopenharmony_ci 41662306a36Sopenharmony_ci if (!current_enabled) { 41762306a36Sopenharmony_ci count--; 41862306a36Sopenharmony_ci continue; 41962306a36Sopenharmony_ci } 42062306a36Sopenharmony_ci 42162306a36Sopenharmony_ci current->scale = 1.0; 42262306a36Sopenharmony_ci current->offset = 0; 42362306a36Sopenharmony_ci current->name = strndup(ent->d_name, 42462306a36Sopenharmony_ci strlen(ent->d_name) - 42562306a36Sopenharmony_ci strlen("_en")); 42662306a36Sopenharmony_ci if (!current->name) { 42762306a36Sopenharmony_ci ret = -ENOMEM; 42862306a36Sopenharmony_ci count--; 42962306a36Sopenharmony_ci goto error_cleanup_array; 43062306a36Sopenharmony_ci } 43162306a36Sopenharmony_ci 43262306a36Sopenharmony_ci /* Get the generic and specific name elements */ 43362306a36Sopenharmony_ci ret = iioutils_break_up_name(current->name, 43462306a36Sopenharmony_ci ¤t->generic_name); 43562306a36Sopenharmony_ci if (ret) { 43662306a36Sopenharmony_ci free(current->name); 43762306a36Sopenharmony_ci count--; 43862306a36Sopenharmony_ci goto error_cleanup_array; 43962306a36Sopenharmony_ci } 44062306a36Sopenharmony_ci 44162306a36Sopenharmony_ci ret = asprintf(&filename, 44262306a36Sopenharmony_ci "%s/%s_index", 44362306a36Sopenharmony_ci scan_el_dir, 44462306a36Sopenharmony_ci current->name); 44562306a36Sopenharmony_ci if (ret < 0) { 44662306a36Sopenharmony_ci ret = -ENOMEM; 44762306a36Sopenharmony_ci goto error_cleanup_array; 44862306a36Sopenharmony_ci } 44962306a36Sopenharmony_ci 45062306a36Sopenharmony_ci sysfsfp = fopen(filename, "r"); 45162306a36Sopenharmony_ci free(filename); 45262306a36Sopenharmony_ci if (!sysfsfp) { 45362306a36Sopenharmony_ci ret = -errno; 45462306a36Sopenharmony_ci fprintf(stderr, "failed to open %s/%s_index\n", 45562306a36Sopenharmony_ci scan_el_dir, current->name); 45662306a36Sopenharmony_ci goto error_cleanup_array; 45762306a36Sopenharmony_ci } 45862306a36Sopenharmony_ci 45962306a36Sopenharmony_ci errno = 0; 46062306a36Sopenharmony_ci if (fscanf(sysfsfp, "%u", ¤t->index) != 1) { 46162306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 46262306a36Sopenharmony_ci if (fclose(sysfsfp)) 46362306a36Sopenharmony_ci perror("build_channel_array(): Failed to close file"); 46462306a36Sopenharmony_ci 46562306a36Sopenharmony_ci goto error_cleanup_array; 46662306a36Sopenharmony_ci } 46762306a36Sopenharmony_ci 46862306a36Sopenharmony_ci if (fclose(sysfsfp)) { 46962306a36Sopenharmony_ci ret = -errno; 47062306a36Sopenharmony_ci goto error_cleanup_array; 47162306a36Sopenharmony_ci } 47262306a36Sopenharmony_ci 47362306a36Sopenharmony_ci /* Find the scale */ 47462306a36Sopenharmony_ci ret = iioutils_get_param_float(¤t->scale, 47562306a36Sopenharmony_ci "scale", 47662306a36Sopenharmony_ci device_dir, 47762306a36Sopenharmony_ci current->name, 47862306a36Sopenharmony_ci current->generic_name); 47962306a36Sopenharmony_ci if ((ret < 0) && (ret != -ENOENT)) 48062306a36Sopenharmony_ci goto error_cleanup_array; 48162306a36Sopenharmony_ci 48262306a36Sopenharmony_ci ret = iioutils_get_param_float(¤t->offset, 48362306a36Sopenharmony_ci "offset", 48462306a36Sopenharmony_ci device_dir, 48562306a36Sopenharmony_ci current->name, 48662306a36Sopenharmony_ci current->generic_name); 48762306a36Sopenharmony_ci if ((ret < 0) && (ret != -ENOENT)) 48862306a36Sopenharmony_ci goto error_cleanup_array; 48962306a36Sopenharmony_ci 49062306a36Sopenharmony_ci ret = iioutils_get_type(¤t->is_signed, 49162306a36Sopenharmony_ci ¤t->bytes, 49262306a36Sopenharmony_ci ¤t->bits_used, 49362306a36Sopenharmony_ci ¤t->shift, 49462306a36Sopenharmony_ci ¤t->mask, 49562306a36Sopenharmony_ci ¤t->be, 49662306a36Sopenharmony_ci device_dir, 49762306a36Sopenharmony_ci buffer_idx, 49862306a36Sopenharmony_ci current->name, 49962306a36Sopenharmony_ci current->generic_name); 50062306a36Sopenharmony_ci if (ret < 0) 50162306a36Sopenharmony_ci goto error_cleanup_array; 50262306a36Sopenharmony_ci } 50362306a36Sopenharmony_ci } 50462306a36Sopenharmony_ci 50562306a36Sopenharmony_ci if (closedir(dp) == -1) { 50662306a36Sopenharmony_ci ret = -errno; 50762306a36Sopenharmony_ci goto error_cleanup_array; 50862306a36Sopenharmony_ci } 50962306a36Sopenharmony_ci 51062306a36Sopenharmony_ci free(scan_el_dir); 51162306a36Sopenharmony_ci /* reorder so that the array is in index order */ 51262306a36Sopenharmony_ci bsort_channel_array_by_index(*ci_array, *counter); 51362306a36Sopenharmony_ci 51462306a36Sopenharmony_ci return 0; 51562306a36Sopenharmony_ci 51662306a36Sopenharmony_cierror_cleanup_array: 51762306a36Sopenharmony_ci for (i = count - 1; i >= 0; i--) { 51862306a36Sopenharmony_ci free((*ci_array)[i].name); 51962306a36Sopenharmony_ci free((*ci_array)[i].generic_name); 52062306a36Sopenharmony_ci } 52162306a36Sopenharmony_ci free(*ci_array); 52262306a36Sopenharmony_ci *ci_array = NULL; 52362306a36Sopenharmony_ci *counter = 0; 52462306a36Sopenharmony_cierror_close_dir: 52562306a36Sopenharmony_ci if (dp) 52662306a36Sopenharmony_ci if (closedir(dp) == -1) 52762306a36Sopenharmony_ci perror("build_channel_array(): Failed to close dir"); 52862306a36Sopenharmony_ci 52962306a36Sopenharmony_cierror_free_name: 53062306a36Sopenharmony_ci free(scan_el_dir); 53162306a36Sopenharmony_ci 53262306a36Sopenharmony_ci return ret; 53362306a36Sopenharmony_ci} 53462306a36Sopenharmony_ci 53562306a36Sopenharmony_cistatic int calc_digits(int num) 53662306a36Sopenharmony_ci{ 53762306a36Sopenharmony_ci int count = 0; 53862306a36Sopenharmony_ci 53962306a36Sopenharmony_ci /* It takes a digit to represent zero */ 54062306a36Sopenharmony_ci if (!num) 54162306a36Sopenharmony_ci return 1; 54262306a36Sopenharmony_ci 54362306a36Sopenharmony_ci while (num != 0) { 54462306a36Sopenharmony_ci num /= 10; 54562306a36Sopenharmony_ci count++; 54662306a36Sopenharmony_ci } 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_ci return count; 54962306a36Sopenharmony_ci} 55062306a36Sopenharmony_ci 55162306a36Sopenharmony_ci/** 55262306a36Sopenharmony_ci * find_type_by_name() - function to match top level types by name 55362306a36Sopenharmony_ci * @name: top level type instance name 55462306a36Sopenharmony_ci * @type: the type of top level instance being searched 55562306a36Sopenharmony_ci * 55662306a36Sopenharmony_ci * Returns the device number of a matched IIO device on success, otherwise a 55762306a36Sopenharmony_ci * negative error code. 55862306a36Sopenharmony_ci * Typical types this is used for are device and trigger. 55962306a36Sopenharmony_ci **/ 56062306a36Sopenharmony_ciint find_type_by_name(const char *name, const char *type) 56162306a36Sopenharmony_ci{ 56262306a36Sopenharmony_ci const struct dirent *ent; 56362306a36Sopenharmony_ci int number, numstrlen, ret; 56462306a36Sopenharmony_ci 56562306a36Sopenharmony_ci FILE *namefp; 56662306a36Sopenharmony_ci DIR *dp; 56762306a36Sopenharmony_ci char thisname[IIO_MAX_NAME_LENGTH]; 56862306a36Sopenharmony_ci char *filename; 56962306a36Sopenharmony_ci 57062306a36Sopenharmony_ci dp = opendir(iio_dir); 57162306a36Sopenharmony_ci if (!dp) { 57262306a36Sopenharmony_ci fprintf(stderr, "No industrialio devices available\n"); 57362306a36Sopenharmony_ci return -ENODEV; 57462306a36Sopenharmony_ci } 57562306a36Sopenharmony_ci 57662306a36Sopenharmony_ci while (ent = readdir(dp), ent) { 57762306a36Sopenharmony_ci if (strcmp(ent->d_name, ".") != 0 && 57862306a36Sopenharmony_ci strcmp(ent->d_name, "..") != 0 && 57962306a36Sopenharmony_ci strlen(ent->d_name) > strlen(type) && 58062306a36Sopenharmony_ci strncmp(ent->d_name, type, strlen(type)) == 0) { 58162306a36Sopenharmony_ci errno = 0; 58262306a36Sopenharmony_ci ret = sscanf(ent->d_name + strlen(type), "%d", &number); 58362306a36Sopenharmony_ci if (ret < 0) { 58462306a36Sopenharmony_ci ret = -errno; 58562306a36Sopenharmony_ci fprintf(stderr, 58662306a36Sopenharmony_ci "failed to read element number\n"); 58762306a36Sopenharmony_ci goto error_close_dir; 58862306a36Sopenharmony_ci } else if (ret != 1) { 58962306a36Sopenharmony_ci ret = -EIO; 59062306a36Sopenharmony_ci fprintf(stderr, 59162306a36Sopenharmony_ci "failed to match element number\n"); 59262306a36Sopenharmony_ci goto error_close_dir; 59362306a36Sopenharmony_ci } 59462306a36Sopenharmony_ci 59562306a36Sopenharmony_ci numstrlen = calc_digits(number); 59662306a36Sopenharmony_ci /* verify the next character is not a colon */ 59762306a36Sopenharmony_ci if (strncmp(ent->d_name + strlen(type) + numstrlen, 59862306a36Sopenharmony_ci ":", 1) != 0) { 59962306a36Sopenharmony_ci filename = malloc(strlen(iio_dir) + strlen(type) 60062306a36Sopenharmony_ci + numstrlen + 6); 60162306a36Sopenharmony_ci if (!filename) { 60262306a36Sopenharmony_ci ret = -ENOMEM; 60362306a36Sopenharmony_ci goto error_close_dir; 60462306a36Sopenharmony_ci } 60562306a36Sopenharmony_ci 60662306a36Sopenharmony_ci ret = sprintf(filename, "%s%s%d/name", iio_dir, 60762306a36Sopenharmony_ci type, number); 60862306a36Sopenharmony_ci if (ret < 0) { 60962306a36Sopenharmony_ci free(filename); 61062306a36Sopenharmony_ci goto error_close_dir; 61162306a36Sopenharmony_ci } 61262306a36Sopenharmony_ci 61362306a36Sopenharmony_ci namefp = fopen(filename, "r"); 61462306a36Sopenharmony_ci if (!namefp) { 61562306a36Sopenharmony_ci free(filename); 61662306a36Sopenharmony_ci continue; 61762306a36Sopenharmony_ci } 61862306a36Sopenharmony_ci 61962306a36Sopenharmony_ci free(filename); 62062306a36Sopenharmony_ci errno = 0; 62162306a36Sopenharmony_ci if (fscanf(namefp, "%s", thisname) != 1) { 62262306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 62362306a36Sopenharmony_ci goto error_close_dir; 62462306a36Sopenharmony_ci } 62562306a36Sopenharmony_ci 62662306a36Sopenharmony_ci if (fclose(namefp)) { 62762306a36Sopenharmony_ci ret = -errno; 62862306a36Sopenharmony_ci goto error_close_dir; 62962306a36Sopenharmony_ci } 63062306a36Sopenharmony_ci 63162306a36Sopenharmony_ci if (strcmp(name, thisname) == 0) { 63262306a36Sopenharmony_ci if (closedir(dp) == -1) 63362306a36Sopenharmony_ci return -errno; 63462306a36Sopenharmony_ci 63562306a36Sopenharmony_ci return number; 63662306a36Sopenharmony_ci } 63762306a36Sopenharmony_ci } 63862306a36Sopenharmony_ci } 63962306a36Sopenharmony_ci } 64062306a36Sopenharmony_ci if (closedir(dp) == -1) 64162306a36Sopenharmony_ci return -errno; 64262306a36Sopenharmony_ci 64362306a36Sopenharmony_ci return -ENODEV; 64462306a36Sopenharmony_ci 64562306a36Sopenharmony_cierror_close_dir: 64662306a36Sopenharmony_ci if (closedir(dp) == -1) 64762306a36Sopenharmony_ci perror("find_type_by_name(): Failed to close directory"); 64862306a36Sopenharmony_ci 64962306a36Sopenharmony_ci return ret; 65062306a36Sopenharmony_ci} 65162306a36Sopenharmony_ci 65262306a36Sopenharmony_cistatic int _write_sysfs_int(const char *filename, const char *basedir, int val, 65362306a36Sopenharmony_ci int verify) 65462306a36Sopenharmony_ci{ 65562306a36Sopenharmony_ci int ret = 0; 65662306a36Sopenharmony_ci FILE *sysfsfp; 65762306a36Sopenharmony_ci int test; 65862306a36Sopenharmony_ci char *temp = malloc(strlen(basedir) + strlen(filename) + 2); 65962306a36Sopenharmony_ci 66062306a36Sopenharmony_ci if (!temp) 66162306a36Sopenharmony_ci return -ENOMEM; 66262306a36Sopenharmony_ci 66362306a36Sopenharmony_ci ret = sprintf(temp, "%s/%s", basedir, filename); 66462306a36Sopenharmony_ci if (ret < 0) 66562306a36Sopenharmony_ci goto error_free; 66662306a36Sopenharmony_ci 66762306a36Sopenharmony_ci sysfsfp = fopen(temp, "w"); 66862306a36Sopenharmony_ci if (!sysfsfp) { 66962306a36Sopenharmony_ci ret = -errno; 67062306a36Sopenharmony_ci fprintf(stderr, "failed to open %s\n", temp); 67162306a36Sopenharmony_ci goto error_free; 67262306a36Sopenharmony_ci } 67362306a36Sopenharmony_ci 67462306a36Sopenharmony_ci ret = fprintf(sysfsfp, "%d", val); 67562306a36Sopenharmony_ci if (ret < 0) { 67662306a36Sopenharmony_ci if (fclose(sysfsfp)) 67762306a36Sopenharmony_ci perror("_write_sysfs_int(): Failed to close dir"); 67862306a36Sopenharmony_ci 67962306a36Sopenharmony_ci goto error_free; 68062306a36Sopenharmony_ci } 68162306a36Sopenharmony_ci 68262306a36Sopenharmony_ci if (fclose(sysfsfp)) { 68362306a36Sopenharmony_ci ret = -errno; 68462306a36Sopenharmony_ci goto error_free; 68562306a36Sopenharmony_ci } 68662306a36Sopenharmony_ci 68762306a36Sopenharmony_ci if (verify) { 68862306a36Sopenharmony_ci sysfsfp = fopen(temp, "r"); 68962306a36Sopenharmony_ci if (!sysfsfp) { 69062306a36Sopenharmony_ci ret = -errno; 69162306a36Sopenharmony_ci fprintf(stderr, "failed to open %s\n", temp); 69262306a36Sopenharmony_ci goto error_free; 69362306a36Sopenharmony_ci } 69462306a36Sopenharmony_ci 69562306a36Sopenharmony_ci if (fscanf(sysfsfp, "%d", &test) != 1) { 69662306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 69762306a36Sopenharmony_ci if (fclose(sysfsfp)) 69862306a36Sopenharmony_ci perror("_write_sysfs_int(): Failed to close dir"); 69962306a36Sopenharmony_ci 70062306a36Sopenharmony_ci goto error_free; 70162306a36Sopenharmony_ci } 70262306a36Sopenharmony_ci 70362306a36Sopenharmony_ci if (fclose(sysfsfp)) { 70462306a36Sopenharmony_ci ret = -errno; 70562306a36Sopenharmony_ci goto error_free; 70662306a36Sopenharmony_ci } 70762306a36Sopenharmony_ci 70862306a36Sopenharmony_ci if (test != val) { 70962306a36Sopenharmony_ci fprintf(stderr, 71062306a36Sopenharmony_ci "Possible failure in int write %d to %s/%s\n", 71162306a36Sopenharmony_ci val, basedir, filename); 71262306a36Sopenharmony_ci ret = -1; 71362306a36Sopenharmony_ci } 71462306a36Sopenharmony_ci } 71562306a36Sopenharmony_ci 71662306a36Sopenharmony_cierror_free: 71762306a36Sopenharmony_ci free(temp); 71862306a36Sopenharmony_ci return ret; 71962306a36Sopenharmony_ci} 72062306a36Sopenharmony_ci 72162306a36Sopenharmony_ci/** 72262306a36Sopenharmony_ci * write_sysfs_int() - write an integer value to a sysfs file 72362306a36Sopenharmony_ci * @filename: name of the file to write to 72462306a36Sopenharmony_ci * @basedir: the sysfs directory in which the file is to be found 72562306a36Sopenharmony_ci * @val: integer value to write to file 72662306a36Sopenharmony_ci * 72762306a36Sopenharmony_ci * Returns a value >= 0 on success, otherwise a negative error code. 72862306a36Sopenharmony_ci **/ 72962306a36Sopenharmony_ciint write_sysfs_int(const char *filename, const char *basedir, int val) 73062306a36Sopenharmony_ci{ 73162306a36Sopenharmony_ci return _write_sysfs_int(filename, basedir, val, 0); 73262306a36Sopenharmony_ci} 73362306a36Sopenharmony_ci 73462306a36Sopenharmony_ci/** 73562306a36Sopenharmony_ci * write_sysfs_int_and_verify() - write an integer value to a sysfs file 73662306a36Sopenharmony_ci * and verify 73762306a36Sopenharmony_ci * @filename: name of the file to write to 73862306a36Sopenharmony_ci * @basedir: the sysfs directory in which the file is to be found 73962306a36Sopenharmony_ci * @val: integer value to write to file 74062306a36Sopenharmony_ci * 74162306a36Sopenharmony_ci * Returns a value >= 0 on success, otherwise a negative error code. 74262306a36Sopenharmony_ci **/ 74362306a36Sopenharmony_ciint write_sysfs_int_and_verify(const char *filename, const char *basedir, 74462306a36Sopenharmony_ci int val) 74562306a36Sopenharmony_ci{ 74662306a36Sopenharmony_ci return _write_sysfs_int(filename, basedir, val, 1); 74762306a36Sopenharmony_ci} 74862306a36Sopenharmony_ci 74962306a36Sopenharmony_cistatic int _write_sysfs_string(const char *filename, const char *basedir, 75062306a36Sopenharmony_ci const char *val, int verify) 75162306a36Sopenharmony_ci{ 75262306a36Sopenharmony_ci int ret = 0; 75362306a36Sopenharmony_ci FILE *sysfsfp; 75462306a36Sopenharmony_ci char *temp = malloc(strlen(basedir) + strlen(filename) + 2); 75562306a36Sopenharmony_ci 75662306a36Sopenharmony_ci if (!temp) { 75762306a36Sopenharmony_ci fprintf(stderr, "Memory allocation failed\n"); 75862306a36Sopenharmony_ci return -ENOMEM; 75962306a36Sopenharmony_ci } 76062306a36Sopenharmony_ci 76162306a36Sopenharmony_ci ret = sprintf(temp, "%s/%s", basedir, filename); 76262306a36Sopenharmony_ci if (ret < 0) 76362306a36Sopenharmony_ci goto error_free; 76462306a36Sopenharmony_ci 76562306a36Sopenharmony_ci sysfsfp = fopen(temp, "w"); 76662306a36Sopenharmony_ci if (!sysfsfp) { 76762306a36Sopenharmony_ci ret = -errno; 76862306a36Sopenharmony_ci fprintf(stderr, "Could not open %s\n", temp); 76962306a36Sopenharmony_ci goto error_free; 77062306a36Sopenharmony_ci } 77162306a36Sopenharmony_ci 77262306a36Sopenharmony_ci ret = fprintf(sysfsfp, "%s", val); 77362306a36Sopenharmony_ci if (ret < 0) { 77462306a36Sopenharmony_ci if (fclose(sysfsfp)) 77562306a36Sopenharmony_ci perror("_write_sysfs_string(): Failed to close dir"); 77662306a36Sopenharmony_ci 77762306a36Sopenharmony_ci goto error_free; 77862306a36Sopenharmony_ci } 77962306a36Sopenharmony_ci 78062306a36Sopenharmony_ci if (fclose(sysfsfp)) { 78162306a36Sopenharmony_ci ret = -errno; 78262306a36Sopenharmony_ci goto error_free; 78362306a36Sopenharmony_ci } 78462306a36Sopenharmony_ci 78562306a36Sopenharmony_ci if (verify) { 78662306a36Sopenharmony_ci sysfsfp = fopen(temp, "r"); 78762306a36Sopenharmony_ci if (!sysfsfp) { 78862306a36Sopenharmony_ci ret = -errno; 78962306a36Sopenharmony_ci fprintf(stderr, "Could not open file to verify\n"); 79062306a36Sopenharmony_ci goto error_free; 79162306a36Sopenharmony_ci } 79262306a36Sopenharmony_ci 79362306a36Sopenharmony_ci if (fscanf(sysfsfp, "%s", temp) != 1) { 79462306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 79562306a36Sopenharmony_ci if (fclose(sysfsfp)) 79662306a36Sopenharmony_ci perror("_write_sysfs_string(): Failed to close dir"); 79762306a36Sopenharmony_ci 79862306a36Sopenharmony_ci goto error_free; 79962306a36Sopenharmony_ci } 80062306a36Sopenharmony_ci 80162306a36Sopenharmony_ci if (fclose(sysfsfp)) { 80262306a36Sopenharmony_ci ret = -errno; 80362306a36Sopenharmony_ci goto error_free; 80462306a36Sopenharmony_ci } 80562306a36Sopenharmony_ci 80662306a36Sopenharmony_ci if (strcmp(temp, val) != 0) { 80762306a36Sopenharmony_ci fprintf(stderr, 80862306a36Sopenharmony_ci "Possible failure in string write of %s " 80962306a36Sopenharmony_ci "Should be %s written to %s/%s\n", temp, val, 81062306a36Sopenharmony_ci basedir, filename); 81162306a36Sopenharmony_ci ret = -1; 81262306a36Sopenharmony_ci } 81362306a36Sopenharmony_ci } 81462306a36Sopenharmony_ci 81562306a36Sopenharmony_cierror_free: 81662306a36Sopenharmony_ci free(temp); 81762306a36Sopenharmony_ci 81862306a36Sopenharmony_ci return ret; 81962306a36Sopenharmony_ci} 82062306a36Sopenharmony_ci 82162306a36Sopenharmony_ci/** 82262306a36Sopenharmony_ci * write_sysfs_string_and_verify() - string write, readback and verify 82362306a36Sopenharmony_ci * @filename: name of file to write to 82462306a36Sopenharmony_ci * @basedir: the sysfs directory in which the file is to be found 82562306a36Sopenharmony_ci * @val: the string to write 82662306a36Sopenharmony_ci * 82762306a36Sopenharmony_ci * Returns a value >= 0 on success, otherwise a negative error code. 82862306a36Sopenharmony_ci **/ 82962306a36Sopenharmony_ciint write_sysfs_string_and_verify(const char *filename, const char *basedir, 83062306a36Sopenharmony_ci const char *val) 83162306a36Sopenharmony_ci{ 83262306a36Sopenharmony_ci return _write_sysfs_string(filename, basedir, val, 1); 83362306a36Sopenharmony_ci} 83462306a36Sopenharmony_ci 83562306a36Sopenharmony_ci/** 83662306a36Sopenharmony_ci * write_sysfs_string() - write string to a sysfs file 83762306a36Sopenharmony_ci * @filename: name of file to write to 83862306a36Sopenharmony_ci * @basedir: the sysfs directory in which the file is to be found 83962306a36Sopenharmony_ci * @val: the string to write 84062306a36Sopenharmony_ci * 84162306a36Sopenharmony_ci * Returns a value >= 0 on success, otherwise a negative error code. 84262306a36Sopenharmony_ci **/ 84362306a36Sopenharmony_ciint write_sysfs_string(const char *filename, const char *basedir, 84462306a36Sopenharmony_ci const char *val) 84562306a36Sopenharmony_ci{ 84662306a36Sopenharmony_ci return _write_sysfs_string(filename, basedir, val, 0); 84762306a36Sopenharmony_ci} 84862306a36Sopenharmony_ci 84962306a36Sopenharmony_ci/** 85062306a36Sopenharmony_ci * read_sysfs_posint() - read an integer value from file 85162306a36Sopenharmony_ci * @filename: name of file to read from 85262306a36Sopenharmony_ci * @basedir: the sysfs directory in which the file is to be found 85362306a36Sopenharmony_ci * 85462306a36Sopenharmony_ci * Returns the read integer value >= 0 on success, otherwise a negative error 85562306a36Sopenharmony_ci * code. 85662306a36Sopenharmony_ci **/ 85762306a36Sopenharmony_ciint read_sysfs_posint(const char *filename, const char *basedir) 85862306a36Sopenharmony_ci{ 85962306a36Sopenharmony_ci int ret; 86062306a36Sopenharmony_ci FILE *sysfsfp; 86162306a36Sopenharmony_ci char *temp = malloc(strlen(basedir) + strlen(filename) + 2); 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_ci if (!temp) { 86462306a36Sopenharmony_ci fprintf(stderr, "Memory allocation failed"); 86562306a36Sopenharmony_ci return -ENOMEM; 86662306a36Sopenharmony_ci } 86762306a36Sopenharmony_ci 86862306a36Sopenharmony_ci ret = sprintf(temp, "%s/%s", basedir, filename); 86962306a36Sopenharmony_ci if (ret < 0) 87062306a36Sopenharmony_ci goto error_free; 87162306a36Sopenharmony_ci 87262306a36Sopenharmony_ci sysfsfp = fopen(temp, "r"); 87362306a36Sopenharmony_ci if (!sysfsfp) { 87462306a36Sopenharmony_ci ret = -errno; 87562306a36Sopenharmony_ci goto error_free; 87662306a36Sopenharmony_ci } 87762306a36Sopenharmony_ci 87862306a36Sopenharmony_ci errno = 0; 87962306a36Sopenharmony_ci if (fscanf(sysfsfp, "%d\n", &ret) != 1) { 88062306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 88162306a36Sopenharmony_ci if (fclose(sysfsfp)) 88262306a36Sopenharmony_ci perror("read_sysfs_posint(): Failed to close dir"); 88362306a36Sopenharmony_ci 88462306a36Sopenharmony_ci goto error_free; 88562306a36Sopenharmony_ci } 88662306a36Sopenharmony_ci 88762306a36Sopenharmony_ci if (fclose(sysfsfp)) 88862306a36Sopenharmony_ci ret = -errno; 88962306a36Sopenharmony_ci 89062306a36Sopenharmony_cierror_free: 89162306a36Sopenharmony_ci free(temp); 89262306a36Sopenharmony_ci 89362306a36Sopenharmony_ci return ret; 89462306a36Sopenharmony_ci} 89562306a36Sopenharmony_ci 89662306a36Sopenharmony_ci/** 89762306a36Sopenharmony_ci * read_sysfs_float() - read a float value from file 89862306a36Sopenharmony_ci * @filename: name of file to read from 89962306a36Sopenharmony_ci * @basedir: the sysfs directory in which the file is to be found 90062306a36Sopenharmony_ci * @val: output the read float value 90162306a36Sopenharmony_ci * 90262306a36Sopenharmony_ci * Returns a value >= 0 on success, otherwise a negative error code. 90362306a36Sopenharmony_ci **/ 90462306a36Sopenharmony_ciint read_sysfs_float(const char *filename, const char *basedir, float *val) 90562306a36Sopenharmony_ci{ 90662306a36Sopenharmony_ci int ret = 0; 90762306a36Sopenharmony_ci FILE *sysfsfp; 90862306a36Sopenharmony_ci char *temp = malloc(strlen(basedir) + strlen(filename) + 2); 90962306a36Sopenharmony_ci 91062306a36Sopenharmony_ci if (!temp) { 91162306a36Sopenharmony_ci fprintf(stderr, "Memory allocation failed"); 91262306a36Sopenharmony_ci return -ENOMEM; 91362306a36Sopenharmony_ci } 91462306a36Sopenharmony_ci 91562306a36Sopenharmony_ci ret = sprintf(temp, "%s/%s", basedir, filename); 91662306a36Sopenharmony_ci if (ret < 0) 91762306a36Sopenharmony_ci goto error_free; 91862306a36Sopenharmony_ci 91962306a36Sopenharmony_ci sysfsfp = fopen(temp, "r"); 92062306a36Sopenharmony_ci if (!sysfsfp) { 92162306a36Sopenharmony_ci ret = -errno; 92262306a36Sopenharmony_ci goto error_free; 92362306a36Sopenharmony_ci } 92462306a36Sopenharmony_ci 92562306a36Sopenharmony_ci errno = 0; 92662306a36Sopenharmony_ci if (fscanf(sysfsfp, "%f\n", val) != 1) { 92762306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 92862306a36Sopenharmony_ci if (fclose(sysfsfp)) 92962306a36Sopenharmony_ci perror("read_sysfs_float(): Failed to close dir"); 93062306a36Sopenharmony_ci 93162306a36Sopenharmony_ci goto error_free; 93262306a36Sopenharmony_ci } 93362306a36Sopenharmony_ci 93462306a36Sopenharmony_ci if (fclose(sysfsfp)) 93562306a36Sopenharmony_ci ret = -errno; 93662306a36Sopenharmony_ci 93762306a36Sopenharmony_cierror_free: 93862306a36Sopenharmony_ci free(temp); 93962306a36Sopenharmony_ci 94062306a36Sopenharmony_ci return ret; 94162306a36Sopenharmony_ci} 94262306a36Sopenharmony_ci 94362306a36Sopenharmony_ci/** 94462306a36Sopenharmony_ci * read_sysfs_string() - read a string from file 94562306a36Sopenharmony_ci * @filename: name of file to read from 94662306a36Sopenharmony_ci * @basedir: the sysfs directory in which the file is to be found 94762306a36Sopenharmony_ci * @str: output the read string 94862306a36Sopenharmony_ci * 94962306a36Sopenharmony_ci * Returns a value >= 0 on success, otherwise a negative error code. 95062306a36Sopenharmony_ci **/ 95162306a36Sopenharmony_ciint read_sysfs_string(const char *filename, const char *basedir, char *str) 95262306a36Sopenharmony_ci{ 95362306a36Sopenharmony_ci int ret = 0; 95462306a36Sopenharmony_ci FILE *sysfsfp; 95562306a36Sopenharmony_ci char *temp = malloc(strlen(basedir) + strlen(filename) + 2); 95662306a36Sopenharmony_ci 95762306a36Sopenharmony_ci if (!temp) { 95862306a36Sopenharmony_ci fprintf(stderr, "Memory allocation failed"); 95962306a36Sopenharmony_ci return -ENOMEM; 96062306a36Sopenharmony_ci } 96162306a36Sopenharmony_ci 96262306a36Sopenharmony_ci ret = sprintf(temp, "%s/%s", basedir, filename); 96362306a36Sopenharmony_ci if (ret < 0) 96462306a36Sopenharmony_ci goto error_free; 96562306a36Sopenharmony_ci 96662306a36Sopenharmony_ci sysfsfp = fopen(temp, "r"); 96762306a36Sopenharmony_ci if (!sysfsfp) { 96862306a36Sopenharmony_ci ret = -errno; 96962306a36Sopenharmony_ci goto error_free; 97062306a36Sopenharmony_ci } 97162306a36Sopenharmony_ci 97262306a36Sopenharmony_ci errno = 0; 97362306a36Sopenharmony_ci if (fscanf(sysfsfp, "%s\n", str) != 1) { 97462306a36Sopenharmony_ci ret = errno ? -errno : -ENODATA; 97562306a36Sopenharmony_ci if (fclose(sysfsfp)) 97662306a36Sopenharmony_ci perror("read_sysfs_string(): Failed to close dir"); 97762306a36Sopenharmony_ci 97862306a36Sopenharmony_ci goto error_free; 97962306a36Sopenharmony_ci } 98062306a36Sopenharmony_ci 98162306a36Sopenharmony_ci if (fclose(sysfsfp)) 98262306a36Sopenharmony_ci ret = -errno; 98362306a36Sopenharmony_ci 98462306a36Sopenharmony_cierror_free: 98562306a36Sopenharmony_ci free(temp); 98662306a36Sopenharmony_ci 98762306a36Sopenharmony_ci return ret; 98862306a36Sopenharmony_ci} 989