sdu_weeding_trial_2013: Working on a waypoint navigation simulator to help debugging and optimizing parameters.