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 19#include <unistd.h> 20#include <stdlib.h> 21#include <stdbool.h> 22#include <stdio.h> 23#include <errno.h> 24#include <string.h> 25#include <poll.h> 26#include <fcntl.h> 27#include <sys/ioctl.h> 28#include "iio_utils.h" 29#include <linux/iio/events.h> 30#include <linux/iio/types.h> 31 32static const char * const iio_chan_type_name_spec[] = { 33 [IIO_VOLTAGE] = "voltage", 34 [IIO_CURRENT] = "current", 35 [IIO_POWER] = "power", 36 [IIO_ACCEL] = "accel", 37 [IIO_ANGL_VEL] = "anglvel", 38 [IIO_MAGN] = "magn", 39 [IIO_LIGHT] = "illuminance", 40 [IIO_INTENSITY] = "intensity", 41 [IIO_PROXIMITY] = "proximity", 42 [IIO_TEMP] = "temp", 43 [IIO_INCLI] = "incli", 44 [IIO_ROT] = "rot", 45 [IIO_ANGL] = "angl", 46 [IIO_TIMESTAMP] = "timestamp", 47 [IIO_CAPACITANCE] = "capacitance", 48 [IIO_ALTVOLTAGE] = "altvoltage", 49 [IIO_CCT] = "cct", 50 [IIO_PRESSURE] = "pressure", 51 [IIO_HUMIDITYRELATIVE] = "humidityrelative", 52 [IIO_ACTIVITY] = "activity", 53 [IIO_STEPS] = "steps", 54}; 55 56static const char * const iio_ev_type_text[] = { 57 [IIO_EV_TYPE_THRESH] = "thresh", 58 [IIO_EV_TYPE_MAG] = "mag", 59 [IIO_EV_TYPE_ROC] = "roc", 60 [IIO_EV_TYPE_THRESH_ADAPTIVE] = "thresh_adaptive", 61 [IIO_EV_TYPE_MAG_ADAPTIVE] = "mag_adaptive", 62 [IIO_EV_TYPE_CHANGE] = "change", 63}; 64 65static const char * const iio_ev_dir_text[] = { 66 [IIO_EV_DIR_EITHER] = "either", 67 [IIO_EV_DIR_RISING] = "rising", 68 [IIO_EV_DIR_FALLING] = "falling" 69}; 70 71static const char * const iio_modifier_names[] = { 72 [IIO_MOD_X] = "x", 73 [IIO_MOD_Y] = "y", 74 [IIO_MOD_Z] = "z", 75 [IIO_MOD_X_AND_Y] = "x&y", 76 [IIO_MOD_X_AND_Z] = "x&z", 77 [IIO_MOD_Y_AND_Z] = "y&z", 78 [IIO_MOD_X_AND_Y_AND_Z] = "x&y&z", 79 [IIO_MOD_X_OR_Y] = "x|y", 80 [IIO_MOD_X_OR_Z] = "x|z", 81 [IIO_MOD_Y_OR_Z] = "y|z", 82 [IIO_MOD_X_OR_Y_OR_Z] = "x|y|z", 83 [IIO_MOD_LIGHT_BOTH] = "both", 84 [IIO_MOD_LIGHT_IR] = "ir", 85 [IIO_MOD_ROOT_SUM_SQUARED_X_Y] = "sqrt(x^2+y^2)", 86 [IIO_MOD_SUM_SQUARED_X_Y_Z] = "x^2+y^2+z^2", 87 [IIO_MOD_LIGHT_CLEAR] = "clear", 88 [IIO_MOD_LIGHT_RED] = "red", 89 [IIO_MOD_LIGHT_GREEN] = "green", 90 [IIO_MOD_LIGHT_BLUE] = "blue", 91 [IIO_MOD_QUATERNION] = "quaternion", 92 [IIO_MOD_TEMP_AMBIENT] = "ambient", 93 [IIO_MOD_TEMP_OBJECT] = "object", 94 [IIO_MOD_NORTH_MAGN] = "from_north_magnetic", 95 [IIO_MOD_NORTH_TRUE] = "from_north_true", 96 [IIO_MOD_NORTH_MAGN_TILT_COMP] = "from_north_magnetic_tilt_comp", 97 [IIO_MOD_NORTH_TRUE_TILT_COMP] = "from_north_true_tilt_comp", 98 [IIO_MOD_RUNNING] = "running", 99 [IIO_MOD_JOGGING] = "jogging", 100 [IIO_MOD_WALKING] = "walking", 101 [IIO_MOD_STILL] = "still", 102}; 103 104static bool event_is_known(struct iio_event_data *event) 105{ 106 enum iio_chan_type type = IIO_EVENT_CODE_EXTRACT_CHAN_TYPE(event->id); 107 enum iio_modifier mod = IIO_EVENT_CODE_EXTRACT_MODIFIER(event->id); 108 enum iio_event_type ev_type = IIO_EVENT_CODE_EXTRACT_TYPE(event->id); 109 enum iio_event_direction dir = IIO_EVENT_CODE_EXTRACT_DIR(event->id); 110 111 switch (type) { 112 case IIO_VOLTAGE: 113 case IIO_CURRENT: 114 case IIO_POWER: 115 case IIO_ACCEL: 116 case IIO_ANGL_VEL: 117 case IIO_MAGN: 118 case IIO_LIGHT: 119 case IIO_INTENSITY: 120 case IIO_PROXIMITY: 121 case IIO_TEMP: 122 case IIO_INCLI: 123 case IIO_ROT: 124 case IIO_ANGL: 125 case IIO_TIMESTAMP: 126 case IIO_CAPACITANCE: 127 case IIO_ALTVOLTAGE: 128 case IIO_CCT: 129 case IIO_PRESSURE: 130 case IIO_HUMIDITYRELATIVE: 131 case IIO_ACTIVITY: 132 case IIO_STEPS: 133 break; 134 default: 135 return false; 136 } 137 138 switch (mod) { 139 case IIO_NO_MOD: 140 case IIO_MOD_X: 141 case IIO_MOD_Y: 142 case IIO_MOD_Z: 143 case IIO_MOD_X_AND_Y: 144 case IIO_MOD_X_AND_Z: 145 case IIO_MOD_Y_AND_Z: 146 case IIO_MOD_X_AND_Y_AND_Z: 147 case IIO_MOD_X_OR_Y: 148 case IIO_MOD_X_OR_Z: 149 case IIO_MOD_Y_OR_Z: 150 case IIO_MOD_X_OR_Y_OR_Z: 151 case IIO_MOD_LIGHT_BOTH: 152 case IIO_MOD_LIGHT_IR: 153 case IIO_MOD_ROOT_SUM_SQUARED_X_Y: 154 case IIO_MOD_SUM_SQUARED_X_Y_Z: 155 case IIO_MOD_LIGHT_CLEAR: 156 case IIO_MOD_LIGHT_RED: 157 case IIO_MOD_LIGHT_GREEN: 158 case IIO_MOD_LIGHT_BLUE: 159 case IIO_MOD_QUATERNION: 160 case IIO_MOD_TEMP_AMBIENT: 161 case IIO_MOD_TEMP_OBJECT: 162 case IIO_MOD_NORTH_MAGN: 163 case IIO_MOD_NORTH_TRUE: 164 case IIO_MOD_NORTH_MAGN_TILT_COMP: 165 case IIO_MOD_NORTH_TRUE_TILT_COMP: 166 case IIO_MOD_RUNNING: 167 case IIO_MOD_JOGGING: 168 case IIO_MOD_WALKING: 169 case IIO_MOD_STILL: 170 break; 171 default: 172 return false; 173 } 174 175 switch (ev_type) { 176 case IIO_EV_TYPE_THRESH: 177 case IIO_EV_TYPE_MAG: 178 case IIO_EV_TYPE_ROC: 179 case IIO_EV_TYPE_THRESH_ADAPTIVE: 180 case IIO_EV_TYPE_MAG_ADAPTIVE: 181 case IIO_EV_TYPE_CHANGE: 182 break; 183 default: 184 return false; 185 } 186 187 switch (dir) { 188 case IIO_EV_DIR_EITHER: 189 case IIO_EV_DIR_RISING: 190 case IIO_EV_DIR_FALLING: 191 case IIO_EV_DIR_NONE: 192 break; 193 default: 194 return false; 195 } 196 197 return true; 198} 199 200static void print_event(struct iio_event_data *event) 201{ 202 enum iio_chan_type type = IIO_EVENT_CODE_EXTRACT_CHAN_TYPE(event->id); 203 enum iio_modifier mod = IIO_EVENT_CODE_EXTRACT_MODIFIER(event->id); 204 enum iio_event_type ev_type = IIO_EVENT_CODE_EXTRACT_TYPE(event->id); 205 enum iio_event_direction dir = IIO_EVENT_CODE_EXTRACT_DIR(event->id); 206 int chan = IIO_EVENT_CODE_EXTRACT_CHAN(event->id); 207 int chan2 = IIO_EVENT_CODE_EXTRACT_CHAN2(event->id); 208 bool diff = IIO_EVENT_CODE_EXTRACT_DIFF(event->id); 209 210 if (!event_is_known(event)) { 211 printf("Unknown event: time: %lld, id: %llx\n", 212 event->timestamp, event->id); 213 return; 214 } 215 216 printf("Event: time: %lld, ", event->timestamp); 217 218 if (mod != IIO_NO_MOD) { 219 printf("type: %s(%s), ", 220 iio_chan_type_name_spec[type], 221 iio_modifier_names[mod]); 222 } else { 223 printf("type: %s, ", 224 iio_chan_type_name_spec[type]); 225 } 226 227 if (diff && chan >= 0 && chan2 >= 0) 228 printf("channel: %d-%d, ", chan, chan2); 229 else if (chan >= 0) 230 printf("channel: %d, ", chan); 231 232 printf("evtype: %s", iio_ev_type_text[ev_type]); 233 234 if (dir != IIO_EV_DIR_NONE) 235 printf(", direction: %s", iio_ev_dir_text[dir]); 236 printf("\n"); 237} 238 239int main(int argc, char **argv) 240{ 241 struct iio_event_data event; 242 const char *device_name; 243 char *chrdev_name; 244 int ret; 245 int dev_num; 246 int fd, event_fd; 247 248 if (argc <= 1) { 249 printf("Usage: %s <device_name>\n", argv[0]); 250 return -1; 251 } 252 253 device_name = argv[1]; 254 255 dev_num = find_type_by_name(device_name, "iio:device"); 256 if (dev_num >= 0) { 257 printf("Found IIO device with name %s with device number %d\n", 258 device_name, dev_num); 259 ret = asprintf(&chrdev_name, "/dev/iio:device%d", dev_num); 260 if (ret < 0) { 261 ret = -ENOMEM; 262 goto error_ret; 263 } 264 } else { 265 /* If we can't find a IIO device by name assume device_name is a 266 IIO chrdev */ 267 chrdev_name = strdup(device_name); 268 } 269 270 fd = open(chrdev_name, 0); 271 if (fd == -1) { 272 fprintf(stdout, "Failed to open %s\n", chrdev_name); 273 ret = -errno; 274 goto error_free_chrdev_name; 275 } 276 277 ret = ioctl(fd, IIO_GET_EVENT_FD_IOCTL, &event_fd); 278 279 close(fd); 280 281 if (ret == -1 || event_fd == -1) { 282 fprintf(stdout, "Failed to retrieve event fd\n"); 283 ret = -errno; 284 goto error_free_chrdev_name; 285 } 286 287 while (true) { 288 ret = read(event_fd, &event, sizeof(event)); 289 if (ret == -1) { 290 if (errno == EAGAIN) { 291 printf("nothing available\n"); 292 continue; 293 } else { 294 perror("Failed to read event from device"); 295 ret = -errno; 296 break; 297 } 298 } 299 300 print_event(&event); 301 } 302 303 close(event_fd); 304error_free_chrdev_name: 305 free(chrdev_name); 306error_ret: 307 return ret; 308} 309