Reversed the plan vector

Reversed the plan vector so the local planner finds out how to reach the goal
Create the vector reversed instead of reverse it after
Merge pull request #162 from martimorta/hydro-devel

Reversed the resulting plan vector in global_planner