X-Git-Url: http://sigrok.org/gitweb/?a=blobdiff_plain;ds=sidebyside;f=src%2Fhardware%2Fyokogawa-dlm%2Fprotocol.c;h=185f9d5c4b7b4944150c70d6a0dbc9a568fb2c49;hb=b18b8a92028475ca3d9ab33c06248d37075837be;hp=a60bc0d3208d3f103400e50ba335fe33d54fa6b3;hpb=f3c60fb6affce2ebd81250db1d60bee733e5f479;p=libsigrok.git
diff --git a/src/hardware/yokogawa-dlm/protocol.c b/src/hardware/yokogawa-dlm/protocol.c
index a60bc0d3..185f9d5c 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[] = {
@@ -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,7 @@ 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, pos, e;
uint64_t f;
float s;
unsigned int s_int;
@@ -377,27 +381,39 @@ 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 = (int)g_strstr_len(value, strlen(value), "E");
+ pos -= (int)value;
+
+ 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;
}
@@ -410,25 +426,38 @@ static int array_float_get(gchar *value, const uint64_t array[][2],
* Obtains information about all analog channels from the oscilloscope.
* The internal state information is updated accordingly.
*
- * @param scpi An open SCPI connection.
+ * @param sdi The device instance.
* @param config The device's device configuration.
* @param state The device's state information.
*
* @return SR_ERR on error, SR_OK otherwise.
*/
-static int analog_channel_state_get(struct sr_scpi_dev_inst *scpi,
+static int analog_channel_state_get(const struct sr_dev_inst *sdi,
const struct scope_config *config,
struct scope_state *state)
{
+ struct sr_scpi_dev_inst *scpi;
int i, j;
+ GSList *l;
+ struct sr_channel *ch;
gchar *response;
- for (i = 0; i < config->analog_channels; ++i) {
+ scpi = sdi->conn;
+
+ for (i = 0; i < config->analog_channels; i++) {
if (dlm_analog_chan_state_get(scpi, i + 1,
&state->analog_states[i].state) != SR_OK)
return SR_ERR;
+ for (l = sdi->channels; l; l = l->next) {
+ ch = l->data;
+ if (ch->index == i) {
+ ch->enabled = state->analog_states[i].state;
+ break;
+ }
+ }
+
if (dlm_analog_chan_vdiv_get(scpi, i + 1, &response) != SR_OK)
return SR_ERR;
@@ -473,39 +502,50 @@ static int analog_channel_state_get(struct sr_scpi_dev_inst *scpi,
* Obtains information about all digital channels from the oscilloscope.
* The internal state information is updated accordingly.
*
- * @param scpi An open SCPI connection.
+ * @param sdi The device instance.
* @param config The device's device configuration.
* @param state The device's state information.
*
* @return SR_ERR on error, SR_OK otherwise.
*/
-static int digital_channel_state_get(struct sr_scpi_dev_inst *scpi,
+static int digital_channel_state_get(const struct sr_dev_inst *sdi,
const struct scope_config *config,
struct scope_state *state)
{
- unsigned int i;
+ struct sr_scpi_dev_inst *scpi;
+ int i;
+ GSList *l;
+ struct sr_channel *ch;
- if (!config->digital_channels)
- {
- sr_warn("Tried obtaining digital channel states on a " \
- "model without digital inputs.");
- return SR_OK;
- }
+ scpi = sdi->conn;
- for (i = 0; i < config->digital_channels; ++i) {
+ 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++) {
if (dlm_digital_chan_state_get(scpi, i + 1,
&state->digital_states[i]) != SR_OK) {
return SR_ERR;
}
+
+ for (l = sdi->channels; l; l = l->next) {
+ ch = l->data;
+ if (ch->index == i + DLM_DIG_CHAN_INDEX_OFFS) {
+ ch->enabled = state->digital_states[i];
+ break;
+ }
+ }
}
- 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;
@@ -514,6 +554,91 @@ static int digital_channel_state_get(struct sr_scpi_dev_inst *scpi,
return SR_OK;
}
+SR_PRIV int dlm_channel_state_set(const struct sr_dev_inst *sdi,
+ const int ch_index, gboolean ch_state)
+{
+ GSList *l;
+ struct sr_channel *ch;
+ struct dev_context *devc = NULL;
+ struct scope_state *state;
+ const struct scope_config *model = NULL;
+ struct sr_scpi_dev_inst *scpi;
+ gboolean chan_found;
+ gboolean *pod_enabled;
+ int i, result;
+
+ result = SR_OK;
+
+ scpi = sdi->conn;
+ devc = sdi->priv;
+ state = devc->model_state;
+ model = devc->model_config;
+ chan_found = 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->index == ch_index) {
+ if (dlm_analog_chan_state_set(scpi, ch->index + 1, ch_state) != SR_OK) {
+ result = SR_ERR;
+ break;
+ }
+
+ ch->enabled = ch_state;
+ state->analog_states[ch->index].state = ch_state;
+ chan_found = TRUE;
+ break;
+ }
+ break;
+ case SR_CHANNEL_LOGIC:
+ i = ch->index - DLM_DIG_CHAN_INDEX_OFFS;
+
+ if (ch->index == ch_index) {
+ if (dlm_digital_chan_state_set(scpi, i + 1, ch_state) != SR_OK) {
+ result = SR_ERR;
+ break;
+ }
+
+ 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 {
+ /* 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++) {
+ if (state->pod_states[i] == pod_enabled[i])
+ continue;
+
+ if (dlm_digital_pod_state_set(scpi, i + 1, pod_enabled[i]) != SR_OK) {
+ result = SR_ERR;
+ break;
+ }
+
+ state->pod_states[i] = pod_enabled[i];
+ }
+
+ g_free(pod_enabled);
+
+ if ((result == SR_OK) && !chan_found)
+ result = SR_ERR_BUG;
+
+ return result;
+}
+
/**
* Obtains information about the sample rate from the oscilloscope.
* The internal state information is updated accordingly.
@@ -531,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)
@@ -564,10 +690,10 @@ SR_PRIV int dlm_scope_state_query(struct sr_dev_inst *sdi)
config = devc->model_config;
state = devc->model_state;
- if (analog_channel_state_get(sdi->conn, config, state) != SR_OK)
+ if (analog_channel_state_get(sdi, config, state) != SR_OK)
return SR_ERR;
- if (digital_channel_state_get(sdi->conn, config, state) != SR_OK)
+ if (digital_channel_state_get(sdi, config, state) != SR_OK)
return SR_ERR;
if (dlm_timebase_get(sdi->conn, &response) != SR_OK)
@@ -724,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));
@@ -838,7 +964,7 @@ static int dlm_analog_samples_send(GArray *data,
struct dev_context *devc;
struct scope_state *model_state;
struct sr_channel *ch;
- struct sr_datafeed_analog analog;
+ struct sr_datafeed_analog_old analog;
struct sr_datafeed_packet packet;
devc = sdi->priv;
@@ -851,10 +977,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));
@@ -871,7 +998,7 @@ static int dlm_analog_samples_send(GArray *data,
analog.mq = SR_MQ_VOLTAGE;
analog.unit = SR_UNIT_VOLT;
analog.mqflags = 0;
- packet.type = SR_DF_ANALOG;
+ packet.type = SR_DF_ANALOG_OLD;
packet.payload = &analog;
sr_session_send(sdi, &packet);
g_slist_free(analog.channels);
@@ -930,7 +1057,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)
{
@@ -1026,7 +1153,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) {
@@ -1034,7 +1162,8 @@ 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);