[发明专利]基于双目相机和惯性导航的结构光扫描测量方法及系统

权利要求书

1.一种基于双目相机和惯性导航的结构光扫描测量方法，其特征在于，包括：

对双目相机、平面靶标、结构光传感器、惯性导航分别建立坐标系，获得相机坐标系、平面靶标坐标系、光平面坐标系、惯性导航坐标系；

通过所述结构光传感器对被测物进行连续扫描，获取所述被测物在所述光平面坐标系下的多组轮廓数据点；

针对每组轮廓数据点，将所述每组轮廓数据点经所述平面靶标坐标系变换至所述相机坐标系下，获得第一三维坐标；将所述每组轮廓数据点经所述惯性导航坐标系变换至所述相机坐标系下，获得第二三维坐标；

通过卡尔曼滤波器对所述第一三维坐标和所述第二三维坐标进行数据优化融合，获得单次扫描被测物轮廓数据；

对各所述单次扫描被测物轮廓数据进行整体拟合，获得所述被测物的整体拟合轮廓数据，完成结构光扫描测量；

所述通过所述结构光传感器对被测物进行连续扫描，获取所述被测物在所述光平面坐标系下的多组轮廓数据点，之前还包括：

将所述双目相机和所述惯性导航进行联合标定，获取所述相机坐标系与所述惯性导航坐标系间的第一变换矩阵、相机内参、相机外参；

根据所述相机内参和所述相机外参固定所述双目相机、所述平面靶标、所述结构光传感器、所述惯性导航的位置；

根据所述位置分别获取所述相机坐标系与所述平面靶标坐标系间的第二变换矩阵、所述相机坐标系与所述光平面坐标系间的第三变换矩阵、所述惯性导航坐标系与所述光平面坐标系间的第五变换矩阵；

通过所述第二变换矩阵和所述第三变换矩阵获取所述平面靶标坐标系与光平面坐标系之间的第四变换矩阵；

所述第二变换矩阵的获取方法，具体包括：

在平面靶标上设置五个圆形标志点，获取所述平面靶标坐标系下的所述圆形标志点三维坐标，并对所述圆形标志点进行排序；

根据所述位置建立图像像素坐标系；

通过所述双目相机对所述平面靶标进行拍摄，提取所述双目相机中包含平面靶标信息的区域，对经所述排序后的每个所述圆形标志点轮廓进行像素提取，获取所述图像像素坐标系下的标志点质心像素坐标；

根据所述标志点质心像素坐标，利用三角测量法获取所述相机坐标系下的所述圆形标志点三维坐标；

根据所述平面靶标坐标系下的所述圆形标志点三维坐标和所述相机坐标系下的所述圆形标志点三维坐标，获取所述第二变换矩阵；

所述根据所述相机内参和所述相机外参固定所述双目相机、所述平面靶标、所述结构光传感器、所述惯性导航的位置具体包括：

使所述双目相机相对所述结构光传感器固定放置；

将所述平面靶标和所述惯性导航均固定于所述结构光传感器上；

所述平面靶标与所述结构光传感器通过特制连接件固定连接。

2.根据权利要求1所述的基于双目相机和惯性导航的结构光扫描测量方法，其特征在于，所述将所述双目相机和所述惯性导航进行联合标定，获取所述相机坐标系与所述惯性导航坐标系间的第一变换矩阵、相机内参、相机外参，具体包括：

固定所述双目相机和所述惯性导航间的相对位置，通过双目相机对不同位姿下的高精度棋盘格标定板进行拍摄，获取标定图片，根据所述标定图片确定所述相机坐标系与所述惯性导航坐标系间的第一变换矩阵、相机内参、相机外参。

3.根据权利要求1所述的基于双目相机和惯性导航的结构光扫描测量方法，其特征在于，所述五个圆形标志点在所述平面靶标上呈T字状分布，且每相邻两个所述圆形标志点之间间距相同。

4.根据权利要求1所述的基于双目相机和惯性导航的结构光扫描测量方法，其特征在于，所述第三变换矩阵的获取方法具体包括：

将立体靶标作为所述被测物置于所述结构光传感器下，使所述结构光传感器的光条与所述立体靶标的棱线相交于非共线的四点上，获取所述光平面坐标系下的所述立体靶标四点三维坐标；

通过所述双目相机对所述立体靶标和所述结构光传感器进行拍摄，提取所述双目相机中包含立体靶标和光条信息的区域，对所述立体靶标四点进行像素提取，获取所述相机坐标系下的所述立体靶标四点像素坐标；

根据所述立体靶标四点像素坐标，利用三角测量法获取所述相机坐标系下的所述立体靶标四点三维坐标；

根据所述光平面坐标系下的所述立体靶标四点三维坐标和所述相机坐标系下的所述立体靶标四点三维坐标，获取所述第三变换矩阵。