fix table lookup

1 files changed, 11 insertions, 10 deletions

diff --git a/fw/main.c b/fw/main.c
index b4fba7d..0fb50ac 100644
--- a/fw/main.c
+++ b/fw/main.c
@@ -316,16 +316,6 @@ driveGauge(Signal sig, Number raw) {
 	Status status;
 	U16 val;
 
-	// TODO: remove
-	CanFrame frame;
-	frame.id = (CanId){.isExt=false, .sid=0x123};
-	frame.rtr = false;
-	frame.dlc = 3u;
-	frame.data[0u] = sig & 0xFF;
-	frame.data[1u] = raw.type & 0xFF;
-	frame.data[2u] = raw.u8;
-	canTx(&frame);
-
 	if (sig >= NSIG) {
 		return ERR;
 	}
@@ -336,6 +326,17 @@ driveGauge(Signal sig, Number raw) {
 		return ERR;
 	}
 
+	// TODO: remove
+	CanFrame frame;
+	frame.id = (CanId){.isExt=false, .sid=0x123};
+	frame.rtr = false;
+	frame.dlc = 5u;
+	frame.data[0u] = sig & 0xFF; // signal
+	frame.data[1u] = raw.type & 0xFF; // key type
+	frame.data[2u] = raw.u8; // key (U8)
+	serU16Be(frame.data+3, val); // val
+	canTx(&frame);
+
 	switch (sig) {
 	case SIG_TACH:
 		// TODO