Change levels of logs

And make messages more consistent with prepending the joint names within
brackets.

Author: Olav de Haas

march_hardware/src/EtherCAT/EthercatMaster.cpp

@@ -183,7 +183,7 @@ int EthercatMaster::receiveProcessData()
   int wkc =  ec_receive_processdata(EC_TIMEOUTRET);
   if (wkc < this->expectedWKC)
   {
-    ROS_WARN("Working counter lower than expected. EtherCAT connection may not be optimal");
+    ROS_WARN_THROTTLE(1, "Working counter lower than expected. EtherCAT connection may not be optimal");
   }
   return wkc;
 }

march_hardware/src/IMotionCube.cpp

@@ -461,23 +461,23 @@ std::string IMotionCube::parseDetailedError(uint16 detailedError)
 
 bool IMotionCube::goToTargetState(IMotionCubeTargetState targetState)
 {
-  ROS_INFO("\tTry to go to '%s'", targetState.getDescription().c_str());
+  ROS_DEBUG("\tTry to go to '%s'", targetState.getDescription().c_str());
   while (!targetState.isReached(this->getStatusWord()))
   {
     this->setControlWord(targetState.getControlWord());
-    ROS_INFO_THROTTLE(0.5, "\tWaiting for '%s': %s", targetState.getDescription().c_str(),
+    ROS_DEBUG_THROTTLE(0.5, "\tWaiting for '%s': %s", targetState.getDescription().c_str(),
                       std::bitset<16>(this->getStatusWord()).to_string().c_str());
     if (targetState.getState() == IMotionCubeTargetState::OPERATION_ENABLED.getState() &&
         this->getState(this->getStatusWord()) == IMCState::fault)
     {
-      ROS_FATAL("IMotionCube went to fault state while attempting to go to %s. Shutting down.",
+      ROS_FATAL("IMotionCube went to fault state while attempting to go to '%s'. Shutting down.",
                 targetState.getDescription().c_str());
       ROS_FATAL("Detailed Error: %s", this->parseDetailedError(this->getDetailedError()).c_str());
       ROS_FATAL("Motion Error: %s", this->parseMotionError(this->getMotionError()).c_str());
       throw std::domain_error("IMC to fault state");
     }
   }
-  ROS_INFO("\tReached '%s'!", targetState.getDescription().c_str());
+  ROS_DEBUG("\tReached '%s'!", targetState.getDescription().c_str());
 }
 
 bool IMotionCube::goToOperationEnabled()

march_hardware/src/Joint.cpp

@@ -25,13 +25,13 @@ void Joint::prepareActuation()
                  this->name.c_str(), this->getActuationMode().toString().c_str());
   if (this->allowActuation)
   {
-    ROS_INFO("Preparing joint %s for actuation", this->name.c_str());
+    ROS_INFO("[%s] Preparing for actuation", this->name.c_str());
     this->iMotionCube.goToOperationEnabled();
-    ROS_INFO("\tJoint %s successfully prepared for actuation", this->name.c_str());
+    ROS_INFO("[%s] Successfully prepared for actuation", this->name.c_str());
   }
   else
   {
-    ROS_ERROR("Trying to prepare joint %s for actuation while it is not "
+    ROS_ERROR("[%s] Trying to prepare for actuation while it is not "
               "allowed to actuate",
               this->name.c_str());
   }
@@ -44,9 +44,9 @@ void Joint::resetIMotionCube()
 
 void Joint::actuateRad(float targetPositionRad)
 {
-  ROS_ASSERT_MSG(this->allowActuation, "Joint %s is not allowed to actuate, "
-                                       "yet its actuate method has been "
-                                       "called.",
+  ROS_ASSERT_MSG(this->allowActuation,
+                 "Joint %s is not allowed to actuate, "
+                 "yet its actuate method has been called",
                  this->name.c_str());
   // TODO(BaCo) check that the position is allowed and does not exceed (torque)
   // limits.
@@ -57,17 +57,17 @@ float Joint::getAngleRad()
 {
   if (!hasIMotionCube())
   {
-    ROS_WARN("Joint %s has no iMotionCube", this->name.c_str());
+    ROS_WARN("[%s] Has no iMotionCube", this->name.c_str());
     return -1;
   }
   return this->iMotionCube.getAngleRad();
 }
 
 void Joint::actuateTorque(int targetTorque)
 {
-  ROS_ASSERT_MSG(this->allowActuation, "Joint %s is not allowed to actuate, "
-                                       "yet its actuate method has been "
-                                       "called.",
+  ROS_ASSERT_MSG(this->allowActuation,
+                 "Joint %s is not allowed to actuate, "
+                 "yet its actuate method has been called",
                  this->name.c_str());
   this->iMotionCube.actuateTorque(targetTorque);
 }
@@ -76,7 +76,7 @@ float Joint::getTorque()
 {
   if (!hasIMotionCube())
   {
-    ROS_WARN("Joint %s has no iMotionCube", this->name.c_str());
+    ROS_WARN("[%s] Has no iMotionCube", this->name.c_str());
     return -1;
   }
   return this->iMotionCube.getTorque();
@@ -86,7 +86,7 @@ int Joint::getAngleIU()
 {
   if (!hasIMotionCube())
   {
-    ROS_WARN("Joint %s has no iMotionCube", this->name.c_str());
+    ROS_WARN("[%s] Has no iMotionCube", this->name.c_str());
     return -1;
   }
   return this->iMotionCube.getAngleIU();
@@ -96,7 +96,7 @@ float Joint::getTemperature()
 {
   if (!hasTemperatureGES())
   {
-    ROS_WARN("Joint %s has no temperature sensor", this->name.c_str());
+    ROS_WARN("[%s] Has no temperature sensor", this->name.c_str());
     return -1;
   }
   return this->temperatureGES.getTemperature();

march_hardware/test/TestJoint.cpp

@@ -45,14 +45,16 @@ TEST_F(JointDeathTest, ActuateDisableActuation)
     joint.setAllowActuation(false);
     joint.setName("actuate_false");
     ASSERT_FALSE(joint.canActuate());
-    ASSERT_DEATH(joint.actuateRad(0.3), "Joint actuate_false is not allowed to actuate, yet its actuate method has been called.");
+    ASSERT_DEATH(joint.actuateRad(0.3), "Joint actuate_false is not allowed to actuate, "
+                                        "yet its actuate method has been called");
 }
 
 TEST_F(JointTest, NoActuationMode)
 {
   march4cpp::Joint joint;
   joint.setName("test_joint");
-  ASSERT_DEATH(joint.actuateRad(1), "Joint test_joint is not allowed to actuate, yet its actuate method has been called.");
+  ASSERT_DEATH(joint.actuateRad(1), "Joint test_joint is not allowed to actuate, "
+                                    "yet its actuate method has been called");
 }
 
 TEST_F(JointTest, ChangeActuationModeToUnknown)

march_hardware_interface/launch/testjoint_linear.launch

@@ -10,7 +10,7 @@
             name="record"
             type="record"
             output="screen"
-            args="-o /home/projectmarch/Documents/logs/Testjoint.bag /march/controller/trajectory/state /clock"
+            args="-q -o /home/projectmarch/Documents/logs/Testjoint.bag /march/controller/trajectory/state /clock"
     />
 
     <node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher"/>

march_hardware_interface/src/march_hardware_interface.cpp

@@ -86,7 +86,10 @@ void MarchHardwareInterface::init()
   {
     SoftJointLimits soft_limits;
     getSoftJointLimits(model.getJoint(joint_names_[i]), soft_limits);
-    ROS_INFO("%s soft_limits_ (%f, %f).", joint_names_[i].c_str(), soft_limits.min_position, soft_limits.max_position);
+    ROS_DEBUG("[%s] Soft limits set to (%f, %f)",
+              joint_names_[i].c_str(),
+              soft_limits.min_position,
+              soft_limits.max_position);
     soft_limits_[i] = soft_limits;
   }
 
@@ -96,7 +99,7 @@ void MarchHardwareInterface::init()
   this->read();
   for (int i = 0; i < num_joints_; ++i)
   {
-    ROS_INFO("Joint %s: first read position: %f", joint_names_[i].c_str(), joint_position_[i]);
+    ROS_DEBUG("[%s] First read position: %f", joint_names_[i].c_str(), joint_position_[i]);
   }
 
   // Create march_pdb_state interface
@@ -129,7 +132,7 @@ void MarchHardwareInterface::init()
       {
         marchRobot.getPowerDistributionBoard()->getHighVoltage().setNetOnOff(true, netNumber);
         usleep(100000);
-        ROS_INFO_THROTTLE(1, "Waiting on high voltage for joint %s", joint_names_[i].c_str());
+        ROS_INFO_THROTTLE(1, "[%s] Waiting on high voltage", joint_names_[i].c_str());
       }
     }
   }
@@ -334,7 +337,7 @@ void MarchHardwareInterface::resetIMotionCubesUntilTheyWork()
       march4cpp::Joint joint = marchRobot.getJoint(joint_names_[i]);
       if (joint.getAngleIU() == 0)
       {
-        ROS_ERROR("Joint %s failed (encoder reset)", joint_names_[i].c_str());
+        ROS_ERROR("[%s] Failed (encoder reset)", joint_names_[i].c_str());
         encoderSetCorrectly = false;
       }
     }

march_temperature_sensor_controller/src/march_temperature_sensor_controller.cpp

@@ -10,7 +10,9 @@ bool MarchTemperatureSensorController::init(march_hardware_interface::MarchTempe
   // get all temperature_sensors from the hardware interface
   const std::vector<std::string>& temperature_sensor_names = hw->getNames();
   for (unsigned i = 0; i < temperature_sensor_names.size(); i++)
-    ROS_INFO("Got temperature sensor %s", temperature_sensor_names[i].c_str());
+  {
+    ROS_DEBUG("Got temperature sensor %s", temperature_sensor_names[i].c_str());
+  }
 
   // get publishing period
   if (!controller_nh.getParam("publish_rate", publish_rate_))