
sub test
Dependencies: mbed ros_lib_kinetic
Diff: main.cpp
- Revision:
- 0:8b1a79d3dec1
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Wed Jun 19 11:16:04 2019 +0000 @@ -0,0 +1,23 @@ +#include "mbed.h" +#include <ros.h> +#include <std_msgs/Empty.h> + +ros::NodeHandle nh; +DigitalOut myled(LED1); + +void messageCb(const std_msgs::Empty& toggle_msg){ + myled = !myled; +} + +ros::Subscriber<std_msgs::Empty> sub("toggle_led", &messageCb); + +int main(){ + nh.getHardware()->setBaud(115200); + nh.initNode(); + nh.subscribe(sub); + + while(1){ + nh.spinOnce(); + wait_ms(1); + } +} \ No newline at end of file