sdu_grassbots_trial_2013: Work in progress, simulation in Stage is now working.