r2maeh2/engine_control
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

turn commands improved

Browse Source
This commit is contained in:
Thomas Klaehn
2016-08-11 21:42:06 +02:00
parent 02a8334ebb
commit 4204b82bd6
1 changed files with 8 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
source/application/shell_commands.c
View File

@@ -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;
}