lecture 5 planning for robot motion 4270236