diff --git a/afsk/main.c b/afsk/main.c index 05184ab2..d5966dc8 100644 --- a/afsk/main.c +++ b/afsk/main.c @@ -682,15 +682,15 @@ int get_tlm_fox() { if (mode == BPSK) h[6] = 99; - posXv = reading[PLUS_X].current * 10; - posYv = reading[PLUS_Y].current * 10; - posZv = reading[PLUS_Z].current * 10; - negXv = reading[MINUS_X].current * 10; - negYv = reading[MINUS_Y].current * 10; - negZv = reading[MINUS_Z].current * 10; + posXv = reading[PLUS_X].current; + posYv = reading[PLUS_Y].current; + posZv = reading[PLUS_Z].current; + negXv = reading[MINUS_X].current; + negYv = reading[MINUS_Y].current; + negZv = reading[MINUS_Z].current; - batt_c_v = reading[BAT].voltage * 100; - battCurr = reading[BAT].current * 10; + batt_c_v = reading[BAT].voltage * 10; + battCurr = reading[BAT].current; /* batt_a_v = 0, batt_b_v = 0, batt_c_v = 8.95 * 100, battCurr = 48.6 * 10; @@ -703,10 +703,10 @@ int get_tlm_fox() { encodeA(b, 3 + head_offset, batt_c_v); encodeA(b, 9 + head_offset, battCurr); encodeA(b, 12 + head_offset,posXv); - encodeB(b, 13 + head_offset,posYv); - encodeA(b, 15 + head_offset,posZv); - encodeB(b, 16 + head_offset,negXv); - encodeA(b, 18 + head_offset,negYv); + encodeB(b, 13 + head_offset,negXv); + encodeA(b, 15 + head_offset,posYv); + encodeB(b, 16 + head_offset,negYv); + encodeA(b, 18 + head_offset,posZv); encodeB(b, 19 + head_offset,negZv); /* batt_c_v += 10;