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", &current_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						     &current->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", &current->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(&current->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(&current->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(&current->is_signed,
49162306a36Sopenharmony_ci						&current->bytes,
49262306a36Sopenharmony_ci						&current->bits_used,
49362306a36Sopenharmony_ci						&current->shift,
49462306a36Sopenharmony_ci						&current->mask,
49562306a36Sopenharmony_ci						&current->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