examples/iio_driver.c

   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 }