一种无人机目标定位的系统误差自动校准方法与流程
本发明属于无人机,具体涉及一种无人机目标定位的系统误差自动校准方法。
背景技术:
0、技术背景
1、目标定位是无人机的一项重要功能,其广泛应用于火点探测、人员搜救、灾害现场位置确定等侦察定位场景。无人机通常采用光电吊舱实时锁定目标并进行激光测距的方法对目标进行实时定位。影响其目标定位精度的主要因素为光电吊舱与姿态测量系统(如惯性测量单元imu)之间的安置角误差、以及光电吊舱与全球导航卫星系统(gnss)天线之间的偏心值等系统误差。若不能对上述系统误差进行有效校准,将严重影响目标定位精度,导致无人机无法应用于对定位精度要求较高的场景。
2、传统的校准方法通常需要在作业区域另行布设已知精确坐标的地面靶标,无人机对靶标进行观测以解算误差。该方法流程繁琐,准备时间长,且每次拆装设备后均需重复此过程,严重影响了无人机作业的便捷性和效率。此外,部分现有技术中,无人机主要在靶标上空盘旋并垂直向下观测,观测几何单一,可能无法充分激励和分离所有方向的系统误差,影响校准精度和稳健性。
技术实现思路
1、本发明的目的在于:克服现有技术的不足,提供一种无人机目标定位的系统误差自动校准方法。该方法无需额外布设地面靶标,利用无人机系统自身组件,通过特定的飞行与观测策略,自动、高效、高精度地完成系统误差校准,显著提升无人机目标定位的便捷性和可靠性。
2、为实现上述技术目的,本发明的技术方案如下:
3、一种无人机目标定位的系统误差自动校准方法,具体包括以下步骤:
4、s1:展开无人机系统,所述系统包括无人机、地面数据链和地面指挥控制站,所述地面指挥控制站具有已知的精确坐标,设有gnss差分基站;
5、s2:控制所述无人机围绕所述地面指挥控制站飞行,并控制无人机上的光电吊舱持续跟踪所述地面指挥控制站,同步采集若干组观测数据,每组观测数据至少包括无人机位置、无人机姿态角、光电吊舱指向角和激光测距值;
6、s3:对采集到的多组观测数据进行粗差剔除,得到有效观测数据集合;
7、s4:基于所述有效观测数据集合和目标定位方程,构建以光电吊舱与姿态测量系统之间的安置角误差、以及光电吊舱与gnss天线之间的偏心误差为待求解参数的残差函数;
8、所述安置角误差包括俯仰角误差、滚转角误差和航向角误差;所述偏心误差包括在无人机机体坐标系下的三个轴向分量
9、s5:利用最优化算法求解所述残差函数,得到所述安置角误差和所述偏心误差的最优估计值;
10、s6:基于所述最优估计值计算评估指标,根据所述评估指标判断校准是否成功。
11、优选地,所述步骤s2中,所述无人机围绕所述地面指挥控制站飞行的航线包括以下至少两种:圆盘绕飞航线、矩形绕飞航线;且所述圆盘绕飞和矩形绕飞均包括顺时针和逆时针方向的飞行。
12、优选地,所述步骤s2中,观测数据具体包括:
13、无人机的纬度bi、经度li、高度hi;
14、无人机的俯仰角pi、滚转角ri、航向角yi;
15、光电吊舱的俯仰角eo_pi、航向角eo_yi;
16、光电吊舱的激光测距值di;以及
17、所述地面指挥控制站的纬度sbi、经度sli、高度shi;
18、其中,i表示第i组观测数据。
19、进一步地,所述步骤s2中,所述圆盘绕飞的平面半径为1公里,飞行相对高度为500米;所述矩形绕飞的边长为2公里,飞行相对高度为500米。
20、优选地,所述步骤s3中,所述粗差剔除包括步骤如下:
21、针对每组观测数据,根据其激光测距值计算粗差阈值;
22、所述粗差阈值计算公式为:;
23、式中
fi表示第i组观测数据的粗差阈值,表示系数,di表示第i组观测数据的激光测距值;光电吊舱目标定位精度与目标距离正相关,值的选取决定了允许出现的粗差与目标距离的比例关系,取值0.03~0.3;
24、根据该组观测数据计算出一个目标点位置,并计算该目标点位置与所述地面指挥控制站的实际位置之间的距离;
25、若所述距离大于所述粗差阈值,则将该组观测数据判定为粗差并予以剔除。
26、进一步地,粗差剔除计算步骤如下:
27、s31观测数据坐标转换:将一组观测数据中的无人机的大地坐标()及及地面站的大地坐标()转换为地心坐标,此坐标转换采用通用公式,得到无人机地心坐标(xai,yai,zai)及地面站地心坐标(xsi,ysi,zsi);
28、s32计算目标坐标。:用目标定位公式,计算目标点地心坐标(xti,yti,zti),其计算公式为:
29、
30、
31、
32、其中,tx,ty,tz为中间变量,其计算公式为:
33、
34、
35、
36、中间变量的计算公式中,做如下定义:
37、
38、
39、
40、
41、
42、s33计算目标点与地面站之间的距离:其计算公式为:
43、
44、s34判定是否剔除该组观测数据:若si≤fi,则保留该组观测数据;否则,认为该组数据粗差超限,予以剔除。
45、优选地,所述步骤s4中,所述残差函数定义为:基于第i组有效观测数据及待求解的系统误差参数,计算得到的目标点坐标(,)与所述地面指挥控制站的已知坐标(,)之间的欧氏距离:
46、
。
47、优选地,所述步骤s5中,最优化算法为最小二乘法,求解,使得具有最小值,其中i表示第i组观测数据,m表示剔除粗差后的观测数据集合中保留的m组观测数据。
48、优选地,所述步骤s6中,将求解出的参数代入残差函数计算残差值ff,若残差值ff小于规定阈值fl,则判定为系统误差求解成功;否则,系统误差求解失败;
49、所述求解了参数后的残差值ff定义如下:
50、。
51、进一步地,规定阈值fl采用下式进行计算:
52、,式中为系数,光电吊舱目标定位精度与目标距离正相关,值的选取决定了校准完成后校准参数的内符合精度。
53、进一步地,取值0.01~0.1。
54、本发明取得的有益效果:
55、与现有技术相比,本发明具有以下显著优点:
56、1.操作便捷,免布设靶标:直接利用无人机系统固有的地面指挥站(其坐标可通过差分gnss精确获得)作为校准基准点,省去了额外布设、测量和维护地面靶标的繁琐工作,极大提升了校准流程的便捷性和作业效率。
57、2.观测几何丰富,精度高:通过圆盘+矩形、顺时针+逆时针等多模式绕飞航线,使无人机从多个方位、角度和距离对固定点进行持续跟踪观测。其丰富的观测几何能更充分地激励和分离各类系统误差,从而通过优化算法得到更精确、更稳健的校准结果。
58、3.全自动,智能化程度高:方法内嵌了基于激光测距加权的自动粗差剔除机制和基于残差的最终评估标准,实现了从数据采集、质量控制、参数解算到结果验证的全流程自动化,减少了对操作人员经验的依赖,保证了校准过程的可靠性和结果的一致性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com