提交 c24b5bc9 编写于 作者: H HongyiSun 提交者: Calvin Miao

Update discretized_trajectory.cc

上级 024caf5a
......@@ -69,7 +69,8 @@ size_t DiscretizedTrajectory::QueryLowerBoundPoint(
if (relative_time >= back().relative_time()) {
return size() - 1;
}
auto func = [&epsilon](const TrajectoryPoint& tp, const double relative_time) {
auto func = [&epsilon](const TrajectoryPoint& tp,
const double relative_time) {
return tp.relative_time() + epsilon < relative_time;
};
auto it_lower = std::lower_bound(begin(), end(), relative_time, func);
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册