X-Git-Url: http://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Fyokogawa-dlm%2Fprotocol.c;h=bd2f33f0913969342b449258b397fc18b3b074d2;hb=d9251a2c9f1ca4380c27240ccca90c9f9ed46d3f;hp=e833389c815ef0e2e1aaf8d689f76f18a067b963;hpb=c65a021c050b3ef05ccc844cf24ee8e620eb669e;p=libsigrok.git diff --git a/src/hardware/yokogawa-dlm/protocol.c b/src/hardware/yokogawa-dlm/protocol.c index e833389c..bd2f33f0 100644 --- a/src/hardware/yokogawa-dlm/protocol.c +++ b/src/hardware/yokogawa-dlm/protocol.c @@ -18,11 +18,15 @@ * along with this program. If not, see . */ -/** @file +/** + * @file + * * Yokogawa DL/DLM series oscilloscope driver * @internal */ +#include +#include "scpi.h" #include "protocol.h" static const char *dlm_coupling_options[] = { @@ -60,7 +64,7 @@ static const char *dlm_4ch_trigger_sources[] = { NULL, }; -/* Note: Values must correlate to the trigger_slopes values */ +/* Note: Values must correlate to the trigger_slopes values. */ const char *dlm_trigger_slopes[3] = { "r", "f", @@ -136,7 +140,7 @@ static const char *scope_analog_channel_names[] = { "1", "2", "3", - "4" + "4", }; static const char *scope_digital_channel_names_8[] = { @@ -147,7 +151,7 @@ static const char *scope_digital_channel_names_8[] = { "D4", "D5", "D6", - "D7" + "D7", }; static const char *scope_digital_channel_names_32[] = { @@ -203,8 +207,8 @@ static const struct scope_config scope_models[] = { .num_ydivs = 8, }, { - .model_id = {"710110", "710120", "710130", NULL}, - .model_name = {"DLM2024", "DLM2034", "DLM2054", NULL}, + .model_id = {"710110", "710120", "710130", NULL}, + .model_name = {"DLM2024", "DLM2034", "DLM2054", NULL}, .analog_channels = 4, .digital_channels = 8, .pods = 1, @@ -220,9 +224,9 @@ static const struct scope_config scope_models[] = { }, { .model_id = {"701307", "701308", "701310", "701311", - "701312", "701313", NULL}, + "701312", "701313", NULL}, .model_name = {"DL9040", "DL9040L", "DL9140", "DL9140L", - "DL9240", "DL9240L", NULL}, + "DL9240", "DL9240L", NULL}, .analog_channels = 4, .digital_channels = 0, .pods = 0, @@ -282,21 +286,21 @@ static void scope_state_dump(const struct scope_config *config, unsigned int i; char *tmp; - for (i = 0; i < config->analog_channels; ++i) { + for (i = 0; i < config->analog_channels; i++) { 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)", + 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); } - for (i = 0; i < config->digital_channels; ++i) { + for (i = 0; i < config->digital_channels; i++) { sr_info("State of digital channel %d -> %s", i, state->digital_states[i] ? "On" : "Off"); } - for (i = 0; i < config->pods; ++i) { + for (i = 0; i < config->pods; i++) { sr_info("State of digital POD %d -> %s", i, state->pod_states[i] ? "On" : "Off"); } @@ -336,7 +340,7 @@ static int array_option_get(char *value, const char *(*array)[], *result = -1; - for (i = 0; (*array)[i]; ++i) + for (i = 0; (*array)[i]; i++) if (!g_strcmp0(value, (*array)[i])) { *result = i; break; @@ -368,7 +372,8 @@ static int array_option_get(char *value, const char *(*array)[], static int array_float_get(gchar *value, const uint64_t array[][2], int array_len, int *result) { - int i; + int i, e; + size_t pos; uint64_t f; float s; unsigned int s_int; @@ -377,27 +382,38 @@ static int array_float_get(gchar *value, const uint64_t array[][2], memset(ss, 0, sizeof(ss)); memset(es, 0, sizeof(es)); - strncpy(ss, value, 5); - strncpy(es, &(value[6]), 3); + /* Get index of the separating 'E' character and break up the string. */ + pos = strcspn(value, "E"); + + strncpy(ss, value, pos); + strncpy(es, &(value[pos+1]), 3); if (sr_atof_ascii(ss, &s) != SR_OK) return SR_ERR; - if (sr_atoi(es, &i) != SR_OK) + if (sr_atoi(es, &e) != SR_OK) return SR_ERR; /* Transform e.g. 10^-03 to 1000 as the array stores the inverse. */ - f = pow(10, abs(i)); + f = pow(10, abs(e)); - /* Adjust the significand/factor pair to make sure + /* + * Adjust the significand/factor pair to make sure * that f is a multiple of 1000. */ - while ((int)fmod(log10(f), 3) > 0) { s *= 10; f *= 10; } + while ((int)fmod(log10(f), 3) > 0) { + s *= 10; + + if (e < 0) + f *= 10; + else + f /= 10; + } /* Truncate s to circumvent rounding errors. */ s_int = (unsigned int)s; for (i = 0; i < array_len; i++) { - if ( (s_int == array[i][0]) && (f == array[i][1]) ) { + if ((s_int == array[i][0]) && (f == array[i][1])) { *result = i; return SR_OK; } @@ -428,7 +444,7 @@ static int analog_channel_state_get(const struct sr_dev_inst *sdi, scpi = sdi->conn; - for (i = 0; i < config->analog_channels; ++i) { + for (i = 0; i < config->analog_channels; i++) { if (dlm_analog_chan_state_get(scpi, i + 1, &state->analog_states[i].state) != SR_OK) @@ -503,14 +519,13 @@ static int digital_channel_state_get(const struct sr_dev_inst *sdi, scpi = sdi->conn; - if (!config->digital_channels) - { - sr_warn("Tried obtaining digital channel states on a " \ - "model without digital inputs."); - return SR_OK; - } + if (!config->digital_channels) { + sr_warn("Tried obtaining digital channel states on a " \ + "model without digital inputs."); + return SR_OK; + } - for (i = 0; i < config->digital_channels; ++i) { + for (i = 0; i < config->digital_channels; i++) { if (dlm_digital_chan_state_get(scpi, i + 1, &state->digital_states[i]) != SR_OK) { return SR_ERR; @@ -525,13 +540,12 @@ static int digital_channel_state_get(const struct sr_dev_inst *sdi, } } - if (!config->pods) - { + if (!config->pods) { sr_warn("Tried obtaining pod states on a model without pods."); return SR_OK; } - for (i = 0; i < config->pods; ++i) { + for (i = 0; i < config->pods; i++) { if (dlm_digital_pod_state_get(scpi, i + 'A', &state->pod_states[i]) != SR_OK) return SR_ERR; @@ -540,9 +554,6 @@ static int digital_channel_state_get(const struct sr_dev_inst *sdi, return SR_OK; } -/** - * - */ SR_PRIV int dlm_channel_state_set(const struct sr_dev_inst *sdi, const int ch_index, gboolean ch_state) { @@ -592,22 +603,23 @@ SR_PRIV int dlm_channel_state_set(const struct sr_dev_inst *sdi, break; } - ch->enabled = ch_state; - state->digital_states[i] = ch_state; - chan_found = TRUE; + ch->enabled = ch_state; + state->digital_states[i] = ch_state; + chan_found = TRUE; - /* The corresponding pod has to be enabled also. */ - pod_enabled[i / 8] |= ch->enabled; - } else + /* The corresponding pod has to be enabled also. */ + pod_enabled[i / 8] |= ch->enabled; + } else { /* Also check all other channels. Maybe we can disable a pod. */ pod_enabled[i / 8] |= ch->enabled; + } break; default: result = SR_ERR_NA; } } - for (i = 0; i < model->pods; ++i) { + for (i = 0; i < model->pods; i++) { if (state->pod_states[i] == pod_enabled[i]) continue; @@ -644,7 +656,8 @@ SR_PRIV int dlm_sample_rate_query(const struct sr_dev_inst *sdi) devc = sdi->priv; state = devc->model_state; - /* No need to find an active channel to query the sample rate: + /* + * No need to find an active channel to query the sample rate: * querying any channel will do, so we use channel 1 all the time. */ if (dlm_analog_chan_srate_get(sdi->conn, 1, &tmp_float) != SR_OK) @@ -837,7 +850,7 @@ SR_PRIV int dlm_device_init(struct sr_dev_inst *sdi, int model_index) } /* Add digital channel groups. */ - for (i = 0; i < scope_models[model_index].pods; ++i) { + for (i = 0; i < scope_models[model_index].pods; i++) { g_snprintf(tmp, sizeof(tmp), "POD%d", i); devc->digital_groups[i] = g_malloc0(sizeof(struct sr_channel_group)); @@ -952,6 +965,9 @@ static int dlm_analog_samples_send(GArray *data, struct scope_state *model_state; struct sr_channel *ch; struct sr_datafeed_analog analog; + struct sr_analog_encoding encoding; + struct sr_analog_meaning meaning; + struct sr_analog_spec spec; struct sr_datafeed_packet packet; devc = sdi->priv; @@ -964,10 +980,11 @@ static int dlm_analog_samples_send(GArray *data, return SR_ERR; } - range = ch_state->waveform_range; + range = ch_state->waveform_range; offset = ch_state->waveform_offset; - /* Convert byte sample to voltage according to + /* + * Convert byte sample to voltage according to * page 269 of the Communication Interface User's Manual. */ float_data = g_array_new(FALSE, FALSE, sizeof(float)); @@ -978,16 +995,18 @@ static int dlm_analog_samples_send(GArray *data, g_array_append_val(float_data, voltage); } - analog.channels = g_slist_append(NULL, ch); + /* TODO: Use proper 'digits' value for this device (and its modes). */ + sr_analog_init(&analog, &encoding, &meaning, &spec, 2); + analog.meaning->channels = g_slist_append(NULL, ch); analog.num_samples = float_data->len; analog.data = (float*)float_data->data; - analog.mq = SR_MQ_VOLTAGE; - analog.unit = SR_UNIT_VOLT; - analog.mqflags = 0; + analog.meaning->mq = SR_MQ_VOLTAGE; + analog.meaning->unit = SR_UNIT_VOLT; + analog.meaning->mqflags = 0; packet.type = SR_DF_ANALOG; packet.payload = &analog; sr_session_send(sdi, &packet); - g_slist_free(analog.channels); + g_slist_free(analog.meaning->channels); g_array_free(float_data, TRUE); g_array_remove_range(data, 0, samples * sizeof(uint8_t)); @@ -1043,7 +1062,7 @@ static int dlm_digital_samples_send(GArray *data, * @param cb_data Callback data, in this case our device instance. * * @return TRUE in case of success or a recoverable error, - * FALSE when a fatal error was encountered. + * FALSE when a fatal error was encountered. */ SR_PRIV int dlm_data_receive(int fd, int revents, void *cb_data) { @@ -1139,7 +1158,8 @@ SR_PRIV int dlm_data_receive(int fd, int revents, void *cb_data) g_array_free(data, TRUE); data = NULL; - /* Signal the end of this frame if this was the last enabled channel + /* + * Signal the end of this frame if this was the last enabled channel * and set the next enabled channel. Then, request its data. */ if (!devc->current_channel->next) { @@ -1147,10 +1167,11 @@ SR_PRIV int dlm_data_receive(int fd, int revents, void *cb_data) sr_session_send(sdi, &packet); devc->current_channel = devc->enabled_channels; - /* As of now we only support importing the current acquisition + /* + * As of now we only support importing the current acquisition * data so we're going to stop at this point. */ - sdi->driver->dev_acquisition_stop(sdi, cb_data); + sdi->driver->dev_acquisition_stop(sdi); return TRUE; } else devc->current_channel = devc->current_channel->next;