|
|
|
@ -9,9 +9,9 @@ |
|
|
|
#include "msp_zhr29_laser_sensor.h" |
|
|
|
|
|
|
|
|
|
|
|
int32_t* g_zhr29_200_laser_sensor_1; |
|
|
|
int32_t* g_zhr29_200_laser_sensor_2; |
|
|
|
int32_t* g_zhr29_200_laser_sensor_3; |
|
|
|
int32_t g_zhr29_200_laser_sensor_1; |
|
|
|
int32_t g_zhr29_200_laser_sensor_2; |
|
|
|
int32_t g_zhr29_200_laser_sensor_3; |
|
|
|
|
|
|
|
static struct UARTHandler *zhr29_200_laser_sensor; |
|
|
|
static DispacherController *laser_sensor_dispacherController; |
|
|
|
@ -88,10 +88,10 @@ void decode_laser_sensor(uint8_t *buffer, uint16_t length) |
|
|
|
{ |
|
|
|
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; |
|
|
|
if(*g_zhr29_200_laser_sensor_1 <= 0) |
|
|
|
g_zhr29_200_laser_sensor_1 = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15840; |
|
|
|
if(g_zhr29_200_laser_sensor_1 <= 0) |
|
|
|
{ |
|
|
|
*g_zhr29_200_laser_sensor_1 = 0; |
|
|
|
g_zhr29_200_laser_sensor_1 = 0; |
|
|
|
} |
|
|
|
// 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)) |
|
|
|
{ |
|
|
|
*g_zhr29_200_laser_sensor_2 = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15850; |
|
|
|
if(*g_zhr29_200_laser_sensor_2 <= 0) |
|
|
|
g_zhr29_200_laser_sensor_2 = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15850; |
|
|
|
if(g_zhr29_200_laser_sensor_2 <= 0) |
|
|
|
{ |
|
|
|
*g_zhr29_200_laser_sensor_2 = 0; |
|
|
|
g_zhr29_200_laser_sensor_2 = 0; |
|
|
|
} |
|
|
|
// 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)) |
|
|
|
{ |
|
|
|
*g_zhr29_200_laser_sensor_3 = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15880; |
|
|
|
if(*g_zhr29_200_laser_sensor_3 <= 0) |
|
|
|
g_zhr29_200_laser_sensor_3 = ((buffer[3] << 24) | (buffer[4] << 16) | (buffer[5] << 8) | buffer[6]) / 10 - 15880; |
|
|
|
if(g_zhr29_200_laser_sensor_3 <= 0) |
|
|
|
{ |
|
|
|
*g_zhr29_200_laser_sensor_3 = 0; |
|
|
|
g_zhr29_200_laser_sensor_3 = 0; |
|
|
|
} |
|
|
|
// if(*g_zhr29_200_laser_sensor_3 >= 280)
|
|
|
|
// {
|
|
|
|
|