turn commands improved
This commit is contained in:
parent
02a8334ebb
commit
4204b82bd6
@ -78,8 +78,10 @@ int shell_commands_init(void)
|
||||
static void *drive_turn_right_cb(const char *param)
|
||||
{
|
||||
int speed = drive_ctrl_get_speed_value();
|
||||
drive_ctrl_set_speed_left(speed);
|
||||
drive_ctrl_set_speed_right(0);
|
||||
drive_ctrl_set_speed_left(abs(speed));
|
||||
if(speed > 0)
|
||||
speed *= -1;
|
||||
drive_ctrl_set_speed_right(speed);
|
||||
|
||||
return NULL;
|
||||
}
|
||||
@ -87,8 +89,10 @@ static void *drive_turn_right_cb(const char *param)
|
||||
static void *drive_turn_left_cb(const char *param)
|
||||
{
|
||||
int speed = drive_ctrl_get_speed_value();
|
||||
drive_ctrl_set_speed_left(0);
|
||||
drive_ctrl_set_speed_right(speed);
|
||||
drive_ctrl_set_speed_right(abs(speed));
|
||||
if(speed > 0)
|
||||
speed *= -1;
|
||||
drive_ctrl_set_speed_left(speed);
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user