Fixed the distance that the robot considers itself at the current goal, so that it can send the next goal. Also some reorganizing.
Fixed the distance that the robot considers itself at the current goal, so that it can send the next goal. Also some reorganizing.

beanstalk42/ROS.NET,nickkazepis/ROS.NET,nickkazepis/ROS.NET,nickkazepis/ROS.NET,uml-robotics/ROS.NET