一种采煤机摇臂惯性/视觉组合定姿装置标定方法制造方法及图纸

一种采煤机摇臂惯性/视觉组合定姿装置标定方法，将惯性测量单元与单目视觉测量单元连接，将惯性测量单元与单目视觉测量单元安装在转台上；把信息处理单元安装在转台周边；将目标特征点单元安装在转台周边，调节内环轴，使单目视觉测量单元指向目标特征点单元；惯性/视觉组合定姿装置通电工作，调节双外环轴，信息处理单元记录第一位置的各个角；保持内环轴角位置不变，调节外环轴；信息处理单元记录第二位置的各个角；信息处理单元利用视觉测量姿态和惯性测量姿态，计算误差；本发明专利技术能够利用转台作为辅助工具，解决采煤机摇臂惯性/视觉组合定姿装置标定问题，具有易于实施，提高标定效率和精度的优点。

A Calibration Method of Inertia/Vision Combination Attitude Setting Device for Shearer Rocker Arm

【技术实现步骤摘要】
一种采煤机摇臂惯性/视觉组合定姿装置标定方法
本专利技术属于采煤机定位定姿
，特别涉及一种采煤机摇臂惯性/视觉组合定姿装置标定方法。
技术介绍
自动化采煤过程中，采煤机是综采工作面落煤和装煤的主要设备，是一种高集成度综采设备。采煤机摇臂是采煤机的重要组成部分，通过测量摇臂姿态，可以实现采煤机截煤轨迹自动测量和自动控制。采煤机摇臂定姿是综采工作面自动化、远程自动控制的关键技术。现有方法主要采用基于标准六面体的标定方法，在惯性测量单元和单目视觉测量单元均安装标准六面体，利用自准直仪、基准平面镜等仪器在精密转台上测量安装误差，该方法操作复杂，对于仪器设备(如自准直仪、转台)和操作人员要求高，需要外部辅助仪器设备提供姿态信息，存在基准传递误差、仪器设备误差等误差，影响了标定效率和精度。
技术实现思路
为了解决上述现有技术的不足，本专利技术提出了一种采煤机摇臂惯性/视觉组合定姿装置标定方法，能够利用转台作为辅助工具，解决采煤机摇臂惯性/视觉组合定姿装置标定问题，具有易于实施，提高标定效率和精度的优点。为了实现上述目的，本专利技术采用了如下的技术方案：一种采煤机摇臂惯性/视觉组合定姿装置标定方法，步骤一：将惯性测量单元3通过工装与单目视觉测量单元2刚性连接，确保惯性测量单元3与单目视觉测量单元2之间不发生相对线位移和相对角位移，将刚性连接好的惯性测量单元3与单目视觉测量单元2安装在双轴转台5上。步骤二：根据信息处理单元4通讯电缆长度，把信息处理单元4安装在双轴转台5上或安装在双轴转台5周边，应确保通讯电缆长度不妨碍双轴转台5的转动。步骤三：将目标特征点单元1安装在双轴转台5周边，调节双轴转台5的转台内环轴6，使单目视觉测量单元2指向目标特征点单元1，确保单目视觉测量单元2能够对光学特征点8成像，记录双轴转台5内环角数值，后续保持内环角不变。步骤四：给惯性/视觉组合定姿装置通电，调节双轴转台5的转台外环轴7，使转台外环轴7的角度为3°～5°，标记为第一位置。步骤五：信息处理单元4记录第一位置的惯性测量俯角、仰角、航向角θ(0)，ψ(0)，γ(0)和滚动角、视觉测量俯仰角、航向角和滚动角θc(0)，ψc(0)，γc(0)。步骤六：保持转台内环轴6角位置不变，调节转台外环轴7，使转台外环轴7的角度为8°～10°，标记为第二位置。步骤七：信息处理单元4记录第二位置的惯性测量俯角、仰角、航向角和滚动角θ(1)，ψ(1)，γ(1)和视觉测量俯仰角、航向角和滚动角θc(1)，ψc(1)，γc(1)。步骤八：信息处理单元4利用视觉测量姿态和惯性测量姿态，根据计算公式计算航向安装误差Φ。进一步的，所述的目标特征点单元1由4个光学特征点组成，4个特征点共面分布，且呈正方形，目标特征点单元1安装在双轴转台5之外；单目视觉测量单元2与惯性测量单元3通过工装刚性连接好后，安装于双轴转台5上，确保目标特征点单元1的光学特征点8全部位于单目视觉测量单元2的视场范围内；单目视觉测量单元2利用单个相机拍摄目标特征点单元1的图像，利用图像上多个特征点之间的相对位置约束关系，求解特征坐标系与单目视觉测量单元体2坐标系之间的姿态关系，并将求解出的姿态传送给信息处理单元4；惯性测量单元3包含了三个单轴的加速度计和三个单轴的陀螺，加速度计测量物体在惯性测量单元3体坐标系三个轴向上的加速度信号，陀螺测量惯性测量单元3体坐标系相对于当地水平地理坐标系的角速度信号，并将角速度和加速度信号传送给信息处理单元4。进一步的，所述的信息处理单元4接收载体三轴角速度和三轴加速度信号，利用捷联惯导算法，解算惯性测量单元3相对于当地水平地理坐标系的姿态；信息处理单元4根据视觉姿态和惯性姿态，计算出惯性测量单元3体坐标系与单目视觉测量单元2体坐标系的航向安装误差；具体计算方法如下：定义图像坐标系：图像左下点为图像坐标系原点，横轴为u轴，纵轴为v轴，图像坐标系以像素数为单位；定义特征坐标系OtXtYtZt：坐标系原点Ot固连在4个目标特征点的几何中心，以4个目标特征点所在平面为YOZ，Xt轴垂直于目标特征点平面向外，Yt轴指天，Zt轴与Xt轴、Yt轴构成右手坐标系；定义单目视觉测量单元2体坐标系OcXcYcZc：坐标系原点Oc固连在相机透视投影中心，当镜头光轴指向目标特征单元1时，Xc轴正向沿镜头的光轴指向目标特征点单元1，Yc轴垂直向上，Zc轴与Xc轴、Yc轴构成右手坐标系；定义惯性测量单元3体坐标系ObXbYbZb：坐标系原点Ob固连在惯性测量单元3中心，Xb轴正向指向惯性测量单元3前方，Yb轴垂直向上，Zb轴与Xb轴、Yb轴构成右手坐标系，前上右坐标系；定义当地水平地理坐标系OnXnYnZn：北天东地理坐标；目标特征点单元1，由4个光学特征点组成，4个特征点共面分布，且呈正方形，安装在双轴转台5周边，使特征坐标系与当地水平地理坐标系OnXnYnZn的轴向重合。进一步的，惯性测量单元体坐标系ObXbYbZb与单目视觉测量单元2体坐标系OcXcYcZc的航向安装误差为Φ，有矩阵关系如下：进一步的，所述的惯性/视觉组合定姿装置开始通电工作，三轴陀螺测量惯性测量单元3体坐标系三个轴的角速度向量三轴加速度计测量惯性测量单元体坐标系三个轴向的加速度向量并将测量的角速度和加速度fb发送给信息处理单元；初始k＝0，信息处理单元4接收外部装订信息：经度λ(0)，纬度高度h(0)和初始姿态同时初始速度V＝[000]T；在时刻k，信息处理单元4首先更新惯性测量单元3体坐标系相对于当地水平地理坐标系的角速度向量其中，表示纬度值，为姿态矩阵，ωie是地球自转角速度，R为地球半径，VE和VN表示东向速度和北向速度；然后，更新四元数q＝[q0q1q2q3]T其中，ΔT表示姿态计算周期；然后，更新惯性测量单元3相对于当地水平地理坐标系的惯性姿态矩阵令其中i，j＝1，2，3根据惯性姿态角计算如下：俯仰角θ＝sin-1(C12)航向角滚动角利用将加速度计输出的加速度向量投影到当地水平地理坐标系fn＝[fNfUfE]T，然后，更新惯性测量单元3的速度V＝[VNVUVE]T，经度λ，纬度和高度h：h(k+1)＝h(k)+0.5ΔT(VU(k)+VU(k+1))令k←k+1，继续下一个时刻的计算；单目视觉测量单元2利用单个相机采集目标特征点单元1的图像，4个特征点在图像坐标系上的像素坐标分别为(ui，vi)，i＝1，2，3，4；根据小孔成像比例关系，有：其中f为相机焦距，d为单个正方形像素的边长物理尺寸，(u0，v0)为光轴与图像坐标系交点的像素坐标；f，d，(u0，v0)均为已知量，(ui，vi)为实测值，因此(kxi，kyi)根据公式(1)计算可得；特征点Pi，i＝1，2，3，4在特征坐标系下的坐标为(Xti，Yti，Zti)，同时在单目视觉测量单元2体坐标系下的坐标(Xci，Yci，Zci)，那么两个坐标系的转换关系如下：其中，(Tx，Ty，Tz)T表示特征坐标系原点Ot到单目视觉测量单元2体坐标系原点Oc平移矢量；表示特征坐标系t到单目视觉测量单元2体坐标系c的状态转移矩阵(又称方向余弦矩阵)；目标坐标系t绕Yt轴旋转航向角ψ，再绕Zt轴旋转俯仰角θ，再绕Xt轴旋转滚动角γ后与单目视觉测量单元2体坐标系本文档来自技高网...

【技术保护点】
1.一种采煤机摇臂惯性/视觉组合定姿装置标定方法，其特征在于：步骤一：将惯性测量单元(3)通过工装与单目视觉测量单元(2)刚性连接，确保惯性测量单元(3)与单目视觉测量单元(2)之间不发生相对线位移和相对角位移，将刚性连接好的惯性测量单元(3)与单目视觉测量单元(2)安装在双轴转台(5)上；步骤二：根据信息处理单元(4)通讯电缆长度，把信息处理单元(4)安装在双轴转台(5)上或安装在双轴转台(5)的周边，应确保通讯电缆长度不妨碍转台的转动；步骤三：将目标特征点单元(1)安装在双轴转台(5)周边，调节双轴转台(5)的转台内环轴(6)，使单目视觉测量单元(2)指向目标特征点单元(1)，确保单目视觉测量单元(2)能够对光学特征点(8)成像，记录双轴转台(5)内环角数值，后续保持内环角不变；步骤四：惯性/视觉组合定姿装置开始通电工作，调节双轴转台(5)的转台外环轴(7)，使转台外环轴(7)的角度为3°～5°，标记为第一位置；步骤五：信息处理单元(4)记录第一位置的惯性测量俯仰角、航向角θ(0)，ψ(0)，γ(0)和滚动角和视觉测量俯仰角、航向角和滚动角θc(0)，ψc(0)，γc(0)；步骤六：双轴转台(5)保持转台内环轴(6)角位置不变，调节转台外环轴(7)，使转台外环轴(7)的角度为8°～10°，标记为第二位置；步骤七：信息处理单元(4)记录第二位置的惯性测量俯仰角、航向角和滚动角θ(1)，ψ(1)，γ(1)和视觉测量俯仰角、航向角和滚动角θc(1)，ψc(1)，γc(1)；步骤八：信息处理单元(4)利用视觉测量姿态和惯性测量姿态，根据计算公式...

【技术特征摘要】
1.一种采煤机摇臂惯性/视觉组合定姿装置标定方法，其特征在于：步骤一：将惯性测量单元(3)通过工装与单目视觉测量单元(2)刚性连接，确保惯性测量单元(3)与单目视觉测量单元(2)之间不发生相对线位移和相对角位移，将刚性连接好的惯性测量单元(3)与单目视觉测量单元(2)安装在双轴转台(5)上；步骤二：根据信息处理单元(4)通讯电缆长度，把信息处理单元(4)安装在双轴转台(5)上或安装在双轴转台(5)的周边，应确保通讯电缆长度不妨碍转台的转动；步骤三：将目标特征点单元(1)安装在双轴转台(5)周边，调节双轴转台(5)的转台内环轴(6)，使单目视觉测量单元(2)指向目标特征点单元(1)，确保单目视觉测量单元(2)能够对光学特征点(8)成像，记录双轴转台(5)内环角数值，后续保持内环角不变；步骤四：惯性/视觉组合定姿装置开始通电工作，调节双轴转台(5)的转台外环轴(7)，使转台外环轴(7)的角度为3°～5°，标记为第一位置；步骤五：信息处理单元(4)记录第一位置的惯性测量俯仰角、航向角θ(0)，ψ(0)，γ(0)和滚动角和视觉测量俯仰角、航向角和滚动角θc(0)，ψc(0)，γc(0)；步骤六：双轴转台(5)保持转台内环轴(6)角位置不变，调节转台外环轴(7)，使转台外环轴(7)的角度为8°～10°，标记为第二位置；步骤七：信息处理单元(4)记录第二位置的惯性测量俯仰角、航向角和滚动角θ(1)，ψ(1)，γ(1)和视觉测量俯仰角、航向角和滚动角θc(1)，ψc(1)，γc(1)；步骤八：信息处理单元(4)利用视觉测量姿态和惯性测量姿态，根据计算公式计算航向安装误差Φ。2.根据权利要求1所述的一种采煤机摇臂惯性/视觉组合定姿装置标定方法，其特征在于：所述的目标特征点单元(1)由4个光学特征点组成，4个特征点共面分布，且呈正方形；单目视觉测量单元(2)与惯性测量单元(3)通过工装刚性连接好后，安装于转台上，确保目标特征点单元(1)的光学特征点(8)全部位于单目视觉测量单元(2)的视场范围内；单目视觉测量单元(2)利用单个相机拍摄目标特征点单元(1)的图像，利用图像上多个特征点之间的相对位置约束关系，求解特征坐标系与单目视觉测量单元(2)体坐标系之间的姿态关系，并将求解出的姿态传送给信息处理单元(4)；惯性测量单元(3)包含了三个单轴的加速度计和三个单轴的陀螺，加速度计测量物体在惯性测量单元(3)体坐标系三个轴向上的加速度信号，陀螺测量惯性测量单元(3)体坐标系相对于当地水平地理坐标系的角速度信号，并将角速度和加速度信号传送给信息处理单元(4)。3.根据权利要求1所述的一种采煤机摇臂惯性/视觉组合定姿装置标定方法，其特征在于：所述的信息处理单元(4)接收载体三轴角速度和三轴加速度信号，利用捷联惯导算法，解算惯性测量单元(3)相对于当地水平地理坐标系的姿态；信息处理单元(4)根据视觉姿态和惯性姿态，计算出惯性测量单元(3)体坐标系与单目视觉测量单元(2)体坐标系的航向安装误差；具体计算方法如下：定义图像坐标系：图像左下点为图像坐标系原点，横轴为u轴，纵轴为v轴，图像坐标系以像素数为单位；定义特征坐标系OtXtYtZt：坐标系原点Ot固连在4个目标特征点的几何中心，以4个目标特征点所在平面为YOZ，Xt轴垂直于目标特征点平面向外，Yt轴指天，Zt轴与Xt轴、Yt轴构成右手坐标系；定义单目视觉测量单元(2)体坐标系OcXcYcZc：坐标系原点Oc固连在相机透视投影中心，Xc轴正向沿镜头的光轴指向目标特征点单元(1)，Yc轴垂直向上，Zc轴与Xc轴、Yc轴构成右手坐标系；定义惯性测量单元(3)体坐标系ObXbY...

【专利技术属性】
技术研发人员：党宏涛，梁成，许孝敏，张敏，邓淇文，孔令云，
申请(专利权)人：西京学院，
类型：发明
国别省市：陕西,61