X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Fyokogawa-dlm%2Fprotocol.c;h=a60bc0d3208d3f103400e50ba335fe33d54fa6b3;hb=f3c60fb6affce2ebd81250db1d60bee733e5f479;hp=84ea966d188a8d16851f33b2d13fe77c8b822c10;hpb=af3487ec288c9eb7042932140fcc8d53abf8c382;p=libsigrok.git diff --git a/src/hardware/yokogawa-dlm/protocol.c b/src/hardware/yokogawa-dlm/protocol.c index 84ea966d..a60bc0d3 100644 --- a/src/hardware/yokogawa-dlm/protocol.c +++ b/src/hardware/yokogawa-dlm/protocol.c @@ -25,22 +25,6 @@ #include "protocol.h" -static const int32_t dlm_hwcaps[] = { - SR_CONF_LOGIC_ANALYZER, - SR_CONF_OSCILLOSCOPE, - SR_CONF_TRIGGER_SLOPE, - SR_CONF_TRIGGER_SOURCE, - SR_CONF_TIMEBASE, - SR_CONF_NUM_TIMEBASE, - SR_CONF_HORIZ_TRIGGERPOS, -}; - -static const int32_t dlm_analog_caps[] = { - SR_CONF_VDIV, - SR_CONF_COUPLING, - SR_CONF_NUM_VDIV, -}; - static const char *dlm_coupling_options[] = { "AC", "DC", @@ -49,13 +33,6 @@ static const char *dlm_coupling_options[] = { NULL, }; -/* Note: Values must correlate to the trigger_slopes values */ -static const char *dlm_trigger_slopes[] = { - "r", - "f", - NULL, -}; - static const char *dlm_2ch_trigger_sources[] = { "1", "2", @@ -83,7 +60,14 @@ static const char *dlm_4ch_trigger_sources[] = { NULL, }; -static const uint64_t dlm_timebases[][2] = { +/* Note: Values must correlate to the trigger_slopes values */ +const char *dlm_trigger_slopes[3] = { + "r", + "f", + NULL, +}; + +const uint64_t dlm_timebases[36][2] = { /* nanoseconds */ { 1, 1000000000 }, { 2, 1000000000 }, @@ -126,7 +110,7 @@ static const uint64_t dlm_timebases[][2] = { { 500, 1 }, }; -static const uint64_t dlm_vdivs[][2] = { +const uint64_t dlm_vdivs[17][2] = { /* millivolts */ { 2, 1000 }, { 5, 1000 }, @@ -155,7 +139,7 @@ static const char *scope_analog_channel_names[] = { "4" }; -static const char *scope_digital_channel_names[] = { +static const char *scope_digital_channel_names_8[] = { "D0", "D1", "D2", @@ -166,7 +150,42 @@ static const char *scope_digital_channel_names[] = { "D7" }; -static struct scope_config scope_models[] = { +static const char *scope_digital_channel_names_32[] = { + "A0", + "A1", + "A2", + "A3", + "A4", + "A5", + "A6", + "A7", + "B0", + "B1", + "B2", + "B3", + "B4", + "B5", + "B6", + "B7", + "C0", + "C1", + "C2", + "C3", + "C4", + "C5", + "C6", + "C7", + "D0", + "D1", + "D2", + "D3", + "D4", + "D5", + "D6", + "D7", +}; + +static const struct scope_config scope_models[] = { { .model_id = {"710105", "710115", "710125", NULL}, .model_name = {"DLM2022", "DLM2032", "DLM2052", NULL}, @@ -175,23 +194,10 @@ static struct scope_config scope_models[] = { .pods = 0, .analog_names = &scope_analog_channel_names, - .digital_names = &scope_digital_channel_names, - - .hw_caps = &dlm_hwcaps, - .num_hwcaps = ARRAY_SIZE(dlm_hwcaps), - - .analog_hwcaps = &dlm_analog_caps, - .num_analog_hwcaps = ARRAY_SIZE(dlm_analog_caps), + .digital_names = &scope_digital_channel_names_8, .coupling_options = &dlm_coupling_options, .trigger_sources = &dlm_2ch_trigger_sources, - .trigger_slopes = &dlm_trigger_slopes, - - .timebases = &dlm_timebases, - .num_timebases = ARRAY_SIZE(dlm_timebases), - - .vdivs = &dlm_vdivs, - .num_vdivs = ARRAY_SIZE(dlm_vdivs), .num_xdivs = 10, .num_ydivs = 8, @@ -204,23 +210,60 @@ static struct scope_config scope_models[] = { .pods = 1, .analog_names = &scope_analog_channel_names, - .digital_names = &scope_digital_channel_names, + .digital_names = &scope_digital_channel_names_8, + + .coupling_options = &dlm_coupling_options, + .trigger_sources = &dlm_4ch_trigger_sources, + + .num_xdivs = 10, + .num_ydivs = 8, + }, + { + .model_id = {"701307", "701308", "701310", "701311", + "701312", "701313", NULL}, + .model_name = {"DL9040", "DL9040L", "DL9140", "DL9140L", + "DL9240", "DL9240L", NULL}, + .analog_channels = 4, + .digital_channels = 0, + .pods = 0, + + .analog_names = &scope_analog_channel_names, + .digital_names = NULL, + + .coupling_options = &dlm_coupling_options, + .trigger_sources = &dlm_4ch_trigger_sources, - .hw_caps = &dlm_hwcaps, - .num_hwcaps = ARRAY_SIZE(dlm_hwcaps), + .num_xdivs = 10, + .num_ydivs = 8, + }, + { + .model_id = {"701320", "701321", NULL}, + .model_name = {"DL9505L", "DL9510L", NULL}, + .analog_channels = 4, + .digital_channels = 16, + .pods = 4, - .analog_hwcaps = &dlm_analog_caps, - .num_analog_hwcaps = ARRAY_SIZE(dlm_analog_caps), + .analog_names = &scope_analog_channel_names, + .digital_names = &scope_digital_channel_names_32, .coupling_options = &dlm_coupling_options, .trigger_sources = &dlm_4ch_trigger_sources, - .trigger_slopes = &dlm_trigger_slopes, - .timebases = &dlm_timebases, - .num_timebases = ARRAY_SIZE(dlm_timebases), + .num_xdivs = 10, + .num_ydivs = 8, + }, + { + .model_id = {"701330", "701331", NULL}, + .model_name = {"DL9705L", "DL9710L", NULL}, + .analog_channels = 4, + .digital_channels = 32, + .pods = 4, + + .analog_names = &scope_analog_channel_names, + .digital_names = &scope_digital_channel_names_32, - .vdivs = &dlm_vdivs, - .num_vdivs = ARRAY_SIZE(dlm_vdivs), + .coupling_options = &dlm_coupling_options, + .trigger_sources = &dlm_4ch_trigger_sources, .num_xdivs = 10, .num_ydivs = 8, @@ -233,33 +276,33 @@ static struct scope_config scope_models[] = { * @param config This is the scope configuration. * @param state The current scope state to print. */ -static void scope_state_dump(struct scope_config *config, +static void scope_state_dump(const struct scope_config *config, struct scope_state *state) { unsigned int i; char *tmp; for (i = 0; i < config->analog_channels; ++i) { - tmp = sr_voltage_string((*config->vdivs)[state->analog_states[i].vdiv][0], - (*config->vdivs)[state->analog_states[i].vdiv][1]); + tmp = sr_voltage_string(dlm_vdivs[state->analog_states[i].vdiv][0], + dlm_vdivs[state->analog_states[i].vdiv][1]); sr_info("State of analog channel %d -> %s : %s (coupling) %s (vdiv) %2.2e (offset)", - i + 1, state->analog_states[i].state ? "On" : "Off", - (*config->coupling_options)[state->analog_states[i].coupling], - tmp, state->analog_states[i].vertical_offset); + i + 1, state->analog_states[i].state ? "On" : "Off", + (*config->coupling_options)[state->analog_states[i].coupling], + tmp, state->analog_states[i].vertical_offset); } for (i = 0; i < config->digital_channels; ++i) { sr_info("State of digital channel %d -> %s", i, - state->digital_states[i] ? "On" : "Off"); + state->digital_states[i] ? "On" : "Off"); } for (i = 0; i < config->pods; ++i) { sr_info("State of digital POD %d -> %s", i, - state->pod_states[i] ? "On" : "Off"); + state->pod_states[i] ? "On" : "Off"); } - tmp = sr_period_string((*config->timebases)[state->timebase][0] * - (*config->timebases)[state->timebase][1]); + tmp = sr_period_string(dlm_timebases[state->timebase][0] * + dlm_timebases[state->timebase][1]); sr_info("Current timebase: %s", tmp); g_free(tmp); @@ -268,12 +311,12 @@ static void scope_state_dump(struct scope_config *config, g_free(tmp); sr_info("Current samples per acquisition (i.e. frame): %d", - state->samples_per_frame); + state->samples_per_frame); 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); + (*config->trigger_sources)[state->trigger_source], + dlm_trigger_slopes[state->trigger_slope], + state->horiz_triggerpos); } /** @@ -328,6 +371,7 @@ static int array_float_get(gchar *value, const uint64_t array[][2], int i; uint64_t f; float s; + unsigned int s_int; gchar ss[10], es[10]; memset(ss, 0, sizeof(ss)); @@ -350,10 +394,10 @@ static int array_float_get(gchar *value, const uint64_t array[][2], while ((int)fmod(log10(f), 3) > 0) { s *= 10; f *= 10; } /* Truncate s to circumvent rounding errors. */ - s = (int)s; + s_int = (unsigned int)s; for (i = 0; i < array_len; i++) { - if ( (s == array[i][0]) && (f == array[i][1]) ) { + if ( (s_int == array[i][0]) && (f == array[i][1]) ) { *result = i; return SR_OK; } @@ -373,8 +417,8 @@ static int array_float_get(gchar *value, const uint64_t array[][2], * @return SR_ERR on error, SR_OK otherwise. */ static int analog_channel_state_get(struct sr_scpi_dev_inst *scpi, - struct scope_config *config, - struct scope_state *state) + const struct scope_config *config, + struct scope_state *state) { int i, j; gchar *response; @@ -382,14 +426,14 @@ static int analog_channel_state_get(struct sr_scpi_dev_inst *scpi, for (i = 0; i < config->analog_channels; ++i) { if (dlm_analog_chan_state_get(scpi, i + 1, - &state->analog_states[i].state) != SR_OK) + &state->analog_states[i].state) != SR_OK) return SR_ERR; if (dlm_analog_chan_vdiv_get(scpi, i + 1, &response) != SR_OK) return SR_ERR; - if (array_float_get(response, *config->vdivs, config->num_vdivs, - &j) != SR_OK) { + if (array_float_get(response, dlm_vdivs, ARRAY_SIZE(dlm_vdivs), + &j) != SR_OK) { g_free(response); return SR_ERR; } @@ -398,15 +442,15 @@ static int analog_channel_state_get(struct sr_scpi_dev_inst *scpi, state->analog_states[i].vdiv = j; if (dlm_analog_chan_voffs_get(scpi, i + 1, - &state->analog_states[i].vertical_offset) != SR_OK) + &state->analog_states[i].vertical_offset) != SR_OK) return SR_ERR; if (dlm_analog_chan_wrange_get(scpi, i + 1, - &state->analog_states[i].waveform_range) != SR_OK) + &state->analog_states[i].waveform_range) != SR_OK) return SR_ERR; if (dlm_analog_chan_woffs_get(scpi, i + 1, - &state->analog_states[i].waveform_offset) != SR_OK) + &state->analog_states[i].waveform_offset) != SR_OK) return SR_ERR; if (dlm_analog_chan_coupl_get(scpi, i + 1, &response) != SR_OK) { @@ -415,7 +459,7 @@ static int analog_channel_state_get(struct sr_scpi_dev_inst *scpi, } if (array_option_get(response, config->coupling_options, - &state->analog_states[i].coupling) != SR_OK) { + &state->analog_states[i].coupling) != SR_OK) { g_free(response); return SR_ERR; } @@ -436,15 +480,15 @@ static int analog_channel_state_get(struct sr_scpi_dev_inst *scpi, * @return SR_ERR on error, SR_OK otherwise. */ static int digital_channel_state_get(struct sr_scpi_dev_inst *scpi, - struct scope_config *config, - struct scope_state *state) + const struct scope_config *config, + struct scope_state *state) { unsigned int i; if (!config->digital_channels) { sr_warn("Tried obtaining digital channel states on a " \ - "model without digital inputs."); + "model without digital inputs."); return SR_OK; } @@ -511,7 +555,7 @@ SR_PRIV int dlm_scope_state_query(struct sr_dev_inst *sdi) { struct dev_context *devc; struct scope_state *state; - struct scope_config *config; + const struct scope_config *config; float tmp_float; gchar *response; int i; @@ -529,8 +573,8 @@ SR_PRIV int dlm_scope_state_query(struct sr_dev_inst *sdi) if (dlm_timebase_get(sdi->conn, &response) != SR_OK) return SR_ERR; - if (array_float_get(response, *config->timebases, - config->num_timebases, &i) != SR_OK) { + if (array_float_get(response, dlm_timebases, + ARRAY_SIZE(dlm_timebases), &i) != SR_OK) { g_free(response); return SR_ERR; } @@ -543,8 +587,8 @@ SR_PRIV int dlm_scope_state_query(struct sr_dev_inst *sdi) /* TODO: Check if the calculation makes sense for the DLM. */ state->horiz_triggerpos = tmp_float / - (((double)(*config->timebases)[state->timebase][0] / - (*config->timebases)[state->timebase][1]) * config->num_xdivs); + (((double)dlm_timebases[state->timebase][0] / + dlm_timebases[state->timebase][1]) * config->num_xdivs); state->horiz_triggerpos -= 0.5; state->horiz_triggerpos *= -1; @@ -554,7 +598,7 @@ SR_PRIV int dlm_scope_state_query(struct sr_dev_inst *sdi) } if (array_option_get(response, config->trigger_sources, - &state->trigger_source) != SR_OK) { + &state->trigger_source) != SR_OK) { g_free(response); return SR_ERR; } @@ -583,20 +627,19 @@ SR_PRIV int dlm_scope_state_query(struct sr_dev_inst *sdi) * * @param config The device configuration to use. * - * @return The newly allocated scope_state struct or NULL on error. + * @return The newly allocated scope_state struct. */ -static struct scope_state *dlm_scope_state_new(struct scope_config *config) +static struct scope_state *dlm_scope_state_new(const struct scope_config *config) { struct scope_state *state; - if (!(state = g_try_malloc0(sizeof(struct scope_state)))) - return NULL; + state = g_malloc0(sizeof(struct scope_state)); state->analog_states = g_malloc0(config->analog_channels * - sizeof(struct analog_channel_state)); + sizeof(struct analog_channel_state)); state->digital_states = g_malloc0(config->digital_channels * - sizeof(gboolean)); + sizeof(gboolean)); state->pod_states = g_malloc0(config->pods * sizeof(gboolean)); @@ -637,7 +680,7 @@ SR_PRIV int dlm_model_get(char *model_id, char **model_name, int *model_index) if (*model_index == -1) { sr_err("Found unsupported DLM device with model identifier %s.", - model_id); + model_id); return SR_ERR_NA; } @@ -660,26 +703,24 @@ SR_PRIV int dlm_device_init(struct sr_dev_inst *sdi, int model_index) devc = sdi->priv; devc->analog_groups = g_malloc0(sizeof(struct sr_channel_group*) * - scope_models[model_index].analog_channels); + scope_models[model_index].analog_channels); devc->digital_groups = g_malloc0(sizeof(struct sr_channel_group*) * - scope_models[model_index].digital_channels); + scope_models[model_index].pods); - /* Add analog channels. */ + /* Add analog channels, each in its own group. */ for (i = 0; i < scope_models[model_index].analog_channels; i++) { - if (!(ch = sr_channel_new(i, SR_CHANNEL_ANALOG, TRUE, - (*scope_models[model_index].analog_names)[i]))) - return SR_ERR_MALLOC; - sdi->channels = g_slist_append(sdi->channels, ch); + ch = sr_channel_new(sdi, i, SR_CHANNEL_ANALOG, TRUE, + (*scope_models[model_index].analog_names)[i]); devc->analog_groups[i] = g_malloc0(sizeof(struct sr_channel_group)); devc->analog_groups[i]->name = g_strdup( - (char *)(*scope_models[model_index].analog_names)[i]); + (char *)(*scope_models[model_index].analog_names)[i]); devc->analog_groups[i]->channels = g_slist_append(NULL, ch); sdi->channel_groups = g_slist_append(sdi->channel_groups, - devc->analog_groups[i]); + devc->analog_groups[i]); } /* Add digital channel groups. */ @@ -697,13 +738,12 @@ SR_PRIV int dlm_device_init(struct sr_dev_inst *sdi, int model_index) /* Add digital channels. */ for (i = 0; i < scope_models[model_index].digital_channels; i++) { - if (!(ch = sr_channel_new(i, SR_CHANNEL_LOGIC, TRUE, - (*scope_models[model_index].digital_names)[i]))) - return SR_ERR_MALLOC; - sdi->channels = g_slist_append(sdi->channels, ch); + ch = sr_channel_new(sdi, DLM_DIG_CHAN_INDEX_OFFS + i, + SR_CHANNEL_LOGIC, TRUE, + (*scope_models[model_index].digital_names)[i]); devc->digital_groups[i / 8]->channels = g_slist_append( - devc->digital_groups[i / 8]->channels, ch); + devc->digital_groups[i / 8]->channels, ch); } devc->model_config = &scope_models[model_index]; devc->frame_limit = 0; @@ -789,8 +829,8 @@ static int dlm_block_data_header_process(GArray *data, int *len) * @return SR_ERR when data is trucated, SR_OK otherwise. */ static int dlm_analog_samples_send(GArray *data, - struct analog_channel_state *ch_state, - struct sr_dev_inst *sdi) + struct analog_channel_state *ch_state, + struct sr_dev_inst *sdi) { uint32_t i, samples; float voltage, range, offset; @@ -821,7 +861,7 @@ static int dlm_analog_samples_send(GArray *data, for (i = 0; i < samples; i++) { voltage = (float)g_array_index(data, int8_t, i); voltage = (range * voltage / - DLM_DIVISION_FOR_BYTE_FORMAT) + offset; + DLM_DIVISION_FOR_BYTE_FORMAT) + offset; g_array_append_val(float_data, voltage); } @@ -852,7 +892,7 @@ static int dlm_analog_samples_send(GArray *data, * @return SR_ERR when data is trucated, SR_OK otherwise. */ static int dlm_digital_samples_send(GArray *data, - struct sr_dev_inst *sdi) + struct sr_dev_inst *sdi) { struct dev_context *devc; struct scope_state *model_state; @@ -923,14 +963,14 @@ SR_PRIV int dlm_data_receive(int fd, int revents, void *cb_data) if (sr_scpi_read_begin(sdi->conn) == SR_OK) /* The 16 here accounts for the header and EOL. */ data = g_array_sized_new(FALSE, FALSE, sizeof(uint8_t), - 16 + model_state->samples_per_frame); + 16 + model_state->samples_per_frame); else return TRUE; } /* Store incoming data. */ chunk_len = sr_scpi_read_data(sdi->conn, devc->receive_buffer, - RECEIVE_BUFFER_SIZE); + RECEIVE_BUFFER_SIZE); if (chunk_len < 0) { sr_err("Error while reading data: %d", chunk_len); goto fail; @@ -957,11 +997,12 @@ SR_PRIV int dlm_data_receive(int fd, int revents, void *cb_data) if (num_bytes == 0) { sr_warn("Zero-length waveform data packet received. " \ - "Live mode not supported yet, stopping " \ - "acquisition and retrying."); + "Live mode not supported yet, stopping " \ + "acquisition and retrying."); /* Don't care about return value here. */ dlm_acquisition_stop(sdi->conn); g_array_free(data, TRUE); + dlm_channel_data_request(sdi); return TRUE; } @@ -1002,7 +1043,7 @@ SR_PRIV int dlm_data_receive(int fd, int revents, void *cb_data) devc->current_channel = devc->current_channel->next; if (dlm_channel_data_request(sdi) != SR_OK) { - sr_err("Failed to request aquisition data."); + sr_err("Failed to request acquisition data."); goto fail; }