Maneuver.FollowTrajectory: If time will be disregarded, then use followpath and not this maneuver.
Maneuver.FollowTrajectory: Fixed a parameter.
Cleaned up here and there.
Maneuver.FollowTrajectory: Simplifying and added function to compute travel speed.
Maneuver.FollowTrajectory: Using the speed function in one more case.
Maneuver.FollowTrajectory: Time difference between two points just cannot be 0.
Maneuver.FollowTrajectory: Enabling by default. Increasing maximum speed.
DUNE.Maneuvers.FollowTrajectory: Base class's method init may fail and lead to maneuver interruption.
Trying to fix bug in displacement.
Maneuver.FollowTrajectory: Changed init function to return boolean in case of non feasibility. Separated possible reasons for failure.
Maneuver.FollowTrajectory: Waypoint displacement was not being correctly performed.