The source project of this merge request has been removed.
Apply backward waypoints to waypoint_replanner
Fixed bug
Fixed functions calculating the posture of waypoints in waypoint_replanner.
Related issue is #8 (closed) .
Description of the bug
In functions for resampling waypoints in straight path, a positive direction is output regardless of the direction of the original waypoints. (The curve path is already supported.)
Expected behavior
The posture of each waypoint should be almost the same as the posture of the vehicle as it passes through each waypoint.
Actual behavior
When backward waypoints is input in the resample mode, the posture may be reversed at a specific waypoint.