Removed simple_motion params from level_two
Renamed vfh_move -> move_goal
Converted old pursuit concurrence to vfh use
Sample approach with vfh concurrence
New vfh debug topic
Use action goal velocity if it isn't 0
Deleted DriveToPoint: replaced by vfh server