lidar、深度相机位置标定方法

lidar、深度相机位置标定方法

![]()

如图所示, O1、O2为IMU的传感器或者旋转平台定义的坐标系统,O1经过T2 变换到O2;S1、S2为深度相机或激光lidar的坐标系,S1经过T1 变换到S2;其中T1为寻找两次观测同名点解算得到,T2为IMU的传感器,或者编码器测量得到。

原理

首先根据几何关系很容易得到一下四个公式:

![]()

将(3)(4)代入(2)中,再将(1)代入得到: ![]() 所以重点是如何求解方程(5)中的X,这个问题可看成是求解最小二乘问题:

![]()

求解求使误差平方和达到极小的X。当然这个最小二乘问题也是比较容易求解的,我们可以做如下转化:

![]()

所以AY=0就属于齐次坐标的最小二乘问题,对A做SVD分解,就可以的得到Y。

代码(略)

声明:该文章系转载,转载该文章的目的在于更广泛的传递信息,并不代表本网站赞同其观点,文章内容仅供参考。

本站是一个个人学习和交流平台,网站上部分文章为网站管理员和网友从相关媒体转载而来,并不用于任何商业目的,内容为作者个人观点, 并不代表本网站赞同其观点和对其真实性负责。

我们已经尽可能的对作者和来源进行了通告,但是可能由于能力有限或疏忽,导致作者和来源有误,亦可能您并不期望您的作品在我们的网站上发布。我们为这些问题向您致歉,如果您在我站上发现此类问题,请及时联系我们,我们将根据您的要求,立即更正或者删除有关内容。本站拥有对此声明的最终解释权。