#define MAX_SIZE 128
#define IIO_DEVICE "iio:device"
#define IIO_SCAN_ELEM "scan_elements"
-#define IIO_SLASH_DEV "/dev/"IIO_DEVICE
-#define IIO_SYSFS_DEVICE "/sys/bus/iio/devices/"IIO_DEVICE
+#define IIO_SLASH_DEV "/dev/" IIO_DEVICE
+#define IIO_SYSFS_DEVICE "/sys/bus/iio/devices/" IIO_DEVICE
#define IIO_EVENTS "events"
mraa_iio_context
mraa_result_t
mraa_iio_get_channel_data(mraa_iio_context dev)
{
- const struct dirent *ent;
+ const struct dirent* ent;
DIR* dir;
int chan_num = 0;
char buf[MAX_SIZE];
if (dir != NULL) {
while ((ent = readdir(dir)) != NULL) {
if (strcmp(ent->d_name + strlen(ent->d_name) - strlen("_en"), "_en") == 0) {
- chan_num++;
+ chan_num++;
}
}
}
dev->chan_num = chan_num;
- //no need proceed if no channel found
- if (chan_num == 0)
- return MRAA_SUCCESS;
+ // no need proceed if no channel found
+ if (chan_num == 0)
+ return MRAA_SUCCESS;
mraa_iio_channel* chan;
dev->channels = calloc(chan_num, sizeof(mraa_iio_channel));
seekdir(dir, 0);
chan->index = chan_num;
close(fd);
- buf[(strlen(buf)-5)] = '\0';
+ buf[(strlen(buf) - 5)] = '\0';
char* str = strdup(buf);
// grab the type of the buffer
snprintf(buf, MAX_SIZE, "%stype", str);
fd = open(buf, O_RDONLY);
if (fd > 0) {
read(fd, readbuf, 31 * sizeof(char));
- ret = sscanf(readbuf, "%ce:%c%u/%u>>%u", &shortbuf,
- &signchar, &chan->bits_used,
- &padint, &chan->shift);
+ ret = sscanf(readbuf, "%ce:%c%u/%u>>%u", &shortbuf, &signchar, &chan->bits_used,
+ &padint, &chan->shift);
chan->bytes = padint / 8;
if (curr_bytes % chan->bytes == 0) {
chan->location = curr_bytes;
} else {
- chan->location = curr_bytes - curr_bytes%chan->bytes + chan->bytes;
+ chan->location = curr_bytes - curr_bytes % chan->bytes + chan->bytes;
}
curr_bytes = chan->location + chan->bytes;
// probably should be 5?
return -1;
}
chan->enabled = (int) strtol(readbuf, NULL, 10);
- //only calculate enable buffer size for trigger buffer extract data
+ // only calculate enable buffer size for trigger buffer extract data
if (chan->enabled) {
dev->datasize += chan->bytes;
}
struct _iio* device;
device = &plat_iio->iio_devices[i];
// we want to check for exact match
- if (strncmp(device->name, name, strlen(device->name)+1) == 0) {
+ if (strncmp(device->name, name, strlen(device->name) + 1) == 0) {
return device->num;
}
}
snprintf(buf, 128, IIO_SYSFS_DEVICE "%d/%s", dev->num, attr_chan);
int fd = open(buf, O_WRONLY);
if (fd != -1) {
- write(fd, data, (strlen(data)+1));
+ write(fd, data, (strlen(data) + 1));
return MRAA_SUCCESS;
}
return MRAA_ERROR_UNSPECIFIED;
}
static mraa_result_t
-mraa_iio_wait_event(int fd, char* data, int *read_size)
+mraa_iio_wait_event(int fd, char* data, int* read_size)
{
struct pollfd pfd;
{
mraa_iio_context dev = (mraa_iio_context) arg;
int i;
- char data[MAX_SIZE*100];
+ char data[MAX_SIZE * 100];
int read_size;
for (;;) {
if (mraa_iio_wait_event(dev->fp, &data[0], &read_size) == MRAA_SUCCESS) {
pthread_setcancelstate(PTHREAD_CANCEL_DISABLE, NULL);
- //only can process if readsize >= enabled channel's datasize
- for (i=0; i<(read_size/dev->datasize); i++) {
+ // only can process if readsize >= enabled channel's datasize
+ for (i = 0; i < (read_size / dev->datasize); i++) {
dev->isr(&data);
}
pthread_setcancelstate(PTHREAD_CANCEL_ENABLE, NULL);
mraa_result_t
mraa_iio_get_event_data(mraa_iio_context dev)
{
- const struct dirent *ent;
+ const struct dirent* ent;
DIR* dir;
int event_num = 0;
char buf[MAX_SIZE];
}
}
dev->event_num = event_num;
- //no need proceed if no event found
- if (event_num == 0)
- return MRAA_SUCCESS;
+ // no need proceed if no event found
+ if (event_num == 0)
+ return MRAA_SUCCESS;
mraa_iio_event* event;
- dev->events = calloc(event_num, sizeof(mraa_iio_event));
- if ( dev->events == NULL)
- {
- closedir(dir);
- return MRAA_ERROR_UNSPECIFIED;
- }
- rewinddir(dir);
- event_num = 0;
- while ((ent = readdir(dir)) != NULL)
- {
+ dev->events = calloc(event_num, sizeof(mraa_iio_event));
+ if (dev->events == NULL) {
+ closedir(dir);
+ return MRAA_ERROR_UNSPECIFIED;
+ }
+ rewinddir(dir);
+ event_num = 0;
+ while ((ent = readdir(dir)) != NULL) {
if (strcmp(ent->d_name + strlen(ent->d_name) - strlen("_en"), "_en") == 0) {
- event = &dev->events[event_num];
+ event = &dev->events[event_num];
event->name = strdup(ent->d_name);
- snprintf(buf, MAX_SIZE, IIO_SYSFS_DEVICE "%d/" IIO_EVENTS "/%s", dev->num, ent->d_name);
- fd = open(buf, O_RDONLY);
- if (fd > 0) {
- if (read(fd, readbuf, 2 * sizeof(char)) != 2) {
- break;
- }
- close(fd);
- }
+ snprintf(buf, MAX_SIZE, IIO_SYSFS_DEVICE "%d/" IIO_EVENTS "/%s", dev->num, ent->d_name);
+ fd = open(buf, O_RDONLY);
+ if (fd > 0) {
+ if (read(fd, readbuf, 2 * sizeof(char)) != 2) {
+ break;
+ }
+ close(fd);
+ }
event->enabled = ((int) strtol(readbuf, NULL, 10));
- //Todo, read other event info.
- event_num++;
+ // Todo, read other event info.
+ event_num++;
}
}
- closedir(dir);
+ closedir(dir);
}
return MRAA_SUCCESS;
}
}
mraa_result_t
-mraa_iio_event_write(mraa_iio_context dev, const char* attribute, const char* data)
+mraa_iio_event_write(mraa_iio_context dev, const char* attribute, const char* data)
{
- int len;
+ int len;
char buf[MAX_SIZE];
snprintf(buf, MAX_SIZE, IIO_SYSFS_DEVICE "%d/" IIO_EVENTS "/%s", dev->num, attribute);
int fd = open(buf, O_WRONLY);
if (fd != -1) {
- int len = write(fd, data, ( strlen(data) +1 ));
+ int len = write(fd, data, (strlen(data) + 1));
return MRAA_SUCCESS;
}
return MRAA_ERROR_UNSPECIFIED;
{
char bu[MAX_SIZE];
int ret;
- int event_fd;
- int fd;
+ int event_fd;
+ int fd;
- sprintf(bu, IIO_SLASH_DEV "%d", dev->num);
+ sprintf(bu, IIO_SLASH_DEV "%d", dev->num);
fd = open(bu, 0);
- ret = ioctl(fd, IIO_GET_EVENT_FD_IOCTL, &event_fd);
- close(fd);
+ ret = ioctl(fd, IIO_GET_EVENT_FD_IOCTL, &event_fd);
+ close(fd);
- if (ret == -1 || event_fd == -1)
- return MRAA_ERROR_UNSPECIFIED;
+ if (ret == -1 || event_fd == -1)
+ return MRAA_ERROR_UNSPECIFIED;
- ret = read(event_fd, data, sizeof(struct iio_event_data));
+ ret = read(event_fd, data, sizeof(struct iio_event_data));
- close(event_fd);
+ close(event_fd);
return MRAA_SUCCESS;
}
static void*
mraa_iio_event_handler(void* arg)
{
- struct iio_event_data data;
+ struct iio_event_data data;
mraa_iio_context dev = (mraa_iio_context) arg;
for (;;) {
mraa_result_t
mraa_iio_event_setup_callback(mraa_iio_context dev, void (*fptr)(struct iio_event_data* data), void* args)
{
- int ret;
+ int ret;
char bu[MAX_SIZE];
if (dev->thread_id != 0) {
return MRAA_ERROR_NO_RESOURCES;
if (dev->fp == -1) {
return MRAA_ERROR_INVALID_RESOURCE;
}
- ret = ioctl(dev->fp, IIO_GET_EVENT_FD_IOCTL, &dev->fp_event);
- close(dev->fp);
+ ret = ioctl(dev->fp, IIO_GET_EVENT_FD_IOCTL, &dev->fp_event);
+ close(dev->fp);
- if (ret == -1 || dev->fp_event == -1)
- {
- return MRAA_ERROR_UNSPECIFIED;
- }
+ if (ret == -1 || dev->fp_event == -1) {
+ return MRAA_ERROR_UNSPECIFIED;
+ }
dev->isr_event = fptr;
pthread_create(&dev->thread_id, NULL, mraa_iio_event_handler, (void*) dev);
}
mraa_result_t
-mraa_iio_event_extract_event(struct iio_event_data* event, int* chan_type, int* modifier, int* type, int* direction, int* channel, int* channel2, int* different)
+mraa_iio_event_extract_event(struct iio_event_data* event,
+ int* chan_type,
+ int* modifier,
+ int* type,
+ int* direction,
+ int* channel,
+ int* channel2,
+ int* different)
{
- *chan_type = IIO_EVENT_CODE_EXTRACT_CHAN_TYPE(event->id);
- *modifier= IIO_EVENT_CODE_EXTRACT_MODIFIER(event->id);
- *type = IIO_EVENT_CODE_EXTRACT_TYPE(event->id);
- *direction = IIO_EVENT_CODE_EXTRACT_DIR(event->id);
- *channel = IIO_EVENT_CODE_EXTRACT_CHAN(event->id);
- *channel2 = IIO_EVENT_CODE_EXTRACT_CHAN2(event->id);
- *different = IIO_EVENT_CODE_EXTRACT_DIFF(event->id);
+ *chan_type = IIO_EVENT_CODE_EXTRACT_CHAN_TYPE(event->id);
+ *modifier = IIO_EVENT_CODE_EXTRACT_MODIFIER(event->id);
+ *type = IIO_EVENT_CODE_EXTRACT_TYPE(event->id);
+ *direction = IIO_EVENT_CODE_EXTRACT_DIR(event->id);
+ *channel = IIO_EVENT_CODE_EXTRACT_CHAN(event->id);
+ *channel2 = IIO_EVENT_CODE_EXTRACT_CHAN2(event->id);
+ *different = IIO_EVENT_CODE_EXTRACT_DIFF(event->id);
return MRAA_SUCCESS;
}
#if 0
return MRAA_SUCCESS;
}
#endif
-
projects / contrib / mraa.git / commitdiff