CN112395542B - 全轨迹位置误差的评估方法 - Google Patents

全轨迹位置误差的评估方法 Download PDF

Info

Publication number
CN112395542B
CN112395542B CN202011302309.8A CN202011302309A CN112395542B CN 112395542 B CN112395542 B CN 112395542B CN 202011302309 A CN202011302309 A CN 202011302309A CN 112395542 B CN112395542 B CN 112395542B
Authority
CN
China
Prior art keywords
track
position error
full
track position
trajectory
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202011302309.8A
Other languages
English (en)
Other versions
CN112395542A (zh
Inventor
刘公绪
高新波
史凌峰
何立火
解宇
陈森
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Xidian University
Original Assignee
Xidian University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Xidian University filed Critical Xidian University
Priority to CN202011302309.8A priority Critical patent/CN112395542B/zh
Publication of CN112395542A publication Critical patent/CN112395542A/zh
Application granted granted Critical
Publication of CN112395542B publication Critical patent/CN112395542B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Theoretical Computer Science (AREA)
  • Data Mining & Analysis (AREA)
  • General Physics & Mathematics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Algebra (AREA)
  • Computational Mathematics (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Mathematical Analysis (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明公开了一种全轨迹位置误差的评估方法,包括:轨迹建模、全轨迹位置误差的评估;所述轨迹建模是指将任意复杂的有限长度轨迹建模为有限个在空间上首尾连接的方向和距离对,如式(1)所示,所述全轨迹位置误差的评估为在参考时间间隔下评估估计轨迹与参考轨迹在空间上的远离程度,即在参考时间间隔内对估计轨迹与参考轨迹作差,如式(2)所示, 所提出的方法弥补了当前端到端或点到点位置误差评估的不足或已有的可视化方法无法定量评估全轨迹位置误差的缺点,实现了全轨迹位置误差的量化和评估,具有较大的理论研究价值和工程实践意义。

Description

全轨迹位置误差的评估方法
技术领域
本发明属于导航与定位技术领域,具体涉及一种全轨迹位置误差的评估方法。
背景技术
位置作为导航与定位系统的最终输出,需要对其进行位置误差评估以评价导航与定位方法或系统的优劣。
已有的位置误差评估方法常常只考虑端到端或点到点误差来定量刻画轨迹始点与终点的距离偏差,而无法考察整条轨迹的位置误差。针对全轨迹位置误差的评估往往依靠可视化方法,即比较估计轨迹(待评估的轨迹)与参考轨迹在视觉上的匹配程度或者偏离程度,无法实现位置误差在全轨迹上的量化和评估。
发明内容
为了解决上述背景技术中所提出的技术问题,本发明的目的在于提供一种全轨迹位置误差的评估方法。
为了实现上述目的,本发明采取的技术方案为:全轨迹位置误差的评估方法,包括以下步骤:
轨迹的建模;
全轨迹位置误差的评估;
所述轨迹建模是指将任意复杂的有限长度轨迹建模为有限个在空间上首尾连接的方向和距离对,如式(1)所示,
其中Tindex表示轨迹;表示轨迹Tindex中的一系列离散位置点,右下角的标号(1、2、……m)表示时间戳所对应的非负整数序列;表示方向和距离对,右下标i表示方向和距离对的序列号,表示/>所对应的子线段的几何中心,Ψ表示航向角,θ表示俯仰角;index为 0或1,T0表示参考轨迹,T1表示估计轨迹;m、n均为一个有限的正整数;
所述全轨迹位置误差的评估为在参考时间间隔下评估估计轨迹与参考轨迹在空间上的远离程度,即在参考时间间隔内对估计轨迹与参考轨迹作差,如式(2)所示,
|·|2表示对·求2-范数;表示估计轨迹中/>所对应的子线段的几何中心,右下标i1表示估计轨迹中方向和距离对的序列号;/>表示参考轨迹中/>所对应的子线段的几何中心,右下标i0表示参考轨迹中方向和距离对的序列号; n1、n0均为一个有限的正整数。
进一步地,所述即/>表示当前位置点到前一位置点的具有某个长度的线段。
进一步地,若轨迹中处处有则三维轨迹降为二维轨迹;若轨迹中处处有/>则该轨迹又降为一维轨迹;式(1)是三维、二维和一维轨迹建模的通用公式。
进一步地,所述参考时间间隔的求取方法为:假设参考轨迹T0的离散位置点的输出频率为F0,估计轨迹T1的离散位置点的输出频率为F1,则参考时间间隔为F为F0和F1的最大公约数。
进一步地,所述
其中Q为评估的总时间段;为估计轨迹T1中的第k个离散位置点;/>为向上取整函数,即通过取整,将QF进行补足,使其为一个正整数;/>为向下取整函数,即通过取整,将QF进行补足,使其为一个正整数。
进一步地,所述
为参考轨迹T0中的第k个离散位置点。
进一步地,所述全轨迹位置误差的评估包括评估全轨迹位置误差最大值、评估全轨迹位置误差最小值、评估全轨迹位置误差平均值,分别如式(3)或(4)、(5)或(6)、(7)或(8) 所示,
其中,max(·),min(·)分别表示对·求最大值和最小值,斜体max,min和mean分别表示全轨迹位置误差的最大值、最小值和平均值。
本发明的有益效果:(1)本发明将任意复杂的有限长度轨迹建模为有限个在空间上的首尾连接的方向和距离对,解决了任意复杂轨迹的建模和量化问题;(2)提出了一种全轨迹位置误差的评估方法,弥补了该领域的技术空白;(3)所提出的方法弥补了当前端到端或点到点位置误差评估的不足和已有的可视化方法无法定量评估全轨迹位置误差的缺点,实现了全轨迹位置误差的量化和评估,具有较大的理论研究价值和工程实践意义。
附图说明
图1为全轨迹位置误差的评估方法的流程图;
图2为本发明方法对10米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹,图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差;
图3为本发明方法对50米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹,图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差;
图4为本发明方法对100米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹,图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差;
图5为本发明方法对200米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹,图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差;
图6为本发明方法对500米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹,图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差;
图7为本发明方法对1000米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹,图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差;
图8为本发明方法对2000米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹,图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差;
图9为本发明方法对5000米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹,图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差;
图10为本发明方法对10000米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹,图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差;
图11为d、Ψ、θ在空间直角坐标系中三者之间关系的示意图。
具体实施方式
为了更好地理解本发明的内容,下面结合具体实施方法对本发明内容作进一步说明,但本发明的保护内容不局限以下实施例。
实施例1
如图1所示,全轨迹位置误差的评估方法,包括以下步骤:
轨迹的建模;
全轨迹位置误差的评估;
所述轨迹建模是指将任意复杂的有限长度轨迹建模为有限个在空间上首尾连接的方向和距离对,如式(1)所示,式(1)表示可以将任意复杂的轨迹分割成一段段可以量化的小线段,
其中Tindex表示轨迹;表示轨迹Tindex中的一系列离散位置点,右下角的标号(1、2、……m)表示时间戳所对应的非负整数序列,相邻时间戳所对应的非负整数序列之间的时间间隔取决于离散位置点的输出频率(相邻时间戳所对应的非负整数序列之间的时间间隔为位置点输出频率的倒数);index为0或1,T0表示参考轨迹,T1表示估计轨迹;m、n均为一个有限的正整数;/>表示方向和距离对,右下标i表示方向和距离对的序列号,/>表示/>所对应的子线段的几何中心,Ψ和θ表示该线段在空间中的方向,即不考虑线段挠度,仅用两个方向角就可以确定该线段在空间中的唯一方向,如图11所示,
更具体地,d在XOY平面的投影与X轴的夹角为Ψ,表示航向角;d与XOY平面投影的夹角为θ,表示俯仰角;
所述全轨迹位置误差的评估为在参考时间间隔下评估估计轨迹与参考轨迹在空间上的远离程度,即在参考时间间隔内对估计轨迹与参考轨迹作差,如式(2)所示,
|·|2表示对·求2-范数;表示估计轨迹中/>所对应的子线段的几何中心,右下标i1表示估计轨迹中方向和距离对的序列号;/>表示参考轨迹中/>所对应的子线段的几何中心,右下标i0表示参考轨迹中方向和距离对的序列号; n1、n0均为一个有限的正整数,n1和n0由评估的总时间段、估计轨迹的位置点输出频率、参考轨迹的位置点输出频率共同决定。
进一步地,所述即/>表示当前位置点到前一位置点的具有某个长度的线段。
进一步地,若轨迹中处处有则三维轨迹降为二维轨迹;若轨迹中处处有/>则该轨迹又降为一维轨迹;式(1)是三维、二维和一维轨迹建模的通用公式。
进一步地,所述参考时间间隔的求取方法为:假设参考轨迹T0的离散位置点的输出频率为F0,估计轨迹T1的离散位置点的输出频率为F1,则参考时间间隔为F为F0和F1的最大公约数。即以参考时间间隔为时间单元评估参考轨迹T0与估计轨迹T1的全轨迹位置误差。
进一步地,所述
即以参考时间间隔为时间单元对估计轨迹进行量化处理;其中Q为评估的总时间段;为估计轨迹T1中的第k个离散位置点;/>为向上取整函数,即通过取整,将QF进行补足,使其为一个正整数;/>为向下取整函数,即通过取整,将QF进行补足,使其为一个正整数;当QF>>1时,向上取整和向下取整的量化结果几乎是一样的。
进一步地,所述
即以参考时间间隔为时间单元对参考轨迹进行量化处理;为参考轨迹T0中的第k个离散位置点。
进一步地,所述全轨迹位置误差的评估包括评估全轨迹位置误差最大值、评估全轨迹位置误差最小值、评估全轨迹位置误差平均值,分别如式(3)或(4)、(5)或(6)、(7)或(8) 所示,
其中,max(·),min(·)分别表示对·求最大值和最小值,斜体max,min和mean分别表示全轨迹位置误差的最大值、最小值和平均值。
实施例2
如图2所示,为对10米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹;图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差,用盒须图表示各误差最大误差,最小误差,中位值等信息,关于测试结果的量化统计见实施例11。
实施例3
如图3所示,为对50米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹;图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差,用盒须图表示各误差最大误差,最小误差,中位值等信息,关于测试结果的量化统计见实施例11。
实施例4
如图4所示,为对100米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹;图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差,用盒须图表示各误差最大误差,最小误差,中位值等信息,关于测试结果的量化统计见实施例11。
实施例5
如图5所示,为对200米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹;图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差,用盒须图表示各误差最大误差,最小误差,中位值等信息,关于测试结果的量化统计见实施例11。
实施例6
如图6所示,为对500米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹;图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差,用盒须图表示各误差最大误差,最小误差,中位值等信息,关于测试结果的量化统计见实施例11。
实施例7
如图7所示,为对1000米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹;图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差,用盒须图表示各误差最大误差,最小误差,中位值等信息,关于测试结果的量化统计见实施例11。
实施例8
如图8所示,为对2000米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹;图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差,用盒须图表示各误差最大误差,最小误差,中位值等信息,关于测试结果的量化统计见实施例11。
实施例9
如图9所示,为对5000米轨迹的测试结果;其中图(a)表示用发明方法得到的参考轨迹和估计轨迹;图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差,用盒须图表示各误差最大误差,最小误差,中位值等信息,关于测试结果的量化统计见实施例11。
实施例10
如图10所示,为对10000米轨迹的测试结果;其中图(a)表示用本发明方法得到的参考轨迹和估计轨迹;图(b)表示X轴方向的轨迹位置误差、Y轴方向的轨迹位置误差、Z轴方向的轨迹位置误差和全轨迹位置误差,用盒须图表示各误差最大误差,最小误差,中位值等信息,关于测试结果的量化统计见实施例11。
实施例11
将实施例2~实施例10测试的定位误差结果进行整理,如表1所示,为本发明方法在各测试轨迹下的全轨迹位置误差统计,而已有的方法并不能实现全轨迹误差评估。
表1所提出方法在各测试轨迹下的全轨迹位置误差统计
以上所述仅为本发明的具体实施方式,不是全部的实施方式,本领域普通技术人员通过阅读本发明说明书而对本发明技术方案采取的任何等效的变换,均为本发明的权利要求所涵盖。

Claims (7)

1.全轨迹位置误差的评估方法,其特征在于,包括以下步骤:
轨迹的建模;
全轨迹位置误差的评估;
所述轨迹建模是指将任意复杂的有限长度轨迹建模为有限个在空间上首尾连接的方向和距离对,如式(1)所示,
其中Tindex表示轨迹;表示轨迹Tindex中的一系列离散位置点,右下角的标号(1、2、……m)表示时间戳所对应的非负整数序列;/>表示方向和距离对,右下标i表示方向和距离对的序列号,/>表示所对应的子线段的几何中心,Ψ表示航向角,θ表示俯仰角;index为0或1,T0表示参考轨迹,T1表示估计轨迹;m、n均为一个有限的正整数;
所述全轨迹位置误差的评估为在参考时间间隔下评估估计轨迹与参考轨迹在空间上的远离程度,即在参考时间间隔内对估计轨迹与参考轨迹作差,如式(2)所示,
|·|2表示对·求2-范数;表示估计轨迹中/>所对应的子线段的几何中心,右下标i1表示估计轨迹中方向和距离对的序列号;/>表示参考轨迹中/>所对应的子线段的几何中心,右下标i0表示参考轨迹中方向和距离对的序列号;n1、n0均为一个有限的正整数。
2.根据权利要求1所述的全轨迹位置误差的评估方法,其特征在于,所述 即/>表示当前位置点到前一位置点的具有某个长度的线段。
3.根据权利要求1所述的全轨迹位置误差的评估方法,其特征在于,若轨迹中处处有则三维轨迹降为二维轨迹;若轨迹中处处有/>则该轨迹又降为一维轨迹;式(1)是三维、二维和一维轨迹建模的通用公式。
4.根据权利要求1所述的全轨迹位置误差的评估方法,其特征在于,所述参考时间间隔的求取方法为:假设参考轨迹T0的离散位置点的输出频率为F0,估计轨迹T1的离散位置点的输出频率为F1,则参考时间间隔为F为F0和F1的最大公约数。
5.根据权利要求4所述的全轨迹位置误差的评估方法,其特征在于,所述
其中Q为评估的总时间段;为估计轨迹T1中的第k个离散位置点;/>为向上取整函数,即通过取整,将QF进行补足,使其为一个正整数;/>为向下取整函数,即通过取整,将QF进行补足,使其为一个正整数。
6.根据权利要求5所述的全轨迹位置误差的评估方法,其特征在于,所述或/>
为参考轨迹T0中的第k个离散位置点。
7.根据权利要求6所述的全轨迹位置误差的评估方法,其特征在于,所述全轨迹位置误差的评估包括评估全轨迹位置误差最大值、评估全轨迹位置误差最小值、评估全轨迹位置误差平均值,分别如式(3)或(4)、(5)或(6)、(7)或(8)所示,
其中,max(·),min(·)分别表示对·求最大值和最小值,斜体max,min和mean分别表示全轨迹位置误差的最大值、最小值和平均值。
CN202011302309.8A 2020-11-19 2020-11-19 全轨迹位置误差的评估方法 Active CN112395542B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011302309.8A CN112395542B (zh) 2020-11-19 2020-11-19 全轨迹位置误差的评估方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011302309.8A CN112395542B (zh) 2020-11-19 2020-11-19 全轨迹位置误差的评估方法

Publications (2)

Publication Number Publication Date
CN112395542A CN112395542A (zh) 2021-02-23
CN112395542B true CN112395542B (zh) 2024-02-20

Family

ID=74607551

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011302309.8A Active CN112395542B (zh) 2020-11-19 2020-11-19 全轨迹位置误差的评估方法

Country Status (1)

Country Link
CN (1) CN112395542B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112985460A (zh) * 2021-03-08 2021-06-18 武汉小安科技有限公司 智能中控定位精度测试方法、装置、电子设备和存储介质

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108900864A (zh) * 2018-07-23 2018-11-27 西安电子科技大学 基于运动轨迹的全参考视频质量评价方法
CN111923905A (zh) * 2019-04-24 2020-11-13 Aptiv技术有限公司 对轨迹进行估计的系统和方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5329856B2 (ja) * 2008-06-27 2013-10-30 本田技研工業株式会社 行動推定システム

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108900864A (zh) * 2018-07-23 2018-11-27 西安电子科技大学 基于运动轨迹的全参考视频质量评价方法
CN111923905A (zh) * 2019-04-24 2020-11-13 Aptiv技术有限公司 对轨迹进行估计的系统和方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
机器人直线运动位置轨迹精度评估方法研究;郭军;王炳荣;;机电工程;20200630(第06期);第724-728页 *

Also Published As

Publication number Publication date
CN112395542A (zh) 2021-02-23

Similar Documents

Publication Publication Date Title
CN102865862B (zh) 全站仪免置平自由设站的测量方法
CN103442434B (zh) 一种应用于隧道环境中的人员定位方法、装置及系统
CN108242145A (zh) 异常轨迹点检测方法和装置
CN112395542B (zh) 全轨迹位置误差的评估方法
CN111323751B (zh) 声源定位方法、装置及存储介质
CN104834923A (zh) 基于全局信息的指纹图像配准方法
CN104036424A (zh) 基于二维码的零件快速选配方法及系统
CN104019834A (zh) 单码道绝对位置的编码方法及读数测量系统
CN112486093A (zh) 平台精度的补偿方法、装置、设备和介质
CN107247193A (zh) 天线近场测试方法及装置
CN112507283B (zh) 一种基于321法则的转换矩阵解算方法
CN112857315A (zh) 基于三维激光扫描的钢管柱垂直度测量方法
CN110689594A (zh) 一种确定三角形格网的离散线的方法和装置
CN107784169B (zh) 基于变差函数及孔隙度的多孔介质表征单元体确定方法
CN112504318B (zh) 一种针对距离编码脉冲丢失情况的测角纠错方法
CN108333576B (zh) 一种旋转式测距验证装置及方法
CN111409109B (zh) 工业机器人稳定性的测量和评估方法
CN111640164B (zh) 一种量化城市轨道交通车站标识可见域的方法
CN110231665B (zh) 基于重复线的捷联式航空重力测量精度评估方法
CN108256261A (zh) 海上浮式结构的稳定性评估方法及装置
CN106354926B (zh) 一种电力设计三维仿真系统
CN104484565A (zh) 铁路线间特定配对关系模型构建方法和线间距计算参数查询方法
Stanfill Statistical methods for random rotations
CN109029326A (zh) 一种两段轴的安装间隙快速计算方法
CN109977538A (zh) 基于等精度原则的一种两段轴的可安装性精确计算方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant