提交 9887839c 编写于 作者: T Tao Jiaming 提交者: lianglia-apollo

fixed bugs reported in 0824 scan, except perception

上级 a0ad9d46
......@@ -321,6 +321,7 @@ PointENU LaneInfo::GetNearestPoint(const Vec2d &point, double *distance) const {
CHECK_NOTNULL(distance);
const auto segment_box = lane_segment_kdtree_->GetNearestObject(point);
CHECK(segment_box != nullptr);
int index = segment_box->id();
Vec2d nearest_point;
*distance = segments_[index].DistanceTo(point, &nearest_point);
......
......@@ -221,6 +221,8 @@ int main(int argc, char *argv[]) {
<< end_point.y() << "," << end_heading
<< " left_width:" << left_width << " right_width:" << right_width
<< std::endl;
std::cout.unsetf(std::ios_base::fixed);
if (FLAGS_dump_lane_width) {
const auto sample_left_widthes = lane_ptr->sampled_left_width();
std::cout << "left width num: " << sample_left_widthes.size()
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册