From 016c5b01c8e2d4513b333d32b0e0689e985e6776 Mon Sep 17 00:00:00 2001 From: _Luc_ Date: Fri, 22 May 2015 19:24:24 +0200 Subject: [PATCH] Change sign of xx in command-new-1d.cpp to make xx>0 <=> backward --- src/commande-new-1d.cpp | 8 +++----- 1 file changed, 3 insertions(+), 5 deletions(-) diff --git a/src/commande-new-1d.cpp b/src/commande-new-1d.cpp index 41bd6b1..7c770c5 100644 --- a/src/commande-new-1d.cpp +++ b/src/commande-new-1d.cpp @@ -17,8 +17,8 @@ class Run private: float xx, yy, dz; - // xx > 0 : forward - // xx < 0 : backward + // xx < 0 : forward + // xx > 0 : backward // yy > 0 : right // yy < 0 : left @@ -56,12 +56,10 @@ class Run if (fabs(yy) > fabs(xx) && fabs(yy) > y_dev_min) { mvt->linear.y = yy * plan_vel; - mvt->linear.x = 0.; } else if (fabs(xx) > x_dev_min) { - mvt->linear.x = xx * plan_vel; - mvt->linear.y = 0.; + mvt->linear.x = - xx * plan_vel; } assert(mvt->linear.x == 0. || mvt->linear.y == 0.);