Sensing, vision based motion planning