LiDAR->GNSS/IMU 标定& 结果Check [ADS]

https://github.com/ApolloAuto/apollo/blob/master/docs/quickstart/multiple_lidar_gnss_calibration_guide.md

目的 :

统一坐标系,(外参的获取过程,后面数据融合做准备)

比如HD map online 实时创建的时候,需要把多个Lidar 对应到统一的坐标系,然后建图。

 transfer the obstacle location detected by LiDAR to the IMU coordinate system, and then to the world coordinate system

All extrinsics are from LiDAR to GNSS, which means this transformation maps the coordinates of a point defined in the LiDAR coordinate system to the coordinates of this point defined in the GNSS coordinate system.


准备:

确保IMU/GNSS 在准确的工作状态

位置误差<2cm

 atitude_std_devlongitude_std_dev and height_std_dev. The smaller the deviation, the better the calibration quality. *** We strongly recommend calibrating the sensors when deviations are smaller than 0.02.***


原理:

LIDAR 到惯导(IMU-GPS) 转换的 外参R|t (rotaion | translation)--旋转+平移

LIDAR 数据格式是 球面坐标系 Spherical coordinate system)

这段代码定义了一个名为`LidarCameraCenterDistanceExceedDynamicThreshold`的函数,它有两个输入参数:`lidar`和`camera`,分别代表激光雷达和相机对象的指针。这个函数的返回值为布尔类型,表示中心距离是否超过了动态阈值。 在函数内部,首先计算了激光雷达和相机对象中心点之间的距离,代码如下: ``` double center_distance = (lidar->GetBaseObject()->center - camera->GetBaseObject()->center).head(2).norm(); ``` 这里使用了Eigen库中的`head`和`norm`函数,将中心点之间的距离计算出来,并赋值给`center_distance`变量。 接着,定义了一个`local_distance`变量,初始值为60。然后,获取了激光雷达对象的补充信息中的点云数据,并判断该点云数据的大小是否大于0,如果大于0,则取出点云数据中的第一个点,计算该点到原点的距离,并把计算结果赋值给`local_distance`变量。代码如下: ``` double local_distance = 60; const base::PointFCloud& cloud = lidar->GetBaseObject()->lidar_supplement.cloud; if (cloud.size() > 0) { const base::PointF& pt = cloud.at(0); local_distance = std::sqrt(pt.x * pt.x + pt.y * pt.y); } ``` 接下来,根据`local_distance`变量的值计算了一个动态阈值,并将计算结果赋值给`dynamic_threshold`变量。具体计算方法为: ``` double dynamic_threshold = 5 + 0.15 * local_distance; ``` 最后,判断中心点之间的距离是否超过了动态阈值`dynamic_threshold`,如果超过了,则返回true,否则返回false。代码如下: ``` if (center_distance > dynamic_threshold) { return true; } return false; ```
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值