基于双线的移动物体姿态测量方法技术

本发明专利技术公开了基于双线的移动物体姿态测量方法，属于姿态测量技术领域，激光穿透基准激光接收标靶并射在参考激光接收标靶上，其中一条激光固定照射基准激光接收标靶的一点，两个标靶中心点的连线平行于激光且随移动物体同步移动。基准激光接收标靶和参考激光接收标靶各自在各自左侧面中心位置建立坐标系，读取激光照射点在各标靶坐标系下的坐标值，通过空间几何关系计算出移动物体在空间中的姿态角。姿态测量方法包括：测量移动物体绕坐标系的Y轴旋转得到的航向角，测量移动物体绕坐标系的X轴旋转得到的俯仰角，测量移动物体绕坐标系的Z轴旋转得到的横滚角，计算其中一条激光照射点在参考激光接收标靶坐标系(未发生横滚时)下的坐标值。时)下的坐标值。时)下的坐标值。

【技术实现步骤摘要】
基于双线的移动物体姿态测量方法


[0001]本专利技术公开了基于双线的移动物体姿态测量方法，属于姿态测量


技术介绍

[0002]姿态角的测量方法有多种，通常是使用磁敏传感器、旋转电位器、角度传感器、机器视觉、惯性传感器等设备对姿态角进行测量，但每种设备的测量方式都有自己的长处与约束。磁敏传感器对环境要求苛刻，温度适应范围窄，可靠性差，通常仅仅作为辅助测量手段；旋转电位器受到的滑动触点的接触效果和机械运动阻力的影响和AD转换模块的转换精度限制，在高分辨率的情况下数据波动严重，难以实现稳定测量；角度传感器中，增量式编码器的角度检测精度受到单圈脉冲数量限制，长期工作会产生累积误差，且断电重启会出现脉冲丢失，需要人工复位，而绝对值编码器的每一个位置对应一个确定的数字码，但受到量程范围的制约，且结构复杂，价格昂贵；机器视觉容易受到粉尘等污染物、摄像仪分辨率以及摄像距离的影响，受到环境的约束较大。惯性传感器存在安装误差、初始对准误差和运动干扰误差等影响，且随着使用时间延长，惯性传感器会因加速度和角速度的积分产生累积漂移，影响正常使用。

技术实现思路

[0003]本专利技术提出了基于双线的移动物体姿态测量方法，解决现有技术中通过仪器进行姿态测量不准确的问题。
[0004]基于双线的移动物体姿态测量方法，包括：
[0005]S1.测量移动物体绕坐标系的Y轴旋转得到的航向角；
[0006]S2.测量移动物体绕坐标系的X轴旋转得到的俯仰角；
[0007]S3.测量移动物体绕坐标系的Z轴旋转得到的横滚角；
[0008]S4.计算其中一条激光照射点在参考激光接收标靶坐标系(未发生横滚)下的坐标值。
[0009]优选地，采用基准激光接收标靶、参考激光接收标靶和两个激光器，所述两个激光器的高度一致，发射出的激光相互平行，激光穿透基准激光接收标靶并射在参考激光接收标靶上，其中一条激光固定照射基准激光接收标靶的一点，两个标靶均竖直放置、中心点的连线平行于激光且随移动物体同步移动。
[0010]优选地，所述基准激光接收标靶和参考激光接收标靶在各自左侧面中心位置建立坐标系，读取激光照射点在各标靶坐标系下的坐标值，通过空间几何关系计算出移动物体在空间中的姿态角。
[0011]优选地，设A、C分别是第一激光线、第二激光线在基准激光接收标靶上的照射点，B、D分别是第一激光线、第二激光线在参考激光接收标靶上的照射点，则横滚角Roll的计算公式为：
[0012]式中，O1为基准激光接收标靶的左侧面坐标系原点，表示O1和A的连线，X和Y分别是C在坐标系{O1}的横纵坐标值。
[0013]优选地，俯仰角沿水平面向上转动时值为正，取值范围为(
‑
90
°‑
90
°
)，设B在坐标系{基准O2}坐标为(x，y)，BHM平面垂直于两个标靶，交坐标系{O1}与坐标系{基准O2}于H和M。即式中，l
HM
为两个标靶之间的距离，pitch为俯仰角。坐标系{基准O2}：未发生横滚时的{O2}坐标系；坐标系{O2}：基准激光接收标靶左侧面中心位置建立的坐标系。
[0014]优选地，航向角yaw绕点A处Y轴逆时针旋转为正，且取值范围为(
‑
90
°‑
90
°
)，)，
[0015]优选地，B的坐标求解过程为：根据B点在参考激光接收标靶的位置情况，将参考激光接收标靶分割为8个区域，求解相邻区域之间的分割线方程，根据横滚角的8个范围，分别求解B在坐标系{基准O2}下的坐标。
[0016]与现有技术对比，本专利技术的有益效果是：本专利技术结构简单，不需要依靠外部数据，姿态角计算方法简单，可以长期工作，不会出现累计误差，可以实现稳定测量；红外激光照射间隔远，产品寿命长，且红外线具有很强的穿透能力，受到粉尘等颗粒物的影响较小，使用温度范围较高；激光接收标靶相对间隔较小，直接附连在物体上，质量较轻，且断电后重新上电不用调零。
附图说明
[0017]图1为本专利技术的测量装置；
[0018]图2为基于图1的三角求解示意图；
[0019]图3为Q方向的视图；
[0020]图4为N方向的视图；
[0021]图5为横滚角：Rall∈(
‑
180
°‑‑
90
°
)时的区域标识图；
[0022]图6为横滚角：Rall∈(
‑
90
°‑0°
)时的区域标识图；
[0023]图7为横滚角：Rall∈(0
°‑
90
°
)时的区域标识图；
[0024]图8为横滚角：Rall∈(90
°‑
180
°
)时的区域标识图；
[0025]附图标记包括：1
‑
第一激光器，2
‑
第二激光器，3
‑
第一激光线，4
‑
第二激光线，5
‑
基准激光接收标靶，6
‑
参考激光接收标靶。
具体实施方式
[0026]下面结合具体实施例对本专利技术的具体实施方式做进一步说明：
[0027]基于双线的移动物体姿态测量方法，包括：
[0028]S1.测量移动物体绕坐标系的Y轴旋转得到的航向角；
[0029]S2.测量移动物体绕坐标系的X轴旋转得到的俯仰角；
[0030]S3.测量移动物体绕坐标系的Z轴旋转得到的横滚角；
[0031]S4.计算其中一条激光照射点在参考激光接收标靶坐标系(未发生横滚)下的坐标值。
[0032]采用基准激光接收标靶5、参考激光接收标靶6和两个激光器，所述两个激光器的高度一致，发射出的激光相互平行，激光穿透基准激光接收标靶5并射在参考激光接收标靶6上，其中一条激光固定照射基准激光接收标靶5的一点，两个标靶均竖直放置、中心点的连线平行于激光且随移动物体同步移动。
[0033]所述基准激光接收标靶5和参考激光接收标靶6在各自左侧面中心位置建立坐标系，读取激光照射点在各标靶坐标系下的坐标值，通过空间几何关系计算出移动物体在空间中的姿态角。
[0034]设A、C分别是第一激光线3、第二激光线4在基准激光接收标靶5上的照射点，B、D分别是第一激光线3、第二激光线4在参考激光接收标靶6上的照射点。横滚角求解中，以基准激光接收标靶5为研究对象，在基准激光接收标靶5存在偏转与俯仰的情况下，如图2，正视该标靶(图中L视向)，在不同角度的横滚角情况下进行分析。图2中坐标系具体为：坐标系{O0}：旋转坐标系：即移动物体绕其三轴依次旋转；坐标系{O1}：基准激光接收标靶5左侧面中心位置建立的坐标系；旋转角度即基准激光接收标靶5的在L视向下的旋转角度:Roll；旋转角Roll为∠O1AC；点E为过点C往坐标系{O1}的x1轴做垂线，垂足为本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于双线的移动物体姿态测量方法，其特征在于，包括：S1.测量移动物体绕坐标系的Y轴旋转得到的航向角；S2.测量移动物体绕坐标系的X轴旋转得到的俯仰角；S3.测量移动物体绕坐标系的Z轴旋转得到的横滚角；S4.计算其中一条激光照射点在未发生横滚的参考激光接收标靶坐标系下的坐标值。2.根据权利要求1所述的基于双线的移动物体姿态测量方法，其特征在于，采用基准激光接收标靶、参考激光接收标靶和两个激光器，所述两个激光器的高度一致，发射出的激光相互平行，激光穿透基准激光接收标靶并射在参考激光接收标靶上，其中一条激光固定照射基准激光接收标靶的一点，两个标靶均竖直放置、中心点的连线平行于激光且随移动物体同步移动。3.根据权利要求2所述的基于双线的移动物体姿态测量方法，其特征在于，所述基准激光接收标靶和参考激光接收标靶在各自左侧面中心位置建立坐标系，读取激光照射点在各标靶坐标系下的坐标值，通过空间几何关系计算出移动物体在空间中的姿态角。4.根据权利要求3所述的基于双线的移动物体姿态测量方法，其特征在于，设A、C分别是第一激光线、第二激光线在基准激光接收标靶上的照射点，B、D分别是第一激光线、第二激光线在参考激光接收标靶上的照射点，则横滚角Roll的计算公式为：式中，O1为基准激光接收标靶左侧...

【专利技术属性】
技术研发人员：仉毅，孟凡盛，朱路群，李文宏，唐红梅，
申请(专利权)人：山东宇飞传动技术有限公司，
类型：发明
国别省市：