from principle of robot motion, chap 2.