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