sub test

Dependencies:   mbed ros_lib_kinetic

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