Dependencies: mbed ros_lib_kinetic
Fork of
NHK_kaida_ros0322_4
by 
ROBOSTEP4期
Diff: main.cpp
- Revision:
- 0:f6fa58c56955
- Child:
- 1:5dd2f53a286f
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Fri Jun 02 14:34:33 2017 +0000
@@ -0,0 +1,22 @@
+#include <mbed.h>
+#include <ros.h>
+#include <std_msgs/String.h>
+#include <geometry_msgs/PoseStamped.h>
+
+ros::NodeHandle nh;
+geometry_msgs::Pose pose;
+void messageCallback(const geometry_msgs::PoseStamped & msg){
+ pose=msg.pose;
+ printf("I GOT [%f],[%f],[%f]",pose.position.x,pose.position.y,pose.position.z);
+ }
+
+
+int main(int argc, char **argv){
+ nh.initNode();
+ ros::NodeHandle nh;
+ ros::Subscriber<geometry_msgs::PoseStamped> sub("lrf_pose",&messageCallback);
+ while(1){
+ nh.spinOnce();
+ wait_ms(1000);
+ }
+}
\ No newline at end of file