aaa

Dependencies:   mbed BNO055_fusion Adafruit_GFX ros_lib_kinetic

Revision:
11:375d474b8522
Parent:
10:3b47050b1652
--- a/myRos.cpp	Fri Mar 22 12:29:18 2019 +0000
+++ b/myRos.cpp	Fri Aug 30 07:53:21 2019 +0000
@@ -51,11 +51,6 @@
  
     initial_pose = get_initial_pose().get_point_msgs();
     initial_pose_pub.publish(&initial_pose);
-
-//    Vec3f tmp = get_initial_pose();
-//    tmp.z(-tmp.z());
-//    initial_pose = tmp.get_point_msgs();
-//    initial_pose_pub.publish(&initial_pose);
 }
 
 void My_Ros::pose_publisher(){
@@ -70,11 +65,6 @@
 
     pose = get_pose().get_point_msgs();
     pose_pub.publish(&pose);
-
-//    Vec3f tmp = get_pose();
-//    tmp.z(-tmp.z());
-//    pose = tmp.get_point_msgs();
-//    pose_pub.publish(&pose);
 }
 
 //This function run every 10 msec at main