Rover_planning.py changes

Should get script better oriented for implementation of the "big finish"