fix STS_R1D_JP two distances instead of three
This commit is contained in:
parent
516786360c
commit
fdfd9d7c22
|
@ -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
|
||||
|
|
Loading…
Reference in New Issue