Zill Khan / Mbed 2 deprecated ROS_HCSR04_test

Integration of HCSR04 with Nucleo board. ROS Enabled

Dependencies:   mbed HCSR04

main.cpp

Committer:
zillkhan
Date:
2021-09-10
Revision:
1:ca82df4237eb
Parent:
0:d94848220e71
Child:
2:2bdc0f9b1a69
Child:
4:13cda079f08d

File content as of revision 1:ca82df4237eb:

#include "mbed.h"
#include <ros.h>
#include <std_msgs/Float32.h>
#include <std_msgs/String.h>
#include "SHARPIR.h"


ros::NodeHandle  nh;

std_msgs::Float32 data;
ros::Publisher sharpir("sharpir", &data);

SHARPIR Sensor(A0); 


int main() {
    float DistanceCM;
    
    nh.initNode();
    nh.advertise(sharpir);
    
    while (1) { //creates an eternal loop
    
        DistanceCM=Sensor.cm();  
        //sprintf (buffer, "%f", DistanceCM);
        
        data.data = DistanceCM;
        sharpir.publish( &data );
        
        nh.spinOnce();
        wait_ms(1000);
    }
}