Control of Differential-drive robot