Home | History | Annotate | Download | only in examples 
      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