sdu_grassbots_2014: wpt_id is now correctly copied to the wpt_nav_status topic.
sdu_grassbots_2014: Added show_route_plan.py utility, corrected copyright.