1 /* Industrialio event test code. 2 * 3 * Copyright (c) 2011-2012 Lars-Peter Clausen <lars@metafoo.de> 4 * 5 * This program is free software; you can redistribute it and/or modify it 6 * under the terms of the GNU General Public License version 2 as published by 7 * the Free Software Foundation. 8 * 9 * This program is primarily intended as an example application. 10 * Reads the current buffer setup from sysfs and starts a short capture 11 * from the specified device, pretty printing the result after appropriate 12 * conversion. 13 * 14 * Usage: 15 * iio_event_monitor <device_name> 16 */ 17 18 #include <unistd.h> 19 #include <stdlib.h> 20 #include <stdbool.h> 21 #include <stdio.h> 22 #include <errno.h> 23 #include <string.h> 24 #include <poll.h> 25 #include <fcntl.h> 26 #include <sys/ioctl.h> 27 #include "iio_utils.h" 28 #include <linux/iio/events.h> 29 #include <linux/iio/types.h> 30 31 static const char * const iio_chan_type_name_spec[] = { 32 [IIO_VOLTAGE] = "voltage", 33 [IIO_CURRENT] = "current", 34 [IIO_POWER] = "power", 35 [IIO_ACCEL] = "accel", 36 [IIO_ANGL_VEL] = "anglvel", 37 [IIO_MAGN] = "magn", 38 [IIO_LIGHT] = "illuminance", 39 [IIO_INTENSITY] = "intensity", 40 [IIO_PROXIMITY] = "proximity", 41 [IIO_TEMP] = "temp", 42 [IIO_INCLI] = "incli", 43 [IIO_ROT] = "rot", 44 [IIO_ANGL] = "angl", 45 [IIO_TIMESTAMP] = "timestamp", 46 [IIO_CAPACITANCE] = "capacitance", 47 [IIO_ALTVOLTAGE] = "altvoltage", 48 [IIO_CCT] = "cct", 49 [IIO_PRESSURE] = "pressure", 50 [IIO_HUMIDITYRELATIVE] = "humidityrelative", 51 [IIO_ACTIVITY] = "activity", 52 [IIO_STEPS] = "steps", 53 [IIO_ENERGY] = "energy", 54 [IIO_DISTANCE] = "distance", 55 [IIO_VELOCITY] = "velocity", 56 [IIO_CONCENTRATION] = "concentration", 57 [IIO_RESISTANCE] = "resistance", 58 [IIO_PH] = "ph", 59 [IIO_UVINDEX] = "uvindex", 60 [IIO_GRAVITY] = "gravity", 61 }; 62 63 static const char * const iio_ev_type_text[] = { 64 [IIO_EV_TYPE_THRESH] = "thresh", 65 [IIO_EV_TYPE_MAG] = "mag", 66 [IIO_EV_TYPE_ROC] = "roc", 67 [IIO_EV_TYPE_THRESH_ADAPTIVE] = "thresh_adaptive", 68 [IIO_EV_TYPE_MAG_ADAPTIVE] = "mag_adaptive", 69 [IIO_EV_TYPE_CHANGE] = "change", 70 }; 71 72 static const char * const iio_ev_dir_text[] = { 73 [IIO_EV_DIR_EITHER] = "either", 74 [IIO_EV_DIR_RISING] = "rising", 75 [IIO_EV_DIR_FALLING] = "falling" 76 }; 77 78 static const char * const iio_modifier_names[] = { 79 [IIO_MOD_X] = "x", 80 [IIO_MOD_Y] = "y", 81 [IIO_MOD_Z] = "z", 82 [IIO_MOD_X_AND_Y] = "x&y", 83 [IIO_MOD_X_AND_Z] = "x&z", 84 [IIO_MOD_Y_AND_Z] = "y&z", 85 [IIO_MOD_X_AND_Y_AND_Z] = "x&y&z", 86 [IIO_MOD_X_OR_Y] = "x|y", 87 [IIO_MOD_X_OR_Z] = "x|z", 88 [IIO_MOD_Y_OR_Z] = "y|z", 89 [IIO_MOD_X_OR_Y_OR_Z] = "x|y|z", 90 [IIO_MOD_LIGHT_BOTH] = "both", 91 [IIO_MOD_LIGHT_IR] = "ir", 92 [IIO_MOD_ROOT_SUM_SQUARED_X_Y] = "sqrt(x^2+y^2)", 93 [IIO_MOD_SUM_SQUARED_X_Y_Z] = "x^2+y^2+z^2", 94 [IIO_MOD_LIGHT_CLEAR] = "clear", 95 [IIO_MOD_LIGHT_RED] = "red", 96 [IIO_MOD_LIGHT_GREEN] = "green", 97 [IIO_MOD_LIGHT_BLUE] = "blue", 98 [IIO_MOD_LIGHT_UV] = "uv", 99 [IIO_MOD_QUATERNION] = "quaternion", 100 [IIO_MOD_TEMP_AMBIENT] = "ambient", 101 [IIO_MOD_TEMP_OBJECT] = "object", 102 [IIO_MOD_NORTH_MAGN] = "from_north_magnetic", 103 [IIO_MOD_NORTH_TRUE] = "from_north_true", 104 [IIO_MOD_NORTH_MAGN_TILT_COMP] = "from_north_magnetic_tilt_comp", 105 [IIO_MOD_NORTH_TRUE_TILT_COMP] = "from_north_true_tilt_comp", 106 [IIO_MOD_RUNNING] = "running", 107 [IIO_MOD_JOGGING] = "jogging", 108 [IIO_MOD_WALKING] = "walking", 109 [IIO_MOD_STILL] = "still", 110 [IIO_MOD_ROOT_SUM_SQUARED_X_Y_Z] = "sqrt(x^2+y^2+z^2)", 111 [IIO_MOD_I] = "i", 112 [IIO_MOD_Q] = "q", 113 [IIO_MOD_CO2] = "co2", 114 [IIO_MOD_VOC] = "voc", 115 }; 116 117 static bool event_is_known(struct iio_event_data *event) 118 { 119 enum iio_chan_type type = IIO_EVENT_CODE_EXTRACT_CHAN_TYPE(event->id); 120 enum iio_modifier mod = IIO_EVENT_CODE_EXTRACT_MODIFIER(event->id); 121 enum iio_event_type ev_type = IIO_EVENT_CODE_EXTRACT_TYPE(event->id); 122 enum iio_event_direction dir = IIO_EVENT_CODE_EXTRACT_DIR(event->id); 123 124 switch (type) { 125 case IIO_VOLTAGE: 126 case IIO_CURRENT: 127 case IIO_POWER: 128 case IIO_ACCEL: 129 case IIO_ANGL_VEL: 130 case IIO_MAGN: 131 case IIO_LIGHT: 132 case IIO_INTENSITY: 133 case IIO_PROXIMITY: 134 case IIO_TEMP: 135 case IIO_INCLI: 136 case IIO_ROT: 137 case IIO_ANGL: 138 case IIO_TIMESTAMP: 139 case IIO_CAPACITANCE: 140 case IIO_ALTVOLTAGE: 141 case IIO_CCT: 142 case IIO_PRESSURE: 143 case IIO_HUMIDITYRELATIVE: 144 case IIO_ACTIVITY: 145 case IIO_STEPS: 146 case IIO_ENERGY: 147 case IIO_DISTANCE: 148 case IIO_VELOCITY: 149 case IIO_CONCENTRATION: 150 case IIO_RESISTANCE: 151 case IIO_PH: 152 case IIO_UVINDEX: 153 case IIO_GRAVITY: 154 break; 155 default: 156 return false; 157 } 158 159 switch (mod) { 160 case IIO_NO_MOD: 161 case IIO_MOD_X: 162 case IIO_MOD_Y: 163 case IIO_MOD_Z: 164 case IIO_MOD_X_AND_Y: 165 case IIO_MOD_X_AND_Z: 166 case IIO_MOD_Y_AND_Z: 167 case IIO_MOD_X_AND_Y_AND_Z: 168 case IIO_MOD_X_OR_Y: 169 case IIO_MOD_X_OR_Z: 170 case IIO_MOD_Y_OR_Z: 171 case IIO_MOD_X_OR_Y_OR_Z: 172 case IIO_MOD_LIGHT_BOTH: 173 case IIO_MOD_LIGHT_IR: 174 case IIO_MOD_ROOT_SUM_SQUARED_X_Y: 175 case IIO_MOD_SUM_SQUARED_X_Y_Z: 176 case IIO_MOD_LIGHT_CLEAR: 177 case IIO_MOD_LIGHT_RED: 178 case IIO_MOD_LIGHT_GREEN: 179 case IIO_MOD_LIGHT_BLUE: 180 case IIO_MOD_LIGHT_UV: 181 case IIO_MOD_QUATERNION: 182 case IIO_MOD_TEMP_AMBIENT: 183 case IIO_MOD_TEMP_OBJECT: 184 case IIO_MOD_NORTH_MAGN: 185 case IIO_MOD_NORTH_TRUE: 186 case IIO_MOD_NORTH_MAGN_TILT_COMP: 187 case IIO_MOD_NORTH_TRUE_TILT_COMP: 188 case IIO_MOD_RUNNING: 189 case IIO_MOD_JOGGING: 190 case IIO_MOD_WALKING: 191 case IIO_MOD_STILL: 192 case IIO_MOD_ROOT_SUM_SQUARED_X_Y_Z: 193 case IIO_MOD_I: 194 case IIO_MOD_Q: 195 case IIO_MOD_CO2: 196 case IIO_MOD_VOC: 197 break; 198 default: 199 return false; 200 } 201 202 switch (ev_type) { 203 case IIO_EV_TYPE_THRESH: 204 case IIO_EV_TYPE_MAG: 205 case IIO_EV_TYPE_ROC: 206 case IIO_EV_TYPE_THRESH_ADAPTIVE: 207 case IIO_EV_TYPE_MAG_ADAPTIVE: 208 case IIO_EV_TYPE_CHANGE: 209 break; 210 default: 211 return false; 212 } 213 214 switch (dir) { 215 case IIO_EV_DIR_EITHER: 216 case IIO_EV_DIR_RISING: 217 case IIO_EV_DIR_FALLING: 218 case IIO_EV_DIR_NONE: 219 break; 220 default: 221 return false; 222 } 223 224 return true; 225 } 226 227 static void print_event(struct iio_event_data *event) 228 { 229 enum iio_chan_type type = IIO_EVENT_CODE_EXTRACT_CHAN_TYPE(event->id); 230 enum iio_modifier mod = IIO_EVENT_CODE_EXTRACT_MODIFIER(event->id); 231 enum iio_event_type ev_type = IIO_EVENT_CODE_EXTRACT_TYPE(event->id); 232 enum iio_event_direction dir = IIO_EVENT_CODE_EXTRACT_DIR(event->id); 233 int chan = IIO_EVENT_CODE_EXTRACT_CHAN(event->id); 234 int chan2 = IIO_EVENT_CODE_EXTRACT_CHAN2(event->id); 235 bool diff = IIO_EVENT_CODE_EXTRACT_DIFF(event->id); 236 237 if (!event_is_known(event)) { 238 fprintf(stderr, "Unknown event: time: %lld, id: %llx\n", 239 event->timestamp, event->id); 240 241 return; 242 } 243 244 printf("Event: time: %lld, type: %s", event->timestamp, 245 iio_chan_type_name_spec[type]); 246 247 if (mod != IIO_NO_MOD) 248 printf("(%s)", iio_modifier_names[mod]); 249 250 if (chan >= 0) { 251 printf(", channel: %d", chan); 252 if (diff && chan2 >= 0) 253 printf("-%d", chan2); 254 } 255 256 printf(", evtype: %s", iio_ev_type_text[ev_type]); 257 258 if (dir != IIO_EV_DIR_NONE) 259 printf(", direction: %s", iio_ev_dir_text[dir]); 260 261 printf("\n"); 262 } 263 264 int main(int argc, char **argv) 265 { 266 struct iio_event_data event; 267 const char *device_name; 268 char *chrdev_name; 269 int ret; 270 int dev_num; 271 int fd, event_fd; 272 273 if (argc <= 1) { 274 fprintf(stderr, "Usage: %s <device_name>\n", argv[0]); 275 return -1; 276 } 277 278 device_name = argv[1]; 279 280 dev_num = find_type_by_name(device_name, "iio:device"); 281 if (dev_num >= 0) { 282 printf("Found IIO device with name %s with device number %d\n", 283 device_name, dev_num); 284 ret = asprintf(&chrdev_name, "/dev/iio:device%d", dev_num); 285 if (ret < 0) 286 return -ENOMEM; 287 } else { 288 /* 289 * If we can't find an IIO device by name assume device_name is 290 * an IIO chrdev 291 */ 292 chrdev_name = strdup(device_name); 293 if (!chrdev_name) 294 return -ENOMEM; 295 } 296 297 fd = open(chrdev_name, 0); 298 if (fd == -1) { 299 ret = -errno; 300 fprintf(stderr, "Failed to open %s\n", chrdev_name); 301 goto error_free_chrdev_name; 302 } 303 304 ret = ioctl(fd, IIO_GET_EVENT_FD_IOCTL, &event_fd); 305 if (ret == -1 || event_fd == -1) { 306 ret = -errno; 307 if (ret == -ENODEV) 308 fprintf(stderr, 309 "This device does not support events\n"); 310 else 311 fprintf(stderr, "Failed to retrieve event fd\n"); 312 if (close(fd) == -1) 313 perror("Failed to close character device file"); 314 315 goto error_free_chrdev_name; 316 } 317 318 if (close(fd) == -1) { 319 ret = -errno; 320 goto error_free_chrdev_name; 321 } 322 323 while (true) { 324 ret = read(event_fd, &event, sizeof(event)); 325 if (ret == -1) { 326 if (errno == EAGAIN) { 327 fprintf(stderr, "nothing available\n"); 328 continue; 329 } else { 330 ret = -errno; 331 perror("Failed to read event from device"); 332 break; 333 } 334 } 335 336 if (ret != sizeof(event)) { 337 fprintf(stderr, "Reading event failed!\n"); 338 ret = -EIO; 339 break; 340 } 341 342 print_event(&event); 343 } 344 345 if (close(event_fd) == -1) 346 perror("Failed to close event file"); 347 348 error_free_chrdev_name: 349 free(chrdev_name); 350 351 return ret; 352 } 353