Control for the Erle Robot