diff --git a/afsk/main.c b/afsk/main.c index c2cb9ba9..4e88f204 100644 --- a/afsk/main.c +++ b/afsk/main.c @@ -1079,6 +1079,8 @@ if (firstTime != ON) if (mode == BPSK) h[6] = 99; + printf("Mxv: %f \n",voltage[map[MINUS_X]]); + posXi = (int)(current[map[PLUS_X]] + 0.5) + 2048; posYi = (int)(current[map[PLUS_Y]] + 0.5) + 2048; posZi = (int)(current[map[PLUS_Z]] + 0.5) + 2048; @@ -1086,6 +1088,7 @@ if (firstTime != ON) negYi = (int)(current[map[MINUS_Y]] + 0.5) + 2048; negZi = (int)(current[map[MINUS_Z]] + 0.5) + 2048; + posXv = (int)(voltage[map[PLUS_X]] * 100); posYv = (int)(voltage[map[PLUS_Y]] * 100); posZv = (int)(voltage[map[PLUS_Z]] * 100); @@ -1099,6 +1102,8 @@ if (firstTime != ON) if (payload == ON) STEMBoardFailure = 0; + printf("NegXv: %d \n", negXv); + batteryVoltage = voltage[map[BAT]]; // if (payload == ON)