double timestamp = apollo::cyber::Clock::NowInSeconds()
时间: 2024-05-27 16:07:17 浏览: 286
`apollo::cyber::Clock::NowInSeconds()`函数返回当前时间戳,单位是秒,类型为`double`。因此,`double timestamp = apollo::cyber::Clock::NowInSeconds();`会将当前时间戳赋值给`timestamp`变量。
引用: `std::vector<routing::LaneWaypoint> future_route_waypoints_; ` 定义了一个`std::vector`类型的名为`future_route_waypoints_`的变量,其中存储了`routing::LaneWaypoint`类型的元素。[^1]
引用: `SensorInfo`是一个结构体类型,存储了传感器的信息,包括名称,类型,方向和帧ID。其中`Reset()`函数用于重置结构体变量的值。这个结构体类型位于`modules/perception/base/sensor_meta.h`文件中。[^2]
相关问题
std::vector<base::ObjectPtr> radar_objects; if (!radar_perception_->Perceive(corrected_obstacles, options, &radar_objects)) { out_message->error_code_ = apollo::common::ErrorCode::PERCEPTION_ERROR_PROCESS; AERROR << "RadarDetector Proc failed."; return true; } out_message->frame_.reset(new base::Frame()); out_message->frame_->sensor_info = radar_info_; out_message->frame_->timestamp = timestamp; out_message->frame_->sensor2world_pose = radar_trans; out_message->frame_->objects = radar_objects; for (auto object_ptr : radar_objects) { object_ptr->local_center = radar2novatel_trans * radar_trans.inverse()* object_ptr->center; AINFO << "Local center point: " << object_ptr->local_center.transpose(); } return true; const double end_timestamp = Clock::NowInSeconds(); const double end_latency = (end_timestamp - in_message->header().timestamp_sec()) * 1e3; AINFO << "FRAME_STATISTICS:Radar:End:msg_time[" << in_message->header().timestamp_sec() << "]:cur_time[" << end_timestamp << "]:cur_latency[" << end_latency << "]"; PERF_BLOCK_END_WITH_INDICATOR(radar_info_.name, "radar_perception"); return true; }
这段代码是一个函数,它处理雷达感知的结果。首先,它将感知到的障碍物数据存储在一个名为radar_objects的vector中。
然后,它创建一个新的base::Frame对象,并将雷达传感器的信息、时间戳、传感器到世界坐标系的变换矩阵和雷达障碍物数据保存在该对象中。
接下来,通过对radar_objects中的每个对象进行循环遍历,计算每个对象的本地中心点坐标,并将结果保存在对象的local_center属性中。
最后,计算处理完成的时间戳和延迟,并输出相关的日志信息。
函数最后返回true表示处理成功。
阅读全文