src/iio/iio.c

   1 /*
   2  * Author: Brendan Le Foll <brendan.le.foll@intel.com>
   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 "iio.h"
  26 #include "mraa_internal.h"
  27 #include "dirent.h"
  28 #include <string.h>
  29
  30 #define IIO_SYSFS_DEVICE "/sys/bus/iio/devices/iio:device"
  31
  32 mraa_iio_context
  33 mraa_iio_init(int device)
  34 {
  35     if (device > plat->iio_device_count) {
  36         return NULL;
  37     }
  38
  39     mraa_iio_context dev = &plat->iio_devices[device];
  40
  41     char* buf;
  42     char sep[] = "_";
  43     char* splitbuf;
  44     DIR* dir;
  45     struct dirent *ent;
  46     if ((dir = opendir (IIO_SYSFS_DEVICE "0/")) != NULL) {
  47         while ((ent = readdir (dir)) != NULL) {
  48             if (strlen(ent->d_name) > 3) {
  49                 if (strncmp(ent->d_name, "in_", 3) == 0) {
  50                     dev->attrnum++;
  51                     buf = strndup(&ent->d_name[3], 64);
  52                     splitbuf = strsep(&buf, sep);
  53                     if (buf == NULL) {
  54                         return NULL;
  55                     }
  56                     int num = atoi(&splitbuf[strlen(splitbuf)-1]);
  57                     if (dev->channum < num) {
  58                         dev->channum = num;
  59                     }
  60                     free(splitbuf);
  61                 }
  62                 else if (strncmp(ent->d_name, "out_", 4) == 0) {
  63                     dev->attrnum++;
  64                 }
  65             }
  66         }
  67         closedir (dir);
  68     } else {
  69         return NULL;
  70     }
  71
  72     return dev;
  73 }
  74
  75 // -1 is the device 'channel'
  76 int
  77 mraa_iio_get_attr_count(mraa_iio_context dev, int channel)
  78 {
  79     // search is 0 indexed
  80     return dev->attrnum + 1;
  81 }
  82
  83 int
  84 mraa_iio_get_channel_count(mraa_iio_context dev)
  85 {
  86     // search is 0 indexed
  87     return dev->channum + 1;
  88 }
  89
  90 const char*
  91 mraa_iio_get_device_name(mraa_iio_context dev)
  92 {
  93     return dev->name;
  94 }
  95
  96 #if 0
  97 mraa_result_t
  98 mraa_iio_get_attr_data(mraa_iio_context dev, mraa_iio_channel* chan)
  99 {
 100     return MRAA_FEATURE_NOT_IMPLEMENTED;
 101 }
 102 #endif
 103
 104 mraa_result_t
 105 mraa_iio_read(mraa_iio_context dev, const char* attribute, float* data)
 106 {
 107     char buf[64];
 108     snprintf(buf, 64, IIO_SYSFS_DEVICE, "%d/%s", dev->num, attribute);
 109     int fd = open(buf, O_RDONLY);
 110     if (fd != -1) {
 111         int len = read(fd, &buf, 64);
 112         *data = strtol(buf, NULL, 10);
 113         return MRAA_SUCCESS;
 114     }
 115     return MRAA_ERROR_UNSPECIFIED;
 116 }
 117
 118 mraa_result_t
 119 mraa_iio_write(mraa_iio_context dev, const char* attribute)
 120 {
 121     return MRAA_ERROR_FEATURE_NOT_IMPLEMENTED;
 122 }
 123
 124 mraa_result_t
 125 mraa_iio_stop(mraa_iio_context dev)
 126 {
 127     free(dev);
 128     return MRAA_SUCCESS;
 129 }
 130