1 /* 2 * Author: Brendan Le Foll 3 * Copyright (c) 2015 Intel Corporation. 4 * 5 * Permission is hereby granted, free of charge, to any person obtaining 6 * a copy of this software and associated documentation files (the 7 * "Software"), to deal in the Software without restriction, including 8 * without limitation the rights to use, copy, modify, merge, publish, 9 * distribute, sublicense, and/or sell copies of the Software, and to 10 * permit persons to whom the Software is furnished to do so, subject to 11 * the following conditions: 12 * 13 * The above copyright notice and this permission notice shall be 14 * included in all copies or substantial portions of the Software. 15 * 16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 17 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 18 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 19 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE 20 * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION 21 * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION 22 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. 23 */ 24 25 #include <unistd.h> 26 #include "mraa/iio.h" 27 28 static void 29 printword(uint16_t input, mraa_iio_channel* chan) 30 { 31 int16_t res; 32 33 if (!chan->lendian) { 34 input = be16toh(input); 35 } else { 36 input = le16toh(input); 37 } 38 39 input >>= chan->shift; 40 input &= chan->mask; 41 if (chan->signedd) { 42 res = (int16_t)(input << (16 - chan->bits_used)) >> (16 - chan->bits_used); 43 } else { 44 res = input; 45 } 46 printf(" value = %05f\n", (float) res); 47 } 48 49 mraa_iio_context iio_device0; 50 mraa_iio_context iio_device6; 51 52 void 53 interrupt(char* data) 54 { 55 mraa_iio_channel* channels = mraa_iio_get_channels(iio_device0); 56 int i = 0; 57 58 for (i; i < mraa_iio_get_channel_count(iio_device0); i++) { 59 if (channels[i].enabled) { 60 printf("channel %d - bytes %d\n", channels[i].index, channels[i].bytes); 61 switch (channels[i].bytes) { 62 case 2: 63 printword(*(uint16_t*) (data + channels[i].location), &channels[i]); 64 } 65 } 66 } 67 } 68 69 void 70 event_interrupt(struct iio_event_data* data) 71 { 72 int chan_type; 73 int modifier; 74 int type; 75 int direction; 76 int channel; 77 int channel2; 78 int different; 79 mraa_iio_event_extract_event(data, &chan_type, &modifier, &type, &direction, &channel, &channel2, &different); 80 81 printf("event time %lld id %lld extracted chan_type %d modifier %d type %d direction %d " 82 "channel %d channel2 %d different %d\n", 83 data->timestamp, data->id, chan_type, modifier, type, direction, channel, channel2, different); 84 } 85 86 int 87 main() 88 { 89 //! [Interesting] 90 iio_device0 = mraa_iio_init(0); 91 if (iio_device0 == NULL) { 92 return EXIT_FAILURE; 93 } 94 95 float iio_float; 96 int iio_int; 97 mraa_result_t ret; 98 99 ret = mraa_iio_write_float(iio_device0, "in_accel_scale", 0.019163); 100 if (ret == MRAA_SUCCESS) { 101 fprintf(stdout, "IIO write success\n"); 102 } 103 104 ret = mraa_iio_read_float(iio_device0, "in_accel_scale", &iio_float); 105 if (ret == MRAA_SUCCESS) { 106 fprintf(stdout, "IIO read %f\n", iio_float); 107 } 108 109 ret = mraa_iio_write_int(iio_device0, "scan_elements/in_accel_x_en", 1); 110 if (ret == MRAA_SUCCESS) { 111 fprintf(stdout, "IIO write success\n"); 112 } 113 114 ret = mraa_iio_read_int(iio_device0, "scan_elements/in_accel_x_en", &iio_int); 115 if (ret == MRAA_SUCCESS) { 116 fprintf(stdout, "IIO read %d\n", iio_int); 117 } 118 119 if (mraa_iio_trigger_buffer(iio_device0, interrupt, NULL) == MRAA_SUCCESS) { 120 sleep(100); 121 return EXIT_SUCCESS; 122 } 123 124 /* 125 struct iio_event_data event; 126 iio_device6 = mraa_iio_init(6); 127 if (iio_device6 == NULL) { 128 return EXIT_FAILURE; 129 } 130 mraa_iio_write_int(iio_device6, "events/in_proximity2_thresh_either_en", 1); 131 132 133 // Blocking until event fired 134 if (mraa_iio_event_poll(iio_device6, &event) == MRAA_SUCCESS) { 135 event_interrupt(&event); //just to show data 136 } 137 138 if (mraa_iio_event_setup_callback(iio_device6, event_interrupt, NULL) == MRAA_SUCCESS) { 139 sleep(100); 140 return EXIT_SUCCESS; 141 }*/ 142 143 //! [Interesting] 144 return EXIT_FAILURE; 145 } 146