ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

Problem running collvoid_local_planner

asked 2013-08-01 02:31:26 -0600

ChrisEule gravatar image

updated 2013-08-01 03:45:55 -0600

Hello guys,

I tried to run the collvoid package and ran into the same problem as described here. Only difference is that I still get the warning when I'm using navfn as global planner, so I guess the problem lies in the local planner (global plan is also displayed in rviz). Does anybody know if there was an update since then to fix that problem? If not what else could be the problem here?

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2013-08-07 02:42:43 -0600

ChrisEule gravatar image

So I found out how to fix the warning "MSG to TF: Quaternion not properly normalized". But that does not influence the weird motion of my robot. It's still rotating in place. I guess there is somesthing wrong with the params in collvoid_params.yaml. That is what I have done to fix the warning.

In the package collvoid_local_planner in file ROSAgent.cpp there is a function setAgentParams(). In that function the orientation will is calculated by tf::getYaw() which calls the method quaternionMsgToTF where the warning will be printed. So I normalized the quaternion myself in setAgentParams():


yaw = tf::getYaw(agent->base_odom_.pose.pose.orientation);


tf::Quaternion quat(agent->base_odom_.pose.pose.orientation.x, agent->base_odom_.pose.pose.orientation.y, agent->base_odom_.pose.pose.orientation.z, agent->base_odom_.pose.pose.orientation.w);

quat = quat.normalize();

yaw = tf::getYaw(quat);

edit flag offensive delete link more


Would you mind sharing the source code of collvoid package? Because the original address is fail(rosws merge and I cannot download it. Thank you

bbbExtremly gravatar image bbbExtremly  ( 2014-01-11 20:10:12 -0600 )edit

Question Tools

1 follower


Asked: 2013-08-01 02:31:26 -0600

Seen: 827 times

Last updated: Aug 07 '13