-

modules/catkin_ws/src/car/src/ultrasonic/Ultrasonic.cpp

@@ -30,7 +30,11 @@ void Ultrasonic::onInit()
             while (ros::ok())
             {
                 ussDataMsg msg;
-                msg.distance = getDistance();
+                auto distance = getDistance();
+                msg.distance = distance;
+                std::cout << "\n------------------------\n"
+                          << "distance: " << distance
+                          << "\n------------------------\n\n";
                 ussData.publish(msg);
                 rate.sleep();
             }