[发明专利]一种惯导/相机安装误差标定方法

权利要求书

1.一种惯导/相机安装误差标定方法，该方法包括如下步骤：

步骤一、系统安装及其连接方式；步骤二、转台旋转并记录数据；步骤三、构建12个未知量的方程组并计算；步骤四、输出结果；

其特征在于：所述系统安装及其连接方式，将惯导与相机安装在转台上，将标定板放置在转台附近，且处于相机的视场范围内；

步骤三、构建12个未知量的方程组并计算：

假设某空间点P由坐标系a中的坐标P_a转换为坐标系b中的坐标P_b，其过程可表示为，

公式(1)，其中P_a＝[x_a,y_a,z_a]^T为空间点P在坐标系a中的坐标；是一个平移向量，其中t_x为由坐标系a向坐标系b平移过程中x方向的平移量，t_y为由坐标系a向坐标系b平移过程中y方向的平移量，t_z为由坐标系a向坐标系b平移过程中z方向的平移量；是一个旋转矩阵，描述了从坐标系a向坐标系b的旋转过程，即坐标系a按的旋转顺序，分别旋转后，其三轴将与坐标系b平行，

在和T中的6个参数(α,β,γ,t_x,t_y,t_z)描述了坐标系a与坐标系b之间的相对位置与相对姿态关系，安装误差标定就是要把这6个参数求解出来；

令

公式(1)整理成以下形式

其中

与分别称为空间点P在坐标系a向坐标系b下的齐次坐标，中的元素由标定参数计算而来，称之为标定矩阵；

将惯导与相机安装在转台上，将标定板放置在转台附近，且处于相机的视场范围内，转台、惯导、相机、标定板四者之间的关系可写成归一化矩阵连乘的形式：

式中：

——4×4矩阵，惯导与转台之间的标定矩阵，通过光瞄与转台旋转参数方法求得，已知量；

——4×4矩阵，惯导与相机之间的标定矩阵，未知量，待求；

——4×4矩阵，相机与标定板之间的标定矩阵，通过光学测量方法求得，已知量；

——4×4矩阵，标定板与转台之间的标定矩阵，未知量；

在上面的连乘公式中，与这两个未知的4×4矩阵中由与共12个未知量表示；

将式(6)写成以下形式：

整理出3个以为变量的方程，分别表示为：

因此，得到该状态下12个未知量的3个方程；

转台旋转4次，每次都获得该状态下的3个方程，一共获得4个状态下12个未知量的12个方程，表示如下：

采用通用的矩阵分解法、最小二乘法求解以上线性方程组，得到线性方程组的解，获得与共12个未知量的值。

2.如权利要求1所述的一种惯导/相机安装误差标定方法，其特征在于，步骤二、旋转转台并记录数据：

系统安装完成后，旋转转台4次，旋转时要求保证：

1、惯导与相机之间的相对位置与相对姿态不变；

2、标定板位置保持不变，从而保证转台与标定板之间的相对位置与相对姿态不变；

3、转台的XYZ三个轴同时旋转一定的角度(三个轴旋角的大小与方向不要求一致)；

4、旋转时要求保证标定板不超出相机的视场范围；

记录4个状态下惯导与转台之间的标定矩阵相机与标定板之间的标定矩阵其中通过光瞄与转台旋转参数获得，通过高精度光学测量方法获得。

3.如权利要求1所述的一种惯导/相机安装误差标定方法，其特征在于，步骤四、输出结果，将步骤三中的作为惯导与相机之间的安装误差输出。