fix: path from waypt-goal is reversed

[Nisarg236]

the path was being reversed here:

smac_planner/src/smac_planner_hybrid.cpp

Line 601 in 19a6d5f

output_path.poses.reserve(path.size());

so now we get the reversed path in getStraightPath and when it is reversed again, it will be straight.

[renan028]

the path was being reversed here:

smac_planner/src/smac_planner_hybrid.cpp

Line 601 in 19a6d5f

output_path.poses.reserve(path.size());

so now we get the reversed path in getStraightPath and when it is reversed again, it will be straight.

I don't understand; that is reserve, not reverse

[Nisarg236]

Ah sorry, I meant the loop below that