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     if (!chan->lendian) {
  33             input = be16toh(input);
  34     } else {
  35             input = le16toh(input);
  36     }
  37
  38     // currently we don't treat scales
  39     chan->scale = 1.0f;
  40
  41     input >>= chan->shift;
  42     input &= chan->mask;
  43     if (chan->signedd) {
  44         res = (int16_t)(input << (16 - chan->bits_used)) >> (16 - chan->bits_used);
  45     } else {
  46         res = input;
  47     }
  48     printf("chan %d == %05f\n", chan->index, ((float)res + chan->offset) * chan->scale);
  49 }
  50
  51 mraa_iio_context iio_device0;
  52
  53 void
  54 interrupt(char* data)
  55 {
  56     mraa_iio_channel* channels = mraa_iio_get_channels(iio_device0);
  57     int i = 0;
  58
  59     for (i; i < mraa_iio_get_channel_count(iio_device0); i++) {
  60         printf("channel bytes %d\n", channels[i].bytes);
  61         switch (channels[i].bytes) {
  62             case 2:
  63                 printword(*(uint16_t *)(data + channels[i].location), &channels[i]);
  64         }
  65     }
  66     printf("data %s\n", (char*) data);
  67 }
  68
  69 int
  70 main()
  71 {
  72     //! [Interesting]
  73     iio_device0 = mraa_iio_init(0);
  74     if (iio_device0 == NULL) {
  75         return EXIT_FAILURE;
  76     }
  77
  78     float iio_value;
  79     mraa_result_t ret = mraa_iio_read(iio_device0, "in_voltage0_raw", &iio_value);
  80     if (ret == MRAA_SUCCESS) {
  81         fprintf(stdout, "IIO read %f\n", iio_value);
  82     }
  83
  84     if (mraa_iio_trigger_buffer(iio_device0, interrupt, NULL) == MRAA_SUCCESS) {
  85         sleep(100);
  86         return EXIT_SUCCESS;
  87     }
  88
  89     //! [Interesting]
  90     return EXIT_FAILURE;
  91 }