OdometryROS: don't publish odom if velocity is null too when publish_null_when_lost is false

This commit is contained in:
matlabbe
2018-03-31 15:44:53 -04:00
parent 6ec6387fc6
commit dc29b74111
+4 -1
View File
@@ -527,7 +527,10 @@ void OdometryROS::processData(const SensorData & data, const ros::Time & stamp)
odom.twist.covariance.at(35) = setTwist?info.reg.covariance.at<double>(5,5):BAD_COVARIANCE; // yawyaw odom.twist.covariance.at(35) = setTwist?info.reg.covariance.at<double>(5,5):BAD_COVARIANCE; // yawyaw
//publish the message //publish the message
odomPub_.publish(odom); if(setTwist || publishNullWhenLost_)
{
odomPub_.publish(odom);
}
} }
// local map / reference frame // local map / reference frame