src/hardware/beaglelogic/beaglelogic_native.c

   1 /*
   2  * This file is part of the libsigrok project.
   3  *
   4  * Copyright (C) 2014-17 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         devc->fd = open(BEAGLELOGIC_DEV_NODE, O_RDONLY | O_NONBLOCK);
  25         return (devc->fd == -1 ? SR_ERR : SR_OK);
  26 }
  27
  28 static int beaglelogic_close(struct dev_context *devc) {
  29         return close(devc->fd);
  30 }
  31
  32 static int beaglelogic_get_buffersize(struct dev_context *devc) {
  33         return ioctl(devc->fd, IOCTL_BL_GET_BUFFER_SIZE, &devc->buffersize);
  34 }
  35
  36 static int beaglelogic_set_buffersize(struct dev_context *devc) {
  37         return ioctl(devc->fd, IOCTL_BL_SET_BUFFER_SIZE, devc->buffersize);
  38 }
  39
  40 /* This is treated differently as it gets a uint64_t while a uint32_t is read */
  41 static int beaglelogic_get_samplerate(struct dev_context *devc) {
  42         uint32_t arg, err;
  43         err = ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_RATE, &arg);
  44         devc->cur_samplerate = arg;
  45         return err;
  46 }
  47
  48 static int beaglelogic_set_samplerate(struct dev_context *devc) {
  49         return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_RATE,
  50                         (uint32_t)devc->cur_samplerate);
  51 }
  52
  53 static int beaglelogic_get_sampleunit(struct dev_context *devc) {
  54         return ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_UNIT, &devc->sampleunit);
  55 }
  56
  57 static int beaglelogic_set_sampleunit(struct dev_context *devc) {
  58         return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_UNIT, devc->sampleunit);
  59 }
  60
  61 static int beaglelogic_get_triggerflags(struct dev_context *devc) {
  62         return ioctl(devc->fd, IOCTL_BL_GET_TRIGGER_FLAGS, &devc->triggerflags);
  63 }
  64
  65 static int beaglelogic_set_triggerflags(struct dev_context *devc) {
  66         return ioctl(devc->fd, IOCTL_BL_SET_TRIGGER_FLAGS, devc->triggerflags);
  67 }
  68
  69 static int beaglelogic_get_lasterror(struct dev_context *devc) {
  70         int fd;
  71         char buf[16];
  72         int ret;
  73
  74         if ((fd = open(BEAGLELOGIC_SYSFS_ATTR(lasterror), O_RDONLY)) == -1)
  75                 return SR_ERR;
  76
  77         if ((ret = read(fd, buf, 16)) < 0)
  78                 return SR_ERR;
  79
  80         close(fd);
  81         devc->last_error = strtoul(buf, NULL, 10);
  82
  83         return SR_OK;
  84 }
  85
  86 static int beaglelogic_start(struct dev_context *devc) {
  87         return ioctl(devc->fd, IOCTL_BL_START);
  88 }
  89
  90 static int beaglelogic_stop(struct dev_context *devc) {
  91         return ioctl(devc->fd, IOCTL_BL_STOP);
  92 }
  93
  94 static int beaglelogic_get_bufunitsize(struct dev_context *devc) {
  95         return ioctl(devc->fd, IOCTL_BL_GET_BUFUNIT_SIZE, &devc->bufunitsize);
  96 }
  97
  98 static int beaglelogic_set_bufunitsize(struct dev_context *devc) {
  99         return ioctl(devc->fd, IOCTL_BL_SET_BUFUNIT_SIZE, devc->bufunitsize);
 100 }
 101
 102 static int beaglelogic_mmap(struct dev_context *devc) {
 103         if (!devc->buffersize)
 104                 beaglelogic_get_buffersize(devc);
 105         devc->sample_buf = mmap(NULL, devc->buffersize,
 106                         PROT_READ, MAP_SHARED, devc->fd, 0);
 107         return (devc->sample_buf == MAP_FAILED ? -1 : SR_OK);
 108 }
 109
 110 static int beaglelogic_munmap(struct dev_context *devc) {
 111         return munmap(devc->sample_buf, devc->buffersize);
 112 }
 113
 114 SR_PRIV const struct beaglelogic_ops beaglelogic_native_ops = {
 115         .open = beaglelogic_open_nonblock,
 116         .close = beaglelogic_close,
 117         .get_buffersize = beaglelogic_get_buffersize,
 118         .set_buffersize = beaglelogic_set_buffersize,
 119         .get_samplerate = beaglelogic_get_samplerate,
 120         .set_samplerate = beaglelogic_set_samplerate,
 121         .get_sampleunit = beaglelogic_get_sampleunit,
 122         .set_sampleunit = beaglelogic_set_sampleunit,
 123         .get_triggerflags = beaglelogic_get_triggerflags,
 124         .set_triggerflags = beaglelogic_set_triggerflags,
 125         .start = beaglelogic_start,
 126         .stop = beaglelogic_stop,
 127         .get_lasterror = beaglelogic_get_lasterror,
 128         .get_bufunitsize = beaglelogic_get_bufunitsize,
 129         .set_bufunitsize = beaglelogic_set_bufunitsize,
 130         .mmap = beaglelogic_mmap,
 131         .munmap = beaglelogic_munmap,
 132 };