Esempio n. 1
0
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:
			if (ch->enabled)
				pod_enabled[ch->index / 8] = TRUE;

			if (ch->enabled == state->digital_states[ch->index])
				break;

			if (dlm_digital_chan_state_set(scpi, ch->index + 1,
					ch->enabled) != SR_OK)
				return SR_ERR;

			state->digital_states[ch->index] = 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;
}
Esempio n. 2
0
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;
}