Update mdp_planner.py
Update mdp_planner.py

quick fix for current nav bugs
bfalacerda/strands_executive,bfalacerda/strands_executive,mudrole1/strands_executive,mudrole1/strands_executive,mudrole1/strands_executive