Optimize pure pursuit computation time

This commit is contained in:
Prateek Machiraju 2019-07-01 11:06:41 -04:00 committed by GitHub
parent 3f0dfe6bba
commit 11b45e96f0
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23

View File

@ -47,7 +47,7 @@ Pose2d PurePursuitTracker::CalculateLookaheadPose(const TimedIterator<Pose2dWith
} }
auto lookahead_pose_by_distance = iterator.CurrentState().state.State().Pose(); auto lookahead_pose_by_distance = iterator.CurrentState().state.State().Pose();
auto previewed_time = units::second_t(0.0); auto previewed_time = lookahead_time_;
// Run the loop until a distance that is greater than the minimum lookahead distance is found or until // Run the loop until a distance that is greater than the minimum lookahead distance is found or until
// we run out of "trajectory" to search. If this happens, we will simply extend the end of the trajectory. // we run out of "trajectory" to search. If this happens, we will simply extend the end of the trajectory.