42 {
43 if (!frame) {
44 AINFO <<
"Frame is nullptr.";
45 return false;
46 }
47 if (!(frame->hdmap_struct)) {
48 frame->hdmap_struct.reset(new base::HdmapStruct);
49 }
50 if (!hdmap_input_) {
51 AINFO <<
"Hdmap input is nullptr";
52 return false;
53 }
54 if (update_pose_) {
55 if (!
QueryPose(&(frame->lidar2world_pose))) {
56 AINFO <<
"Failed to query updated pose.";
57 }
58 }
60 point.x = frame->lidar2world_pose.translation()(0);
61 point.y = frame->lidar2world_pose.translation()(1);
62 point.z = frame->lidar2world_pose.translation()(2);
64 frame->hdmap_struct)) {
65 frame->hdmap_struct->road_polygons.clear();
66 frame->hdmap_struct->road_boundary.clear();
67 frame->hdmap_struct->hole_polygons.clear();
68 frame->hdmap_struct->junction_polygons.clear();
69 AINFO <<
"Failed to get roi from hdmap.";
70 }
71 return true;
72}
bool QueryPose(Eigen::Affine3d *sensor2world_pose) const
Query the pose