adds test in commande-new-1d

This commit is contained in:
Louis-Guillaume DUBOIS 2015-05-22 17:20:19 +02:00
parent 49dd9208dd
commit f2777c5d98

View file

@ -3,6 +3,7 @@
#include <locale.h> #include <locale.h>
#include <limits> #include <limits>
#include <math.h> #include <math.h>
#include <assert.h>
#include <pcl_ros/point_cloud.h> #include <pcl_ros/point_cloud.h>
#include <pcl/point_types.h> #include <pcl/point_types.h>
@ -60,7 +61,8 @@ class Run
{ {
mvt->linear.x = xx * plan_vel; mvt->linear.x = xx * plan_vel;
} }
assert( !(mvt->linear.x > 0. && mvt->linear.y > 0.) );
pub.publish(mvt); pub.publish(mvt);
ROS_INFO("cmd published"); ROS_INFO("cmd published");
}//end publish }//end publish