|
|
|
@ -700,6 +700,9 @@ int main(int argc, char * argv[]) {
|
|
|
|
token = strtok(NULL, space);
|
|
|
|
token = strtok(NULL, space);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
sensor[XS1] = 100;
|
|
|
|
|
|
|
|
sensor[XS2] = 200;
|
|
|
|
|
|
|
|
sensor[XS3] = 300;
|
|
|
|
printf("\n");
|
|
|
|
printf("\n");
|
|
|
|
// if (sensor[GPS1] != 0) {
|
|
|
|
// if (sensor[GPS1] != 0) {
|
|
|
|
if ((sensor[GPS1] > -90.0) && (sensor[GPS1] < 90.0) && (sensor[GPS1] != 0.0)) {
|
|
|
|
if ((sensor[GPS1] > -90.0) && (sensor[GPS1] < 90.0) && (sensor[GPS1] != 0.0)) {
|
|
|
|
@ -1529,10 +1532,6 @@ void get_tlm_fox() {
|
|
|
|
encodeB(b, 46 + head_offset, PSUCurrent);
|
|
|
|
encodeB(b, 46 + head_offset, PSUCurrent);
|
|
|
|
encodeA(b, 48 + head_offset, (int)(sensor[DTEMP] * 10 + 0.5) + 2048);
|
|
|
|
encodeA(b, 48 + head_offset, (int)(sensor[DTEMP] * 10 + 0.5) + 2048);
|
|
|
|
// encodeB(b, 49 + head_offset, (int)(sensor[XS1] * 10 + 0.5) + 2048);
|
|
|
|
// encodeB(b, 49 + head_offset, (int)(sensor[XS1] * 10 + 0.5) + 2048);
|
|
|
|
|
|
|
|
|
|
|
|
sensor[XS2] = 100.0;
|
|
|
|
|
|
|
|
sensor[XS2] = 1000;
|
|
|
|
|
|
|
|
sensor[XS3] = 500;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
encodeB(b, 49 + head_offset, (int)(sensor[XS1]));
|
|
|
|
encodeB(b, 49 + head_offset, (int)(sensor[XS1]));
|
|
|
|
encodeA(b, 0 + head_offset, (int)(sensor[XS2]));
|
|
|
|
encodeA(b, 0 + head_offset, (int)(sensor[XS2]));
|
|
|
|
|