Advertisement
Ruslan_nig

ros_ultrasonic_1

May 30th, 2021
1,075
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. #include <ros.h>
  2. #include <std_msgs/String.h>
  3. #include <std_msgs/Int32.h>
  4. ros:: NodeHandle nh;
  5. std_msgs::Int32 str_msg;
  6. //std_msgs::String str_msg;
  7. ros::Publisher chatter("chatter",&str_msg);
  8. char hello[13]="hello world!";
  9. #include <NewPing.h>
  10. #define PIN_TRIG 12
  11. #define PIN_ECHO 11
  12. #define MAX_DISTANCE 200
  13. NewPing sonar(PIN_TRIG, PIN_ECHO, MAX_DISTANCE);
  14. void setup() {
  15.   nh.initNode();
  16.   nh.advertise(chatter);
  17.  // Serial.begin(9600);
  18.  
  19. }
  20.  
  21. void loop() {
  22.   //str_msg.data=hello;
  23.   //str_msg.data = 15;
  24.   chatter.publish(&str_msg);
  25.  
  26.   nh.spinOnce();
  27. delay(50);
  28.  
  29. unsigned int distance = sonar.ping_cm();
  30. char distanceString[16];
  31. itoa(distance,distanceString,10);
  32. str_msg.data = distance;
  33.  
  34. //Serial.print(distance);
  35. //Serial.println("  cm");
  36. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement