From: Benjamin Larsson <redacted>
Date: Sat, 23 Apr 2016 16:22:19 +0000 (+0200)
Subject: Support changing calibration pulse frequency
X-Git-Tag: sigrok-firmware-fx2lafw-0.1.4~30
X-Git-Url: https://sigrok.org/gitweb/?a=commitdiff_plain;h=a425fae9a25f54af8d514aff8824382f7b317ba4;p=sigrok-firmware-fx2lafw.git

Support changing calibration pulse frequency
---

diff --git a/sainsmart_dds120.c b/sainsmart_dds120.c
index ae3c5997..6748d47b 100644
--- a/sainsmart_dds120.c
+++ b/sainsmart_dds120.c
@@ -347,6 +347,30 @@ static BOOL set_samplerate(BYTE rate)
 	return TRUE;
 }
 
+static BOOL set_calibration_pulse(BYTE fs)
+{
+	switch (fs) {
+	case 0:		// 100Hz
+		RCAP2L = -10000 & 0xff;
+		RCAP2H = (-10000 >> 8) & 0xff;
+		return TRUE;
+	case 1:		// 1kHz
+		RCAP2L = -1000 & 0xff;
+		RCAP2H = (-1000 >> 8) & 0xff;
+		return TRUE;
+	case 10:	// 1kHz
+		RCAP2L = -100 & 0xff;
+		RCAP2H = 0xff;
+		return TRUE;
+	case 50:	// 50kHz
+		RCAP2L = -20 & 0xff;
+		RCAP2H = 0xff;
+		return TRUE;
+	default:
+		return FALSE;
+	}
+}
+
 /* Set *alt_ifc to the current alt interface for ifc. */
 BOOL handle_get_interface(BYTE ifc, BYTE *alt_ifc)
 {
@@ -390,7 +414,7 @@ BOOL handle_vendorcommand(BYTE cmd)
 	stop_sampling();
 
 	/* Clear EP0BCH/L for each valid command. */
-	if (cmd >= 0xe0 && cmd <= 0xe5) {
+	if (cmd >= 0xe0 && cmd <= 0xe6) {
 		EP0BCH = 0;
 		EP0BCL = 0;
 		while (EP0CS & bmEPBUSY);
@@ -414,6 +438,9 @@ BOOL handle_vendorcommand(BYTE cmd)
 	case 0xe5:
 		set_coupling(EP0BUF[0]);
 		return TRUE;
+	case 0xe6:
+		set_calibration_pulse(EP0BUF[0]);
+		return TRUE;
 	}
 
 	return FALSE; /* Not handled by handlers. */