Improve robot motion model

to enable drifting around corners and control via mouse to work better.