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