ME5621 Mobile Robot control