fix STS_R1D_JP two distances instead of three

This commit is contained in:
Yunhorn 2024-05-22 14:20:52 +08:00
parent 516786360c
commit fdfd9d7c22
1 changed files with 4 additions and 4 deletions

View File

@ -856,16 +856,16 @@ static void SendTxData(void)
#elif defined(STS_O5)
AppData.Buffer[i++] = (uint8_t)(oo_data.state_sensor1_on_off)&0xff;
#elif defined(YUNHORN_STS_R0_ENABLED)
AppData.Buffer[i++] = (uint8_t)(0x06)&0xff; //#length of following bytes
#elif defined(YUNHORN_STS_R0_ENABLED) // TOF_1 & TOF_2 for STS_R1D
AppData.Buffer[i++] = (uint8_t)(0x04)&0xff; //#length of following bytes
AppData.Buffer[i++] = (uint8_t)(r0_data.distance_mm >>8)&0xff; //#05
AppData.Buffer[i++] = (uint8_t)(r0_data.distance_mm)&0xff; //#06
AppData.Buffer[i++] = (uint8_t)(r0_data.distance1_mm >>8)&0xff; //#07
AppData.Buffer[i++] = (uint8_t)(r0_data.distance1_mm)&0xff; //#08
#ifdef TOF_3
AppData.Buffer[i++] = (uint8_t)(r0_data.distance2_mm >>8)&0xff; //#09
AppData.Buffer[i++] = (uint8_t)(r0_data.distance2_mm)&0xff; //#10
#endif
#ifdef SOAP_LEVEL
AppData.Buffer[i++] = (uint8_t)(sts_soap_level_state)&0xff; //#11
#endif