added current as well as voltage encoding in fox

pull/32/head
alanbjohnston 6 years ago committed by GitHub
parent 242347db4d
commit b4d9863d65
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23

@ -682,8 +682,8 @@ int get_tlm_fox() {
*/
int id, frm_type = 0x01, TxTemp = 0, IHUcpuTemp = 0;
int batt_a_v = 0, batt_b_v = 0, batt_c_v = 0, battCurr = 0;
int posXv = 0, negXv = 0, posYv = 0, negYv = 0,
posZv = 0, negZv = 0;
int posXv = 0, negXv = 0, posYv = 0, negYv = 0, posZv = 0, negZv = 0;
int posXi = 0, negXi = 0, posYi = 0, negYi = 0, posZi = 0, negZi = 0;
int head_offset = 0;
short int buffer_test[bufLen];
@ -787,33 +787,46 @@ if (firstTime != ON)
h[6] = 99;
// posXv = reading[PLUS_X].current;
posXv = testCount++;
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;
posXi = reading[PLUS_X].current;
posYi = reading[PLUS_Y].current;
posZi = reading[PLUS_Z].current;
negXi = reading[MINUS_X].current;
negYi = reading[MINUS_Y].current;
negZi = reading[MINUS_Z].current;
posXv = reading[PLUS_X].voltage;
posYv = reading[PLUS_Y].voltage;
posZv = reading[PLUS_Z].voltage;
negXv = reading[MINUS_X].voltage;
negYv = reading[MINUS_Y].voltage;
negZv = reading[MINUS_Z].voltage;
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;
posXv = 296, negXv = 45, posYv = 220, negYv = 68,
posZv = 280, negZv = 78;
*/
posXv = 10, negXv = 20, posYv = 30, negYv = 40, posZv = 50, negZv = 60;
posXi = 110, negXi = 120, posYi = 130, negYi = 140, posZi = 150, negZi = 160;
encodeA(b, 0 + head_offset, batt_a_v);
encodeB(b, 1 + head_offset, batt_b_v);
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,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);
encodeA(b, 21 + head_offset,posXi);
encodeB(b, 22 + head_offset,negXi);
encodeA(b, 24 + head_offset,posYi;
encodeB(b, 25 + head_offset,negYi);
encodeA(b, 27 + head_offset,posZi);
encodeB(b, 28 + head_offset,negZi);
encodeA(b, 39 + head_offset, IHUcpuTemp);
/* batt_c_v += 10;

Loading…
Cancel
Save

Powered by TurnKey Linux.