|
|
@ -88,10 +88,10 @@ void decode_laser_sensor(uint8_t *buffer, uint16_t length) |
|
|
{ |
|
|
{ |
|
|
if((buffer[0] == 0x01) && (buffer[1] == 0x04) && (buffer[2] == 0x04)) |
|
|
if((buffer[0] == 0x01) && (buffer[1] == 0x04) && (buffer[2] == 0x04)) |
|
|
{ |
|
|
{ |
|
|
g_zhr29_200_laser_sensor_1 = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15840; |
|
|
GV.ZHR29_200_measure_results.laser_sensor_1_measure_distance = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15840; |
|
|
if(g_zhr29_200_laser_sensor_1 <= 0) |
|
|
if(GV.ZHR29_200_measure_results.laser_sensor_1_measure_distance <= 0) |
|
|
{ |
|
|
{ |
|
|
g_zhr29_200_laser_sensor_1 = 0; |
|
|
GV.ZHR29_200_measure_results.laser_sensor_1_measure_distance = 0; |
|
|
} |
|
|
} |
|
|
// if(*g_zhr29_200_laser_sensor_1 >= 280)
|
|
|
// if(*g_zhr29_200_laser_sensor_1 >= 280)
|
|
|
// {
|
|
|
// {
|
|
|
@ -104,10 +104,10 @@ void decode_laser_sensor(uint8_t *buffer, uint16_t length) |
|
|
} |
|
|
} |
|
|
else if((buffer[0] == 0x02) && (buffer[1] == 0x04) && (buffer[2] == 0x04)) |
|
|
else if((buffer[0] == 0x02) && (buffer[1] == 0x04) && (buffer[2] == 0x04)) |
|
|
{ |
|
|
{ |
|
|
g_zhr29_200_laser_sensor_2 = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15850; |
|
|
GV.ZHR29_200_measure_results.laser_sensor_2_measure_distance = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15850; |
|
|
if(g_zhr29_200_laser_sensor_2 <= 0) |
|
|
if(GV.ZHR29_200_measure_results.laser_sensor_2_measure_distance <= 0) |
|
|
{ |
|
|
{ |
|
|
g_zhr29_200_laser_sensor_2 = 0; |
|
|
GV.ZHR29_200_measure_results.laser_sensor_2_measure_distance = 0; |
|
|
} |
|
|
} |
|
|
// if(*g_zhr29_200_laser_sensor_2 >= 280)
|
|
|
// if(*g_zhr29_200_laser_sensor_2 >= 280)
|
|
|
// {
|
|
|
// {
|
|
|
@ -121,10 +121,10 @@ void decode_laser_sensor(uint8_t *buffer, uint16_t length) |
|
|
} |
|
|
} |
|
|
else if((buffer[0] == 0x03) && (buffer[1] == 0x04) && (buffer[2] == 0x04)) |
|
|
else if((buffer[0] == 0x03) && (buffer[1] == 0x04) && (buffer[2] == 0x04)) |
|
|
{ |
|
|
{ |
|
|
g_zhr29_200_laser_sensor_3 = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15880; |
|
|
GV.ZHR29_200_measure_results.laser_sensor_3_measure_distance = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15880; |
|
|
if(g_zhr29_200_laser_sensor_3 <= 0) |
|
|
if(GV.ZHR29_200_measure_results.laser_sensor_3_measure_distance <= 0) |
|
|
{ |
|
|
{ |
|
|
g_zhr29_200_laser_sensor_3 = 0; |
|
|
GV.ZHR29_200_measure_results.laser_sensor_3_measure_distance = 0; |
|
|
} |
|
|
} |
|
|
// if(*g_zhr29_200_laser_sensor_3 >= 280)
|
|
|
// if(*g_zhr29_200_laser_sensor_3 >= 280)
|
|
|
// {
|
|
|
// {
|
|
|
|