駿 高世 / Mbed 2 deprecated abu2019_mr1

aaa

Dependencies:   mbed BNO055_fusion Adafruit_GFX ros_lib_kinetic

Diff: myRos.cpp

Revision:
10:3b47050b1652
Parent:
8:80708bacb5b5
Child:
11:375d474b8522
--- a/myRos.cpp	Sun Jan 06 04:23:42 2019 +0000
+++ b/myRos.cpp	Fri Mar 22 12:29:18 2019 +0000
@@ -51,6 +51,11 @@
  
     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(){
@@ -62,9 +67,14 @@
         nh_.advertise(pose_pub);    
         init_flag = true;
     }
-   
+
     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