Pioneer Amigo Robots Velocity Obstacle code in ROS