From f2777c5d986537b41f33a785059da7ae2a07cb32 Mon Sep 17 00:00:00 2001
From: Louis-Guillaume DUBOIS <contact@lgdubois.fr>
Date: Fri, 22 May 2015 17:20:19 +0200
Subject: [PATCH] adds test in commande-new-1d

---
 src/commande-new-1d.cpp | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/src/commande-new-1d.cpp b/src/commande-new-1d.cpp
index ed577b4..268a767 100644
--- a/src/commande-new-1d.cpp
+++ b/src/commande-new-1d.cpp
@@ -3,6 +3,7 @@
 #include <locale.h>
 #include <limits>
 #include <math.h>
+#include <assert.h>
 
 #include <pcl_ros/point_cloud.h>
 #include <pcl/point_types.h>
@@ -60,7 +61,8 @@ class Run
       {
         mvt->linear.x = xx * plan_vel;
       }
-
+      
+      assert( !(mvt->linear.x > 0. && mvt->linear.y > 0.) );
       pub.publish(mvt);
       ROS_INFO("cmd published");
     }//end publish