X-Git-Url: https://sigrok.org/gitweb/?p=libsigrok.git;a=blobdiff_plain;f=hardware%2Fhameg-hmo%2Fprotocol.c;h=afa6efe375673b3ac9a9935d73d9c4ba1616b58a;hp=2f7f5ab43999c1dc987b9c0972aba522477efdb6;hb=43cd4637285833706f8a404ca027bcf0ee75b9ae;hpb=965b463d9825c2a72a3a1cfcc10e1a23ccc768aa diff --git a/hardware/hameg-hmo/protocol.c b/hardware/hameg-hmo/protocol.c index 2f7f5ab4..afa6efe3 100644 --- a/hardware/hameg-hmo/protocol.c +++ b/hardware/hameg-hmo/protocol.c @@ -25,6 +25,8 @@ static const char *hameg_scpi_dialect[] = { [SCPI_CMD_SET_TIMEBASE] = ":TIM:SCAL %s", [SCPI_CMD_GET_COUPLING] = ":CHAN%d:COUP?", [SCPI_CMD_SET_COUPLING] = ":CHAN%d:COUP %s", + [SCPI_CMD_GET_SAMPLE_RATE] = ":ACQ:SRAT?", + [SCPI_CMD_GET_SAMPLE_RATE_LIVE] = ":%s:DATA:POINTS?", [SCPI_CMD_GET_ANALOG_DATA] = ":CHAN%d:DATA?", [SCPI_CMD_GET_VERTICAL_DIV] = ":CHAN%d:SCAL?", [SCPI_CMD_SET_VERTICAL_DIV] = ":CHAN%d:SCAL %s", @@ -38,7 +40,7 @@ static const char *hameg_scpi_dialect[] = { [SCPI_CMD_SET_DIG_CHAN_STATE] = ":LOG%d:STAT %d", [SCPI_CMD_GET_VERTICAL_OFFSET] = ":CHAN%d:POS?", [SCPI_CMD_GET_HORIZ_TRIGGERPOS] = ":TIM:POS?", - [SCPI_CMD_SET_HORIZ_TRIGGERPOS] = ":TIM:POS %E", + [SCPI_CMD_SET_HORIZ_TRIGGERPOS] = ":TIM:POS %s", [SCPI_CMD_GET_ANALOG_CHAN_STATE] = ":CHAN%d:STAT?", [SCPI_CMD_SET_ANALOG_CHAN_STATE] = ":CHAN%d:STAT %d", }; @@ -50,6 +52,8 @@ static const int32_t hmo_hwcaps[] = { SR_CONF_NUM_TIMEBASE, SR_CONF_TRIGGER_SLOPE, SR_CONF_HORIZ_TRIGGERPOS, + SR_CONF_SAMPLERATE, + SR_CONF_LIMIT_FRAMES, }; static const int32_t hmo_analog_caps[] = { @@ -164,14 +168,14 @@ static const uint64_t hmo_vdivs[][2] = { { 10, 1 }, }; -static const char *scope_analog_probe_names[] = { +static const char *scope_analog_channel_names[] = { "CH1", "CH2", "CH3", "CH4", }; -static const char *scope_digital_probe_names[] = { +static const char *scope_digital_channel_names[] = { "D0", "D1", "D2", @@ -197,8 +201,8 @@ static struct scope_config scope_models[] = { .digital_channels = 8, .digital_pods = 1, - .analog_names = &scope_analog_probe_names, - .digital_names = &scope_digital_probe_names, + .analog_names = &scope_analog_channel_names, + .digital_names = &scope_digital_channel_names, .hw_caps = &hmo_hwcaps, .num_hwcaps = ARRAY_SIZE(hmo_hwcaps), @@ -227,8 +231,8 @@ static struct scope_config scope_models[] = { .digital_channels = 8, .digital_pods = 1, - .analog_names = &scope_analog_probe_names, - .digital_names = &scope_digital_probe_names, + .analog_names = &scope_analog_channel_names, + .digital_names = &scope_digital_channel_names, .hw_caps = &hmo_hwcaps, .num_hwcaps = ARRAY_SIZE(hmo_hwcaps), @@ -257,12 +261,15 @@ static void scope_state_dump(struct scope_config *config, struct scope_state *state) { unsigned int i; + char *tmp; for (i = 0; i < config->analog_channels; ++i) { - sr_info("State of analog channel %d -> %s : %s %.3eV %.3e offset", i + 1, - state->analog_channels[i].state ? "On" : "Off", + tmp = sr_voltage_string((*config->vdivs)[state->analog_channels[i].vdiv][0], + (*config->vdivs)[state->analog_channels[i].vdiv][1]); + sr_info("State of analog channel %d -> %s : %s (coupling) %s (vdiv) %2.2e (offset)", + i + 1, state->analog_channels[i].state ? "On" : "Off", (*config->coupling_options)[state->analog_channels[i].coupling], - state->analog_channels[i].vdiv, state->analog_channels[i].vertical_offset); + tmp, state->analog_channels[i].vertical_offset); } for (i = 0; i < config->digital_channels; ++i) { @@ -275,8 +282,16 @@ static void scope_state_dump(struct scope_config *config, state->digital_pods[i] ? "On" : "Off"); } - sr_info("Current timebase: %.2es", state->timebase); - sr_info("Current trigger: %s (source), %s (slope) %.2e (offset)", + tmp = sr_period_string((*config->timebases)[state->timebase][0] * + (*config->timebases)[state->timebase][1]); + sr_info("Current timebase: %s", tmp); + g_free(tmp); + + tmp = sr_samplerate_string(state->sample_rate); + sr_info("Current samplerate: %s", tmp); + g_free(tmp); + + sr_info("Current trigger: %s (source), %s (slope) %.2f (offset)", (*config->trigger_sources)[state->trigger_source], (*config->trigger_slopes)[state->trigger_slope], state->horiz_triggerpos); @@ -314,7 +329,8 @@ static int analog_channel_state_get(struct sr_scpi_dev_inst *scpi, struct scope_config *config, struct scope_state *state) { - unsigned int i; + unsigned int i, j; + float tmp_float; char command[MAX_COMMAND_SIZE]; for (i = 0; i < config->analog_channels; ++i) { @@ -330,8 +346,16 @@ static int analog_channel_state_get(struct sr_scpi_dev_inst *scpi, (*config->scpi_dialect)[SCPI_CMD_GET_VERTICAL_DIV], i + 1); - if (sr_scpi_get_float(scpi, command, - &state->analog_channels[i].vdiv) != SR_OK) + if (sr_scpi_get_float(scpi, command, &tmp_float) != SR_OK) + return SR_ERR; + for (j = 0; j < config->num_vdivs; j++) { + if (tmp_float == ((float) (*config->vdivs)[j][0] / + (*config->vdivs)[j][1])) { + state->analog_channels[i].vdiv = j; + break; + } + } + if (i == config->num_vdivs) return SR_ERR; g_snprintf(command, sizeof(command), @@ -384,32 +408,112 @@ static int digital_channel_state_get(struct sr_scpi_dev_inst *scpi, return SR_OK; } +SR_PRIV int hmo_update_sample_rate(const struct sr_dev_inst *sdi) +{ + struct dev_context *devc; + struct scope_state *state; + struct scope_config *config; + + int tmp; + unsigned int i; + float tmp_float; + gboolean channel_found; + char tmp_str[MAX_COMMAND_SIZE]; + char chan_name[20]; + + devc = sdi->priv; + config = devc->model_config; + state = devc->model_state; + channel_found = FALSE; + + for (i = 0; i < config->analog_channels; ++i) { + if (state->analog_channels[i].state) { + g_snprintf(chan_name, sizeof(chan_name), "CHAN%d", i + 1); + g_snprintf(tmp_str, sizeof(tmp_str), + (*config->scpi_dialect)[SCPI_CMD_GET_SAMPLE_RATE_LIVE], + chan_name); + channel_found = TRUE; + break; + } + } + + if (!channel_found) { + for (i = 0; i < config->digital_pods; i++) { + if (state->digital_pods[i]) { + g_snprintf(chan_name, sizeof(chan_name), "POD%d", i); + g_snprintf(tmp_str, sizeof(tmp_str), + (*config->scpi_dialect)[SCPI_CMD_GET_SAMPLE_RATE_LIVE], + chan_name); + channel_found = TRUE; + break; + } + } + } + + /* No channel is active, ask the instrument for the sample rate + * in single shot mode */ + if (!channel_found) { + if (sr_scpi_get_float(sdi->conn, + (*config->scpi_dialect)[SCPI_CMD_GET_SAMPLE_RATE], + &tmp_float) != SR_OK) + return SR_ERR; + + state->sample_rate = tmp_float; + } else { + if (sr_scpi_get_int(sdi->conn, tmp_str, &tmp) != SR_OK) + return SR_ERR; + state->sample_rate = tmp / (((float) (*config->timebases)[state->timebase][0] / + (*config->timebases)[state->timebase][1]) * + config->num_xdivs); + } + + return SR_OK; +} + SR_PRIV int hmo_scope_state_get(struct sr_dev_inst *sdi) { struct dev_context *devc; struct scope_state *state; struct scope_config *config; + float tmp_float; + unsigned int i; devc = sdi->priv; config = devc->model_config; state = devc->model_state; + sr_info("Fetching scope state"); + if (analog_channel_state_get(sdi->conn, config, state) != SR_OK) return SR_ERR; if (digital_channel_state_get(sdi->conn, config, state) != SR_OK) return SR_ERR; - /* TODO: Check if value is sensible. */ if (sr_scpi_get_float(sdi->conn, (*config->scpi_dialect)[SCPI_CMD_GET_TIMEBASE], - &state->timebase) != SR_OK) + &tmp_float) != SR_OK) + return SR_ERR; + + for (i = 0; i < config->num_timebases; i++) { + if (tmp_float == ((float) (*config->timebases)[i][0] / + (*config->timebases)[i][1])) { + state->timebase = i; + break; + } + } + if (i == config->num_timebases) return SR_ERR; if (sr_scpi_get_float(sdi->conn, (*config->scpi_dialect)[SCPI_CMD_GET_HORIZ_TRIGGERPOS], - &state->horiz_triggerpos) != SR_OK) + &tmp_float) != SR_OK) return SR_ERR; + state->horiz_triggerpos = tmp_float / + (((double) (*config->timebases)[state->timebase][0] / + (*config->timebases)[state->timebase][1]) * config->num_xdivs); + state->horiz_triggerpos -= 0.5; + state->horiz_triggerpos *= -1; if (scope_state_get_array_option(sdi->conn, (*config->scpi_dialect)[SCPI_CMD_GET_TRIGGER_SOURCE], @@ -421,6 +525,11 @@ SR_PRIV int hmo_scope_state_get(struct sr_dev_inst *sdi) config->trigger_slopes, &state->trigger_slope) != SR_OK) return SR_ERR; + if (hmo_update_sample_rate(sdi) != SR_OK) + return SR_ERR; + + sr_info("Fetching finished."); + scope_state_dump(config, state); return SR_OK; @@ -472,7 +581,7 @@ SR_PRIV int hmo_init_device(struct sr_dev_inst *sdi) char tmp[25]; int model_index; unsigned int i, j; - struct sr_probe *probe; + struct sr_channel *ch; struct dev_context *devc; devc = sdi->priv; @@ -495,46 +604,46 @@ SR_PRIV int hmo_init_device(struct sr_dev_inst *sdi) return SR_ERR_NA; } - if (!(devc->analog_groups = g_try_malloc0(sizeof(struct sr_probe_group) * + if (!(devc->analog_groups = g_try_malloc0(sizeof(struct sr_channel_group) * scope_models[model_index].analog_channels))) return SR_ERR_MALLOC; - if (!(devc->digital_groups = g_try_malloc0(sizeof(struct sr_probe_group) * + if (!(devc->digital_groups = g_try_malloc0(sizeof(struct sr_channel_group) * scope_models[model_index].digital_pods))) return SR_ERR_MALLOC; /* Add analog channels. */ for (i = 0; i < scope_models[model_index].analog_channels; i++) { - if (!(probe = sr_probe_new(i, SR_PROBE_ANALOG, TRUE, + if (!(ch = sr_channel_new(i, SR_CHANNEL_ANALOG, TRUE, (*scope_models[model_index].analog_names)[i]))) return SR_ERR_MALLOC; - sdi->probes = g_slist_append(sdi->probes, probe); + sdi->channels = g_slist_append(sdi->channels, ch); devc->analog_groups[i].name = (char *)(*scope_models[model_index].analog_names)[i]; - devc->analog_groups[i].probes = g_slist_append(NULL, probe); + devc->analog_groups[i].channels = g_slist_append(NULL, ch); - sdi->probe_groups = g_slist_append(sdi->probe_groups, + sdi->channel_groups = g_slist_append(sdi->channel_groups, &devc->analog_groups[i]); } - /* Add digital probe groups. */ + /* Add digital channel groups. */ for (i = 0; i < scope_models[model_index].digital_pods; ++i) { g_snprintf(tmp, 25, "POD%d", i); devc->digital_groups[i].name = g_strdup(tmp); - sdi->probe_groups = g_slist_append(sdi->probe_groups, + sdi->channel_groups = g_slist_append(sdi->channel_groups, &devc->digital_groups[i < 8 ? 0 : 1]); } /* Add digital channels. */ for (i = 0; i < scope_models[model_index].digital_channels; i++) { - if (!(probe = sr_probe_new(i, SR_PROBE_LOGIC, TRUE, + if (!(ch = sr_channel_new(i, SR_CHANNEL_LOGIC, TRUE, (*scope_models[model_index].digital_names)[i]))) return SR_ERR_MALLOC; - sdi->probes = g_slist_append(sdi->probes, probe); + sdi->channels = g_slist_append(sdi->channels, ch); - devc->digital_groups[i < 8 ? 0 : 1].probes = g_slist_append( - devc->digital_groups[i < 8 ? 0 : 1].probes, probe); + devc->digital_groups[i < 8 ? 0 : 1].channels = g_slist_append( + devc->digital_groups[i < 8 ? 0 : 1].channels, ch); } devc->model_config = &scope_models[model_index]; @@ -548,7 +657,7 @@ SR_PRIV int hmo_init_device(struct sr_dev_inst *sdi) SR_PRIV int hmo_receive_data(int fd, int revents, void *cb_data) { - struct sr_probe *probe; + struct sr_channel *ch; struct sr_dev_inst *sdi; struct dev_context *devc; struct sr_datafeed_packet packet; @@ -565,10 +674,10 @@ SR_PRIV int hmo_receive_data(int fd, int revents, void *cb_data) return TRUE; if (revents == G_IO_IN) { - probe = devc->current_probe->data; + ch = devc->current_channel->data; - switch (probe->type) { - case SR_PROBE_ANALOG: + switch (ch->type) { + case SR_CHANNEL_ANALOG: if (sr_scpi_get_floatv(sdi->conn, NULL, &data) != SR_OK) { if (data) g_array_free(data, TRUE); @@ -579,7 +688,7 @@ SR_PRIV int hmo_receive_data(int fd, int revents, void *cb_data) packet.type = SR_DF_FRAME_BEGIN; sr_session_send(sdi, &packet); - analog.probes = g_slist_append(NULL, probe); + analog.channels = g_slist_append(NULL, ch); analog.num_samples = data->len; analog.data = (float *) data->data; analog.mq = SR_MQ_VOLTAGE; @@ -588,10 +697,10 @@ SR_PRIV int hmo_receive_data(int fd, int revents, void *cb_data) packet.type = SR_DF_ANALOG; packet.payload = &analog; sr_session_send(cb_data, &packet); - g_slist_free(analog.probes); + g_slist_free(analog.channels); g_array_free(data, TRUE); break; - case SR_PROBE_LOGIC: + case SR_CHANNEL_LOGIC: if (sr_scpi_get_uint8v(sdi->conn, NULL, &data) != SR_OK) { if (data) g_free(data); @@ -610,22 +719,20 @@ SR_PRIV int hmo_receive_data(int fd, int revents, void *cb_data) g_array_free(data, TRUE); break; default: - sr_err("Invalid probe type."); + sr_err("Invalid channel type."); break; } packet.type = SR_DF_FRAME_END; sr_session_send(sdi, &packet); - if (devc->current_probe->next) { - devc->current_probe = devc->current_probe->next; + if (devc->current_channel->next) { + devc->current_channel = devc->current_channel->next; hmo_request_data(sdi); } else if (++devc->num_frames == devc->frame_limit) { - packet.type = SR_DF_END; - sr_session_send(sdi, &packet); sdi->driver->dev_acquisition_stop(sdi, cb_data); } else { - devc->current_probe = devc->enabled_probes; + devc->current_channel = devc->enabled_channels; hmo_request_data(sdi); } }