rover_planning_2.py

Forgot to commit. here it is
mazegen2

same deal