Added arduino code from the robobot drive