diff --git a/main.c b/main.c index b8aa1a39..284bc4a1 100644 --- a/main.c +++ b/main.c @@ -1594,9 +1594,13 @@ void get_tlm_fox() { (i2c_bus0 == OFF) * 16 + (i2c_bus1 == OFF) * 32 + (i2c_bus3 == OFF) * 64 + (camera == OFF) * 128 + groundCommandCount * 256; encodeA(b, 51 + head_offset, status); - encodeB(b, 52 + head_offset, rxAntennaDeployed + txAntennaDeployed * 2 + c2cStatus * 4); - printf("Ant status %d \n", rxAntennaDeployed + txAntennaDeployed * 2 + c2cStatus * 4); + if (mode == BPSK) { + encodeA(b_max, 51 + head_offset, status); + encodeA(b_min, 51 + head_offset, status); + encodeB(b_max, 52 + head_offset, rxAntennaDeployed + txAntennaDeployed * 2 + c2cStatus * 4); + encodeB(b_min, 52 + head_offset, rxAntennaDeployed + txAntennaDeployed * 2 + c2cStatus * 4); + } if (txAntennaDeployed == 0) { txAntennaDeployed = 1;