ROBOSTEP4期 / Mbed 2 deprecated NHK_kaida_ros0329

射出(3/29用)

Dependencies:   mbed ros_lib_kinetic

Fork of NHK_kaida_ros0322_4 by ROBOSTEP4期

main.cpp

Committer:
agari
Date:
2017-06-02
Revision:
0:f6fa58c56955
Child:
1:5dd2f53a286f

File content as of revision 0:f6fa58c56955:

#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);
    }
}