Zill Khan / ROS_SharpIR_test

Testing sensor

main.cpp

Committer:
zillkhan
Date:
2021-09-28
Revision:
3:1be742e63b57
Parent:
2:13cda079f08d

File content as of revision 3:1be742e63b57:

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