From: Kumar Abhishek Date: Fri, 15 Sep 2017 18:31:53 +0000 (+0530) Subject: beaglelogic: Re-organize to prepare for TCP support X-Git-Url: https://sigrok.org/gitaction?a=commitdiff_plain;h=0bca2e75f555fc975970c8e9c859c37c74380ede;p=libsigrok.git beaglelogic: Re-organize to prepare for TCP support Organize driver functions into an ops structure (there will be separate structures for both native and TCP mode of operation). Signed-off-by: Kumar Abhishek --- diff --git a/src/hardware/beaglelogic/api.c b/src/hardware/beaglelogic/api.c index d93f4af3..ef3e8ffa 100644 --- a/src/hardware/beaglelogic/api.c +++ b/src/hardware/beaglelogic/api.c @@ -102,6 +102,9 @@ static GSList *scan(struct sr_dev_driver *di, GSList *options) devc = beaglelogic_devc_alloc(); + devc->beaglelogic = &beaglelogic_native_ops; + + /* Fill the channels */ for (i = 0; i < maxch; i++) sr_channel_new(sdi, i, SR_CHANNEL_LOGIC, TRUE, channel_names[i]); @@ -119,7 +122,7 @@ static int dev_open(struct sr_dev_inst *sdi) struct dev_context *devc = sdi->priv; /* Open BeagleLogic */ - if (beaglelogic_open_nonblock(devc)) + if (devc->beaglelogic->open(devc)) return SR_ERR; /* Set fd and local attributes */ @@ -128,20 +131,20 @@ static int dev_open(struct sr_dev_inst *sdi) devc->pollfd.revents = 0; /* Get the default attributes */ - beaglelogic_get_samplerate(devc); - beaglelogic_get_sampleunit(devc); - beaglelogic_get_buffersize(devc); - beaglelogic_get_bufunitsize(devc); + devc->beaglelogic->get_samplerate(devc); + devc->beaglelogic->get_sampleunit(devc); + devc->beaglelogic->get_buffersize(devc); + devc->beaglelogic->get_bufunitsize(devc); /* Set the triggerflags to default for continuous capture unless we * explicitly limit samples using SR_CONF_LIMIT_SAMPLES */ devc->triggerflags = BL_TRIGGERFLAGS_CONTINUOUS; - beaglelogic_set_triggerflags(devc); + devc->beaglelogic->set_triggerflags(devc); /* Map the kernel capture FIFO for reads, saves 1 level of memcpy */ - if (beaglelogic_mmap(devc) != SR_OK) { + if (devc->beaglelogic->mmap(devc) != SR_OK) { sr_err("Unable to map capture buffer"); - beaglelogic_close(devc); + devc->beaglelogic->close(devc); return SR_ERR; } @@ -153,8 +156,8 @@ static int dev_close(struct sr_dev_inst *sdi) struct dev_context *devc = sdi->priv; /* Close the memory mapping and the file */ - beaglelogic_munmap(devc); - beaglelogic_close(devc); + devc->beaglelogic->munmap(devc); + devc->beaglelogic->close(devc); return SR_OK; } @@ -197,7 +200,7 @@ static int config_set(uint32_t key, GVariant *data, switch (key) { case SR_CONF_SAMPLERATE: devc->cur_samplerate = g_variant_get_uint64(data); - return beaglelogic_set_samplerate(devc); + return devc->beaglelogic->set_samplerate(devc); case SR_CONF_LIMIT_SAMPLES: tmp_u64 = g_variant_get_uint64(data); devc->limit_samples = tmp_u64; @@ -214,7 +217,7 @@ static int config_set(uint32_t key, GVariant *data, devc->buffersize / (SAMPLEUNIT_TO_BYTES(devc->sampleunit) * 1000000)); } - return beaglelogic_set_triggerflags(devc); + return devc->beaglelogic->set_triggerflags(devc); case SR_CONF_CAPTURE_RATIO: devc->capture_ratio = g_variant_get_uint64(data); break; @@ -268,7 +271,7 @@ static int dev_acquisition_start(const struct sr_dev_inst *sdi) if (channel->index >= 8 && channel->enabled) devc->sampleunit = BL_SAMPLEUNIT_16_BITS; } - beaglelogic_set_sampleunit(devc); + devc->beaglelogic->set_sampleunit(devc); /* Configure triggers & send header packet */ if ((trigger = sr_session_trigger_get(sdi->session))) { @@ -284,7 +287,7 @@ static int dev_acquisition_start(const struct sr_dev_inst *sdi) std_session_send_df_header(sdi); /* Trigger and add poll on file */ - beaglelogic_start(devc); + devc->beaglelogic->start(devc); sr_session_source_add_pollfd(sdi->session, &devc->pollfd, BUFUNIT_TIMEOUT_MS(devc), beaglelogic_receive_data, (void *)sdi); @@ -297,7 +300,7 @@ static int dev_acquisition_stop(struct sr_dev_inst *sdi) struct dev_context *devc = sdi->priv; /* Execute a stop on BeagleLogic */ - beaglelogic_stop(devc); + devc->beaglelogic->stop(devc); /* lseek to offset 0, flushes the cache */ lseek(devc->fd, 0, SEEK_SET); diff --git a/src/hardware/beaglelogic/beaglelogic.h b/src/hardware/beaglelogic/beaglelogic.h index 0c1331b4..11bd1491 100644 --- a/src/hardware/beaglelogic/beaglelogic.h +++ b/src/hardware/beaglelogic/beaglelogic.h @@ -47,12 +47,14 @@ #define IOCTL_BL_GET_TRIGGER_FLAGS _IOR('k', 0x23, uint32_t) #define IOCTL_BL_SET_TRIGGER_FLAGS _IOW('k', 0x23, uint32_t) +#define IOCTL_BL_GET_CUR_INDEX _IOR('k', 0x24, uint32_t) #define IOCTL_BL_CACHE_INVALIDATE _IO('k', 0x25) #define IOCTL_BL_GET_BUFFER_SIZE _IOR('k', 0x26, uint32_t) #define IOCTL_BL_SET_BUFFER_SIZE _IOW('k', 0x26, uint32_t) #define IOCTL_BL_GET_BUFUNIT_SIZE _IOR('k', 0x27, uint32_t) +#define IOCTL_BL_SET_BUFUNIT_SIZE _IOW('k', 0x27, uint32_t) #define IOCTL_BL_FILL_TEST_PATTERN _IO('k', 0x28) @@ -90,32 +92,37 @@ enum beaglelogic_sampleunit { * SR_OK or SR_ERR */ -SR_PRIV int beaglelogic_open_nonblock(struct dev_context *devc); -SR_PRIV int beaglelogic_close(struct dev_context *devc); +struct beaglelogic_ops { + int (*open)(struct dev_context *devc); + int (*close)(struct dev_context *devc); -SR_PRIV int beaglelogic_get_buffersize(struct dev_context *devc); -SR_PRIV int beaglelogic_set_buffersize(struct dev_context *devc); + int (*get_buffersize)(struct dev_context *devc); + int (*set_buffersize)(struct dev_context *devc); -SR_PRIV int beaglelogic_get_samplerate(struct dev_context *devc); -SR_PRIV int beaglelogic_set_samplerate(struct dev_context *devc); + int (*get_samplerate)(struct dev_context *devc); + int (*set_samplerate)(struct dev_context *devc); -SR_PRIV int beaglelogic_get_sampleunit(struct dev_context *devc); -SR_PRIV int beaglelogic_set_sampleunit(struct dev_context *devc); + int (*get_sampleunit)(struct dev_context *devc); + int (*set_sampleunit)(struct dev_context *devc); -SR_PRIV int beaglelogic_get_triggerflags(struct dev_context *devc); -SR_PRIV int beaglelogic_set_triggerflags(struct dev_context *devc); + int (*get_triggerflags)(struct dev_context *devc); + int (*set_triggerflags)(struct dev_context *devc); -/* Start and stop the capture operation */ -SR_PRIV int beaglelogic_start(struct dev_context *devc); -SR_PRIV int beaglelogic_stop(struct dev_context *devc); + /* Start and stop the capture operation */ + int (*start)(struct dev_context *devc); + int (*stop)(struct dev_context *devc); -/* Get the last error size */ -SR_PRIV int beaglelogic_getlasterror(struct dev_context *devc); + /* Get the last error size */ + int (*get_lasterror)(struct dev_context *devc); -/* Gets the unit size of the capture buffer (usually 4 or 8 MB) */ -SR_PRIV int beaglelogic_get_bufunitsize(struct dev_context *devc); + /* Gets the unit size of the capture buffer (usually 4 or 8 MB) */ + int (*get_bufunitsize)(struct dev_context *devc); + int (*set_bufunitsize)(struct dev_context *devc); -SR_PRIV int beaglelogic_mmap(struct dev_context *devc); -SR_PRIV int beaglelogic_munmap(struct dev_context *devc); + int (*mmap)(struct dev_context *devc); + int (*munmap)(struct dev_context *devc); +}; + +SR_PRIV extern const struct beaglelogic_ops beaglelogic_native_ops; #endif diff --git a/src/hardware/beaglelogic/beaglelogic_native.c b/src/hardware/beaglelogic/beaglelogic_native.c index 84314c23..b907b1cd 100644 --- a/src/hardware/beaglelogic/beaglelogic_native.c +++ b/src/hardware/beaglelogic/beaglelogic_native.c @@ -20,53 +20,53 @@ #include "protocol.h" #include "beaglelogic.h" -SR_PRIV inline int beaglelogic_open_nonblock(struct dev_context *devc) { +static int beaglelogic_open_nonblock(struct dev_context *devc) { devc->fd = open(BEAGLELOGIC_DEV_NODE, O_RDONLY | O_NONBLOCK); return (devc->fd == -1 ? SR_ERR : SR_OK); } -SR_PRIV inline int beaglelogic_close(struct dev_context *devc) { +static int beaglelogic_close(struct dev_context *devc) { return close(devc->fd); } -SR_PRIV inline int beaglelogic_get_buffersize(struct dev_context *devc) { +static int beaglelogic_get_buffersize(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_GET_BUFFER_SIZE, &devc->buffersize); } -SR_PRIV inline int beaglelogic_set_buffersize(struct dev_context *devc) { +static int beaglelogic_set_buffersize(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_SET_BUFFER_SIZE, devc->buffersize); } /* This is treated differently as it gets a uint64_t while a uint32_t is read */ -SR_PRIV inline int beaglelogic_get_samplerate(struct dev_context *devc) { +static int beaglelogic_get_samplerate(struct dev_context *devc) { uint32_t arg, err; err = ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_RATE, &arg); devc->cur_samplerate = arg; return err; } -SR_PRIV inline int beaglelogic_set_samplerate(struct dev_context *devc) { +static int beaglelogic_set_samplerate(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_RATE, (uint32_t)devc->cur_samplerate); } -SR_PRIV inline int beaglelogic_get_sampleunit(struct dev_context *devc) { +static int beaglelogic_get_sampleunit(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_GET_SAMPLE_UNIT, &devc->sampleunit); } -SR_PRIV inline int beaglelogic_set_sampleunit(struct dev_context *devc) { +static int beaglelogic_set_sampleunit(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_SET_SAMPLE_UNIT, devc->sampleunit); } -SR_PRIV inline int beaglelogic_get_triggerflags(struct dev_context *devc) { +static int beaglelogic_get_triggerflags(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_GET_TRIGGER_FLAGS, &devc->triggerflags); } -SR_PRIV inline int beaglelogic_set_triggerflags(struct dev_context *devc) { +static int beaglelogic_set_triggerflags(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_SET_TRIGGER_FLAGS, devc->triggerflags); } -SR_PRIV int beaglelogic_getlasterror(struct dev_context *devc) { +static int beaglelogic_get_lasterror(struct dev_context *devc) { int fd; char buf[16]; int ret; @@ -83,19 +83,23 @@ SR_PRIV int beaglelogic_getlasterror(struct dev_context *devc) { return SR_OK; } -SR_PRIV inline int beaglelogic_start(struct dev_context *devc) { +static int beaglelogic_start(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_START); } -SR_PRIV inline int beaglelogic_stop(struct dev_context *devc) { +static int beaglelogic_stop(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_STOP); } -SR_PRIV int beaglelogic_get_bufunitsize(struct dev_context *devc) { +static int beaglelogic_get_bufunitsize(struct dev_context *devc) { return ioctl(devc->fd, IOCTL_BL_GET_BUFUNIT_SIZE, &devc->bufunitsize); } -SR_PRIV int beaglelogic_mmap(struct dev_context *devc) { +static int beaglelogic_set_bufunitsize(struct dev_context *devc) { + return ioctl(devc->fd, IOCTL_BL_SET_BUFUNIT_SIZE, devc->bufunitsize); +} + +static int beaglelogic_mmap(struct dev_context *devc) { if (!devc->buffersize) beaglelogic_get_buffersize(devc); devc->sample_buf = mmap(NULL, devc->buffersize, @@ -103,6 +107,26 @@ SR_PRIV int beaglelogic_mmap(struct dev_context *devc) { return (devc->sample_buf == MAP_FAILED ? -1 : SR_OK); } -SR_PRIV int beaglelogic_munmap(struct dev_context *devc) { +static int beaglelogic_munmap(struct dev_context *devc) { return munmap(devc->sample_buf, devc->buffersize); } + +SR_PRIV const struct beaglelogic_ops beaglelogic_native_ops = { + .open = beaglelogic_open_nonblock, + .close = beaglelogic_close, + .get_buffersize = beaglelogic_get_buffersize, + .set_buffersize = beaglelogic_set_buffersize, + .get_samplerate = beaglelogic_get_samplerate, + .set_samplerate = beaglelogic_set_samplerate, + .get_sampleunit = beaglelogic_get_sampleunit, + .set_sampleunit = beaglelogic_set_sampleunit, + .get_triggerflags = beaglelogic_get_triggerflags, + .set_triggerflags = beaglelogic_set_triggerflags, + .start = beaglelogic_start, + .stop = beaglelogic_stop, + .get_lasterror = beaglelogic_get_lasterror, + .get_bufunitsize = beaglelogic_get_bufunitsize, + .set_bufunitsize = beaglelogic_set_bufunitsize, + .mmap = beaglelogic_mmap, + .munmap = beaglelogic_munmap, +}; diff --git a/src/hardware/beaglelogic/protocol.h b/src/hardware/beaglelogic/protocol.h index 5df27dcd..3539a7a4 100644 --- a/src/hardware/beaglelogic/protocol.h +++ b/src/hardware/beaglelogic/protocol.h @@ -36,6 +36,10 @@ struct dev_context { int max_channels; uint32_t fw_ver; + /* Operations */ + const struct beaglelogic_ops *beaglelogic; + + /* Acquisition settings: see beaglelogic.h */ uint64_t cur_samplerate; uint64_t limit_samples; uint32_t sampleunit;