sdu_grassbots_2014: Working on the route plan server, status subscription and set auto/manual should work now (not well tested yet).