X-Git-Url: http://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Fkern-scale%2Fapi.c;h=3ab8857b2c5122e2d8e8371af8818354abb3dbea;hb=700d6b64d578ce10e57f6a2289e37a5564eccf1c;hp=2d68fcf652491de73b98fa50737d84390585de67;hpb=9380ec2f05e67518b1b23057749df3684a0cf05e;p=libsigrok.git diff --git a/src/hardware/kern-scale/api.c b/src/hardware/kern-scale/api.c index 2d68fcf6..3ab8857b 100644 --- a/src/hardware/kern-scale/api.c +++ b/src/hardware/kern-scale/api.c @@ -18,9 +18,28 @@ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA */ +#include +#include +#include +#include "libsigrok-internal.h" #include "protocol.h" -SR_PRIV struct sr_dev_driver kern_scale_driver_info; +static const uint32_t scanopts[] = { + SR_CONF_CONN, + SR_CONF_SERIALCOMM, +}; + +static const uint32_t devopts[] = { + SR_CONF_SCALE, + SR_CONF_CONTINUOUS, + SR_CONF_LIMIT_SAMPLES | SR_CONF_SET, + SR_CONF_LIMIT_MSEC | SR_CONF_SET, +}; + +static int dev_clear(const struct sr_dev_driver *di) +{ + return std_dev_clear(di, NULL); +} static int init(struct sr_dev_driver *di, struct sr_context *sr_ctx) { @@ -29,145 +48,210 @@ static int init(struct sr_dev_driver *di, struct sr_context *sr_ctx) static GSList *scan(struct sr_dev_driver *di, GSList *options) { + struct scale_info *scale; + struct sr_config *src; + GSList *l, *devices; + const char *conn, *serialcomm; + struct sr_dev_inst *sdi; struct drv_context *drvc; - GSList *devices; + struct dev_context *devc; + struct sr_serial_dev_inst *serial; + int ret; + size_t len; + uint8_t buf[128]; + + scale = (struct scale_info *)di; + + conn = serialcomm = NULL; + for (l = options; l; l = l->next) { + src = l->data; + switch (src->key) { + case SR_CONF_CONN: + conn = g_variant_get_string(src->data, NULL); + break; + case SR_CONF_SERIALCOMM: + serialcomm = g_variant_get_string(src->data, NULL); + break; + } + } + if (!conn) + return NULL; - (void)options; + if (!serialcomm) + serialcomm = scale->conn; - devices = NULL; - drvc = di->context; - drvc->instances = NULL; + serial = sr_serial_dev_inst_new(conn, serialcomm); - return devices; -} + if (serial_open(serial, SERIAL_RDWR) != SR_OK) + return NULL; -static GSList *dev_list(const struct sr_dev_driver *di) -{ - return ((struct drv_context *)(di->context))->instances; -} + sr_info("Probing serial port %s.", conn); -static int dev_clear(const struct sr_dev_driver *di) -{ - return std_dev_clear(di, NULL); -} - -static int dev_open(struct sr_dev_inst *sdi) -{ - (void)sdi; + drvc = di->context; + devices = NULL; + serial_flush(serial); - sdi->status = SR_ST_ACTIVE; + sr_spew("Set O1 mode (continuous values, stable and unstable ones)."); + if (serial_write_nonblocking(serial, "O1\r\n", 4) != 4) + goto scan_cleanup; + /* Device replies with "A00\r\n" (OK) or "E01\r\n" (Error). Ignore. */ - return SR_OK; -} + /* Let's get a bit of data and see if we can find a packet. */ + len = sizeof(buf); + ret = serial_stream_detect(serial, buf, &len, scale->packet_size, + scale->packet_valid, 3000, scale->baudrate); + if (ret != SR_OK) + goto scan_cleanup; -static int dev_close(struct sr_dev_inst *sdi) -{ - (void)sdi; + sr_info("Found device on port %s.", conn); + sdi = g_malloc0(sizeof(struct sr_dev_inst)); sdi->status = SR_ST_INACTIVE; + sdi->vendor = g_strdup(scale->vendor); + sdi->model = g_strdup(scale->device); + devc = g_malloc0(sizeof(struct dev_context)); + sdi->inst_type = SR_INST_SERIAL; + sdi->conn = serial; + sdi->priv = devc; + sdi->driver = di; + sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "Mass"); + drvc->instances = g_slist_append(drvc->instances, sdi); + devices = g_slist_append(devices, sdi); + +scan_cleanup: + serial_close(serial); - return SR_OK; -} - -static int cleanup(const struct sr_dev_driver *di) -{ - dev_clear(di); - - return SR_OK; + return devices; } -static int config_get(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi, - const struct sr_channel_group *cg) +static GSList *dev_list(const struct sr_dev_driver *di) { - int ret; - - (void)sdi; - (void)data; - (void)cg; - - ret = SR_OK; - switch (key) { - default: - return SR_ERR_NA; - } - - return ret; + return ((struct drv_context *)(di->context))->instances; } static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sdi, const struct sr_channel_group *cg) { - int ret; + struct dev_context *devc; - (void)data; (void)cg; if (sdi->status != SR_ST_ACTIVE) return SR_ERR_DEV_CLOSED; - ret = SR_OK; + if (!(devc = sdi->priv)) + return SR_ERR_BUG; + switch (key) { + case SR_CONF_LIMIT_SAMPLES: + devc->limit_samples = g_variant_get_uint64(data); + break; + case SR_CONF_LIMIT_MSEC: + devc->limit_msec = g_variant_get_uint64(data); + break; default: - ret = SR_ERR_NA; + return SR_ERR_NA; } - return ret; + return SR_OK; } static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi, const struct sr_channel_group *cg) { - int ret; - (void)sdi; - (void)data; (void)cg; - ret = SR_OK; switch (key) { + case SR_CONF_SCAN_OPTIONS: + *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, + scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t)); + break; + case SR_CONF_DEVICE_OPTIONS: + *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, + devopts, ARRAY_SIZE(devopts), sizeof(uint32_t)); + break; default: return SR_ERR_NA; } - return ret; + return SR_OK; } -static int dev_acquisition_start(const struct sr_dev_inst *sdi, void *cb_data) +static int dev_acquisition_start(const struct sr_dev_inst *sdi) { - (void)sdi; - (void)cb_data; + struct dev_context *devc; + struct sr_serial_dev_inst *serial; if (sdi->status != SR_ST_ACTIVE) return SR_ERR_DEV_CLOSED; + devc = sdi->priv; + serial = sdi->conn; + + sr_spew("Set O1 mode (continuous values, stable and unstable ones)."); + if (serial_write_nonblocking(serial, "O1\r\n", 4) != 4) + return SR_ERR; + /* Device replies with "A00\r\n" (OK) or "E01\r\n" (Error). Ignore. */ + + devc->num_samples = 0; + devc->starttime = g_get_monotonic_time(); + + std_session_send_df_header(sdi, LOG_PREFIX); + + /* Poll every 50ms, or whenever some data comes in. */ + serial_source_add(sdi->session, serial, G_IO_IN, 50, + kern_scale_receive_data, (void *)sdi); + return SR_OK; } -static int dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data) +static int dev_acquisition_stop(struct sr_dev_inst *sdi) { - (void)cb_data; + return std_serial_dev_acquisition_stop(sdi, std_serial_dev_close, + sdi->conn, LOG_PREFIX); +} - if (sdi->status != SR_ST_ACTIVE) - return SR_ERR_DEV_CLOSED; +#define SCALE(ID, CHIPSET, VENDOR, MODEL, CONN, BAUDRATE, PACKETSIZE, \ + VALID, PARSE) \ + &(struct scale_info) { \ + { \ + .name = ID, \ + .longname = VENDOR " " MODEL, \ + .api_version = 1, \ + .init = init, \ + .cleanup = std_cleanup, \ + .scan = scan, \ + .dev_list = dev_list, \ + .dev_clear = dev_clear, \ + .config_get = NULL, \ + .config_set = config_set, \ + .config_list = config_list, \ + .dev_open = std_serial_dev_open, \ + .dev_close = std_serial_dev_close, \ + .dev_acquisition_start = dev_acquisition_start, \ + .dev_acquisition_stop = dev_acquisition_stop, \ + .context = NULL, \ + }, \ + VENDOR, MODEL, CONN, BAUDRATE, PACKETSIZE, \ + VALID, PARSE, sizeof(struct CHIPSET##_info) \ + } - return SR_OK; -} +/* + * Some scales have (user-configurable) 14-byte or 15-byte packets. + * We transparently support both variants by specifying the larger value + * below and due to the way the stream parser works. + * + * The scales have a standard baudrate (model dependent) as listed below, + * but serial parameters are user-configurable. We support that by letting + * the user override them via "serialcomm". + */ -SR_PRIV struct sr_dev_driver kern_scale_driver_info = { - .name = "kern-scale", - .longname = "KERN Scale", - .api_version = 1, - .init = init, - .cleanup = cleanup, - .scan = scan, - .dev_list = dev_list, - .dev_clear = dev_clear, - .config_get = config_get, - .config_set = config_set, - .config_list = config_list, - .dev_open = dev_open, - .dev_close = dev_close, - .dev_acquisition_start = dev_acquisition_start, - .dev_acquisition_stop = dev_acquisition_stop, - .context = NULL, +SR_PRIV const struct scale_info *kern_scale_drivers[] = { + SCALE( + "kern-ew-6200-2nm", kern, + "KERN", "EW 6200-2NM", "1200/8n2", 1200, + 15 /* (or 14) */, sr_kern_packet_valid, sr_kern_parse + ), + NULL };