X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Ffx2lafw%2Fprotocol.c;h=8e69b77fd545eb38641d1fe34252cd6b182c16e0;hb=b02bb45f4cf6378520e5a5b82ff39013cfa270b6;hp=513fd0e2821f8fe039b45b4e58a33423ea152ac0;hpb=3be42bc22f8b36599a448273c12a76d3e0f7a940;p=libsigrok.git

diff --git a/src/hardware/fx2lafw/protocol.c b/src/hardware/fx2lafw/protocol.c
index 513fd0e2..8e69b77f 100644
--- a/src/hardware/fx2lafw/protocol.c
+++ b/src/hardware/fx2lafw/protocol.c
@@ -306,7 +306,8 @@ SR_PRIV struct dev_context *fx2lafw_dev_new(void)
 	devc->limit_samples = 0;
 	devc->capture_ratio = 0;
 	devc->sample_wide = FALSE;
-	devc->trigger_en = FALSE;
+	devc->dslogic_continuous_mode = FALSE;
+	devc->dslogic_clock_edge = DS_EDGE_RISING;
 	devc->stl = NULL;
 
 	return devc;
@@ -330,9 +331,8 @@ static void finish_acquisition(struct sr_dev_inst *sdi)
 
 	devc = sdi->priv;
 
-	std_session_send_df_end(sdi, LOG_PREFIX);
+	std_session_send_df_end(sdi);
 
-	/* Remove fds from polling. */
 	usb_source_remove(sdi->session, devc->ctx);
 
 	devc->num_transfers = 0;
@@ -385,15 +385,20 @@ static void resubmit_transfer(struct libusb_transfer *transfer)
 
 }
 
-SR_PRIV void mso_send_data_proc(struct dev_context *devc,
+SR_PRIV void mso_send_data_proc(struct sr_dev_inst *sdi,
 	uint8_t *data, size_t length, size_t sample_width)
 {
 	size_t i;
-	sample_width = sample_width;
+	struct dev_context *devc;
+
+	(void)sample_width;
+
+	devc = sdi->priv;
+
 	length /= 2;
 
 	/* Send the logic */
-	for(i = 0; i < length; i++) {
+	for (i = 0; i < length; i++) {
 		devc->logic_buffer[i]  = data[i * 2];
 		/* Rescale to -10V - +10V from 0-255. */
 		devc->analog_buffer[i] = data[i * 2 + 1] - 128.0f / 12.8f;
@@ -409,7 +414,8 @@ SR_PRIV void mso_send_data_proc(struct dev_context *devc,
 		.type = SR_DF_LOGIC,
 		.payload = &logic
 	};
-	sr_session_send(devc->cb_data, &logic_packet);
+
+	sr_session_send(sdi, &logic_packet);
 
 	const struct sr_datafeed_analog_old analog = {
 		.channels = devc->enabled_analog_channels,
@@ -424,11 +430,11 @@ SR_PRIV void mso_send_data_proc(struct dev_context *devc,
 		.type = SR_DF_ANALOG_OLD,
 		.payload = &analog
 	};
-	sr_session_send(devc->cb_data, &analog_packet);
 
+	sr_session_send(sdi, &analog_packet);
 }
 
-SR_PRIV void la_send_data_proc(struct dev_context *devc,
+SR_PRIV void la_send_data_proc(struct sr_dev_inst *sdi,
 	uint8_t *data, size_t length, size_t sample_width)
 {
 	const struct sr_datafeed_logic logic = {
@@ -442,7 +448,7 @@ SR_PRIV void la_send_data_proc(struct dev_context *devc,
 		.payload = &logic
 	};
 
-	sr_session_send(devc->cb_data, &packet);
+	sr_session_send(sdi, &packet);
 }
 
 SR_PRIV void LIBUSB_CALL fx2lafw_receive_transfer(struct libusb_transfer *transfer)
@@ -450,6 +456,7 @@ SR_PRIV void LIBUSB_CALL fx2lafw_receive_transfer(struct libusb_transfer *transf
 	struct sr_dev_inst *sdi;
 	struct dev_context *devc;
 	gboolean packet_has_error = FALSE;
+	struct sr_datafeed_packet packet;
 	unsigned int num_samples;
 	int trigger_offset, cur_sample_count, unitsize;
 	int pre_trigger_samples;
@@ -502,8 +509,6 @@ SR_PRIV void LIBUSB_CALL fx2lafw_receive_transfer(struct libusb_transfer *transf
 	} else {
 		devc->empty_transfer_count = 0;
 	}
-	if (devc->trigger_en)
-		devc->trigger_fired = TRUE;
 	if (devc->trigger_fired) {
 		if (!devc->limit_samples || devc->sent_samples < devc->limit_samples) {
 			/* Send the incoming transfer to the session bus. */
@@ -512,11 +517,29 @@ SR_PRIV void LIBUSB_CALL fx2lafw_receive_transfer(struct libusb_transfer *transf
 			else
 				num_samples = cur_sample_count;
 
-			devc->send_data_proc(devc,
-						(uint8_t*)transfer->buffer,
-						num_samples * unitsize,
-						unitsize);
-			devc->sent_samples += num_samples;
+			if (devc->dslogic && devc->trigger_pos > devc->sent_samples
+				&& devc->trigger_pos <= devc->sent_samples + num_samples) {
+					/* DSLogic trigger in this block. Send trigger position. */
+					trigger_offset = devc->trigger_pos - devc->sent_samples;
+					/* Pre-trigger samples. */
+					devc->send_data_proc(sdi, (uint8_t *)transfer->buffer,
+						trigger_offset * unitsize, unitsize);
+					devc->sent_samples += trigger_offset;
+					/* Trigger position. */
+					devc->trigger_pos = 0;
+					packet.type = SR_DF_TRIGGER;
+					packet.payload = NULL;
+					sr_session_send(sdi, &packet);
+					/* Post trigger samples. */
+					num_samples -= trigger_offset;
+					devc->send_data_proc(sdi, (uint8_t *)transfer->buffer
+							+ trigger_offset * unitsize, num_samples * unitsize, unitsize);
+					devc->sent_samples += num_samples;
+			} else {
+				devc->send_data_proc(sdi, (uint8_t *)transfer->buffer,
+					num_samples * unitsize, unitsize);
+				devc->sent_samples += num_samples;
+			}
 		}
 	} else {
 		trigger_offset = soft_trigger_logic_check(devc->stl,
@@ -528,10 +551,9 @@ SR_PRIV void LIBUSB_CALL fx2lafw_receive_transfer(struct libusb_transfer *transf
 					num_samples > devc->limit_samples - devc->sent_samples)
 				num_samples = devc->limit_samples - devc->sent_samples;
 
-			devc->send_data_proc(devc,
-						(uint8_t*)transfer->buffer + trigger_offset * unitsize,
-						num_samples * unitsize,
-						unitsize);
+			devc->send_data_proc(sdi, (uint8_t *)transfer->buffer
+					+ trigger_offset * unitsize,
+					num_samples * unitsize, unitsize);
 			devc->sent_samples += num_samples;
 
 			devc->trigger_fired = TRUE;