diff --git a/app/by_motion.c b/app/by_motion.c index b29e6d6..49613cc 100644 --- a/app/by_motion.c +++ b/app/by_motion.c @@ -112,12 +112,12 @@ void by_motion_run(void) void by_motion_can_handle(uint16_t stdd_id, const uint8_t *data, uint8_t len) { -#define BC2D_MODEL2 +#define BC2D_MODEL1 if (0x01 == stdd_id) { #if defined(BC2D_MODEL1) - int16_t speed_m1_temp = (int16_t)data[0] | ((int16_t)data[1] << 8); - int16_t speed_m2_temp = (int16_t)data[2] | ((int16_t)data[3] << 8); + int16_t speed_m1_temp = (int16_t)(data[0] | (data[1] << 8)); + int16_t speed_m2_temp = (int16_t)(data[2] | (data[3] << 8)); by_motion_set_speed_m1(speed_m1_temp); by_motion_set_speed_m2(speed_m2_temp); #elif defined(BC2D_MODEL2)