X-Git-Url: http://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Fyokogawa-dlm%2Fapi.c;h=28480f52f1da60bd23e96bdf653cd9125bfec86e;hb=53012da658ae94b245240c8a3e115723eede4c7d;hp=9a1c6a001c345e64837af4abd109ce2f05e9a109;hpb=c65a021c050b3ef05ccc844cf24ee8e620eb669e;p=libsigrok.git diff --git a/src/hardware/yokogawa-dlm/api.c b/src/hardware/yokogawa-dlm/api.c index 9a1c6a00..28480f52 100644 --- a/src/hardware/yokogawa-dlm/api.c +++ b/src/hardware/yokogawa-dlm/api.c @@ -18,40 +18,42 @@ * along with this program. If not, see . */ +#include #include +#include "scpi.h" #include "protocol.h" -SR_PRIV struct sr_dev_driver yokogawa_dlm_driver_info; +static struct sr_dev_driver yokogawa_dlm_driver_info; static const char *MANUFACTURER_ID = "YOKOGAWA"; static const char *MANUFACTURER_NAME = "Yokogawa"; -static const uint32_t dlm_scanopts[] = { +static const uint32_t scanopts[] = { SR_CONF_CONN, }; -static const uint32_t dlm_drvopts[] = { +static const uint32_t drvopts[] = { SR_CONF_LOGIC_ANALYZER, SR_CONF_OSCILLOSCOPE, }; -static const uint32_t dlm_devopts[] = { +static const uint32_t devopts[] = { SR_CONF_LIMIT_FRAMES | SR_CONF_GET | SR_CONF_SET, SR_CONF_SAMPLERATE | SR_CONF_GET, SR_CONF_TIMEBASE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST, SR_CONF_NUM_HDIV | SR_CONF_GET, SR_CONF_HORIZ_TRIGGERPOS | SR_CONF_GET | SR_CONF_SET, - SR_CONF_TRIGGER_SLOPE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST, SR_CONF_TRIGGER_SOURCE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST, + SR_CONF_TRIGGER_SLOPE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST, }; -static const uint32_t dlm_analog_devopts[] = { - SR_CONF_COUPLING | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST, - SR_CONF_VDIV | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST, +static const uint32_t devopts_cg_analog[] = { SR_CONF_NUM_VDIV | SR_CONF_GET, + SR_CONF_VDIV | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST, + SR_CONF_COUPLING | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST, }; -static const uint32_t dlm_digital_devopts[] = { +static const uint32_t devopts_cg_digital[] = { }; enum { @@ -61,11 +63,6 @@ enum { CG_DIGITAL, }; -static int init(struct sr_dev_driver *di, struct sr_context *sr_ctx) -{ - return std_init(sr_ctx, di, LOG_PREFIX); -} - static struct sr_dev_inst *probe_usbtmc_device(struct sr_scpi_dev_inst *scpi) { struct sr_dev_inst *sdi; @@ -90,7 +87,6 @@ static struct sr_dev_inst *probe_usbtmc_device(struct sr_scpi_dev_inst *scpi) goto fail; sdi = g_malloc0(sizeof(struct sr_dev_inst)); - sdi->status = SR_ST_ACTIVE; sdi->vendor = g_strdup(MANUFACTURER_NAME); sdi->model = g_strdup(model_name); sdi->version = g_strdup(hw_info->firmware_version); @@ -110,16 +106,11 @@ static struct sr_dev_inst *probe_usbtmc_device(struct sr_scpi_dev_inst *scpi) if (dlm_device_init(sdi, model_index) != SR_OK) goto fail; - sr_scpi_close(sdi->conn); - - sdi->status = SR_ST_INACTIVE; return sdi; fail: - if (hw_info) - sr_scpi_hw_info_free(hw_info); - if (sdi) - sr_dev_inst_free(sdi); + sr_scpi_hw_info_free(hw_info); + sr_dev_inst_free(sdi); g_free(devc); return NULL; @@ -127,72 +118,45 @@ fail: static GSList *scan(struct sr_dev_driver *di, GSList *options) { - return sr_scpi_scan(di->priv, options, probe_usbtmc_device); -} - -static GSList *dev_list(const struct sr_dev_driver *di) -{ - return ((struct drv_context *)(di->priv))->instances; + return sr_scpi_scan(di->context, options, probe_usbtmc_device); } -static void clear_helper(void *priv) +static void clear_helper(struct dev_context *devc) { - struct dev_context *devc; - - devc = priv; - dlm_scope_state_destroy(devc->model_state); - g_free(devc->analog_groups); g_free(devc->digital_groups); - g_free(devc); } static int dev_clear(const struct sr_dev_driver *di) { - return std_dev_clear(di, clear_helper); + return std_dev_clear_with_callback(di, (std_dev_clear_callback)clear_helper); } static int dev_open(struct sr_dev_inst *sdi) { - if (sdi->status != SR_ST_ACTIVE && sr_scpi_open(sdi->conn) != SR_OK) + if (sr_scpi_open(sdi->conn) != SR_OK) return SR_ERR; if (dlm_scope_state_query(sdi) != SR_OK) return SR_ERR; - sdi->status = SR_ST_ACTIVE; - return SR_OK; } static int dev_close(struct sr_dev_inst *sdi) { - if (sdi->status == SR_ST_INACTIVE) - return SR_OK; - - sr_scpi_close(sdi->conn); - - sdi->status = SR_ST_INACTIVE; - - return SR_OK; -} - -static int cleanup(const struct sr_dev_driver *di) -{ - dev_clear(di); - - return SR_OK; + return sr_scpi_close(sdi->conn); } /** * Check which category a given channel group belongs to. * * @param devc Our internal device context. - * @param cg The channel group to check. + * @param cg The channel group to check. * - * @retval CG_NONE cg is NULL - * @retval CG_ANALOG cg is an analog group + * @retval CG_NONE cg is NULL + * @retval CG_ANALOG cg is an analog group * @retval CG_DIGITAL cg is a digital group * @retval CG_INVALID cg is something else */ @@ -207,11 +171,11 @@ static int check_channel_group(struct dev_context *devc, if (!cg) return CG_NONE; - for (i = 0; i < model->analog_channels; ++i) + for (i = 0; i < model->analog_channels; i++) if (cg == devc->analog_groups[i]) return CG_ANALOG; - for (i = 0; i < model->pods; ++i) + for (i = 0; i < model->pods; i++) if (cg == devc->digital_groups[i]) return CG_DIGITAL; @@ -228,13 +192,14 @@ static int config_get(uint32_t key, GVariant **data, const struct sr_dev_inst *s const struct scope_config *model; struct scope_state *state; - if (!sdi || !(devc = sdi->priv)) + if (!sdi) return SR_ERR_ARG; + devc = sdi->priv; + if ((cg_type = check_channel_group(devc, cg)) == CG_INVALID) return SR_ERR; - ret = SR_ERR_NA; model = devc->model_config; state = devc->model_state; @@ -269,7 +234,7 @@ static int config_get(uint32_t key, GVariant **data, const struct sr_dev_inst *s } else if (cg_type != CG_ANALOG) break; - for (i = 0; i < model->analog_channels; ++i) { + for (i = 0; i < model->analog_channels; i++) { if (cg != devc->analog_groups[i]) continue; *data = g_variant_new("(tt)", @@ -299,7 +264,7 @@ static int config_get(uint32_t key, GVariant **data, const struct sr_dev_inst *s } else if (cg_type != CG_ANALOG) break; - for (i = 0; i < model->analog_channels; ++i) { + for (i = 0; i < model->analog_channels; i++) { if (cg != devc->analog_groups[i]) continue; *data = g_variant_new_string((*model->coupling_options)[state->analog_states[i].coupling]); @@ -318,25 +283,6 @@ static int config_get(uint32_t key, GVariant **data, const struct sr_dev_inst *s return ret; } -static GVariant *build_tuples(const uint64_t (*array)[][2], unsigned int n) -{ - unsigned int i; - GVariant *rational[2]; - GVariantBuilder gvb; - - g_variant_builder_init(&gvb, G_VARIANT_TYPE_ARRAY); - - for (i = 0; i < n; i++) { - rational[0] = g_variant_new_uint64((*array)[i][0]); - rational[1] = g_variant_new_uint64((*array)[i][1]); - - /* FIXME: Valgrind reports a memory leak here. */ - g_variant_builder_add_value(&gvb, g_variant_new_tuple(rational, 2)); - } - - return g_variant_builder_end(&gvb); -} - static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sdi, const struct sr_channel_group *cg) { @@ -391,7 +337,7 @@ static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sd if (p != dlm_vdivs[i][0] || q != dlm_vdivs[i][1]) continue; - for (j = 1; j <= model->analog_channels; ++j) { + for (j = 1; j <= model->analog_channels; j++) { if (cg != devc->analog_groups[j - 1]) continue; state->analog_states[j - 1].vdiv = i; @@ -462,7 +408,7 @@ static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sd for (i = 0; (*model->coupling_options)[i]; i++) { if (strcmp(tmp, (*model->coupling_options)[i]) != 0) continue; - for (j = 1; j <= model->analog_channels; ++j) { + for (j = 1; j <= model->analog_channels; j++) { if (cg != devc->analog_groups[j - 1]) continue; state->analog_states[j-1].coupling = i; @@ -494,7 +440,7 @@ static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sd static int config_channel_set(const struct sr_dev_inst *sdi, struct sr_channel *ch, unsigned int changes) { - /* Curretly we only handle SR_CHANNEL_SET_ENABLED. */ + /* Currently we only handle SR_CHANNEL_SET_ENABLED. */ if (changes != SR_CHANNEL_SET_ENABLED) return SR_ERR_NA; @@ -505,39 +451,19 @@ static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst * const struct sr_channel_group *cg) { int cg_type = CG_NONE; - struct dev_context *devc = NULL; - const struct scope_config *model = NULL; - - /* SR_CONF_SCAN_OPTIONS is always valid, regardless of sdi or probe group. */ - if (key == SR_CONF_SCAN_OPTIONS) { - *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, - dlm_scanopts, ARRAY_SIZE(dlm_scanopts), sizeof(uint32_t)); - return SR_OK; - } - - /* If sdi is NULL, nothing except SR_CONF_DEVICE_OPTIONS can be provided. */ - if (key == SR_CONF_DEVICE_OPTIONS && !sdi) { - *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, - dlm_drvopts, ARRAY_SIZE(dlm_drvopts), sizeof(uint32_t)); - return SR_OK; - } - - if (!sdi) - return SR_ERR_ARG; + struct dev_context *devc; + const struct scope_config *model; - devc = sdi->priv; - model = devc->model_config; + devc = (sdi) ? sdi->priv : NULL; + model = (devc) ? devc->model_config : NULL; - /* If cg is NULL, only the SR_CONF_DEVICE_OPTIONS that are not - * specific to a probe group must be returned. */ if (!cg) { switch (key) { + case SR_CONF_SCAN_OPTIONS: case SR_CONF_DEVICE_OPTIONS: - *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, - dlm_devopts, ARRAY_SIZE(dlm_devopts), sizeof(uint32_t)); - return SR_OK; + return STD_CONFIG_LIST(key, data, sdi, cg, scanopts, drvopts, devopts); case SR_CONF_TIMEBASE: - *data = build_tuples(&dlm_timebases, ARRAY_SIZE(dlm_timebases)); + *data = std_gvar_tuple_array(&dlm_timebases, ARRAY_SIZE(dlm_timebases)); return SR_OK; case SR_CONF_TRIGGER_SOURCE: if (!model) @@ -550,7 +476,7 @@ static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst * g_strv_length((char **)dlm_trigger_slopes)); return SR_OK; case SR_CONF_NUM_HDIV: - *data = g_variant_new_uint32(ARRAY_SIZE(dlm_timebases)); + *data = g_variant_new_uint32(model->num_xdivs); return SR_OK; default: return SR_ERR_NA; @@ -562,16 +488,12 @@ static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst * switch (key) { case SR_CONF_DEVICE_OPTIONS: - if (cg_type == CG_ANALOG) { - *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, - dlm_analog_devopts, ARRAY_SIZE(dlm_analog_devopts), sizeof(uint32_t)); - } else if (cg_type == CG_DIGITAL) { - *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, - dlm_digital_devopts, ARRAY_SIZE(dlm_digital_devopts), sizeof(uint32_t)); - } else { - *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, - NULL, 0, sizeof(uint32_t)); - } + if (cg_type == CG_ANALOG) + *data = std_gvar_array_u32(ARRAY_AND_SIZE(devopts_cg_analog)); + else if (cg_type == CG_DIGITAL) + *data = std_gvar_array_u32(ARRAY_AND_SIZE(devopts_cg_digital)); + else + *data = std_gvar_array_u32(NULL, 0); break; case SR_CONF_COUPLING: if (cg_type == CG_NONE) @@ -582,7 +504,7 @@ static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst * case SR_CONF_VDIV: if (cg_type == CG_NONE) return SR_ERR_CHANNEL_GROUP; - *data = build_tuples(&dlm_vdivs, ARRAY_SIZE(dlm_vdivs)); + *data = std_gvar_tuple_array(&dlm_vdivs, ARRAY_SIZE(dlm_vdivs)); break; default: return SR_ERR_NA; @@ -622,80 +544,7 @@ static int dlm_check_channels(GSList *channels) return SR_OK; } -static int dlm_setup_channels(const struct sr_dev_inst *sdi) -{ - GSList *l; - unsigned int i; - gboolean *pod_enabled, setup_changed; - struct scope_state *state; - const struct scope_config *model; - struct sr_channel *ch; - struct dev_context *devc; - struct sr_scpi_dev_inst *scpi; - - devc = sdi->priv; - scpi = sdi->conn; - state = devc->model_state; - model = devc->model_config; - setup_changed = FALSE; - - pod_enabled = g_malloc0(sizeof(gboolean) * model->pods); - - for (l = sdi->channels; l; l = l->next) { - ch = l->data; - switch (ch->type) { - case SR_CHANNEL_ANALOG: - if (ch->enabled == state->analog_states[ch->index].state) - break; - - if (dlm_analog_chan_state_set(scpi, ch->index + 1, - ch->enabled) != SR_OK) - return SR_ERR; - - state->analog_states[ch->index].state = ch->enabled; - setup_changed = TRUE; - break; - case SR_CHANNEL_LOGIC: - i = ch->index - DLM_DIG_CHAN_INDEX_OFFS; - if (ch->enabled) - pod_enabled[i / 8] = TRUE; - - if (ch->enabled == state->digital_states[i]) - break; - - if (dlm_digital_chan_state_set(scpi, i + 1, - ch->enabled) != SR_OK) - return SR_ERR; - - state->digital_states[i] = ch->enabled; - setup_changed = TRUE; - break; - default: - return SR_ERR; - } - } - - for (i = 1; i <= model->pods; ++i) { - if (state->pod_states[i - 1] == pod_enabled[i - 1]) - continue; - - if (dlm_digital_pod_state_set(scpi, i, - pod_enabled[i - 1]) != SR_OK) - return SR_ERR; - - state->pod_states[i - 1] = pod_enabled[i - 1]; - setup_changed = TRUE; - } - - g_free(pod_enabled); - - if (setup_changed && dlm_sample_rate_query(sdi) != SR_OK) - return SR_ERR; - - 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) { GSList *l; gboolean digital_added; @@ -703,11 +552,6 @@ static int dev_acquisition_start(const struct sr_dev_inst *sdi, void *cb_data) struct dev_context *devc; struct sr_scpi_dev_inst *scpi; - (void)cb_data; - - if (sdi->status != SR_ST_ACTIVE) - return SR_ERR_DEV_CLOSED; - scpi = sdi->conn; devc = sdi->priv; digital_added = FALSE; @@ -736,35 +580,21 @@ static int dev_acquisition_start(const struct sr_dev_inst *sdi, void *cb_data) return SR_ERR_NA; } - if (dlm_setup_channels(sdi) != SR_OK) { - sr_err("Failed to setup channel configuration!"); - return SR_ERR; - } - /* Request data for the first enabled channel. */ devc->current_channel = devc->enabled_channels; dlm_channel_data_request(sdi); - /* Call our callback when data comes in or after 5ms. */ sr_scpi_source_add(sdi->session, scpi, G_IO_IN, 5, dlm_data_receive, (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) { struct dev_context *devc; - struct sr_datafeed_packet packet; - - (void)cb_data; - - packet.type = SR_DF_END; - packet.payload = NULL; - sr_session_send(sdi, &packet); - if (sdi->status != SR_ST_ACTIVE) - return SR_ERR_DEV_CLOSED; + std_session_send_df_end(sdi); devc = sdi->priv; @@ -777,14 +607,14 @@ static int dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data) return SR_OK; } -SR_PRIV struct sr_dev_driver yokogawa_dlm_driver_info = { +static struct sr_dev_driver yokogawa_dlm_driver_info = { .name = "yokogawa-dlm", .longname = "Yokogawa DL/DLM", .api_version = 1, - .init = init, - .cleanup = cleanup, + .init = std_init, + .cleanup = std_cleanup, .scan = scan, - .dev_list = dev_list, + .dev_list = std_dev_list, .dev_clear = dev_clear, .config_get = config_get, .config_set = config_set, @@ -794,5 +624,6 @@ SR_PRIV struct sr_dev_driver yokogawa_dlm_driver_info = { .dev_close = dev_close, .dev_acquisition_start = dev_acquisition_start, .dev_acquisition_stop = dev_acquisition_stop, - .priv = NULL, + .context = NULL, }; +SR_REGISTER_DEV_DRIVER(yokogawa_dlm_driver_info);