src/hardware/beaglelogic/beaglelogic_native.c

   1 /*
   2  * This file is part of the libsigrok project.
   3  *
   4  * Copyright (C) 2014-2017 Kumar Abhishek <abhishek@theembeddedkitchen.net>
   5  *
   6  * This program is free software: you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation, either version 3 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include "protocol.h"
  21 #include "beaglelogic.h"
  22
  23 static int beaglelogic_open_nonblock(struct dev_context *devc)
  24 {
  25         devc->fd = open(BEAGLELOGIC_DEV_NODE, O_RDONLY | O_NONBLOCK);
  26
  27         return ((devc->fd == -1) ? SR_ERR : SR_OK);
  28 }
  29
  30 static int beaglelogic_close(struct dev_context *devc)
  31 {
  32         return close(devc->fd);
  33 }
  34
  35 static int beaglelogic_get_buffersize(struct dev_context *devc)
  36 {
  37         return ioctl(devc->fd, IOCTL_BL_GET_BUFFER_SIZE, &devc->buffersize);
  38 }
  39
  40 static int beaglelogic_set_buffersize(struct dev_context *devc)
  41 {
  42         return ioctl(devc->fd, IOCTL_BL_SET_BUFFER_SIZE, devc->buffersize);
  43 }
  44
  45 /* This is treated differently as it gets a uint64_t while a uint32_t is read */
  46 static int beaglelogic_get_samplerate(struct dev_context *devc)
  47 {
  48         uint32_t arg, err;
  49
  50         err = ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_RATE, &arg);
  51         devc->cur_samplerate = arg;
  52
  53         return err;
  54 }
  55
  56 static int beaglelogic_set_samplerate(struct dev_context *devc)
  57 {
  58         return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_RATE,
  59                         (uint32_t)devc->cur_samplerate);
  60 }
  61
  62 static int beaglelogic_get_sampleunit(struct dev_context *devc)
  63 {
  64         return ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_UNIT, &devc->sampleunit);
  65 }
  66
  67 static int beaglelogic_set_sampleunit(struct dev_context *devc)
  68 {
  69         return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_UNIT, devc->sampleunit);
  70 }
  71
  72 static int beaglelogic_get_triggerflags(struct dev_context *devc)
  73 {
  74         return ioctl(devc->fd, IOCTL_BL_GET_TRIGGER_FLAGS, &devc->triggerflags);
  75 }
  76
  77 static int beaglelogic_set_triggerflags(struct dev_context *devc)
  78 {
  79         return ioctl(devc->fd, IOCTL_BL_SET_TRIGGER_FLAGS, devc->triggerflags);
  80 }
  81
  82 static int beaglelogic_get_lasterror(struct dev_context *devc)
  83 {
  84         int fd;
  85         char buf[16];
  86         int ret;
  87
  88         if ((fd = open(BEAGLELOGIC_SYSFS_ATTR(lasterror), O_RDONLY)) == -1)
  89                 return SR_ERR;
  90
  91         ret = read(fd, buf, 16);
  92         close(fd);
  93
  94         if (ret)
  95                 return SR_ERR;
  96
  97         devc->last_error = strtoul(buf, NULL, 10);
  98
  99         return SR_OK;
 100 }
 101
 102 static int beaglelogic_start(struct dev_context *devc)
 103 {
 104         return ioctl(devc->fd, IOCTL_BL_START);
 105 }
 106
 107 static int beaglelogic_stop(struct dev_context *devc)
 108 {
 109         return ioctl(devc->fd, IOCTL_BL_STOP);
 110 }
 111
 112 static int beaglelogic_get_bufunitsize(struct dev_context *devc)
 113 {
 114         return ioctl(devc->fd, IOCTL_BL_GET_BUFUNIT_SIZE, &devc->bufunitsize);
 115 }
 116
 117 static int beaglelogic_set_bufunitsize(struct dev_context *devc)
 118 {
 119         return ioctl(devc->fd, IOCTL_BL_SET_BUFUNIT_SIZE, devc->bufunitsize);
 120 }
 121
 122 static int beaglelogic_mmap(struct dev_context *devc)
 123 {
 124         if (!devc->buffersize)
 125                 beaglelogic_get_buffersize(devc);
 126         devc->sample_buf = mmap(NULL, devc->buffersize,
 127                         PROT_READ, MAP_SHARED, devc->fd, 0);
 128
 129         return ((devc->sample_buf == MAP_FAILED) ? -1 : SR_OK);
 130 }
 131
 132 static int beaglelogic_munmap(struct dev_context *devc)
 133 {
 134         return munmap(devc->sample_buf, devc->buffersize);
 135 }
 136
 137 SR_PRIV const struct beaglelogic_ops beaglelogic_native_ops = {
 138         .open = beaglelogic_open_nonblock,
 139         .close = beaglelogic_close,
 140         .get_buffersize = beaglelogic_get_buffersize,
 141         .set_buffersize = beaglelogic_set_buffersize,
 142         .get_samplerate = beaglelogic_get_samplerate,
 143         .set_samplerate = beaglelogic_set_samplerate,
 144         .get_sampleunit = beaglelogic_get_sampleunit,
 145         .set_sampleunit = beaglelogic_set_sampleunit,
 146         .get_triggerflags = beaglelogic_get_triggerflags,
 147         .set_triggerflags = beaglelogic_set_triggerflags,
 148         .start = beaglelogic_start,
 149         .stop = beaglelogic_stop,
 150         .get_lasterror = beaglelogic_get_lasterror,
 151         .get_bufunitsize = beaglelogic_get_bufunitsize,
 152         .set_bufunitsize = beaglelogic_set_bufunitsize,
 153         .mmap = beaglelogic_mmap,
 154         .munmap = beaglelogic_munmap,
 155 };