一种视觉姿态测量装置动态精度评估系统及方法与流程
本发明涉及测量测试,具体涉及一种视觉姿态测量装置动态精度评估系统及方法。
背景技术:
1、目前针对可重复使用火箭降落过程中的导航问题,大都以惯导为中心结合多种辅助导航设备构成组合导航系统。常见的导航设备包括了惯性/gnss组合导航系统、大气数据系统、雷达高度计等。由于箭体在降落阶段飞行环境变化巨大,导致上述导航设备工作可靠度降低,导航精度下降,不可避免的给相对位姿估计带来不利影响。
2、为实现高可靠和高精度导航,需要引入其它导航措施,提升导航冗余度,以便准确估计箭体相对回收平台的相对位姿。
3、视觉导航技术在可重复使用火箭回收着陆段有着较好的导航精度,可作为返回着陆段导航系统的重要技术补充。视觉导航技术测量的是箭体相对回收平台的位姿信息,但动态测量精度需要进行精确的评估,以验证是否满足导航精度需求。
4、因此,需要一种视觉姿态测量装置动态精度评估系统及方法。
技术实现思路
1、本发明是为了解决视觉导航系统动态精度难以精确测量的问题,提供一种视觉姿态测量装置动态精度评估系统及方法,评估系统包含安装于无人机上的测量设备及地面标定设备。安装于无人机上的设备主要包括固定工装、高精度基准惯导系统a、数据综合控制器及相关连接线缆;地面标定设备包括了高精度标定靶标、高精度基准惯导系统b、对比转接工装、全站仪设备、rtk及相关连接线缆。被测视觉姿态测量装置由视觉信号处理器、视觉传感单元(相机)、地面合作目标及连接线缆组成。将高精度惯导系统a、数据综合控制器、视觉姿态测量装置中的视觉信号处理器、视觉传感单元安装至固定工装并用线缆连接,将固定工装安装至无人机框架并锁紧。无人机在动态飞行过程中,所有设备加电工作后,视觉姿态测量装置接收数据综合控制器的同步脉冲,启动相机观测地面合作目标,在视觉信号处理器中完成相对姿态计算并输出至数据综合控制器。数据综合控制器根据事前标定过的相机与惯导系统的姿态关系,完成导航坐标系下的姿态计算,并完成与基准惯导系统a输出的姿态对比评估。
2、本发明提供一种视觉姿态测量装置动态精度评估系统,包括连接在固定工装上且互连的基准惯导系统a、数据综合控制器、待测视觉姿态测量装置和位于地面的基准惯导系统b、标定靶标、对比转接工装、rtk、全站仪;
3、待测视觉姿态测量装置包括互连的视觉信号处理器、视觉传感单元和位于地面的地面合作目标,视觉信号处理器连接在固定工装上,视觉传感单元连接在固定工装的底部、侧部或穿过固定工装,视觉传感单元可不被遮挡的观测标定靶标或地面合作目标,固定工装固定在高度h处或者连接在无人机上;
4、数据综合控制器接收基准惯导系统a和视觉信号处理器的输出数据及信号并向视觉信号处理器发送同步脉冲以及进行数据存储;
5、基准惯导系统b和标定靶标连接在对比转接工装上部,对比转接工装位于地面;
6、通过基准惯导系统a、数据综合控制器、视觉信号处理器、视觉传感单元、基准惯导系统b和标定靶标进行视觉传感单元与基准惯导系统a的姿态关系对齐得到姿态矩阵;
7、通过rtk和全站仪得到地面合作目标坐标系与导航坐标系间的姿态矩阵;
8、无人机在动态飞行时,视觉传感单元观测地面合作目标,数据综合控制器根据和视觉传感单元的姿态数据得到动态飞行过程中视觉传感单元与导航坐标系的旋转矩阵;数据综合控制器根据将基准惯导系统a的姿态测量值转换至视觉传感单元相对导航坐标系下的旋转矩阵,数据综合控制器将与进行比较并评估待测视觉姿态测量装置的精度。
9、本发明所述的一种视觉姿态测量装置动态精度评估系统,作为优选方式,标定靶标包括底面基准面和侧面基准面;对比转接工装包括水平安装基准面和垂直安装基准面,基准惯导系统b和标定靶标均连接在水平安装基准面上且侧面基准面分别与垂直安装基准面对齐;
10、rtk通过测量位于地面的标志点a的位置坐标和标志点b的位置坐标得到ab连线与真北方向的夹角;
11、全站仪依据确定真北方向。
12、本发明所述的一种视觉姿态测量装置动态精度评估系统,作为优选方式,视觉传感单元为相机,地面合作目标为待测视觉姿态测量装置配套使用平面靶标的缩比靶标,标定靶标为棋盘格靶标;
13、待测视觉姿态测量装置接收数据综合控制器的同步脉冲后启动视觉传感单元拍摄标定靶标或地面合作目标,视觉信号处理器进行相对姿态计算并输出至数据综合控制器;
14、基准惯导系统a和基准惯导系统b均输出导航姿态角。
15、本发明提供一种视觉姿态测量装置动态精度评估系统的评估方法,包括以下步骤:
16、s1、搭建视觉姿态测量装置动态精度评估系统,数据综合控制器根据视觉传感单元拍摄的标定靶标照片计算视觉传感单元坐标系与标定靶标坐标系间的旋转矩阵,并得到视觉传感单元坐标系与基准惯导系统a坐标系间的姿态矩阵;
17、s2、将地面合作目标放置于飞行试验场地地面,通过rtk和全站仪得到地面合作目标坐标系与导航坐标系间的姿态矩阵;
18、s3、进行动态飞行试验,比较待测视觉姿态测量装置计算的相对导航坐标系的俯仰姿态角、横滚姿态角、偏航姿态角与通过等效基准惯导系统a转换得到的相对导航坐标系的俯仰姿态角、横滚姿态角、偏姿态角,完成视觉姿态测量装置动态姿态精度评估。
19、本发明所述的一种视觉姿态测量装置动态精度评估系统的评估方法,作为优选方式,步骤s1包括以下步骤:
20、s11、搭建视觉姿态测量装置动态精度评估系统并将组装后的固定工装悬挂到高度h;
21、s12、上电后,视觉传感单元拍摄标定靶标的图像并传输至视觉信号处理器,数据综合控制器读取视觉信号处理器的标定靶标图像并计算视觉传感单元坐标系与标定靶标坐标系间的旋转矩阵;
22、s13、由于基准惯导系统b和标定靶标的基准面对齐,根据得到标定靶标坐标系与基准惯导系统b坐标系间的旋转阵;
23、s14、基准惯导系统b输出导航坐标系姿态角,得到基准惯导系统b坐标系与导航坐标系间的姿态矩阵;
24、s15、得到视觉传感单元坐标系与导航坐标系间的姿态矩阵:
25、。
26、本发明所述的一种视觉姿态测量装置动态精度评估系统的评估方法,作为优选方式,步骤s2包括以下步骤:
27、s21、将地面合作目标放置于飞行试验场地地面;
28、s22、在地面合作目标附近选取标志点a,使用rtk测量标志点a的位置坐标,远离a点选取标志点b,使用rtk测量标志点b的位置坐标,根据ab点的位置坐标计算ab连线与真北方向的夹角;
29、s23、将全站仪固定在a点正上方,将全站仪的对中杆垂直放置于b点,当全站仪观察窗中心观测到对中杆标记时,全站仪偏离北向角度为;
30、s24、依据确立真北方向,以a点为坐标原点建立东北天导航坐标系,用全站仪测量地面合作目标的四个对称角点m、n、s、t相对坐标原点a的坐标、、和;
31、s25、计算地面合作目标坐标系原点、方向的矢量和,地面合作目标坐标系原点为地面合作目标的中心;
32、s26、根据和计算、方向的单位矢量、;
33、s27、根据和计算方向的单位矢量;
34、s28、根据、和得到地面合作目标坐标系到导航坐标系的姿态转换矩阵。
35、本发明所述的一种视觉姿态测量装置动态精度评估系统的评估方法,作为优选方式,步骤s22中,使小于待测视觉姿态测量装置的标称姿态精度:
36、;
37、其中,为ab间的距离,为rtk的水平位置测量精度:
38、步骤s24中,
39、;
40、;
41、;
42、;
43、步骤s25中,
44、;
45、;
46、步骤s26中,
47、;
48、;
49、步骤s27中,
50、;
51、步骤s28中,
52、。
53、本发明所述的一种视觉姿态测量装置动态精度评估系统的评估方法,作为优选方式,当角度误差与待测视觉姿态测量装置的姿态测量精度相比不可忽略时,使用格拉姆-施密特正交化方法构建、、方向的单位矢量并获得值;
54、其中,,的单位为°。
55、本发明所述的一种视觉姿态测量装置动态精度评估系统的评估方法,作为优选方式,步骤s3包括以下步骤:
56、s31、将固定工装安装至无人机框架并锁紧,无人机及所有设备加电正常工作后按预定飞行轨迹进行动态飞行试验;
57、s32、在动态飞行过程中,基准惯导系统a按固定频率输出姿态测量值,对应时间间隔,数据综合控制器以基准惯导系统a输出的频率为的高频数据包为系统时间标志;
58、数据综合控制器每收到n组惯导姿态数据时,触发同步脉冲至待测视觉姿态测量装置,使待测视觉姿态测量装置启动视觉传感单元拍摄地面合作目标,完成视觉传感单元相对于地面合作目标的姿态矩阵的计算,并向数据综合控制器输出姿态矩阵测量值及启动同步脉冲至输出姿态值的时间差,完成惯导姿态和视觉传感单元姿态的时间对齐;
59、s33、数据综合控制器同时接收基准惯导系统a输出的姿态数据和待测视觉姿态测量装置输出的姿态数据,动态飞行过程中视觉传感单元与导航坐标系的旋转矩阵为:
60、;
61、将基准惯导系统a姿态测量值转换至视觉传感单元坐标系,得到:
62、;
63、通过旋转矩阵计算视觉传感单元相对导航坐标系的俯仰、横滚、偏航三个姿态角,通过计算转换至视觉传感单元坐标系的等效基准惯导系统a坐标系相对导航坐标系的俯仰、横滚、偏航三个姿态角;
64、s34、比较通过两个旋转矩阵计算的三个姿态角,完成待测视觉姿态测量装置的动态姿态精度评估。
65、本发明具有以下优点:
66、本发明通过机上测量设备和地面标定设备完成基准惯导系统a和相机的姿态对齐功能。将高精度惯导系统a、数据综合控制器、视觉姿态测量装置中的视觉信号处理器、视觉传感单元安装至固定工装并用线缆连接,将固定工装安装至无人机框架并锁紧。无人机在动态飞行过程中,所有设备加电工作后,视觉姿态测量装置接收数据综合控制器的同步脉冲,启动相机观测地面合作目标,在视觉信号处理器中完成相对姿态计算并输出至数据综合控制器。数据综合控制器根据事前标定过的相机与惯导系统的姿态关系,完成导航坐标系下的姿态计算,并完成与基准惯导系统a输出的姿态对比评估。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com