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.);