Paul Cercueil | bb4401d | 2014-02-28 16:10:49 +0100 | [diff] [blame] | 1 | /* |
| 2 | * libiio - Library for interfacing industrial I/O (IIO) devices |
| 3 | * |
| 4 | * Copyright (C) 2014 Analog Devices, Inc. |
| 5 | * Author: Paul Cercueil <paul.cercueil@analog.com> |
| 6 | * |
| 7 | * This library is free software; you can redistribute it and/or |
| 8 | * modify it under the terms of the GNU Lesser General Public |
| 9 | * License as published by the Free Software Foundation; either |
| 10 | * version 2.1 of the License, or (at your option) any later version. |
| 11 | * |
| 12 | * This library is distributed in the hope that it will be useful, |
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 15 | * Lesser General Public License for more details. |
| 16 | * |
| 17 | * */ |
| 18 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 19 | #include "debug.h" |
| 20 | #include "iio-private.h" |
Robin Getz | 57295ce | 2018-05-24 21:45:08 +0000 | [diff] [blame] | 21 | #include "sort.h" |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 22 | |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 23 | #include <dirent.h> |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 24 | #include <errno.h> |
Lars-Peter Clausen | ea5ea6f | 2016-04-21 18:23:38 +0200 | [diff] [blame] | 25 | #include <limits.h> |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 26 | #include <poll.h> |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 27 | #include <stdbool.h> |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 28 | #include <stddef.h> |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 29 | #include <stdio.h> |
| 30 | #include <string.h> |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 31 | #include <sys/eventfd.h> |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 32 | #include <sys/ioctl.h> |
| 33 | #include <sys/mman.h> |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 34 | #include <sys/types.h> |
| 35 | #include <sys/stat.h> |
| 36 | #include <unistd.h> |
Lars-Peter Clausen | ac9e328 | 2014-07-14 13:36:46 +0200 | [diff] [blame] | 37 | #include <string.h> |
Lars-Peter Clausen | 00f8009 | 2014-07-01 17:52:05 +0200 | [diff] [blame] | 38 | #include <sys/utsname.h> |
Lars-Peter Clausen | b22da00 | 2016-04-21 14:58:53 +0200 | [diff] [blame] | 39 | #include <time.h> |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 40 | #include <unistd.h> |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 41 | #include <fcntl.h> |
Paul Cercueil | e6be070 | 2016-11-18 10:57:23 +0100 | [diff] [blame] | 42 | #ifdef WITH_LOCAL_CONFIG |
| 43 | #include <ini.h> |
| 44 | #endif |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 45 | |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 46 | #define DEFAULT_TIMEOUT_MS 1000 |
| 47 | |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 48 | #define NB_BLOCKS 4 |
| 49 | |
| 50 | #define BLOCK_ALLOC_IOCTL _IOWR('i', 0xa0, struct block_alloc_req) |
| 51 | #define BLOCK_FREE_IOCTL _IO('i', 0xa1) |
| 52 | #define BLOCK_QUERY_IOCTL _IOWR('i', 0xa2, struct block) |
| 53 | #define BLOCK_ENQUEUE_IOCTL _IOWR('i', 0xa3, struct block) |
| 54 | #define BLOCK_DEQUEUE_IOCTL _IOWR('i', 0xa4, struct block) |
| 55 | |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 56 | #define BLOCK_FLAG_CYCLIC BIT(1) |
| 57 | |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 58 | /* Forward declarations */ |
| 59 | static ssize_t local_read_dev_attr(const struct iio_device *dev, |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 60 | const char *attr, char *dst, size_t len, enum iio_attr_type type); |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 61 | static ssize_t local_read_chn_attr(const struct iio_channel *chn, |
| 62 | const char *attr, char *dst, size_t len); |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 63 | static ssize_t local_write_dev_attr(const struct iio_device *dev, |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 64 | const char *attr, const char *src, size_t len, enum iio_attr_type type); |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 65 | static ssize_t local_write_chn_attr(const struct iio_channel *chn, |
| 66 | const char *attr, const char *src, size_t len); |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 67 | |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 68 | struct block_alloc_req { |
| 69 | uint32_t type, |
| 70 | size, |
| 71 | count, |
| 72 | id; |
| 73 | }; |
| 74 | |
| 75 | struct block { |
| 76 | uint32_t id, |
| 77 | size, |
| 78 | bytes_used, |
| 79 | type, |
| 80 | flags, |
| 81 | offset; |
| 82 | uint64_t timestamp; |
| 83 | }; |
| 84 | |
Paul Cercueil | 00558f1 | 2016-04-12 14:40:40 +0200 | [diff] [blame] | 85 | struct iio_context_pdata { |
Lars-Peter Clausen | 8068be3 | 2016-04-22 10:36:34 +0200 | [diff] [blame] | 86 | unsigned int rw_timeout_ms; |
Paul Cercueil | 00558f1 | 2016-04-12 14:40:40 +0200 | [diff] [blame] | 87 | }; |
| 88 | |
Paul Cercueil | eaab658 | 2014-02-21 09:35:59 +0100 | [diff] [blame] | 89 | struct iio_device_pdata { |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 90 | int fd; |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 91 | bool blocking; |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 92 | unsigned int samples_count; |
| 93 | unsigned int max_nb_blocks; |
| 94 | unsigned int allocated_nb_blocks; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 95 | |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 96 | struct block *blocks; |
| 97 | void **addrs; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 98 | int last_dequeued; |
Paul Cercueil | 6ea8a75 | 2014-06-03 11:35:35 +0200 | [diff] [blame] | 99 | bool is_high_speed, cyclic, cyclic_buffer_enqueued, buffer_enabled; |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 100 | |
| 101 | int cancel_fd; |
Paul Cercueil | eaab658 | 2014-02-21 09:35:59 +0100 | [diff] [blame] | 102 | }; |
| 103 | |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 104 | struct iio_channel_pdata { |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 105 | char *enable_fn; |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 106 | struct iio_channel_attr *protected_attrs; |
| 107 | unsigned int nb_protected_attrs; |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 108 | }; |
| 109 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 110 | static const char * const device_attrs_blacklist[] = { |
| 111 | "dev", |
| 112 | "uevent", |
| 113 | }; |
| 114 | |
Matt Fornero | 7f9598f | 2017-11-30 14:07:52 -0500 | [diff] [blame] | 115 | static const char * const buffer_attrs_reserved[] = { |
| 116 | "length", |
| 117 | "enable", |
| 118 | }; |
| 119 | |
Lars-Peter Clausen | 387c866 | 2016-04-21 15:19:09 +0200 | [diff] [blame] | 120 | static int ioctl_nointr(int fd, unsigned long request, void *data) |
| 121 | { |
| 122 | int ret; |
| 123 | |
| 124 | do { |
| 125 | ret = ioctl(fd, request, data); |
| 126 | } while (ret == -1 && errno == EINTR); |
| 127 | |
| 128 | return ret; |
| 129 | } |
| 130 | |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 131 | static void local_free_channel_pdata(struct iio_channel *chn) |
| 132 | { |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 133 | if (chn->pdata) { |
| 134 | free(chn->pdata->enable_fn); |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 135 | free(chn->pdata); |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 136 | } |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 137 | } |
| 138 | |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 139 | static void local_free_pdata(struct iio_device *device) |
| 140 | { |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 141 | unsigned int i; |
| 142 | |
| 143 | for (i = 0; i < device->nb_channels; i++) |
| 144 | local_free_channel_pdata(device->channels[i]); |
| 145 | |
| 146 | if (device->pdata) { |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 147 | free(device->pdata->blocks); |
| 148 | free(device->pdata->addrs); |
| 149 | free(device->pdata); |
| 150 | } |
| 151 | } |
| 152 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 153 | static void local_shutdown(struct iio_context *ctx) |
| 154 | { |
Paul Cercueil | 42d1235 | 2014-05-05 16:11:58 +0200 | [diff] [blame] | 155 | /* Free the backend data stored in every device structure */ |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 156 | unsigned int i; |
Paul Cercueil | 00558f1 | 2016-04-12 14:40:40 +0200 | [diff] [blame] | 157 | |
Paul Cercueil | b04d4d1 | 2016-08-01 15:46:06 +0200 | [diff] [blame] | 158 | for (i = 0; i < ctx->nb_devices; i++) { |
| 159 | struct iio_device *dev = ctx->devices[i]; |
| 160 | |
| 161 | iio_device_close(dev); |
| 162 | local_free_pdata(dev); |
| 163 | } |
Paul Cercueil | 00558f1 | 2016-04-12 14:40:40 +0200 | [diff] [blame] | 164 | |
| 165 | free(ctx->pdata); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 166 | } |
| 167 | |
Michael Hennerich | 1c8aa57 | 2014-11-06 17:42:30 +0100 | [diff] [blame] | 168 | /** Shrinks the first nb characters of a string |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 169 | * e.g. strcut("foobar", 4) replaces the content with "ar". */ |
| 170 | static void strcut(char *str, int nb) |
| 171 | { |
| 172 | char *ptr = str + nb; |
| 173 | while (*ptr) |
| 174 | *str++ = *ptr++; |
| 175 | *str = 0; |
| 176 | } |
| 177 | |
| 178 | static int set_channel_name(struct iio_channel *chn) |
| 179 | { |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 180 | struct iio_channel_pdata *pdata = chn->pdata; |
Lars-Peter Clausen | 816c426 | 2015-03-27 15:57:43 +0100 | [diff] [blame] | 181 | size_t prefix_len = 0; |
| 182 | const char *attr0; |
| 183 | const char *ptr; |
| 184 | unsigned int i; |
| 185 | |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 186 | if (chn->nb_attrs + pdata->nb_protected_attrs < 2) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 187 | return 0; |
| 188 | |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 189 | if (chn->nb_attrs) |
| 190 | attr0 = ptr = chn->attrs[0].name; |
| 191 | else |
| 192 | attr0 = ptr = pdata->protected_attrs[0].name; |
Lars-Peter Clausen | 816c426 | 2015-03-27 15:57:43 +0100 | [diff] [blame] | 193 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 194 | while (true) { |
| 195 | bool can_fix = true; |
Lars-Peter Clausen | 816c426 | 2015-03-27 15:57:43 +0100 | [diff] [blame] | 196 | size_t len; |
| 197 | |
| 198 | ptr = strchr(ptr, '_'); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 199 | if (!ptr) |
| 200 | break; |
| 201 | |
Lars-Peter Clausen | eec8cf8 | 2016-01-25 16:02:02 +0100 | [diff] [blame] | 202 | len = ptr - attr0 + 1; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 203 | for (i = 1; can_fix && i < chn->nb_attrs; i++) |
Paul Cercueil | b34e022 | 2014-05-05 15:32:38 +0200 | [diff] [blame] | 204 | can_fix = !strncmp(attr0, chn->attrs[i].name, len); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 205 | |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 206 | for (i = !chn->nb_attrs; |
| 207 | can_fix && i < pdata->nb_protected_attrs; i++) { |
| 208 | can_fix = !strncmp(attr0, |
| 209 | pdata->protected_attrs[i].name, len); |
| 210 | } |
| 211 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 212 | if (!can_fix) |
| 213 | break; |
| 214 | |
Lars-Peter Clausen | 816c426 | 2015-03-27 15:57:43 +0100 | [diff] [blame] | 215 | prefix_len = len; |
| 216 | ptr = ptr + 1; |
| 217 | } |
| 218 | |
| 219 | if (prefix_len) { |
| 220 | char *name; |
| 221 | |
Lars-Peter Clausen | eec8cf8 | 2016-01-25 16:02:02 +0100 | [diff] [blame] | 222 | name = malloc(prefix_len); |
Lars-Peter Clausen | 816c426 | 2015-03-27 15:57:43 +0100 | [diff] [blame] | 223 | if (!name) |
| 224 | return -ENOMEM; |
Lars-Peter Clausen | eec8cf8 | 2016-01-25 16:02:02 +0100 | [diff] [blame] | 225 | strncpy(name, attr0, prefix_len - 1); |
| 226 | name[prefix_len - 1] = '\0'; |
Lars-Peter Clausen | 816c426 | 2015-03-27 15:57:43 +0100 | [diff] [blame] | 227 | DEBUG("Setting name of channel %s to %s\n", chn->id, name); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 228 | chn->name = name; |
| 229 | |
| 230 | /* Shrink the attribute name */ |
| 231 | for (i = 0; i < chn->nb_attrs; i++) |
Lars-Peter Clausen | eec8cf8 | 2016-01-25 16:02:02 +0100 | [diff] [blame] | 232 | strcut(chn->attrs[i].name, prefix_len); |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 233 | for (i = 0; i < pdata->nb_protected_attrs; i++) |
| 234 | strcut(pdata->protected_attrs[i].name, prefix_len); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 235 | } |
| 236 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 237 | return 0; |
| 238 | } |
| 239 | |
Lars-Peter Clausen | b22da00 | 2016-04-21 14:58:53 +0200 | [diff] [blame] | 240 | /* |
| 241 | * Used to generate the timeout parameter for operations like poll. Returns the |
| 242 | * number of ms until it is timeout_rel ms after the time specified in start. If |
| 243 | * timeout_rel is 0 returns -1 to indicate no timeout. |
| 244 | * |
| 245 | * The timeout that is specified for IIO operations is the maximum time a buffer |
| 246 | * push() or refill() operation should take before returning. poll() is used to |
| 247 | * wait for either data activity or for the timeout to elapse. poll() might get |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 248 | * interrupted in which case it is called again or the read()/write() operation |
| 249 | * might not complete the full buffer size in one call in which case we go back |
| 250 | * to poll() again as well. Passing the same timeout as before would increase |
| 251 | * the total timeout and if repeated interruptions occur (e.g. by a timer |
| 252 | * signal) the operation might never time out or with significant delay. Hence |
| 253 | * before each poll() invocation the timeout is recalculated relative to the |
| 254 | * start of refill() or push() operation. |
Lars-Peter Clausen | b22da00 | 2016-04-21 14:58:53 +0200 | [diff] [blame] | 255 | */ |
| 256 | static int get_rel_timeout_ms(struct timespec *start, unsigned int timeout_rel) |
| 257 | { |
| 258 | struct timespec now; |
| 259 | int diff_ms; |
| 260 | |
| 261 | if (timeout_rel == 0) /* No timeout */ |
| 262 | return -1; |
| 263 | |
| 264 | clock_gettime(CLOCK_MONOTONIC, &now); |
| 265 | |
| 266 | diff_ms = (now.tv_sec - start->tv_sec) * 1000; |
| 267 | diff_ms += (now.tv_nsec - start->tv_nsec) / 1000000; |
| 268 | |
| 269 | if (diff_ms >= timeout_rel) /* Expired */ |
| 270 | return 0; |
| 271 | if (diff_ms > 0) /* Should never be false, but lets be safe */ |
| 272 | timeout_rel -= diff_ms; |
| 273 | if (timeout_rel > INT_MAX) |
| 274 | return INT_MAX; |
| 275 | |
| 276 | return (int) timeout_rel; |
| 277 | } |
| 278 | |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 279 | static int device_check_ready(const struct iio_device *dev, short events, |
| 280 | struct timespec *start) |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 281 | { |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 282 | struct pollfd pollfd[2] = { |
| 283 | { |
| 284 | .fd = dev->pdata->fd, |
| 285 | .events = events, |
| 286 | }, { |
| 287 | .fd = dev->pdata->cancel_fd, |
| 288 | .events = POLLIN, |
| 289 | } |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 290 | }; |
Lars-Peter Clausen | b22da00 | 2016-04-21 14:58:53 +0200 | [diff] [blame] | 291 | unsigned int rw_timeout_ms = dev->ctx->pdata->rw_timeout_ms; |
Lars-Peter Clausen | b22da00 | 2016-04-21 14:58:53 +0200 | [diff] [blame] | 292 | int timeout_rel; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 293 | int ret; |
| 294 | |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 295 | if (!dev->pdata->blocking) |
| 296 | return 0; |
| 297 | |
Lars-Peter Clausen | b22da00 | 2016-04-21 14:58:53 +0200 | [diff] [blame] | 298 | do { |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 299 | timeout_rel = get_rel_timeout_ms(start, rw_timeout_ms); |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 300 | ret = poll(pollfd, 2, timeout_rel); |
Lars-Peter Clausen | b22da00 | 2016-04-21 14:58:53 +0200 | [diff] [blame] | 301 | } while (ret == -1 && errno == EINTR); |
| 302 | |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 303 | if ((pollfd[1].revents & POLLIN)) |
| 304 | return -EBADF; |
| 305 | |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 306 | if (ret < 0) |
| 307 | return -errno; |
| 308 | if (!ret) |
| 309 | return -ETIMEDOUT; |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 310 | if (pollfd[0].revents & POLLNVAL) |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 311 | return -EBADF; |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 312 | if (!(pollfd[0].revents & events)) |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 313 | return -EIO; |
| 314 | return 0; |
| 315 | } |
| 316 | |
Lars-Peter Clausen | 819d310 | 2016-04-21 14:02:09 +0200 | [diff] [blame] | 317 | static ssize_t local_read(const struct iio_device *dev, |
| 318 | void *dst, size_t len, uint32_t *mask, size_t words) |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 319 | { |
Lars-Peter Clausen | 819d310 | 2016-04-21 14:02:09 +0200 | [diff] [blame] | 320 | struct iio_device_pdata *pdata = dev->pdata; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 321 | uintptr_t ptr = (uintptr_t) dst; |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 322 | struct timespec start; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 323 | ssize_t readsize; |
Lars-Peter Clausen | 819d310 | 2016-04-21 14:02:09 +0200 | [diff] [blame] | 324 | ssize_t ret; |
| 325 | |
| 326 | if (pdata->fd == -1) |
| 327 | return -EBADF; |
| 328 | if (words != dev->words) |
| 329 | return -EINVAL; |
| 330 | |
Lars-Peter Clausen | 819d310 | 2016-04-21 14:02:09 +0200 | [diff] [blame] | 331 | memcpy(mask, dev->mask, words); |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 332 | |
Lars-Peter Clausen | 8ba0d5b | 2016-02-17 11:30:23 +0100 | [diff] [blame] | 333 | if (len == 0) |
| 334 | return 0; |
| 335 | |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 336 | clock_gettime(CLOCK_MONOTONIC, &start); |
Lars-Peter Clausen | 525c93e | 2016-04-21 14:05:27 +0200 | [diff] [blame] | 337 | |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 338 | while (len > 0) { |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 339 | ret = device_check_ready(dev, POLLIN, &start); |
| 340 | if (ret < 0) |
| 341 | break; |
| 342 | |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 343 | do { |
Lars-Peter Clausen | 819d310 | 2016-04-21 14:02:09 +0200 | [diff] [blame] | 344 | ret = read(pdata->fd, (void *) ptr, len); |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 345 | } while (ret == -1 && errno == EINTR); |
| 346 | |
| 347 | if (ret == -1) { |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 348 | if (pdata->blocking && errno == EAGAIN) |
| 349 | continue; |
Rémi Lefèvre | a9ef676 | 2016-12-19 16:29:38 +0100 | [diff] [blame] | 350 | ret = -errno; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 351 | break; |
| 352 | } else if (ret == 0) { |
| 353 | ret = -EIO; |
| 354 | break; |
| 355 | } |
| 356 | |
| 357 | ptr += ret; |
| 358 | len -= ret; |
| 359 | } |
| 360 | |
| 361 | readsize = (ssize_t)(ptr - (uintptr_t) dst); |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 362 | if ((ret > 0 || ret == -EAGAIN) && (readsize > 0)) |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 363 | return readsize; |
| 364 | else |
| 365 | return ret; |
| 366 | } |
| 367 | |
Lars-Peter Clausen | 819d310 | 2016-04-21 14:02:09 +0200 | [diff] [blame] | 368 | static ssize_t local_write(const struct iio_device *dev, |
| 369 | const void *src, size_t len) |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 370 | { |
Lars-Peter Clausen | 819d310 | 2016-04-21 14:02:09 +0200 | [diff] [blame] | 371 | struct iio_device_pdata *pdata = dev->pdata; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 372 | uintptr_t ptr = (uintptr_t) src; |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 373 | struct timespec start; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 374 | ssize_t writtensize; |
Lars-Peter Clausen | 819d310 | 2016-04-21 14:02:09 +0200 | [diff] [blame] | 375 | ssize_t ret; |
| 376 | |
| 377 | if (pdata->fd == -1) |
| 378 | return -EBADF; |
| 379 | |
Lars-Peter Clausen | 525c93e | 2016-04-21 14:05:27 +0200 | [diff] [blame] | 380 | if (len == 0) |
| 381 | return 0; |
| 382 | |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 383 | clock_gettime(CLOCK_MONOTONIC, &start); |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 384 | |
| 385 | while (len > 0) { |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 386 | ret = device_check_ready(dev, POLLOUT, &start); |
| 387 | if (ret < 0) |
| 388 | break; |
| 389 | |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 390 | do { |
Lars-Peter Clausen | 819d310 | 2016-04-21 14:02:09 +0200 | [diff] [blame] | 391 | ret = write(pdata->fd, (void *) ptr, len); |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 392 | } while (ret == -1 && errno == EINTR); |
| 393 | |
| 394 | if (ret == -1) { |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 395 | if (pdata->blocking && errno == EAGAIN) |
| 396 | continue; |
| 397 | |
Rémi Lefèvre | a9ef676 | 2016-12-19 16:29:38 +0100 | [diff] [blame] | 398 | ret = -errno; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 399 | break; |
| 400 | } else if (ret == 0) { |
| 401 | ret = -EIO; |
| 402 | break; |
| 403 | } |
| 404 | |
| 405 | ptr += ret; |
| 406 | len -= ret; |
| 407 | } |
| 408 | |
| 409 | writtensize = (ssize_t)(ptr - (uintptr_t) src); |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 410 | if ((ret > 0 || ret == -EAGAIN) && (writtensize > 0)) |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 411 | return writtensize; |
| 412 | else |
| 413 | return ret; |
| 414 | } |
| 415 | |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 416 | static ssize_t local_enable_buffer(const struct iio_device *dev) |
| 417 | { |
| 418 | struct iio_device_pdata *pdata = dev->pdata; |
| 419 | ssize_t ret = 0; |
| 420 | |
| 421 | if (!pdata->buffer_enabled) { |
| 422 | ret = local_write_dev_attr(dev, |
| 423 | "buffer/enable", "1", 2, false); |
| 424 | if (ret >= 0) |
| 425 | pdata->buffer_enabled = true; |
| 426 | } |
| 427 | |
Robin Getz | 79ccac8 | 2018-10-30 17:49:22 -0400 | [diff] [blame] | 428 | return ret; |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 429 | } |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 430 | |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 431 | static int local_set_kernel_buffers_count(const struct iio_device *dev, |
| 432 | unsigned int nb_blocks) |
| 433 | { |
| 434 | struct iio_device_pdata *pdata = dev->pdata; |
| 435 | |
| 436 | if (pdata->fd != -1) |
| 437 | return -EBUSY; |
| 438 | |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 439 | pdata->max_nb_blocks = nb_blocks; |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 440 | |
| 441 | return 0; |
| 442 | } |
| 443 | |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 444 | static ssize_t local_get_buffer(const struct iio_device *dev, |
Paul Cercueil | 76ca884 | 2015-03-05 11:16:16 +0100 | [diff] [blame] | 445 | void **addr_ptr, size_t bytes_used, |
| 446 | uint32_t *mask, size_t words) |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 447 | { |
| 448 | struct block block; |
| 449 | struct iio_device_pdata *pdata = dev->pdata; |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 450 | struct timespec start; |
Lars-Peter Clausen | 3417a1a | 2016-04-18 14:29:02 +0200 | [diff] [blame] | 451 | char err_str[1024]; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 452 | int f = pdata->fd; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 453 | ssize_t ret; |
| 454 | |
| 455 | if (!pdata->is_high_speed) |
| 456 | return -ENOSYS; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 457 | if (f == -1) |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 458 | return -EBADF; |
Paul Cercueil | 3b6ad44 | 2014-05-12 17:43:31 +0200 | [diff] [blame] | 459 | if (!addr_ptr) |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 460 | return -EINVAL; |
| 461 | |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 462 | if (pdata->last_dequeued >= 0) { |
Paul Cercueil | 3b6ad44 | 2014-05-12 17:43:31 +0200 | [diff] [blame] | 463 | struct block *last_block = &pdata->blocks[pdata->last_dequeued]; |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 464 | |
| 465 | if (pdata->cyclic) { |
| 466 | if (pdata->cyclic_buffer_enqueued) |
| 467 | return -EBUSY; |
| 468 | pdata->blocks[0].flags |= BLOCK_FLAG_CYCLIC; |
| 469 | pdata->cyclic_buffer_enqueued = true; |
| 470 | } |
| 471 | |
Paul Cercueil | 3b6ad44 | 2014-05-12 17:43:31 +0200 | [diff] [blame] | 472 | last_block->bytes_used = bytes_used; |
Lars-Peter Clausen | 387c866 | 2016-04-21 15:19:09 +0200 | [diff] [blame] | 473 | ret = (ssize_t) ioctl_nointr(f, |
Paul Cercueil | 3b6ad44 | 2014-05-12 17:43:31 +0200 | [diff] [blame] | 474 | BLOCK_ENQUEUE_IOCTL, last_block); |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 475 | if (ret) { |
| 476 | ret = (ssize_t) -errno; |
Lars-Peter Clausen | 3417a1a | 2016-04-18 14:29:02 +0200 | [diff] [blame] | 477 | iio_strerror(errno, err_str, sizeof(err_str)); |
| 478 | ERROR("Unable to enqueue block: %s\n", err_str); |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 479 | return ret; |
| 480 | } |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 481 | |
| 482 | if (pdata->cyclic) { |
| 483 | *addr_ptr = pdata->addrs[pdata->last_dequeued]; |
| 484 | return (ssize_t) last_block->bytes_used; |
| 485 | } |
Markus Gnadl | 6991e29 | 2017-12-19 13:55:52 +0100 | [diff] [blame] | 486 | |
| 487 | pdata->last_dequeued = -1; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 488 | } |
| 489 | |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 490 | clock_gettime(CLOCK_MONOTONIC, &start); |
Lars-Peter Clausen | e63811e | 2016-04-21 11:22:33 +0200 | [diff] [blame] | 491 | |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 492 | do { |
| 493 | ret = (ssize_t) device_check_ready(dev, POLLIN | POLLOUT, &start); |
| 494 | if (ret < 0) |
| 495 | return ret; |
| 496 | |
| 497 | memset(&block, 0, sizeof(block)); |
| 498 | ret = (ssize_t) ioctl_nointr(f, BLOCK_DEQUEUE_IOCTL, &block); |
| 499 | } while (pdata->blocking && ret == -1 && errno == EAGAIN); |
| 500 | |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 501 | if (ret) { |
| 502 | ret = (ssize_t) -errno; |
Paul Cercueil | ea51a3f | 2016-05-25 17:22:03 +0200 | [diff] [blame] | 503 | if ((!pdata->blocking && ret != -EAGAIN) || |
| 504 | (pdata->blocking && ret != -ETIMEDOUT)) { |
Lars-Peter Clausen | f840835 | 2016-04-25 10:43:11 +0200 | [diff] [blame] | 505 | iio_strerror(errno, err_str, sizeof(err_str)); |
| 506 | ERROR("Unable to dequeue block: %s\n", err_str); |
| 507 | } |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 508 | return ret; |
| 509 | } |
| 510 | |
Paul Cercueil | 558ade4 | 2014-11-27 10:59:48 +0100 | [diff] [blame] | 511 | /* Requested buffer size is too big! */ |
Dan Nechita | ed45c96 | 2020-02-04 10:56:42 +0200 | [diff] [blame] | 512 | if (pdata->last_dequeued < 0 && bytes_used > block.size) |
Paul Cercueil | 558ade4 | 2014-11-27 10:59:48 +0100 | [diff] [blame] | 513 | return -EFBIG; |
| 514 | |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 515 | pdata->last_dequeued = block.id; |
| 516 | *addr_ptr = pdata->addrs[block.id]; |
| 517 | return (ssize_t) block.bytes_used; |
| 518 | } |
| 519 | |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 520 | static ssize_t local_read_all_dev_attrs(const struct iio_device *dev, |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 521 | char *dst, size_t len, enum iio_attr_type type) |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 522 | { |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 523 | unsigned int i, nb; |
| 524 | char **attrs; |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 525 | char *ptr = dst; |
| 526 | |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 527 | switch (type) { |
| 528 | case IIO_ATTR_TYPE_DEVICE: |
| 529 | nb = dev->nb_attrs; |
| 530 | attrs = dev->attrs; |
| 531 | break; |
| 532 | case IIO_ATTR_TYPE_DEBUG: |
| 533 | nb = dev->nb_debug_attrs; |
| 534 | attrs = dev->debug_attrs; |
| 535 | break; |
| 536 | case IIO_ATTR_TYPE_BUFFER: |
| 537 | nb = dev->nb_buffer_attrs; |
| 538 | attrs = dev->buffer_attrs; |
| 539 | break; |
| 540 | default: |
| 541 | return -EINVAL; |
| 542 | break; |
| 543 | } |
| 544 | |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 545 | for (i = 0; len >= 4 && i < nb; i++) { |
| 546 | /* Recursive! */ |
| 547 | ssize_t ret = local_read_dev_attr(dev, attrs[i], |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 548 | ptr + 4, len - 4, type); |
Paul Cercueil | 2042c90 | 2016-04-25 18:43:45 +0200 | [diff] [blame] | 549 | *(uint32_t *) ptr = iio_htobe32(ret); |
Paul Cercueil | 13fb262 | 2014-06-05 15:53:20 +0200 | [diff] [blame] | 550 | |
| 551 | /* Align the length to 4 bytes */ |
| 552 | if (ret > 0 && ret & 3) |
| 553 | ret = ((ret >> 2) + 1) << 2; |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 554 | ptr += 4 + (ret < 0 ? 0 : ret); |
| 555 | len -= 4 + (ret < 0 ? 0 : ret); |
| 556 | } |
| 557 | |
| 558 | return ptr - dst; |
| 559 | } |
| 560 | |
| 561 | static ssize_t local_read_all_chn_attrs(const struct iio_channel *chn, |
| 562 | char *dst, size_t len) |
| 563 | { |
| 564 | unsigned int i; |
| 565 | char *ptr = dst; |
| 566 | |
| 567 | for (i = 0; len >= 4 && i < chn->nb_attrs; i++) { |
| 568 | /* Recursive! */ |
| 569 | ssize_t ret = local_read_chn_attr(chn, |
| 570 | chn->attrs[i].name, ptr + 4, len - 4); |
Paul Cercueil | 2042c90 | 2016-04-25 18:43:45 +0200 | [diff] [blame] | 571 | *(uint32_t *) ptr = iio_htobe32(ret); |
Paul Cercueil | 13fb262 | 2014-06-05 15:53:20 +0200 | [diff] [blame] | 572 | |
| 573 | /* Align the length to 4 bytes */ |
| 574 | if (ret > 0 && ret & 3) |
| 575 | ret = ((ret >> 2) + 1) << 2; |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 576 | ptr += 4 + (ret < 0 ? 0 : ret); |
| 577 | len -= 4 + (ret < 0 ? 0 : ret); |
| 578 | } |
| 579 | |
| 580 | return ptr - dst; |
| 581 | } |
| 582 | |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 583 | static int local_buffer_analyze(unsigned int nb, const char *src, size_t len) |
| 584 | { |
| 585 | while (nb--) { |
| 586 | int32_t val; |
| 587 | |
| 588 | if (len < 4) |
| 589 | return -EINVAL; |
| 590 | |
Paul Cercueil | 2042c90 | 2016-04-25 18:43:45 +0200 | [diff] [blame] | 591 | val = (int32_t) iio_be32toh(*(uint32_t *) src); |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 592 | src += 4; |
| 593 | len -= 4; |
| 594 | |
| 595 | if (val > 0) { |
| 596 | if ((uint32_t) val > len) |
| 597 | return -EINVAL; |
Paul Cercueil | 33f2145 | 2014-06-10 13:57:41 +0200 | [diff] [blame] | 598 | |
| 599 | /* Align the length to 4 bytes */ |
| 600 | if (val & 3) |
| 601 | val = ((val >> 2) + 1) << 2; |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 602 | len -= val; |
| 603 | src += val; |
| 604 | } |
| 605 | } |
| 606 | |
| 607 | /* We should have analyzed the whole buffer by now */ |
| 608 | return !len ? 0 : -EINVAL; |
| 609 | } |
| 610 | |
| 611 | static ssize_t local_write_all_dev_attrs(const struct iio_device *dev, |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 612 | const char *src, size_t len, enum iio_attr_type type) |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 613 | { |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 614 | unsigned int i, nb; |
| 615 | char **attrs; |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 616 | const char *ptr = src; |
| 617 | |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 618 | switch (type) { |
| 619 | case IIO_ATTR_TYPE_DEVICE: |
| 620 | nb = dev->nb_attrs; |
| 621 | attrs = dev->attrs; |
| 622 | break; |
| 623 | case IIO_ATTR_TYPE_DEBUG: |
| 624 | nb = dev->nb_debug_attrs; |
| 625 | attrs = dev->debug_attrs; |
| 626 | break; |
| 627 | case IIO_ATTR_TYPE_BUFFER: |
| 628 | nb = dev->nb_buffer_attrs; |
| 629 | attrs = dev->buffer_attrs; |
| 630 | break; |
| 631 | default: |
| 632 | return -EINVAL; |
| 633 | break; |
| 634 | } |
| 635 | |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 636 | /* First step: Verify that the buffer is in the correct format */ |
| 637 | if (local_buffer_analyze(nb, src, len)) |
| 638 | return -EINVAL; |
| 639 | |
| 640 | /* Second step: write the attributes */ |
| 641 | for (i = 0; i < nb; i++) { |
Paul Cercueil | 2042c90 | 2016-04-25 18:43:45 +0200 | [diff] [blame] | 642 | int32_t val = (int32_t) iio_be32toh(*(uint32_t *) ptr); |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 643 | ptr += 4; |
| 644 | |
| 645 | if (val > 0) { |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 646 | local_write_dev_attr(dev, attrs[i], ptr, val, type); |
Paul Cercueil | 13fb262 | 2014-06-05 15:53:20 +0200 | [diff] [blame] | 647 | |
| 648 | /* Align the length to 4 bytes */ |
| 649 | if (val & 3) |
| 650 | val = ((val >> 2) + 1) << 2; |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 651 | ptr += val; |
| 652 | } |
| 653 | } |
| 654 | |
| 655 | return ptr - src; |
| 656 | } |
| 657 | |
| 658 | static ssize_t local_write_all_chn_attrs(const struct iio_channel *chn, |
| 659 | const char *src, size_t len) |
| 660 | { |
| 661 | unsigned int i, nb = chn->nb_attrs; |
| 662 | const char *ptr = src; |
| 663 | |
| 664 | /* First step: Verify that the buffer is in the correct format */ |
| 665 | if (local_buffer_analyze(nb, src, len)) |
| 666 | return -EINVAL; |
| 667 | |
| 668 | /* Second step: write the attributes */ |
| 669 | for (i = 0; i < nb; i++) { |
Paul Cercueil | 2042c90 | 2016-04-25 18:43:45 +0200 | [diff] [blame] | 670 | int32_t val = (int32_t) iio_be32toh(*(uint32_t *) ptr); |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 671 | ptr += 4; |
| 672 | |
| 673 | if (val > 0) { |
| 674 | local_write_chn_attr(chn, chn->attrs[i].name, ptr, val); |
Paul Cercueil | 13fb262 | 2014-06-05 15:53:20 +0200 | [diff] [blame] | 675 | |
| 676 | /* Align the length to 4 bytes */ |
| 677 | if (val & 3) |
| 678 | val = ((val >> 2) + 1) << 2; |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 679 | ptr += val; |
| 680 | } |
| 681 | } |
| 682 | |
| 683 | return ptr - src; |
| 684 | } |
| 685 | |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 686 | static ssize_t local_read_dev_attr(const struct iio_device *dev, |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 687 | const char *attr, char *dst, size_t len, enum iio_attr_type type) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 688 | { |
Paul Cercueil | 3e89830 | 2014-02-17 16:17:11 +0100 | [diff] [blame] | 689 | FILE *f; |
| 690 | char buf[1024]; |
| 691 | ssize_t ret; |
| 692 | |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 693 | if (!attr) |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 694 | return local_read_all_dev_attrs(dev, dst, len, type); |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 695 | |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 696 | switch (type) { |
| 697 | case IIO_ATTR_TYPE_DEVICE: |
| 698 | iio_snprintf(buf, sizeof(buf), "/sys/bus/iio/devices/%s/%s", |
| 699 | dev->id, attr); |
| 700 | break; |
| 701 | case IIO_ATTR_TYPE_DEBUG: |
| 702 | iio_snprintf(buf, sizeof(buf), "/sys/kernel/debug/iio/%s/%s", |
| 703 | dev->id, attr); |
| 704 | break; |
| 705 | case IIO_ATTR_TYPE_BUFFER: |
| 706 | iio_snprintf(buf, sizeof(buf), "/sys/bus/iio/devices/%s/buffer/%s", |
| 707 | dev->id, attr); |
| 708 | break; |
| 709 | default: |
| 710 | return -EINVAL; |
Paul Cercueil | 9c9a556 | 2017-01-24 10:48:31 +0100 | [diff] [blame] | 711 | } |
| 712 | |
Lars-Peter Clausen | e791774 | 2016-02-11 14:49:16 +0100 | [diff] [blame] | 713 | f = fopen(buf, "re"); |
Paul Cercueil | 3e89830 | 2014-02-17 16:17:11 +0100 | [diff] [blame] | 714 | if (!f) |
| 715 | return -errno; |
| 716 | |
| 717 | ret = fread(dst, 1, len, f); |
| 718 | if (ret > 0) |
| 719 | dst[ret - 1] = '\0'; |
Adrian Suciu | 8edf0a2 | 2019-07-09 12:20:22 +0300 | [diff] [blame] | 720 | else |
| 721 | dst[0] = '\0'; |
Paul Cercueil | 96dfedd | 2014-03-11 09:53:09 +0100 | [diff] [blame] | 722 | fflush(f); |
| 723 | if (ferror(f)) |
Paul Cercueil | f466c6d | 2014-06-02 17:41:02 +0200 | [diff] [blame] | 724 | ret = -errno; |
Paul Cercueil | 3e89830 | 2014-02-17 16:17:11 +0100 | [diff] [blame] | 725 | fclose(f); |
Paul Cercueil | 6e7f79e | 2014-04-04 12:27:24 +0200 | [diff] [blame] | 726 | return ret ? ret : -EIO; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 727 | } |
| 728 | |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 729 | static ssize_t local_write_dev_attr(const struct iio_device *dev, |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 730 | const char *attr, const char *src, size_t len, enum iio_attr_type type) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 731 | { |
Paul Cercueil | 3e89830 | 2014-02-17 16:17:11 +0100 | [diff] [blame] | 732 | FILE *f; |
| 733 | char buf[1024]; |
| 734 | ssize_t ret; |
Paul Cercueil | 3e89830 | 2014-02-17 16:17:11 +0100 | [diff] [blame] | 735 | |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 736 | if (!attr) |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 737 | return local_write_all_dev_attrs(dev, src, len, type); |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 738 | |
Matt Fornero | 81f04a5 | 2017-11-30 14:36:37 -0500 | [diff] [blame] | 739 | switch (type) { |
| 740 | case IIO_ATTR_TYPE_DEVICE: |
| 741 | iio_snprintf(buf, sizeof(buf), "/sys/bus/iio/devices/%s/%s", |
| 742 | dev->id, attr); |
| 743 | break; |
| 744 | case IIO_ATTR_TYPE_DEBUG: |
| 745 | iio_snprintf(buf, sizeof(buf), "/sys/kernel/debug/iio/%s/%s", |
| 746 | dev->id, attr); |
| 747 | break; |
| 748 | case IIO_ATTR_TYPE_BUFFER: |
| 749 | iio_snprintf(buf, sizeof(buf), "/sys/bus/iio/devices/%s/buffer/%s", |
| 750 | dev->id, attr); |
| 751 | break; |
| 752 | default: |
| 753 | return -EINVAL; |
Paul Cercueil | 9c9a556 | 2017-01-24 10:48:31 +0100 | [diff] [blame] | 754 | } |
| 755 | |
Lars-Peter Clausen | e791774 | 2016-02-11 14:49:16 +0100 | [diff] [blame] | 756 | f = fopen(buf, "we"); |
Paul Cercueil | 3e89830 | 2014-02-17 16:17:11 +0100 | [diff] [blame] | 757 | if (!f) |
| 758 | return -errno; |
| 759 | |
| 760 | ret = fwrite(src, 1, len, f); |
Paul Cercueil | 96dfedd | 2014-03-11 09:53:09 +0100 | [diff] [blame] | 761 | fflush(f); |
| 762 | if (ferror(f)) |
Paul Cercueil | f466c6d | 2014-06-02 17:41:02 +0200 | [diff] [blame] | 763 | ret = -errno; |
Paul Cercueil | 3e89830 | 2014-02-17 16:17:11 +0100 | [diff] [blame] | 764 | fclose(f); |
Paul Cercueil | 6e7f79e | 2014-04-04 12:27:24 +0200 | [diff] [blame] | 765 | return ret ? ret : -EIO; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 766 | } |
| 767 | |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 768 | static const char * get_filename(const struct iio_channel *chn, |
| 769 | const char *attr) |
| 770 | { |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 771 | unsigned int i; |
Paul Cercueil | 42d1235 | 2014-05-05 16:11:58 +0200 | [diff] [blame] | 772 | for (i = 0; i < chn->nb_attrs; i++) |
| 773 | if (!strcmp(attr, chn->attrs[i].name)) |
| 774 | return chn->attrs[i].filename; |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 775 | return attr; |
| 776 | } |
| 777 | |
| 778 | static ssize_t local_read_chn_attr(const struct iio_channel *chn, |
| 779 | const char *attr, char *dst, size_t len) |
| 780 | { |
Paul Cercueil | 4ca6ddc | 2014-05-21 14:51:50 +0200 | [diff] [blame] | 781 | if (!attr) |
| 782 | return local_read_all_chn_attrs(chn, dst, len); |
| 783 | |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 784 | attr = get_filename(chn, attr); |
Paul Cercueil | 50c762a | 2014-04-14 15:55:43 +0200 | [diff] [blame] | 785 | return local_read_dev_attr(chn->dev, attr, dst, len, false); |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 786 | } |
| 787 | |
| 788 | static ssize_t local_write_chn_attr(const struct iio_channel *chn, |
Paul Cercueil | cecda35 | 2014-05-06 18:14:29 +0200 | [diff] [blame] | 789 | const char *attr, const char *src, size_t len) |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 790 | { |
Paul Cercueil | 1da2812 | 2014-05-22 10:59:49 +0200 | [diff] [blame] | 791 | if (!attr) |
| 792 | return local_write_all_chn_attrs(chn, src, len); |
| 793 | |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 794 | attr = get_filename(chn, attr); |
Paul Cercueil | cecda35 | 2014-05-06 18:14:29 +0200 | [diff] [blame] | 795 | return local_write_dev_attr(chn->dev, attr, src, len, false); |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 796 | } |
| 797 | |
Lars-Peter Clausen | 1302f96 | 2017-08-10 09:52:58 +0200 | [diff] [blame] | 798 | static int channel_write_state(const struct iio_channel *chn, bool en) |
Paul Cercueil | 8a7975e | 2014-03-12 12:53:43 +0100 | [diff] [blame] | 799 | { |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 800 | ssize_t ret; |
| 801 | |
Paul Cercueil | 270f304 | 2017-04-11 17:28:59 +0200 | [diff] [blame] | 802 | if (!chn->pdata->enable_fn) { |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 803 | ERROR("Libiio bug: No \"en\" attribute parsed\n"); |
| 804 | return -EINVAL; |
| 805 | } |
| 806 | |
Lars-Peter Clausen | 1302f96 | 2017-08-10 09:52:58 +0200 | [diff] [blame] | 807 | ret = local_write_chn_attr(chn, chn->pdata->enable_fn, en ? "1" : "0", 2); |
Paul Cercueil | 8a7975e | 2014-03-12 12:53:43 +0100 | [diff] [blame] | 808 | if (ret < 0) |
| 809 | return (int) ret; |
| 810 | else |
| 811 | return 0; |
| 812 | } |
| 813 | |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 814 | static int enable_high_speed(const struct iio_device *dev) |
| 815 | { |
| 816 | struct block_alloc_req req; |
| 817 | struct iio_device_pdata *pdata = dev->pdata; |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 818 | unsigned int nb_blocks; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 819 | unsigned int i; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 820 | int ret, fd = pdata->fd; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 821 | |
Lars-Peter Clausen | 9ff8c7a | 2018-05-02 14:04:55 +0200 | [diff] [blame] | 822 | /* |
| 823 | * For the BLOCK_ALLOC_IOCTL ioctl it is not possible to distingush |
| 824 | * between an error during the allocation (e.g. incorrect size) or |
| 825 | * whether the high-speed interface is not supported. BLOCK_FREE_IOCTL does |
| 826 | * never fail if the device supports the high-speed interface, so we use it |
| 827 | * here. Calling it when no blocks are allocated the ioctl has no effect. |
| 828 | */ |
| 829 | ret = ioctl_nointr(fd, BLOCK_FREE_IOCTL, NULL); |
| 830 | if (ret < 0) |
| 831 | return -ENOSYS; |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 832 | |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 833 | if (pdata->cyclic) { |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 834 | nb_blocks = 1; |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 835 | DEBUG("Enabling cyclic mode\n"); |
| 836 | } else { |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 837 | nb_blocks = pdata->max_nb_blocks; |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 838 | DEBUG("Cyclic mode not enabled\n"); |
| 839 | } |
| 840 | |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 841 | pdata->blocks = calloc(nb_blocks, sizeof(*pdata->blocks)); |
| 842 | if (!pdata->blocks) |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 843 | return -ENOMEM; |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 844 | |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 845 | pdata->addrs = calloc(nb_blocks, sizeof(*pdata->addrs)); |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 846 | if (!pdata->addrs) { |
| 847 | free(pdata->blocks); |
| 848 | pdata->blocks = NULL; |
| 849 | return -ENOMEM; |
| 850 | } |
| 851 | |
Paul Cercueil | 1fa913d | 2015-04-28 16:30:53 +0200 | [diff] [blame] | 852 | req.id = 0; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 853 | req.type = 0; |
| 854 | req.size = pdata->samples_count * |
| 855 | iio_device_get_sample_size_mask(dev, dev->mask, dev->words); |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 856 | req.count = nb_blocks; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 857 | |
Lars-Peter Clausen | 387c866 | 2016-04-21 15:19:09 +0200 | [diff] [blame] | 858 | ret = ioctl_nointr(fd, BLOCK_ALLOC_IOCTL, &req); |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 859 | if (ret < 0) { |
| 860 | ret = -errno; |
| 861 | goto err_freemem; |
| 862 | } |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 863 | |
Lars-Peter Clausen | 5552643 | 2017-11-15 13:24:46 +0100 | [diff] [blame] | 864 | if (req.count == 0) { |
| 865 | ret = -ENOMEM; |
| 866 | goto err_block_free; |
| 867 | } |
| 868 | |
Lars-Peter Clausen | c27cc53 | 2014-07-08 10:47:26 +0200 | [diff] [blame] | 869 | /* We might get less blocks than what we asked for */ |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 870 | pdata->allocated_nb_blocks = req.count; |
Lars-Peter Clausen | c27cc53 | 2014-07-08 10:47:26 +0200 | [diff] [blame] | 871 | |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 872 | /* mmap all the blocks */ |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 873 | for (i = 0; i < pdata->allocated_nb_blocks; i++) { |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 874 | pdata->blocks[i].id = i; |
Lars-Peter Clausen | 387c866 | 2016-04-21 15:19:09 +0200 | [diff] [blame] | 875 | ret = ioctl_nointr(fd, BLOCK_QUERY_IOCTL, &pdata->blocks[i]); |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 876 | if (ret) { |
| 877 | ret = -errno; |
| 878 | goto err_munmap; |
| 879 | } |
| 880 | |
Lars-Peter Clausen | 387c866 | 2016-04-21 15:19:09 +0200 | [diff] [blame] | 881 | ret = ioctl_nointr(fd, BLOCK_ENQUEUE_IOCTL, &pdata->blocks[i]); |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 882 | if (ret) { |
| 883 | ret = -errno; |
| 884 | goto err_munmap; |
| 885 | } |
| 886 | |
Paul Cercueil | 032a565 | 2014-05-12 17:11:19 +0200 | [diff] [blame] | 887 | pdata->addrs[i] = mmap(0, pdata->blocks[i].size, |
| 888 | PROT_READ | PROT_WRITE, |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 889 | MAP_SHARED, fd, pdata->blocks[i].offset); |
| 890 | if (pdata->addrs[i] == MAP_FAILED) { |
| 891 | ret = -errno; |
| 892 | goto err_munmap; |
| 893 | } |
| 894 | } |
| 895 | |
Paul Cercueil | 4a702d3 | 2014-05-12 17:02:37 +0200 | [diff] [blame] | 896 | pdata->last_dequeued = -1; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 897 | return 0; |
| 898 | |
| 899 | err_munmap: |
| 900 | for (; i > 0; i--) |
| 901 | munmap(pdata->addrs[i - 1], pdata->blocks[i - 1].size); |
Lars-Peter Clausen | 5552643 | 2017-11-15 13:24:46 +0100 | [diff] [blame] | 902 | err_block_free: |
Lars-Peter Clausen | 387c866 | 2016-04-21 15:19:09 +0200 | [diff] [blame] | 903 | ioctl_nointr(fd, BLOCK_FREE_IOCTL, 0); |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 904 | pdata->allocated_nb_blocks = 0; |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 905 | err_freemem: |
| 906 | free(pdata->addrs); |
| 907 | pdata->addrs = NULL; |
| 908 | free(pdata->blocks); |
| 909 | pdata->blocks = NULL; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 910 | return ret; |
| 911 | } |
| 912 | |
Paul Cercueil | 92f15c2 | 2015-04-20 11:36:51 +0200 | [diff] [blame] | 913 | static int local_open(const struct iio_device *dev, |
| 914 | size_t samples_count, bool cyclic) |
Paul Cercueil | 8a7975e | 2014-03-12 12:53:43 +0100 | [diff] [blame] | 915 | { |
| 916 | unsigned int i; |
| 917 | int ret; |
| 918 | char buf[1024]; |
| 919 | struct iio_device_pdata *pdata = dev->pdata; |
Lars-Peter Clausen | 00f8009 | 2014-07-01 17:52:05 +0200 | [diff] [blame] | 920 | |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 921 | if (pdata->fd != -1) |
Paul Cercueil | 8a7975e | 2014-03-12 12:53:43 +0100 | [diff] [blame] | 922 | return -EBUSY; |
| 923 | |
Paul Cercueil | cecda35 | 2014-05-06 18:14:29 +0200 | [diff] [blame] | 924 | ret = local_write_dev_attr(dev, "buffer/enable", "0", 2, false); |
Paul Cercueil | f0aeae3 | 2014-04-02 13:52:26 +0200 | [diff] [blame] | 925 | if (ret < 0) |
Paul Cercueil | 48e3945 | 2014-03-14 09:37:53 +0100 | [diff] [blame] | 926 | return ret; |
| 927 | |
Paul Cercueil | 9c9a556 | 2017-01-24 10:48:31 +0100 | [diff] [blame] | 928 | iio_snprintf(buf, sizeof(buf), "%lu", (unsigned long) samples_count); |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 929 | ret = local_write_dev_attr(dev, "buffer/length", |
| 930 | buf, strlen(buf) + 1, false); |
| 931 | if (ret < 0) |
| 932 | return ret; |
Paul Cercueil | e6ebf49 | 2014-04-02 13:57:36 +0200 | [diff] [blame] | 933 | |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 934 | pdata->cancel_fd = eventfd(0, EFD_CLOEXEC | EFD_NONBLOCK); |
| 935 | if (pdata->cancel_fd == -1) |
| 936 | return -errno; |
| 937 | |
Paul Cercueil | 9c9a556 | 2017-01-24 10:48:31 +0100 | [diff] [blame] | 938 | iio_snprintf(buf, sizeof(buf), "/dev/%s", dev->id); |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 939 | pdata->fd = open(buf, O_RDWR | O_CLOEXEC | O_NONBLOCK); |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 940 | if (pdata->fd == -1) { |
| 941 | ret = -errno; |
| 942 | goto err_close_cancel_fd; |
| 943 | } |
Paul Cercueil | 8a7975e | 2014-03-12 12:53:43 +0100 | [diff] [blame] | 944 | |
Paul Cercueil | 1133434 | 2015-06-23 16:55:35 +0200 | [diff] [blame] | 945 | /* Disable channels */ |
| 946 | for (i = 0; i < dev->nb_channels; i++) { |
| 947 | struct iio_channel *chn = dev->channels[i]; |
| 948 | if (chn->index >= 0 && !iio_channel_is_enabled(chn)) { |
Lars-Peter Clausen | 1302f96 | 2017-08-10 09:52:58 +0200 | [diff] [blame] | 949 | ret = channel_write_state(chn, false); |
Paul Cercueil | 1133434 | 2015-06-23 16:55:35 +0200 | [diff] [blame] | 950 | if (ret < 0) |
| 951 | goto err_close; |
Lars-Peter Clausen | 15d7e15 | 2015-03-04 15:59:47 +0100 | [diff] [blame] | 952 | } |
Paul Cercueil | 1133434 | 2015-06-23 16:55:35 +0200 | [diff] [blame] | 953 | } |
| 954 | /* Enable channels */ |
| 955 | for (i = 0; i < dev->nb_channels; i++) { |
| 956 | struct iio_channel *chn = dev->channels[i]; |
| 957 | if (chn->index >= 0 && iio_channel_is_enabled(chn)) { |
Lars-Peter Clausen | 1302f96 | 2017-08-10 09:52:58 +0200 | [diff] [blame] | 958 | ret = channel_write_state(chn, true); |
Paul Cercueil | 1133434 | 2015-06-23 16:55:35 +0200 | [diff] [blame] | 959 | if (ret < 0) |
| 960 | goto err_close; |
Paul Cercueil | e131122 | 2014-03-12 15:46:16 +0100 | [diff] [blame] | 961 | } |
Paul Cercueil | 8a7975e | 2014-03-12 12:53:43 +0100 | [diff] [blame] | 962 | } |
| 963 | |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 964 | pdata->cyclic = cyclic; |
| 965 | pdata->cyclic_buffer_enqueued = false; |
Paul Cercueil | 6ea8a75 | 2014-06-03 11:35:35 +0200 | [diff] [blame] | 966 | pdata->buffer_enabled = false; |
Paul Cercueil | b762fc6 | 2014-05-12 16:56:09 +0200 | [diff] [blame] | 967 | pdata->samples_count = samples_count; |
Lars-Peter Clausen | 5552643 | 2017-11-15 13:24:46 +0100 | [diff] [blame] | 968 | |
| 969 | ret = enable_high_speed(dev); |
| 970 | if (ret < 0 && ret != -ENOSYS) |
| 971 | goto err_close; |
| 972 | |
| 973 | pdata->is_high_speed = !ret; |
Paul Cercueil | b762fc6 | 2014-05-12 16:56:09 +0200 | [diff] [blame] | 974 | |
Paul Cercueil | 6ea8a75 | 2014-06-03 11:35:35 +0200 | [diff] [blame] | 975 | if (!pdata->is_high_speed) { |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 976 | unsigned long size = samples_count * pdata->max_nb_blocks; |
Paul Cercueil | 032a565 | 2014-05-12 17:11:19 +0200 | [diff] [blame] | 977 | WARNING("High-speed mode not enabled\n"); |
Paul Cercueil | ed621ee | 2015-06-24 10:50:21 +0200 | [diff] [blame] | 978 | |
Lars-Peter Clausen | 2380479 | 2016-04-20 18:17:56 +0200 | [diff] [blame] | 979 | /* Cyclic mode is only supported in high-speed mode */ |
Lars-Peter Clausen | 3e8774c | 2016-09-21 16:49:32 +0200 | [diff] [blame] | 980 | if (cyclic) { |
| 981 | ret = -EPERM; |
| 982 | goto err_close; |
| 983 | } |
Lars-Peter Clausen | 2380479 | 2016-04-20 18:17:56 +0200 | [diff] [blame] | 984 | |
Paul Cercueil | ed621ee | 2015-06-24 10:50:21 +0200 | [diff] [blame] | 985 | /* Increase the size of the kernel buffer, when using the |
| 986 | * low-speed interface. This avoids losing samples when |
| 987 | * refilling the iio_buffer. */ |
Paul Cercueil | 9c9a556 | 2017-01-24 10:48:31 +0100 | [diff] [blame] | 988 | iio_snprintf(buf, sizeof(buf), "%lu", size); |
Paul Cercueil | ed621ee | 2015-06-24 10:50:21 +0200 | [diff] [blame] | 989 | ret = local_write_dev_attr(dev, "buffer/length", |
| 990 | buf, strlen(buf) + 1, false); |
| 991 | if (ret < 0) |
| 992 | goto err_close; |
Paul Cercueil | 6ea8a75 | 2014-06-03 11:35:35 +0200 | [diff] [blame] | 993 | } |
Paul Cercueil | 45c575d | 2014-03-20 15:14:01 +0100 | [diff] [blame] | 994 | |
Lars-Peter Clausen | 53d6d45 | 2016-04-20 17:46:11 +0200 | [diff] [blame] | 995 | ret = local_enable_buffer(dev); |
| 996 | if (ret < 0) |
| 997 | goto err_close; |
| 998 | |
Paul Cercueil | 45c575d | 2014-03-20 15:14:01 +0100 | [diff] [blame] | 999 | return 0; |
Paul Cercueil | e131122 | 2014-03-12 15:46:16 +0100 | [diff] [blame] | 1000 | err_close: |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 1001 | close(pdata->fd); |
| 1002 | pdata->fd = -1; |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 1003 | err_close_cancel_fd: |
| 1004 | close(pdata->cancel_fd); |
| 1005 | pdata->cancel_fd = -1; |
Paul Cercueil | e131122 | 2014-03-12 15:46:16 +0100 | [diff] [blame] | 1006 | return ret; |
Paul Cercueil | 8a7975e | 2014-03-12 12:53:43 +0100 | [diff] [blame] | 1007 | } |
| 1008 | |
| 1009 | static int local_close(const struct iio_device *dev) |
| 1010 | { |
| 1011 | struct iio_device_pdata *pdata = dev->pdata; |
Paul Cercueil | 270f304 | 2017-04-11 17:28:59 +0200 | [diff] [blame] | 1012 | unsigned int i; |
Paul Cercueil | fc8ec4a | 2014-03-17 16:42:22 +0100 | [diff] [blame] | 1013 | int ret; |
| 1014 | |
Paul Cercueil | b6a40c2 | 2015-07-02 11:12:16 +0200 | [diff] [blame] | 1015 | if (pdata->fd == -1) |
Paul Cercueil | fc8ec4a | 2014-03-17 16:42:22 +0100 | [diff] [blame] | 1016 | return -EBADF; |
| 1017 | |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 1018 | if (pdata->is_high_speed) { |
| 1019 | unsigned int i; |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 1020 | for (i = 0; i < pdata->allocated_nb_blocks; i++) |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 1021 | munmap(pdata->addrs[i], pdata->blocks[i].size); |
Lars-Peter Clausen | 387c866 | 2016-04-21 15:19:09 +0200 | [diff] [blame] | 1022 | ioctl_nointr(pdata->fd, BLOCK_FREE_IOCTL, 0); |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 1023 | pdata->allocated_nb_blocks = 0; |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 1024 | free(pdata->addrs); |
| 1025 | pdata->addrs = NULL; |
| 1026 | free(pdata->blocks); |
| 1027 | pdata->blocks = NULL; |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 1028 | } |
| 1029 | |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 1030 | ret = close(pdata->fd); |
Paul Cercueil | 8a7975e | 2014-03-12 12:53:43 +0100 | [diff] [blame] | 1031 | if (ret) |
| 1032 | return ret; |
| 1033 | |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 1034 | close(pdata->cancel_fd); |
| 1035 | |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 1036 | pdata->fd = -1; |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 1037 | pdata->cancel_fd = -1; |
| 1038 | |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 1039 | ret = local_write_dev_attr(dev, "buffer/enable", "0", 2, false); |
Paul Cercueil | 270f304 | 2017-04-11 17:28:59 +0200 | [diff] [blame] | 1040 | |
| 1041 | for (i = 0; i < dev->nb_channels; i++) { |
| 1042 | struct iio_channel *chn = dev->channels[i]; |
| 1043 | |
Lars-Peter Clausen | 1302f96 | 2017-08-10 09:52:58 +0200 | [diff] [blame] | 1044 | if (chn->pdata->enable_fn) |
| 1045 | channel_write_state(chn, false); |
Paul Cercueil | 270f304 | 2017-04-11 17:28:59 +0200 | [diff] [blame] | 1046 | } |
| 1047 | |
Paul Cercueil | 71694c7 | 2014-05-22 14:02:13 +0200 | [diff] [blame] | 1048 | return (ret < 0) ? ret : 0; |
Paul Cercueil | 8a7975e | 2014-03-12 12:53:43 +0100 | [diff] [blame] | 1049 | } |
| 1050 | |
Romain Roffé | 8789786 | 2015-06-30 13:34:08 +0200 | [diff] [blame] | 1051 | static int local_get_fd(const struct iio_device *dev) |
| 1052 | { |
Paul Cercueil | 2cdc81b | 2015-07-02 11:13:23 +0200 | [diff] [blame] | 1053 | if (dev->pdata->fd == -1) |
| 1054 | return -EBADF; |
| 1055 | else |
| 1056 | return dev->pdata->fd; |
Romain Roffé | 8789786 | 2015-06-30 13:34:08 +0200 | [diff] [blame] | 1057 | } |
| 1058 | |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 1059 | static int local_set_blocking_mode(const struct iio_device *dev, bool blocking) |
| 1060 | { |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 1061 | if (dev->pdata->fd == -1) |
| 1062 | return -EBADF; |
| 1063 | |
| 1064 | if (dev->pdata->cyclic) |
| 1065 | return -EPERM; |
| 1066 | |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 1067 | dev->pdata->blocking = blocking; |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 1068 | |
Lars-Peter Clausen | 6cc2aff | 2016-04-22 10:24:15 +0200 | [diff] [blame] | 1069 | return 0; |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 1070 | } |
| 1071 | |
Paul Cercueil | 096e9aa | 2014-03-10 12:48:51 +0100 | [diff] [blame] | 1072 | static int local_get_trigger(const struct iio_device *dev, |
| 1073 | const struct iio_device **trigger) |
| 1074 | { |
| 1075 | char buf[1024]; |
| 1076 | unsigned int i; |
| 1077 | ssize_t nb = local_read_dev_attr(dev, "trigger/current_trigger", |
Paul Cercueil | 50c762a | 2014-04-14 15:55:43 +0200 | [diff] [blame] | 1078 | buf, sizeof(buf), false); |
Paul Cercueil | d09322a | 2014-04-02 13:50:18 +0200 | [diff] [blame] | 1079 | if (nb < 0) { |
Paul Cercueil | 096e9aa | 2014-03-10 12:48:51 +0100 | [diff] [blame] | 1080 | *trigger = NULL; |
Paul Cercueil | 096e9aa | 2014-03-10 12:48:51 +0100 | [diff] [blame] | 1081 | return (int) nb; |
Paul Cercueil | d09322a | 2014-04-02 13:50:18 +0200 | [diff] [blame] | 1082 | } |
Paul Cercueil | 096e9aa | 2014-03-10 12:48:51 +0100 | [diff] [blame] | 1083 | |
Lars-Peter Clausen | b5cdc10 | 2014-08-21 14:45:52 +0200 | [diff] [blame] | 1084 | if (buf[0] == '\0') { |
| 1085 | *trigger = NULL; |
| 1086 | return 0; |
| 1087 | } |
| 1088 | |
Paul Cercueil | 096e9aa | 2014-03-10 12:48:51 +0100 | [diff] [blame] | 1089 | nb = dev->ctx->nb_devices; |
Paul Cercueil | 4e2f665 | 2014-04-04 12:41:45 +0200 | [diff] [blame] | 1090 | for (i = 0; i < (size_t) nb; i++) { |
Paul Cercueil | 096e9aa | 2014-03-10 12:48:51 +0100 | [diff] [blame] | 1091 | const struct iio_device *cur = dev->ctx->devices[i]; |
| 1092 | if (cur->name && !strcmp(cur->name, buf)) { |
| 1093 | *trigger = cur; |
| 1094 | return 0; |
| 1095 | } |
| 1096 | } |
| 1097 | return -ENXIO; |
| 1098 | } |
| 1099 | |
| 1100 | static int local_set_trigger(const struct iio_device *dev, |
| 1101 | const struct iio_device *trigger) |
| 1102 | { |
| 1103 | ssize_t nb; |
| 1104 | const char *value = trigger ? trigger->name : ""; |
Paul Cercueil | cecda35 | 2014-05-06 18:14:29 +0200 | [diff] [blame] | 1105 | nb = local_write_dev_attr(dev, "trigger/current_trigger", |
| 1106 | value, strlen(value) + 1, false); |
Paul Cercueil | 096e9aa | 2014-03-10 12:48:51 +0100 | [diff] [blame] | 1107 | if (nb < 0) |
| 1108 | return (int) nb; |
| 1109 | else |
| 1110 | return 0; |
| 1111 | } |
| 1112 | |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1113 | static bool is_channel(const char *attr, bool strict) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1114 | { |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1115 | char *ptr = NULL; |
Paul Cercueil | ec6857d | 2014-03-11 17:23:49 +0100 | [diff] [blame] | 1116 | if (!strncmp(attr, "in_timestamp_", sizeof("in_timestamp_") - 1)) |
| 1117 | return true; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1118 | if (!strncmp(attr, "in_", 3)) |
| 1119 | ptr = strchr(attr + 3, '_'); |
| 1120 | else if (!strncmp(attr, "out_", 4)) |
| 1121 | ptr = strchr(attr + 4, '_'); |
| 1122 | if (!ptr) |
| 1123 | return false; |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1124 | if (!strict) |
| 1125 | return true; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1126 | if (*(ptr - 1) >= '0' && *(ptr - 1) <= '9') |
| 1127 | return true; |
Lars-Peter Clausen | 2d620de | 2015-03-27 13:33:55 +0100 | [diff] [blame] | 1128 | |
Lars-Peter Clausen | ca20c24 | 2018-01-24 11:04:10 +0100 | [diff] [blame] | 1129 | if (find_channel_modifier(ptr + 1, NULL) != IIO_NO_MOD) |
Lars-Peter Clausen | 2d620de | 2015-03-27 13:33:55 +0100 | [diff] [blame] | 1130 | return true; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1131 | return false; |
| 1132 | } |
| 1133 | |
| 1134 | static char * get_channel_id(const char *attr) |
| 1135 | { |
Lars-Peter Clausen | ca20c24 | 2018-01-24 11:04:10 +0100 | [diff] [blame] | 1136 | char *res, *ptr; |
| 1137 | size_t len; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1138 | |
| 1139 | attr = strchr(attr, '_') + 1; |
Lars-Peter Clausen | ca20c24 | 2018-01-24 11:04:10 +0100 | [diff] [blame] | 1140 | ptr = strchr(attr, '_'); |
| 1141 | if (find_channel_modifier(ptr + 1, &len) != IIO_NO_MOD) |
| 1142 | ptr += len + 1; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1143 | |
| 1144 | res = malloc(ptr - attr + 1); |
| 1145 | if (!res) |
| 1146 | return NULL; |
| 1147 | |
| 1148 | memcpy(res, attr, ptr - attr); |
| 1149 | res[ptr - attr] = 0; |
| 1150 | return res; |
| 1151 | } |
| 1152 | |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1153 | static char * get_short_attr_name(struct iio_channel *chn, const char *attr) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1154 | { |
| 1155 | char *ptr = strchr(attr, '_') + 1; |
Lars-Peter Clausen | 2d620de | 2015-03-27 13:33:55 +0100 | [diff] [blame] | 1156 | size_t len; |
Lars-Peter Clausen | 82390f5 | 2014-07-30 15:34:56 +0200 | [diff] [blame] | 1157 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1158 | ptr = strchr(ptr, '_') + 1; |
Lars-Peter Clausen | ca20c24 | 2018-01-24 11:04:10 +0100 | [diff] [blame] | 1159 | if (find_channel_modifier(ptr, &len) != IIO_NO_MOD) |
Lars-Peter Clausen | 2d620de | 2015-03-27 13:33:55 +0100 | [diff] [blame] | 1160 | ptr += len + 1; |
Lars-Peter Clausen | 82390f5 | 2014-07-30 15:34:56 +0200 | [diff] [blame] | 1161 | |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1162 | if (chn->name) { |
| 1163 | size_t len = strlen(chn->name); |
Robin Getz | 4c8043f | 2018-10-24 12:59:06 +0000 | [diff] [blame] | 1164 | if (strncmp(chn->name, ptr, len) == 0 && ptr[len] == '_') |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1165 | ptr += len + 1; |
| 1166 | } |
| 1167 | |
Paul Cercueil | caf0e71 | 2016-08-25 17:27:02 +0200 | [diff] [blame] | 1168 | return iio_strdup(ptr); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1169 | } |
| 1170 | |
| 1171 | static int read_device_name(struct iio_device *dev) |
| 1172 | { |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1173 | char buf[1024]; |
Paul Cercueil | 8c29e41 | 2014-04-07 09:46:45 +0200 | [diff] [blame] | 1174 | ssize_t ret = iio_device_attr_read(dev, "name", buf, sizeof(buf)); |
Paul Cercueil | 30430c7 | 2014-02-17 16:52:37 +0100 | [diff] [blame] | 1175 | if (ret < 0) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1176 | return ret; |
Paul Cercueil | 30430c7 | 2014-02-17 16:52:37 +0100 | [diff] [blame] | 1177 | else if (ret == 0) |
| 1178 | return -EIO; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1179 | |
Paul Cercueil | caf0e71 | 2016-08-25 17:27:02 +0200 | [diff] [blame] | 1180 | dev->name = iio_strdup(buf); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1181 | if (!dev->name) |
| 1182 | return -ENOMEM; |
Paul Cercueil | 30430c7 | 2014-02-17 16:52:37 +0100 | [diff] [blame] | 1183 | else |
| 1184 | return 0; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1185 | } |
| 1186 | |
| 1187 | static int add_attr_to_device(struct iio_device *dev, const char *attr) |
| 1188 | { |
Paul Cercueil | bb61827 | 2014-02-20 11:35:52 +0100 | [diff] [blame] | 1189 | char **attrs, *name; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1190 | unsigned int i; |
| 1191 | |
| 1192 | for (i = 0; i < ARRAY_SIZE(device_attrs_blacklist); i++) |
| 1193 | if (!strcmp(device_attrs_blacklist[i], attr)) |
| 1194 | return 0; |
| 1195 | |
| 1196 | if (!strcmp(attr, "name")) |
| 1197 | return read_device_name(dev); |
| 1198 | |
Paul Cercueil | caf0e71 | 2016-08-25 17:27:02 +0200 | [diff] [blame] | 1199 | name = iio_strdup(attr); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1200 | if (!name) |
| 1201 | return -ENOMEM; |
| 1202 | |
| 1203 | attrs = realloc(dev->attrs, (1 + dev->nb_attrs) * sizeof(char *)); |
| 1204 | if (!attrs) { |
| 1205 | free(name); |
| 1206 | return -ENOMEM; |
| 1207 | } |
| 1208 | |
| 1209 | attrs[dev->nb_attrs++] = name; |
| 1210 | dev->attrs = attrs; |
| 1211 | DEBUG("Added attr \'%s\' to device \'%s\'\n", attr, dev->id); |
| 1212 | return 0; |
| 1213 | } |
| 1214 | |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1215 | static int handle_protected_scan_element_attr(struct iio_channel *chn, |
| 1216 | const char *name, const char *path) |
| 1217 | { |
| 1218 | struct iio_device *dev = chn->dev; |
| 1219 | char buf[1024]; |
| 1220 | int ret; |
| 1221 | |
| 1222 | if (!strcmp(name, "index")) { |
| 1223 | ret = local_read_dev_attr(dev, path, buf, sizeof(buf), false); |
| 1224 | if (ret > 0) |
| 1225 | chn->index = atol(buf); |
| 1226 | |
| 1227 | } else if (!strcmp(name, "type")) { |
| 1228 | ret = local_read_dev_attr(dev, path, buf, sizeof(buf), false); |
| 1229 | if (ret > 0) { |
| 1230 | char endian, sign; |
| 1231 | |
Lucas Magasweran | 77fe291 | 2016-08-29 13:47:29 -0700 | [diff] [blame] | 1232 | if (strchr(buf, 'X')) { |
| 1233 | sscanf(buf, "%ce:%c%u/%uX%u>>%u", &endian, &sign, |
| 1234 | &chn->format.bits, &chn->format.length, |
| 1235 | &chn->format.repeat, &chn->format.shift); |
| 1236 | } else { |
| 1237 | chn->format.repeat = 1; |
| 1238 | sscanf(buf, "%ce:%c%u/%u>>%u", &endian, &sign, |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1239 | &chn->format.bits, &chn->format.length, |
| 1240 | &chn->format.shift); |
Lucas Magasweran | 77fe291 | 2016-08-29 13:47:29 -0700 | [diff] [blame] | 1241 | } |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1242 | chn->format.is_signed = (sign == 's' || sign == 'S'); |
| 1243 | chn->format.is_fully_defined = |
| 1244 | (sign == 'S' || sign == 'U'|| |
| 1245 | chn->format.bits == chn->format.length); |
| 1246 | chn->format.is_be = endian == 'b'; |
| 1247 | } |
| 1248 | |
| 1249 | } else if (!strcmp(name, "en")) { |
| 1250 | if (chn->pdata->enable_fn) { |
| 1251 | ERROR("Libiio bug: \"en\" attribute already parsed for channel %s!\n", |
| 1252 | chn->id); |
| 1253 | return -EINVAL; |
| 1254 | } |
| 1255 | |
Paul Cercueil | caf0e71 | 2016-08-25 17:27:02 +0200 | [diff] [blame] | 1256 | chn->pdata->enable_fn = iio_strdup(path); |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1257 | if (!chn->pdata->enable_fn) |
| 1258 | return -ENOMEM; |
| 1259 | |
| 1260 | } else { |
| 1261 | return -EINVAL; |
| 1262 | } |
| 1263 | |
| 1264 | return 0; |
| 1265 | } |
| 1266 | |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 1267 | static int handle_scan_elements(struct iio_channel *chn) |
| 1268 | { |
| 1269 | struct iio_channel_pdata *pdata = chn->pdata; |
| 1270 | unsigned int i; |
| 1271 | |
| 1272 | for (i = 0; i < pdata->nb_protected_attrs; i++) { |
| 1273 | int ret = handle_protected_scan_element_attr(chn, |
| 1274 | pdata->protected_attrs[i].name, |
| 1275 | pdata->protected_attrs[i].filename); |
| 1276 | if (ret < 0) |
| 1277 | return ret; |
| 1278 | } |
| 1279 | |
| 1280 | return 0; |
| 1281 | } |
| 1282 | |
| 1283 | static int add_protected_attr(struct iio_channel *chn, char *name, char *fn) |
| 1284 | { |
| 1285 | struct iio_channel_pdata *pdata = chn->pdata; |
| 1286 | struct iio_channel_attr *attrs; |
| 1287 | |
| 1288 | attrs = realloc(pdata->protected_attrs, |
| 1289 | (1 + pdata->nb_protected_attrs) * sizeof(*attrs)); |
| 1290 | if (!attrs) |
| 1291 | return -ENOMEM; |
| 1292 | |
| 1293 | attrs[pdata->nb_protected_attrs].name = name; |
| 1294 | attrs[pdata->nb_protected_attrs++].filename = fn; |
| 1295 | pdata->protected_attrs = attrs; |
| 1296 | |
| 1297 | DEBUG("Add protected attr \'%s\' to channel \'%s\'\n", name, chn->id); |
| 1298 | return 0; |
| 1299 | } |
| 1300 | |
| 1301 | static void free_protected_attrs(struct iio_channel *chn) |
| 1302 | { |
| 1303 | struct iio_channel_pdata *pdata = chn->pdata; |
| 1304 | unsigned int i; |
| 1305 | |
| 1306 | for (i = 0; i < pdata->nb_protected_attrs; i++) { |
| 1307 | free(pdata->protected_attrs[i].name); |
| 1308 | free(pdata->protected_attrs[i].filename); |
| 1309 | } |
| 1310 | |
| 1311 | free(pdata->protected_attrs); |
| 1312 | pdata->nb_protected_attrs = 0; |
Gwendal Grignou | 8a5a00b | 2017-05-08 10:03:40 -0700 | [diff] [blame] | 1313 | pdata->protected_attrs = NULL; |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 1314 | } |
| 1315 | |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1316 | static int add_attr_to_channel(struct iio_channel *chn, |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1317 | const char *attr, const char *path, bool is_scan_element) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1318 | { |
Paul Cercueil | b34e022 | 2014-05-05 15:32:38 +0200 | [diff] [blame] | 1319 | struct iio_channel_attr *attrs; |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1320 | char *fn, *name = get_short_attr_name(chn, attr); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1321 | if (!name) |
| 1322 | return -ENOMEM; |
| 1323 | |
Paul Cercueil | caf0e71 | 2016-08-25 17:27:02 +0200 | [diff] [blame] | 1324 | fn = iio_strdup(path); |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 1325 | if (!fn) |
| 1326 | goto err_free_name; |
| 1327 | |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 1328 | if (is_scan_element) { |
| 1329 | int ret = add_protected_attr(chn, name, fn); |
| 1330 | |
| 1331 | if (ret < 0) |
| 1332 | goto err_free_fn; |
| 1333 | |
| 1334 | return 0; |
| 1335 | } |
| 1336 | |
Paul Cercueil | b34e022 | 2014-05-05 15:32:38 +0200 | [diff] [blame] | 1337 | attrs = realloc(chn->attrs, (1 + chn->nb_attrs) * |
| 1338 | sizeof(struct iio_channel_attr)); |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 1339 | if (!attrs) |
| 1340 | goto err_free_fn; |
| 1341 | |
Paul Cercueil | 42d1235 | 2014-05-05 16:11:58 +0200 | [diff] [blame] | 1342 | attrs[chn->nb_attrs].filename = fn; |
Paul Cercueil | b34e022 | 2014-05-05 15:32:38 +0200 | [diff] [blame] | 1343 | attrs[chn->nb_attrs++].name = name; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1344 | chn->attrs = attrs; |
| 1345 | DEBUG("Added attr \'%s\' to channel \'%s\'\n", name, chn->id); |
| 1346 | return 0; |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 1347 | |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 1348 | err_free_fn: |
| 1349 | free(fn); |
| 1350 | err_free_name: |
| 1351 | free(name); |
| 1352 | return -ENOMEM; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1353 | } |
| 1354 | |
| 1355 | static int add_channel_to_device(struct iio_device *dev, |
| 1356 | struct iio_channel *chn) |
| 1357 | { |
| 1358 | struct iio_channel **channels = realloc(dev->channels, |
| 1359 | (dev->nb_channels + 1) * sizeof(struct iio_channel *)); |
| 1360 | if (!channels) |
| 1361 | return -ENOMEM; |
| 1362 | |
| 1363 | channels[dev->nb_channels++] = chn; |
| 1364 | dev->channels = channels; |
Robin Getz | 57295ce | 2018-05-24 21:45:08 +0000 | [diff] [blame] | 1365 | DEBUG("Added %s channel \'%s\' to device \'%s\'\n", |
| 1366 | chn->is_output ? "output" : "input", chn->id, dev->id); |
| 1367 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1368 | return 0; |
| 1369 | } |
| 1370 | |
| 1371 | static int add_device_to_context(struct iio_context *ctx, |
| 1372 | struct iio_device *dev) |
| 1373 | { |
| 1374 | struct iio_device **devices = realloc(ctx->devices, |
| 1375 | (ctx->nb_devices + 1) * sizeof(struct iio_device *)); |
| 1376 | if (!devices) |
| 1377 | return -ENOMEM; |
| 1378 | |
| 1379 | devices[ctx->nb_devices++] = dev; |
| 1380 | ctx->devices = devices; |
| 1381 | DEBUG("Added device \'%s\' to context \'%s\'\n", dev->id, ctx->name); |
| 1382 | return 0; |
| 1383 | } |
| 1384 | |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1385 | static struct iio_channel *create_channel(struct iio_device *dev, |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1386 | char *id, const char *attr, const char *path, |
| 1387 | bool is_scan_element) |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1388 | { |
Lars-Peter Clausen | d1be838 | 2016-02-24 11:13:45 +0100 | [diff] [blame] | 1389 | struct iio_channel *chn = zalloc(sizeof(*chn)); |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1390 | if (!chn) |
| 1391 | return NULL; |
| 1392 | |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 1393 | chn->pdata = zalloc(sizeof(*chn->pdata)); |
| 1394 | if (!chn->pdata) |
| 1395 | goto err_free_chn; |
| 1396 | |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1397 | if (!strncmp(attr, "out_", 4)) |
| 1398 | chn->is_output = true; |
| 1399 | else if (strncmp(attr, "in_", 3)) |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 1400 | goto err_free_chn_pdata; |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1401 | |
| 1402 | chn->dev = dev; |
| 1403 | chn->id = id; |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1404 | chn->is_scan_element = is_scan_element; |
| 1405 | chn->index = -ENOENT; |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1406 | |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1407 | if (!add_attr_to_channel(chn, attr, path, is_scan_element)) |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1408 | return chn; |
| 1409 | |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 1410 | err_free_chn_pdata: |
| 1411 | free(chn->pdata->enable_fn); |
| 1412 | free(chn->pdata); |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1413 | err_free_chn: |
| 1414 | free(chn); |
| 1415 | return NULL; |
| 1416 | } |
| 1417 | |
| 1418 | static int add_channel(struct iio_device *dev, const char *name, |
| 1419 | const char *path, bool dir_is_scan_elements) |
| 1420 | { |
| 1421 | struct iio_channel *chn; |
| 1422 | char *channel_id; |
| 1423 | unsigned int i; |
| 1424 | int ret; |
| 1425 | |
| 1426 | channel_id = get_channel_id(name); |
| 1427 | if (!channel_id) |
| 1428 | return -ENOMEM; |
| 1429 | |
| 1430 | for (i = 0; i < dev->nb_channels; i++) { |
| 1431 | chn = dev->channels[i]; |
| 1432 | if (!strcmp(chn->id, channel_id) |
| 1433 | && chn->is_output == (name[0] == 'o')) { |
| 1434 | free(channel_id); |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1435 | ret = add_attr_to_channel(chn, name, path, |
| 1436 | dir_is_scan_elements); |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1437 | chn->is_scan_element = dir_is_scan_elements && !ret; |
| 1438 | return ret; |
| 1439 | } |
| 1440 | } |
| 1441 | |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1442 | chn = create_channel(dev, channel_id, name, path, dir_is_scan_elements); |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1443 | if (!chn) { |
| 1444 | free(channel_id); |
| 1445 | return -ENXIO; |
| 1446 | } |
Lars-Peter Clausen | c6f8592 | 2016-04-20 15:03:49 +0200 | [diff] [blame] | 1447 | |
| 1448 | iio_channel_init_finalize(chn); |
| 1449 | |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1450 | ret = add_channel_to_device(dev, chn); |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 1451 | if (ret) { |
| 1452 | free(chn->pdata->enable_fn); |
| 1453 | free(chn->pdata); |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1454 | free_channel(chn); |
Paul Cercueil | 3f9dcb0 | 2016-08-09 17:16:25 +0200 | [diff] [blame] | 1455 | } |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1456 | return ret; |
| 1457 | } |
| 1458 | |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1459 | /* |
| 1460 | * Possible return values: |
| 1461 | * 0 = Attribute should not be moved to the channel |
| 1462 | * 1 = Attribute should be moved to the channel and it is a shared attribute |
| 1463 | * 2 = Attribute should be moved to the channel and it is a private attribute |
| 1464 | */ |
| 1465 | static unsigned int is_global_attr(struct iio_channel *chn, const char *attr) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1466 | { |
Lars-Peter Clausen | 8ba0d5b | 2016-02-17 11:30:23 +0100 | [diff] [blame] | 1467 | unsigned int len; |
fpagliughi | 94ee218 | 2020-01-25 16:32:56 -0500 | [diff] [blame] | 1468 | char *ptr, *dashptr; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1469 | |
Paul Cercueil | 35a0131 | 2014-02-20 10:56:57 +0100 | [diff] [blame] | 1470 | if (!chn->is_output && !strncmp(attr, "in_", 3)) |
| 1471 | attr += 3; |
| 1472 | else if (chn->is_output && !strncmp(attr, "out_", 4)) |
| 1473 | attr += 4; |
| 1474 | else |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1475 | return 0; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1476 | |
Lars-Peter Clausen | ca20c24 | 2018-01-24 11:04:10 +0100 | [diff] [blame] | 1477 | ptr = strchr(attr, '_'); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1478 | if (!ptr) |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1479 | return 0; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1480 | |
| 1481 | len = ptr - attr; |
| 1482 | |
fpagliughi | 6af74f2 | 2020-01-31 09:04:48 -0500 | [diff] [blame] | 1483 | // Check for matching global differential attr, like "voltage-voltage" |
fpagliughi | 94ee218 | 2020-01-25 16:32:56 -0500 | [diff] [blame] | 1484 | dashptr = strchr(attr, '-'); |
| 1485 | if (dashptr && dashptr > attr && dashptr < ptr) { |
fpagliughi | ef761f2 | 2020-02-03 09:04:56 -0500 | [diff] [blame] | 1486 | unsigned int len1 = dashptr - attr; |
| 1487 | unsigned int len2 = ptr - dashptr - 1; |
fpagliughi | 6af74f2 | 2020-01-31 09:04:48 -0500 | [diff] [blame] | 1488 | const char* iddashptr = strchr(chn->id, '-'); |
fpagliughi | ef761f2 | 2020-02-03 09:04:56 -0500 | [diff] [blame] | 1489 | if (iddashptr && strlen(iddashptr + 1) > len2 && |
fpagliughi | 6af74f2 | 2020-01-31 09:04:48 -0500 | [diff] [blame] | 1490 | iddashptr - chn->id > len1 && |
| 1491 | chn->id[len1] >= '0' && chn->id[len1] <= '9' && |
fpagliughi | 94ee218 | 2020-01-25 16:32:56 -0500 | [diff] [blame] | 1492 | !strncmp(chn->id, attr, len1) && |
fpagliughi | ef761f2 | 2020-02-03 09:04:56 -0500 | [diff] [blame] | 1493 | iddashptr[len2 + 1] >= '0' && iddashptr[len2 + 1] <= '9' && |
| 1494 | !strncmp(iddashptr + 1, dashptr + 1, len2)) |
fpagliughi | 94ee218 | 2020-01-25 16:32:56 -0500 | [diff] [blame] | 1495 | return 1; |
| 1496 | } |
| 1497 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1498 | if (strncmp(chn->id, attr, len)) |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1499 | return 0; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1500 | |
| 1501 | DEBUG("Found match: %s and %s\n", chn->id, attr); |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1502 | if (chn->id[len] >= '0' && chn->id[len] <= '9') { |
| 1503 | if (chn->name) { |
| 1504 | size_t name_len = strlen(chn->name); |
| 1505 | if (strncmp(chn->name, attr + len + 1, name_len) == 0 && |
| 1506 | attr[len + 1 + name_len] == '_') |
| 1507 | return 2; |
| 1508 | } |
| 1509 | return 1; |
| 1510 | } else if (chn->id[len] != '_') { |
| 1511 | return 0; |
| 1512 | } |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1513 | |
Lars-Peter Clausen | ca20c24 | 2018-01-24 11:04:10 +0100 | [diff] [blame] | 1514 | if (find_channel_modifier(chn->id + len + 1, NULL) != IIO_NO_MOD) |
Lars-Peter Clausen | 2d620de | 2015-03-27 13:33:55 +0100 | [diff] [blame] | 1515 | return 1; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1516 | |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1517 | return 0; |
| 1518 | } |
| 1519 | |
| 1520 | static int detect_global_attr(struct iio_device *dev, const char *attr, |
| 1521 | unsigned int level, bool *match) |
| 1522 | { |
| 1523 | unsigned int i; |
| 1524 | |
| 1525 | *match = false; |
| 1526 | for (i = 0; i < dev->nb_channels; i++) { |
| 1527 | struct iio_channel *chn = dev->channels[i]; |
| 1528 | if (is_global_attr(chn, attr) == level) { |
| 1529 | int ret; |
| 1530 | *match = true; |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1531 | ret = add_attr_to_channel(chn, attr, attr, false); |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1532 | if (ret) |
| 1533 | return ret; |
| 1534 | } |
| 1535 | } |
| 1536 | |
| 1537 | return 0; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1538 | } |
| 1539 | |
| 1540 | static int detect_and_move_global_attrs(struct iio_device *dev) |
| 1541 | { |
| 1542 | unsigned int i; |
Paul Cercueil | bb61827 | 2014-02-20 11:35:52 +0100 | [diff] [blame] | 1543 | char **ptr = dev->attrs; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1544 | |
| 1545 | for (i = 0; i < dev->nb_attrs; i++) { |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1546 | const char *attr = dev->attrs[i]; |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1547 | bool match; |
| 1548 | int ret; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1549 | |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1550 | ret = detect_global_attr(dev, attr, 2, &match); |
| 1551 | if (ret) |
| 1552 | return ret; |
| 1553 | |
| 1554 | if (!match) { |
| 1555 | ret = detect_global_attr(dev, attr, 1, &match); |
| 1556 | if (ret) |
| 1557 | return ret; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1558 | } |
| 1559 | |
Lars-Peter Clausen | de6faf0 | 2014-08-25 15:42:51 +0200 | [diff] [blame] | 1560 | if (match) { |
Paul Cercueil | bb61827 | 2014-02-20 11:35:52 +0100 | [diff] [blame] | 1561 | free(dev->attrs[i]); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1562 | dev->attrs[i] = NULL; |
| 1563 | } |
| 1564 | } |
| 1565 | |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1566 | /* Find channels without an index */ |
| 1567 | for (i = 0; i < dev->nb_attrs; i++) { |
| 1568 | const char *attr = dev->attrs[i]; |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1569 | int ret; |
| 1570 | |
| 1571 | if (!dev->attrs[i]) |
| 1572 | continue; |
| 1573 | |
| 1574 | if (is_channel(attr, false)) { |
| 1575 | ret = add_channel(dev, attr, attr, false); |
| 1576 | if (ret) |
| 1577 | return ret; |
| 1578 | |
| 1579 | free(dev->attrs[i]); |
| 1580 | dev->attrs[i] = NULL; |
| 1581 | } |
| 1582 | } |
| 1583 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1584 | for (i = 0; i < dev->nb_attrs; i++) { |
| 1585 | if (dev->attrs[i]) |
| 1586 | *ptr++ = dev->attrs[i]; |
| 1587 | } |
| 1588 | |
| 1589 | dev->nb_attrs = ptr - dev->attrs; |
Lars-Peter Clausen | e8a2bb3 | 2016-04-12 18:43:31 +0200 | [diff] [blame] | 1590 | if (!dev->nb_attrs) { |
| 1591 | free(dev->attrs); |
| 1592 | dev->attrs = NULL; |
| 1593 | } |
| 1594 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1595 | return 0; |
| 1596 | } |
| 1597 | |
Matt Fornero | 7f9598f | 2017-11-30 14:07:52 -0500 | [diff] [blame] | 1598 | static int add_buffer_attr(void *d, const char *path) |
| 1599 | { |
| 1600 | struct iio_device *dev = (struct iio_device *) d; |
| 1601 | const char *name = strrchr(path, '/') + 1; |
| 1602 | char **attrs, *attr; |
| 1603 | int i; |
| 1604 | |
| 1605 | for (i = 0; i < ARRAY_SIZE(buffer_attrs_reserved); i++) |
| 1606 | if (!strcmp(buffer_attrs_reserved[i], name)) |
| 1607 | return 0; |
| 1608 | |
| 1609 | attr = iio_strdup(name); |
| 1610 | if (!attr) |
| 1611 | return -ENOMEM; |
| 1612 | |
| 1613 | attrs = realloc(dev->buffer_attrs, (1 + dev->nb_buffer_attrs) * sizeof(char *)); |
| 1614 | if (!attrs) { |
| 1615 | free(attr); |
| 1616 | return -ENOMEM; |
| 1617 | } |
| 1618 | |
| 1619 | attrs[dev->nb_buffer_attrs++] = attr; |
| 1620 | dev->buffer_attrs = attrs; |
| 1621 | DEBUG("Added buffer attr \'%s\' to device \'%s\'\n", attr, dev->id); |
| 1622 | return 0; |
| 1623 | } |
| 1624 | |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1625 | static int add_attr_or_channel_helper(struct iio_device *dev, |
Paul Cercueil | a91358e | 2014-04-24 16:40:19 +0200 | [diff] [blame] | 1626 | const char *path, bool dir_is_scan_elements) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1627 | { |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1628 | char buf[1024]; |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1629 | const char *name = strrchr(path, '/') + 1; |
Paul Cercueil | a91358e | 2014-04-24 16:40:19 +0200 | [diff] [blame] | 1630 | |
| 1631 | if (dir_is_scan_elements) { |
Paul Cercueil | 9c9a556 | 2017-01-24 10:48:31 +0100 | [diff] [blame] | 1632 | iio_snprintf(buf, sizeof(buf), "scan_elements/%s", name); |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1633 | path = buf; |
Paul Cercueil | a91358e | 2014-04-24 16:40:19 +0200 | [diff] [blame] | 1634 | } else { |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1635 | if (!is_channel(name, true)) |
| 1636 | return add_attr_to_device(dev, name); |
Paul Cercueil | a91358e | 2014-04-24 16:40:19 +0200 | [diff] [blame] | 1637 | path = name; |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1638 | } |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1639 | |
Lars-Peter Clausen | d9806c2 | 2016-01-26 16:35:42 +0100 | [diff] [blame] | 1640 | return add_channel(dev, name, path, dir_is_scan_elements); |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1641 | } |
| 1642 | |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1643 | static int add_attr_or_channel(void *d, const char *path) |
| 1644 | { |
Paul Cercueil | a91358e | 2014-04-24 16:40:19 +0200 | [diff] [blame] | 1645 | return add_attr_or_channel_helper((struct iio_device *) d, path, false); |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1646 | } |
| 1647 | |
| 1648 | static int add_scan_element(void *d, const char *path) |
| 1649 | { |
Paul Cercueil | a91358e | 2014-04-24 16:40:19 +0200 | [diff] [blame] | 1650 | return add_attr_or_channel_helper((struct iio_device *) d, path, true); |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1651 | } |
| 1652 | |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1653 | static int foreach_in_dir(void *d, const char *path, bool is_dir, |
| 1654 | int (*callback)(void *, const char *)) |
| 1655 | { |
Paul Cercueil | 883204f | 2016-11-17 12:35:28 +0100 | [diff] [blame] | 1656 | struct dirent *entry; |
| 1657 | DIR *dir; |
| 1658 | int ret = 0; |
| 1659 | |
| 1660 | dir = opendir(path); |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1661 | if (!dir) |
| 1662 | return -errno; |
| 1663 | |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1664 | while (true) { |
| 1665 | struct stat st; |
| 1666 | char buf[1024]; |
Paul Cercueil | 883204f | 2016-11-17 12:35:28 +0100 | [diff] [blame] | 1667 | |
| 1668 | errno = 0; |
| 1669 | entry = readdir(dir); |
| 1670 | if (!entry) { |
| 1671 | if (!errno) |
| 1672 | break; |
| 1673 | |
| 1674 | ret = -errno; |
| 1675 | iio_strerror(errno, buf, sizeof(buf)); |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1676 | ERROR("Unable to open directory %s: %s\n", path, buf); |
Paul Cercueil | 883204f | 2016-11-17 12:35:28 +0100 | [diff] [blame] | 1677 | goto out_close_dir; |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1678 | } |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1679 | |
Paul Cercueil | 9c9a556 | 2017-01-24 10:48:31 +0100 | [diff] [blame] | 1680 | iio_snprintf(buf, sizeof(buf), "%s/%s", path, entry->d_name); |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1681 | if (stat(buf, &st) < 0) { |
| 1682 | ret = -errno; |
Paul Cercueil | 87b988f | 2015-05-22 10:57:32 +0200 | [diff] [blame] | 1683 | iio_strerror(errno, buf, sizeof(buf)); |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1684 | ERROR("Unable to stat file: %s\n", buf); |
Paul Cercueil | 883204f | 2016-11-17 12:35:28 +0100 | [diff] [blame] | 1685 | goto out_close_dir; |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1686 | } |
| 1687 | |
| 1688 | if (is_dir && S_ISDIR(st.st_mode) && entry->d_name[0] != '.') |
| 1689 | ret = callback(d, buf); |
| 1690 | else if (!is_dir && S_ISREG(st.st_mode)) |
| 1691 | ret = callback(d, buf); |
| 1692 | else |
| 1693 | continue; |
| 1694 | |
Paul Cercueil | 883204f | 2016-11-17 12:35:28 +0100 | [diff] [blame] | 1695 | if (ret < 0) |
| 1696 | goto out_close_dir; |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1697 | } |
| 1698 | |
Paul Cercueil | 883204f | 2016-11-17 12:35:28 +0100 | [diff] [blame] | 1699 | out_close_dir: |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1700 | closedir(dir); |
Paul Cercueil | 883204f | 2016-11-17 12:35:28 +0100 | [diff] [blame] | 1701 | return ret; |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1702 | } |
| 1703 | |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1704 | static int add_scan_elements(struct iio_device *dev, const char *devpath) |
| 1705 | { |
| 1706 | struct stat st; |
| 1707 | char buf[1024]; |
Paul Cercueil | 9c9a556 | 2017-01-24 10:48:31 +0100 | [diff] [blame] | 1708 | |
| 1709 | iio_snprintf(buf, sizeof(buf), "%s/scan_elements", devpath); |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1710 | |
| 1711 | if (!stat(buf, &st) && S_ISDIR(st.st_mode)) { |
| 1712 | int ret = foreach_in_dir(dev, buf, false, add_scan_element); |
| 1713 | if (ret < 0) |
| 1714 | return ret; |
| 1715 | } |
| 1716 | |
| 1717 | return 0; |
| 1718 | } |
| 1719 | |
Matt Fornero | 7f9598f | 2017-11-30 14:07:52 -0500 | [diff] [blame] | 1720 | static int add_buffer_attributes(struct iio_device *dev, const char *devpath) |
| 1721 | { |
| 1722 | struct stat st; |
| 1723 | char buf[1024]; |
| 1724 | |
| 1725 | iio_snprintf(buf, sizeof(buf), "%s/buffer", devpath); |
| 1726 | |
| 1727 | if (!stat(buf, &st) && S_ISDIR(st.st_mode)) { |
| 1728 | int ret = foreach_in_dir(dev, buf, false, add_buffer_attr); |
| 1729 | if (ret < 0) |
| 1730 | return ret; |
Robin Getz | 57295ce | 2018-05-24 21:45:08 +0000 | [diff] [blame] | 1731 | |
| 1732 | qsort(dev->buffer_attrs, dev->nb_buffer_attrs, sizeof(char *), |
Robin Getz | b863436 | 2018-10-24 12:39:11 +0000 | [diff] [blame] | 1733 | iio_buffer_attr_compare); |
Matt Fornero | 7f9598f | 2017-11-30 14:07:52 -0500 | [diff] [blame] | 1734 | } |
| 1735 | |
| 1736 | return 0; |
| 1737 | } |
| 1738 | |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1739 | static int create_device(void *d, const char *path) |
| 1740 | { |
Paul Cercueil | ff77823 | 2014-03-24 14:23:08 +0100 | [diff] [blame] | 1741 | uint32_t *mask = NULL; |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1742 | unsigned int i; |
| 1743 | int ret; |
| 1744 | struct iio_context *ctx = d; |
Lars-Peter Clausen | d1be838 | 2016-02-24 11:13:45 +0100 | [diff] [blame] | 1745 | struct iio_device *dev = zalloc(sizeof(*dev)); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1746 | if (!dev) |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1747 | return -ENOMEM; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1748 | |
Lars-Peter Clausen | d1be838 | 2016-02-24 11:13:45 +0100 | [diff] [blame] | 1749 | dev->pdata = zalloc(sizeof(*dev->pdata)); |
Paul Cercueil | eaab658 | 2014-02-21 09:35:59 +0100 | [diff] [blame] | 1750 | if (!dev->pdata) { |
| 1751 | free(dev); |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1752 | return -ENOMEM; |
Paul Cercueil | eaab658 | 2014-02-21 09:35:59 +0100 | [diff] [blame] | 1753 | } |
| 1754 | |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 1755 | dev->pdata->fd = -1; |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 1756 | dev->pdata->blocking = true; |
Lars-Peter Clausen | 23605a3 | 2017-11-15 13:23:54 +0100 | [diff] [blame] | 1757 | dev->pdata->max_nb_blocks = NB_BLOCKS; |
Romain Roffé | 6ce74a2 | 2015-06-30 11:45:11 +0200 | [diff] [blame] | 1758 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1759 | dev->ctx = ctx; |
Paul Cercueil | caf0e71 | 2016-08-25 17:27:02 +0200 | [diff] [blame] | 1760 | dev->id = iio_strdup(strrchr(path, '/') + 1); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1761 | if (!dev->id) { |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 1762 | local_free_pdata(dev); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1763 | free(dev); |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1764 | return -ENOMEM; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1765 | } |
| 1766 | |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1767 | ret = foreach_in_dir(dev, path, false, add_attr_or_channel); |
Paul Cercueil | 290e0e0 | 2016-08-09 15:54:44 +0200 | [diff] [blame] | 1768 | if (ret < 0) |
| 1769 | goto err_free_device; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1770 | |
Matt Fornero | 7f9598f | 2017-11-30 14:07:52 -0500 | [diff] [blame] | 1771 | ret = add_buffer_attributes(dev, path); |
| 1772 | if (ret < 0) |
| 1773 | goto err_free_device; |
Robin Getz | 4c8043f | 2018-10-24 12:59:06 +0000 | [diff] [blame] | 1774 | |
Michael Hennerich | ebe4966 | 2014-11-07 10:32:44 +0100 | [diff] [blame] | 1775 | ret = add_scan_elements(dev, path); |
Paul Cercueil | 290e0e0 | 2016-08-09 15:54:44 +0200 | [diff] [blame] | 1776 | if (ret < 0) |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 1777 | goto err_free_scan_elements; |
Paul Cercueil | e3fbd95 | 2014-03-11 16:58:33 +0100 | [diff] [blame] | 1778 | |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 1779 | for (i = 0; i < dev->nb_channels; i++) { |
| 1780 | struct iio_channel *chn = dev->channels[i]; |
| 1781 | |
| 1782 | set_channel_name(chn); |
| 1783 | ret = handle_scan_elements(chn); |
| 1784 | free_protected_attrs(chn); |
Enrico Granata | 8539d5d | 2019-05-06 11:05:23 -0700 | [diff] [blame] | 1785 | if (ret < 0) { |
| 1786 | if (dev->name && |
| 1787 | !strcmp("cros-ec-ring", dev->name)) { |
| 1788 | DEBUG("ignoring cros-ec-ring\n"); |
| 1789 | |
| 1790 | /* pretend the operation completed successfully |
| 1791 | * even though we can't process the attributes |
| 1792 | * of the sensor ring */ |
| 1793 | ret = 0; |
| 1794 | goto err_free_scan_elements; |
| 1795 | } |
| 1796 | } |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 1797 | } |
Paul Cercueil | bab69a9 | 2015-07-03 11:24:17 +0200 | [diff] [blame] | 1798 | |
Michael Hennerich | ebe4966 | 2014-11-07 10:32:44 +0100 | [diff] [blame] | 1799 | ret = detect_and_move_global_attrs(dev); |
Paul Cercueil | 290e0e0 | 2016-08-09 15:54:44 +0200 | [diff] [blame] | 1800 | if (ret < 0) |
| 1801 | goto err_free_device; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1802 | |
Robin Getz | b26e7c3 | 2018-11-05 03:13:05 +0000 | [diff] [blame] | 1803 | /* sorting is done after global attrs are added */ |
| 1804 | for (i = 0; i < dev->nb_channels; i++) { |
| 1805 | struct iio_channel *chn = dev->channels[i]; |
| 1806 | qsort(chn->attrs, chn->nb_attrs, sizeof(struct iio_channel_attr), |
| 1807 | iio_channel_attr_compare); |
| 1808 | } |
Robin Getz | 4c8043f | 2018-10-24 12:59:06 +0000 | [diff] [blame] | 1809 | qsort(dev->attrs, dev->nb_attrs, sizeof(char *), |
Robin Getz | b863436 | 2018-10-24 12:39:11 +0000 | [diff] [blame] | 1810 | iio_device_attr_compare); |
Robin Getz | 57295ce | 2018-05-24 21:45:08 +0000 | [diff] [blame] | 1811 | |
Paul Cercueil | ff77823 | 2014-03-24 14:23:08 +0100 | [diff] [blame] | 1812 | dev->words = (dev->nb_channels + 31) / 32; |
| 1813 | if (dev->words) { |
| 1814 | mask = calloc(dev->words, sizeof(*mask)); |
Paul Cercueil | 45c575d | 2014-03-20 15:14:01 +0100 | [diff] [blame] | 1815 | if (!mask) { |
Paul Cercueil | 290e0e0 | 2016-08-09 15:54:44 +0200 | [diff] [blame] | 1816 | ret = -ENOMEM; |
| 1817 | goto err_free_device; |
Paul Cercueil | 45c575d | 2014-03-20 15:14:01 +0100 | [diff] [blame] | 1818 | } |
Paul Cercueil | 45c575d | 2014-03-20 15:14:01 +0100 | [diff] [blame] | 1819 | } |
| 1820 | |
Paul Cercueil | ff77823 | 2014-03-24 14:23:08 +0100 | [diff] [blame] | 1821 | dev->mask = mask; |
Paul Cercueil | 45c575d | 2014-03-20 15:14:01 +0100 | [diff] [blame] | 1822 | |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1823 | ret = add_device_to_context(ctx, dev); |
Paul Cercueil | 290e0e0 | 2016-08-09 15:54:44 +0200 | [diff] [blame] | 1824 | if (!ret) |
| 1825 | return 0; |
| 1826 | |
Paul Cercueil | 54e96cc | 2016-12-19 12:27:25 +0100 | [diff] [blame] | 1827 | err_free_scan_elements: |
| 1828 | for (i = 0; i < dev->nb_channels; i++) |
| 1829 | free_protected_attrs(dev->channels[i]); |
Paul Cercueil | 290e0e0 | 2016-08-09 15:54:44 +0200 | [diff] [blame] | 1830 | err_free_device: |
| 1831 | local_free_pdata(dev); |
| 1832 | free_device(dev); |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 1833 | return ret; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1834 | } |
| 1835 | |
Paul Cercueil | ddaa26a | 2014-04-14 17:32:18 +0200 | [diff] [blame] | 1836 | static int add_debug_attr(void *d, const char *path) |
| 1837 | { |
| 1838 | struct iio_device *dev = d; |
| 1839 | const char *attr = strrchr(path, '/') + 1; |
Paul Cercueil | caf0e71 | 2016-08-25 17:27:02 +0200 | [diff] [blame] | 1840 | char **attrs, *name = iio_strdup(attr); |
Paul Cercueil | ddaa26a | 2014-04-14 17:32:18 +0200 | [diff] [blame] | 1841 | if (!name) |
| 1842 | return -ENOMEM; |
| 1843 | |
| 1844 | attrs = realloc(dev->debug_attrs, |
| 1845 | (1 + dev->nb_debug_attrs) * sizeof(char *)); |
| 1846 | if (!attrs) { |
| 1847 | free(name); |
| 1848 | return -ENOMEM; |
| 1849 | } |
| 1850 | |
| 1851 | attrs[dev->nb_debug_attrs++] = name; |
| 1852 | dev->debug_attrs = attrs; |
| 1853 | DEBUG("Added debug attr \'%s\' to device \'%s\'\n", name, dev->id); |
| 1854 | return 0; |
| 1855 | } |
| 1856 | |
| 1857 | static int add_debug(void *d, const char *path) |
| 1858 | { |
| 1859 | struct iio_context *ctx = d; |
| 1860 | const char *name = strrchr(path, '/') + 1; |
| 1861 | struct iio_device *dev = iio_context_find_device(ctx, name); |
| 1862 | if (!dev) |
| 1863 | return -ENODEV; |
| 1864 | else |
| 1865 | return foreach_in_dir(dev, path, false, add_debug_attr); |
| 1866 | } |
| 1867 | |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 1868 | static int local_set_timeout(struct iio_context *ctx, unsigned int timeout) |
| 1869 | { |
Paul Cercueil | 00558f1 | 2016-04-12 14:40:40 +0200 | [diff] [blame] | 1870 | ctx->pdata->rw_timeout_ms = timeout; |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 1871 | return 0; |
| 1872 | } |
| 1873 | |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 1874 | static void local_cancel(const struct iio_device *dev) |
| 1875 | { |
| 1876 | struct iio_device_pdata *pdata = dev->pdata; |
| 1877 | uint64_t event = 1; |
| 1878 | int ret; |
| 1879 | |
| 1880 | ret = write(pdata->cancel_fd, &event, sizeof(event)); |
| 1881 | if (ret == -1) { |
| 1882 | /* If this happens something went very seriously wrong */ |
| 1883 | char err_str[1024]; |
| 1884 | iio_strerror(errno, err_str, sizeof(err_str)); |
| 1885 | ERROR("Unable to signal cancellation event: %s\n", err_str); |
| 1886 | } |
| 1887 | } |
| 1888 | |
Paul Cercueil | 0865e80 | 2014-10-28 14:35:19 +0100 | [diff] [blame] | 1889 | static struct iio_context * local_clone( |
| 1890 | const struct iio_context *ctx __attribute__((unused))) |
| 1891 | { |
Paul Cercueil | 63e5218 | 2014-12-11 12:52:48 +0100 | [diff] [blame] | 1892 | return local_create_context(); |
Paul Cercueil | 0865e80 | 2014-10-28 14:35:19 +0100 | [diff] [blame] | 1893 | } |
| 1894 | |
Lars-Peter Clausen | 09a59d7 | 2016-02-03 15:27:04 +0100 | [diff] [blame] | 1895 | static const struct iio_backend_ops local_ops = { |
Paul Cercueil | 0865e80 | 2014-10-28 14:35:19 +0100 | [diff] [blame] | 1896 | .clone = local_clone, |
Paul Cercueil | 44010ea | 2014-02-21 11:47:04 +0100 | [diff] [blame] | 1897 | .open = local_open, |
| 1898 | .close = local_close, |
Romain Roffé | 8789786 | 2015-06-30 13:34:08 +0200 | [diff] [blame] | 1899 | .get_fd = local_get_fd, |
Romain Roffé | cead1da | 2015-06-30 13:35:51 +0200 | [diff] [blame] | 1900 | .set_blocking_mode = local_set_blocking_mode, |
Paul Cercueil | 44010ea | 2014-02-21 11:47:04 +0100 | [diff] [blame] | 1901 | .read = local_read, |
| 1902 | .write = local_write, |
Romain Roffé | 0f73747 | 2015-06-30 16:45:54 +0200 | [diff] [blame] | 1903 | .set_kernel_buffers_count = local_set_kernel_buffers_count, |
Paul Cercueil | 92f46df | 2014-04-28 13:17:53 +0200 | [diff] [blame] | 1904 | .get_buffer = local_get_buffer, |
Paul Cercueil | 167d311 | 2014-02-18 12:23:53 +0100 | [diff] [blame] | 1905 | .read_device_attr = local_read_dev_attr, |
| 1906 | .write_device_attr = local_write_dev_attr, |
| 1907 | .read_channel_attr = local_read_chn_attr, |
| 1908 | .write_channel_attr = local_write_chn_attr, |
Paul Cercueil | 096e9aa | 2014-03-10 12:48:51 +0100 | [diff] [blame] | 1909 | .get_trigger = local_get_trigger, |
| 1910 | .set_trigger = local_set_trigger, |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1911 | .shutdown = local_shutdown, |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 1912 | .set_timeout = local_set_timeout, |
Lars-Peter Clausen | f4b57c2 | 2016-04-21 16:46:53 +0200 | [diff] [blame] | 1913 | .cancel = local_cancel, |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1914 | }; |
| 1915 | |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1916 | static void init_data_scale(struct iio_channel *chn) |
Paul Cercueil | cac16ac | 2014-06-11 14:32:17 +0200 | [diff] [blame] | 1917 | { |
| 1918 | char buf[1024]; |
| 1919 | ssize_t ret; |
| 1920 | |
Paul Cercueil | cac16ac | 2014-06-11 14:32:17 +0200 | [diff] [blame] | 1921 | ret = iio_channel_attr_read(chn, "scale", buf, sizeof(buf)); |
| 1922 | if (ret < 0) { |
| 1923 | chn->format.with_scale = false; |
| 1924 | } else { |
| 1925 | chn->format.with_scale = true; |
| 1926 | chn->format.scale = atof(buf); |
| 1927 | } |
| 1928 | } |
| 1929 | |
| 1930 | static void init_scan_elements(struct iio_context *ctx) |
| 1931 | { |
| 1932 | unsigned int i, j; |
| 1933 | |
| 1934 | for (i = 0; i < ctx->nb_devices; i++) { |
| 1935 | struct iio_device *dev = ctx->devices[i]; |
| 1936 | |
Paul Cercueil | a1a34c6 | 2016-08-09 12:53:39 +0200 | [diff] [blame] | 1937 | for (j = 0; j < dev->nb_channels; j++) |
| 1938 | init_data_scale(dev->channels[j]); |
Paul Cercueil | cac16ac | 2014-06-11 14:32:17 +0200 | [diff] [blame] | 1939 | } |
| 1940 | } |
| 1941 | |
Paul Cercueil | e6be070 | 2016-11-18 10:57:23 +0100 | [diff] [blame] | 1942 | #ifdef WITH_LOCAL_CONFIG |
| 1943 | static int populate_context_attrs(struct iio_context *ctx, const char *file) |
| 1944 | { |
| 1945 | struct INI *ini; |
| 1946 | int ret; |
| 1947 | |
| 1948 | ini = ini_open(file); |
| 1949 | if (!ini) { |
| 1950 | /* INI file not present -> not an error */ |
| 1951 | if (errno == ENOENT) |
| 1952 | return 0; |
| 1953 | else |
| 1954 | return -errno; |
| 1955 | } |
| 1956 | |
| 1957 | while (true) { |
| 1958 | const char *section; |
| 1959 | size_t len; |
| 1960 | |
| 1961 | ret = ini_next_section(ini, §ion, &len); |
| 1962 | if (ret <= 0) |
| 1963 | goto out_close_ini; |
| 1964 | |
| 1965 | if (!strncmp(section, "Context Attributes", len)) |
| 1966 | break; |
| 1967 | } |
| 1968 | |
| 1969 | do { |
| 1970 | const char *key, *value; |
| 1971 | char *new_key, *new_val; |
| 1972 | size_t klen, vlen; |
| 1973 | |
| 1974 | ret = ini_read_pair(ini, &key, &klen, &value, &vlen); |
| 1975 | if (ret <= 0) |
| 1976 | break; |
| 1977 | |
| 1978 | /* Create a dup of the strings read from the INI, since they are |
| 1979 | * not NULL-terminated. */ |
| 1980 | new_key = strndup(key, klen); |
| 1981 | new_val = strndup(value, vlen); |
| 1982 | |
| 1983 | if (!new_key || !new_val) |
| 1984 | ret = -ENOMEM; |
| 1985 | else |
| 1986 | ret = iio_context_add_attr(ctx, new_key, new_val); |
| 1987 | |
| 1988 | free(new_key); |
| 1989 | free(new_val); |
| 1990 | } while (!ret); |
| 1991 | |
| 1992 | out_close_ini: |
| 1993 | ini_close(ini); |
| 1994 | return ret; |
| 1995 | } |
| 1996 | #endif |
| 1997 | |
Paul Cercueil | 63e5218 | 2014-12-11 12:52:48 +0100 | [diff] [blame] | 1998 | struct iio_context * local_create_context(void) |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 1999 | { |
Paul Cercueil | fd38747 | 2015-08-05 10:34:19 +0200 | [diff] [blame] | 2000 | int ret = -ENOMEM; |
Paul Cercueil | c957d9f | 2015-01-08 15:05:42 +0100 | [diff] [blame] | 2001 | unsigned int len; |
| 2002 | struct utsname uts; |
Lars-Peter Clausen | d1be838 | 2016-02-24 11:13:45 +0100 | [diff] [blame] | 2003 | struct iio_context *ctx = zalloc(sizeof(*ctx)); |
Paul Cercueil | 3ad8e37 | 2015-03-16 17:07:37 +0100 | [diff] [blame] | 2004 | if (!ctx) |
Paul Cercueil | fd38747 | 2015-08-05 10:34:19 +0200 | [diff] [blame] | 2005 | goto err_set_errno; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 2006 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 2007 | ctx->ops = &local_ops; |
| 2008 | ctx->name = "local"; |
Harvey Yang | bc3f48e | 2019-10-22 11:17:28 +0800 | [diff] [blame] | 2009 | ctx->client_id = -1; |
Paul Cercueil | 00558f1 | 2016-04-12 14:40:40 +0200 | [diff] [blame] | 2010 | |
| 2011 | ctx->pdata = zalloc(sizeof(*ctx->pdata)); |
| 2012 | if (!ctx->pdata) { |
| 2013 | free(ctx); |
| 2014 | goto err_set_errno; |
| 2015 | } |
| 2016 | |
Paul Cercueil | e1e0a8f | 2014-06-10 15:40:29 +0200 | [diff] [blame] | 2017 | local_set_timeout(ctx, DEFAULT_TIMEOUT_MS); |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 2018 | |
Paul Cercueil | c957d9f | 2015-01-08 15:05:42 +0100 | [diff] [blame] | 2019 | uname(&uts); |
| 2020 | len = strlen(uts.sysname) + strlen(uts.nodename) + strlen(uts.release) |
| 2021 | + strlen(uts.version) + strlen(uts.machine); |
| 2022 | ctx->description = malloc(len + 5); /* 4 spaces + EOF */ |
| 2023 | if (!ctx->description) { |
Paul Cercueil | 00558f1 | 2016-04-12 14:40:40 +0200 | [diff] [blame] | 2024 | free(ctx->pdata); |
Paul Cercueil | c957d9f | 2015-01-08 15:05:42 +0100 | [diff] [blame] | 2025 | free(ctx); |
Paul Cercueil | fd38747 | 2015-08-05 10:34:19 +0200 | [diff] [blame] | 2026 | goto err_set_errno; |
Paul Cercueil | c957d9f | 2015-01-08 15:05:42 +0100 | [diff] [blame] | 2027 | } |
| 2028 | |
Paul Cercueil | 9c9a556 | 2017-01-24 10:48:31 +0100 | [diff] [blame] | 2029 | iio_snprintf(ctx->description, len + 5, "%s %s %s %s %s", uts.sysname, |
Paul Cercueil | c957d9f | 2015-01-08 15:05:42 +0100 | [diff] [blame] | 2030 | uts.nodename, uts.release, uts.version, uts.machine); |
| 2031 | |
Paul Cercueil | 1be5783 | 2014-03-11 16:27:16 +0100 | [diff] [blame] | 2032 | ret = foreach_in_dir(ctx, "/sys/bus/iio/devices", true, create_device); |
Paul Cercueil | fd38747 | 2015-08-05 10:34:19 +0200 | [diff] [blame] | 2033 | if (ret < 0) |
| 2034 | goto err_context_destroy; |
Paul Cercueil | 4c6729d | 2014-04-04 17:24:41 +0200 | [diff] [blame] | 2035 | |
Robin Getz | 57295ce | 2018-05-24 21:45:08 +0000 | [diff] [blame] | 2036 | qsort(ctx->devices, ctx->nb_devices, sizeof(struct iio_device *), |
Robin Getz | b863436 | 2018-10-24 12:39:11 +0000 | [diff] [blame] | 2037 | iio_device_compare); |
Robin Getz | 57295ce | 2018-05-24 21:45:08 +0000 | [diff] [blame] | 2038 | |
Paul Cercueil | ddaa26a | 2014-04-14 17:32:18 +0200 | [diff] [blame] | 2039 | foreach_in_dir(ctx, "/sys/kernel/debug/iio", true, add_debug); |
Paul Cercueil | c1ed848 | 2014-06-11 16:29:43 +0200 | [diff] [blame] | 2040 | |
Paul Cercueil | cac16ac | 2014-06-11 14:32:17 +0200 | [diff] [blame] | 2041 | init_scan_elements(ctx); |
Paul Cercueil | e6be070 | 2016-11-18 10:57:23 +0100 | [diff] [blame] | 2042 | |
| 2043 | #ifdef WITH_LOCAL_CONFIG |
| 2044 | ret = populate_context_attrs(ctx, "/etc/libiio.ini"); |
| 2045 | if (ret < 0) |
| 2046 | goto err_context_destroy; |
| 2047 | #endif |
| 2048 | |
Paul Cercueil | 267b25a | 2016-11-24 17:30:58 +0100 | [diff] [blame] | 2049 | ret = iio_context_add_attr(ctx, "local,kernel", uts.release); |
| 2050 | if (ret < 0) |
| 2051 | goto err_context_destroy; |
| 2052 | |
Paul Cercueil | fd38747 | 2015-08-05 10:34:19 +0200 | [diff] [blame] | 2053 | ret = iio_context_init(ctx); |
| 2054 | if (ret < 0) |
| 2055 | goto err_context_destroy; |
Paul Cercueil | ae88fde | 2014-03-12 11:47:10 +0100 | [diff] [blame] | 2056 | |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 2057 | return ctx; |
Paul Cercueil | 3ad8e37 | 2015-03-16 17:07:37 +0100 | [diff] [blame] | 2058 | |
Paul Cercueil | fd38747 | 2015-08-05 10:34:19 +0200 | [diff] [blame] | 2059 | err_context_destroy: |
| 2060 | iio_context_destroy(ctx); |
| 2061 | err_set_errno: |
| 2062 | errno = -ret; |
Paul Cercueil | 3ad8e37 | 2015-03-16 17:07:37 +0100 | [diff] [blame] | 2063 | return NULL; |
Paul Cercueil | 0b2ce71 | 2014-02-17 15:04:18 +0100 | [diff] [blame] | 2064 | } |
Lars-Peter Clausen | 3db58d6 | 2016-04-25 15:00:54 +0200 | [diff] [blame] | 2065 | |
| 2066 | static int check_device(void *d, const char *path) |
| 2067 | { |
| 2068 | *(bool *)d = true; |
| 2069 | return 0; |
| 2070 | } |
| 2071 | |
| 2072 | int local_context_scan(struct iio_scan_result *scan_result) |
| 2073 | { |
| 2074 | struct iio_context_info **info; |
| 2075 | bool exists = false; |
Paul Cercueil | 6303ca2 | 2016-11-10 16:55:40 +0100 | [diff] [blame] | 2076 | char *desc, *uri; |
Lars-Peter Clausen | 3db58d6 | 2016-04-25 15:00:54 +0200 | [diff] [blame] | 2077 | int ret; |
| 2078 | |
Paul Cercueil | ea6ab97 | 2016-12-21 18:24:03 +0100 | [diff] [blame] | 2079 | ret = foreach_in_dir(&exists, "/sys/bus/iio", true, check_device); |
Lars-Peter Clausen | 3db58d6 | 2016-04-25 15:00:54 +0200 | [diff] [blame] | 2080 | if (ret < 0 || !exists) |
| 2081 | return 0; |
| 2082 | |
Paul Cercueil | 6303ca2 | 2016-11-10 16:55:40 +0100 | [diff] [blame] | 2083 | desc = iio_strdup("Local devices"); |
| 2084 | if (!desc) |
Lars-Peter Clausen | 3db58d6 | 2016-04-25 15:00:54 +0200 | [diff] [blame] | 2085 | return -ENOMEM; |
| 2086 | |
Paul Cercueil | 6303ca2 | 2016-11-10 16:55:40 +0100 | [diff] [blame] | 2087 | uri = iio_strdup("local:"); |
| 2088 | if (!uri) |
| 2089 | goto err_free_desc; |
Lars-Peter Clausen | 3db58d6 | 2016-04-25 15:00:54 +0200 | [diff] [blame] | 2090 | |
Paul Cercueil | 6303ca2 | 2016-11-10 16:55:40 +0100 | [diff] [blame] | 2091 | info = iio_scan_result_add(scan_result, 1); |
| 2092 | if (!info) |
| 2093 | goto err_free_uri; |
| 2094 | |
| 2095 | info[0]->description = desc; |
| 2096 | info[0]->uri = uri; |
Lars-Peter Clausen | 3db58d6 | 2016-04-25 15:00:54 +0200 | [diff] [blame] | 2097 | return 0; |
Paul Cercueil | 6303ca2 | 2016-11-10 16:55:40 +0100 | [diff] [blame] | 2098 | |
| 2099 | err_free_uri: |
| 2100 | free(uri); |
| 2101 | err_free_desc: |
| 2102 | free(desc); |
| 2103 | return -ENOMEM; |
Lars-Peter Clausen | 3db58d6 | 2016-04-25 15:00:54 +0200 | [diff] [blame] | 2104 | } |