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
printword(uint16_t input,mraa_iio_channel * chan)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
interrupt(char * data)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
event_interrupt(struct iio_event_data * data)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
main()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