CN115855116B - 误差标定工艺生成方法及*** - Google Patents
误差标定工艺生成方法及*** Download PDFInfo
- Publication number
- CN115855116B CN115855116B CN202310082015.6A CN202310082015A CN115855116B CN 115855116 B CN115855116 B CN 115855116B CN 202310082015 A CN202310082015 A CN 202310082015A CN 115855116 B CN115855116 B CN 115855116B
- Authority
- CN
- China
- Prior art keywords
- error calibration
- error
- mechanical arm
- calibration data
- inertial navigation
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 122
- 238000004458 analytical method Methods 0.000 claims abstract description 24
- 238000012163 sequencing technique Methods 0.000 claims abstract description 24
- 238000012300 Sequence Analysis Methods 0.000 claims abstract description 17
- 238000009434 installation Methods 0.000 claims description 62
- 239000011159 matrix material Substances 0.000 claims description 16
- 238000004364 calculation method Methods 0.000 claims description 10
- 239000003550 marker Substances 0.000 claims description 9
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 238000007499 fusion processing Methods 0.000 claims description 4
- 238000000605 extraction Methods 0.000 claims 2
- 238000005259 measurement Methods 0.000 description 13
- 238000012360 testing method Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 238000010219 correlation analysis Methods 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 241000287196 Asthenes Species 0.000 description 1
- 238000012098 association analyses Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 230000014759 maintenance of location Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Navigation (AREA)
Abstract
本发明涉及惯性导航领域,公开了一种误差标定工艺生成方法及***,用于提高对捷联惯导进行误差标定时的效率。方法包括:对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合;对所述捷联惯导进行精度参数标定,得到参数标定数据集合;对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系;通过所述数据关联关系进行流程顺序分析,得到多个流程排序结果;基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺。
Description
技术领域
本发明涉及惯性导航技术领域,尤其涉及一种误差标定工艺生成方法及***。
背景技术
随着惯导技术的不断发展,配装捷联惯导已经成为标准配置,提高了无人工程车的自动化水平和作业精度,缩短了无人工程车的作业准备及反应时间。与此同时,对无人工程车配置捷联惯导的标校及其工艺提出了快速、高精度以及工艺流程中的工序可调换性提出了高的要求。
但是,在实际工作过程中,由于机械加工和安装误差的影响,导致捷联惯组和无人工程车及其机械臂之间的方位角和姿态角不一致。经常会由于进度要求,需要调换自动机械臂自动转向试验、全方位寻北试验以及水平定位精度试验的工艺顺序,一般情况下需要考虑各安装误差之间的嵌套关系,比如在标校载体机械臂安装误差前能否先进行捷联惯导与载车的安装误差标校、捷联惯导与坐标北间的安装误差会不会对定位精度产生影响等,而且目前在标校工艺中标校流程顺序无法变更,导致在对捷联惯导进行误差标定时效率较低。
发明内容
有鉴于此,本发明实施例提供了一种误差标定工艺生成方法及***,解决了对捷联惯导进行误差标定时效率较低的技术问题。
本发明提供了一种误差标定工艺生成方法,包括:对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合;对所述捷联惯导进行精度参数标定,得到参数标定数据集合;对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系;通过所述数据关联关系进行流程顺序分析,得到多个流程排序结果;基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺。
本发明提供的误差标定工艺生成方法,对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合,在此过程中中无需引入坐标北真值,只需用双经纬仪测得机械臂转向过程中的相对航向变化,再与惯导的相对变化量即可标定出捷联惯导与机械臂的航向安装误差角,进而对所述捷联惯导进行精度参数标定,得到参数标定数据集合,对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系,通过所述数据关联关系进行流程顺序分析,得到多个流程排序结果,基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺,本申请方案,在简化标校工艺流程的同时,还可以增加标校工艺程序的灵活性。
根据本发明中所述对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合步骤,包括:通过两点法对所述机械臂上的所述捷联惯导进行安装误差标定,得到第一误差标定数据;通过单标杆法对所述机械臂上的所述捷联惯导进行坐标北真值误差标定,得到第二误差标定数据;将所述第一误差标定数据及所述第二误差标定数据合并为所述误差标定数据集合。
根据本发明中所述通过两点法对所述机械臂上的所述捷联惯导进行安装误差标定,得到第一误差标定数据步骤,包括:通过两点法对所述机械臂进行标记点位置分析,确定标记点位置信息集合;基于所述标记点位置信息集合,通过预置的第一经纬仪及预置的第二经纬仪进行坐标系构建,得到标记点坐标系;通过所述第一经纬仪及所述第二经纬仪进行姿态角数据采集,得到目标姿态角信息;基于所述标记点坐标系及所述标记点位置信息集合,对所述目标姿态角信息进行安装误差标定,得到第一误差标定数据。
根据本发明中所述基于所述标记点坐标系及所述标记点位置信息集合,对所述目标姿态角信息进行安装误差标定,得到第一误差标定数据步骤,包括:基于所述标记点坐标系,对所述目标姿态角信息及所述标记点位置信息集合进行标记点坐标计算,得到目标标记点坐标集合;通过所述目标标记点坐标集合进行安装误差标定,得到第一误差标定数据。
根据本发明中所述通过单标杆法对所述机械臂上的所述捷联惯导进行坐标北真值误差标定,得到第二误差标定数据步骤,包括:通过单标杆法进行标定点位确定,得到第一基准点位及第二基准点位;对所述第一基准点位及所述第二基准点位进行方位角计算,得到基准点方位角;基于预设的多个机械臂朝向,依次对所述机械臂进行寻北密位值计算,得到多个寻北密位数据;通过所述多个寻北密位数据及所述基准点方位角进行坐标北真值误差标定,得到第二误差标定数据。
根据本发明中所述通过所述多个寻北密位数据及所述基准点方位角进行坐标北真值误差标定,得到第二误差标定数据步骤,包括:通过所述多个寻北密位数据依次对每一所述机械臂朝向进行安装误差标定,得到与每一所述机械臂朝向对应的误差标定数据;基于所述基准点方位角,对与每一所述机械臂朝向对应的误差标定数据进行数据融合处理,得到第二误差标定数据。
根据本发明中所述对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系步骤,包括:对所述误差标定数据集合及所述参数标定数据集合进行姿态角信息提取,得到待匹配姿态角信息;通过所述待匹配姿态角信息进行误差嵌套关系分析,得到目标嵌套关系;基于所述目标嵌套关系进行数据关联关系生成,得到数据关联关系。
本发明还提供了一种误差标定工艺生成***,包括:
误差标定模块,用于对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合;
参数标定模块,用于对所述捷联惯导进行精度参数标定,得到参数标定数据集合;
关系分析模块,用于对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系;
顺序分析模块,用于通过所述数据关联关系进行流程顺序分析,得到多个流程排序结果;
工艺生成模块,用于基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺。
附图说明
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例中误差标定工艺生成方法的流程图。
图2为本发明实施例中对安装在目标载体中机械臂上的捷联惯导进行误差标定的流程图。
图4为本发明实施例中对机械臂上的捷联惯导进行坐标北真值误差标定的流程图。
图5为本发明实施例中对误差标定数据集合及参数标定数据集合进行关联关系分析的流程图。
图6为本发明实施例中误差标定工艺生成***的示意图。
附图标记:
501、误差标定模块;502、参数标定模块;503、关系分析模块;504、顺序分析模块;505、工艺生成模块。
具体实施方式
下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在本发明的描述中,需要说明的是,术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”、“第三”仅用于描述目的,而不能理解为指示或暗示相对重要性。
此外,下面所描述的本发明不同实施方式中所涉及的技术特征只要彼此之间未构成冲突就可以相互结合。
为便于理解,下面对本发明实施例的具体流程进行描述,请参阅图1,图1是本发明实施例的误差标定工艺生成方法的流程图,如图1所示,该流程图包括以下步骤:
S101:对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合;
可以理解的是,本发明的执行主体可以为误差标定工艺生成装置,还可以是终端或者服务器,具体此处不做限定。本发明实施例以服务器为执行主体为例进行说明。
需要说明的是,误差标定数据集合包括但不限于捷联惯导与机械臂的安装误差及捷联惯导与坐标北真值间的安装误差,其中,捷联惯导与机械臂的安装误差可以为方向误差、横倾误差以及纵倾误差,在本申请方案中,分别通过两点法与单标杆法进行误差标定,得到误差标定数据集合。
S102:对捷联惯导进行精度参数标定,得到参数标定数据集合;
具体的,服务器启动定位定向导航设备并进行寻北试验,待寻北完毕后通过预知的操控标校界面确定标定起始点坐标,使得定位定向导航设备进入标定状态,然后控制该目标载体沿较为平直的路段行驶约3km准确停在另一标准坐标点/>上,此时记录定位定向导航设备在该测量点定位坐标值/>。并通过操控标校界面确定标定终点坐标/>,进一步的,服务器对标定终点坐标/>及测量点定位坐标值/>进行精度参数标定,得到参数标定数据集合,其中,该参数标定数据集合包括里程系数、航向安装误差、高低角误差。
S103:对误差标定数据集合及参数标定数据集合进行关联关系分析,确定数据关联关系;
S104:通过数据关联关系进行流程顺序分析,得到多个流程排序结果;
S105:基于多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺。
需要说明的是,在对安装在目标载体中机械臂上的捷联惯导进行误差标定及对捷联惯导进行精度参数标定时,所使用的多个姿态角存在对应的关联计算关系,在本申请实施例中,服务器对该多个姿态角进行关联关系分析,确定对应的数据关联关系,进而服务器根据该数据关联关系进行嵌套关系分析,确定对应的数据嵌套关系,并根据该数据嵌套关系进行标定流程执行顺序分析,确定多个流程排序结果,基于多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺。
通过执行上述步骤,对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合,在此过程中中无需引入坐标北真值,只需用双经纬仪测得机械臂转向过程中的相对航向变化,再与惯导的相对变化量即可标定出捷联惯导与机械臂的航向安装误差角,进而对所述捷联惯导进行精度参数标定,得到参数标定数据集合,对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系,通过所述数据关联关系进行流程顺序分析,得到多个流程排序结果,基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺,本申请方案,在简化标校工艺流程的同时,还可以增加标校工艺程序的灵活性。
在一具体实施例中,如图2所示,执行步骤S101的过程可以具体包括如下步骤:
S201:通过两点法对机械臂上的捷联惯导进行安装误差标定,得到第一误差标定数据;
S202:通过单标杆法对机械臂上的捷联惯导进行坐标北真值误差标定,得到第二误差标定数据;
S203:将第一误差标定数据及第二误差标定数据合并为误差标定数据集合。
具体的,服务器通过两点法对机械臂上的捷联惯导进行安装误差标定时,无需引入坐标北真值,只需用双经纬仪测得目标载体机械臂转向过程中的相对航向变化,并对该捷联惯导输出的相对变化量及该相对航向变化进行安装误差标定,即可得到第一误差标定数据,可以提升对误差数据标定的效率。进一步的,在服务器通过单标杆法对机械臂上的捷联惯导进行坐标北真值误差标定时,标定过程中只需要两个基准点,即目标载体当前位置的坐标值及1000米外的标杆坐标值。即可标定东南西北四个方向的安装误差值,同时根据四个方向的安装误差值进行坐标北真值误差标定,得到第二误差标定数据,最终将第一误差标定数据及第二误差标定数据合并为误差标定数据集合。
在一具体实施例中,执行步骤S201的过程可以具体包括如下步骤:
(1)通过两点法对机械臂进行标记点位置分析,确定标记点位置信息集合;
(2)基于标记点位置信息集合,通过预置的第一经纬仪及预置的第二经纬仪进行坐标系构建,得到标记点坐标系;
(3)通过第一经纬仪及第二经纬仪进行姿态角数据采集,得到目标姿态角信息;
(4)基于标记点坐标系及标记点位置信息集合,对目标姿态角信息进行安装误差标定,得到第一误差标定数据。
在一具体实施例中,对目标姿态角信息进行安装误差标定,得到第一误差标定数据的过程可以具体包括如下步骤:
(1)基于标记点坐标系,对目标姿态角信息及标记点位置信息集合进行标记点坐标计算,得到目标标记点坐标集合;
(2)通过目标标记点坐标集合进行安装误差标定,得到第一误差标定数据。
需要说明的是,通过两点法标定捷联惯导与机械臂的安装误差的基本原理是将目标载体停放于基本水平的地面上,机械臂云台可转动方位角,机械臂可转动高低角,捷联惯组安装于机械臂根部,在机械臂上做两个标记点a和b,确定标记点位置信息集合,使连线方向和该机械臂平行,同时获取第一经纬仪及第二经纬仪的位置信息,其中,在通过预置的第一经纬仪及预置的第二经纬仪进行坐标系构建时,通过预置的第一经纬仪及预置的第二经纬仪进行坐标系构建,得到标记点坐标系,其中,记第二经纬仪B在过第一经纬仪A的水平面上的投影为,以第一经纬仪所在位置A点为原点,/>为x轴,过A点竖直向上为z轴,建立标记点坐标系。
进一步的,采集第一经纬仪A测得第二经纬仪B相对于A的高低角为,测得标记点a的高低角为/>,由第一经纬仪A对标记点a和第二经纬仪B进行方位角测量,标记点a和第二经纬仪B之间的方位夹角为/>。同样的,由第二经纬仪B测量,可得到a的高低角/>,标记点a和第一经纬仪A之间的方位夹角为/>。设/>长度为单位1,以下求标记点a的坐标。
具体的,设标记点a在水平面上的投影为,则在/>中,由正弦定理两角(/>和/>)和一边(/>)可求得边长/>,其中,该标记点a在水平面上的投影为/>及边长/>等信息可以参阅图3,如图3所示,图3为在标记点坐标系中求解边长/>的示意图,其中,A点位坐标系中原点O的位置。
则标记点a的坐标为
当经纬仪水平投影线与真北夹角/>数值确定时,可由相对方位角求出机械臂相对于真北的方位角/>,进一步的,选取东北天地理坐标系作为导航坐标系,记为/>系,将载体系记为/>系,/>系经过三个欧拉角的转动,即航向角/>、俯仰角/>和横滚角,可得到/>系,用姿态矩阵表示为
进一步的,将机械臂坐标系记作系,同时默认设置捷联惯组与机械臂之间的横滚角没有安装误差,并设置捷联惯组与机械臂之间的方位角安装误差为/>,俯仰角安装误差为/>,进而服务器计算捷联惯组与机械臂之间的安装误差矩阵,如下所示:
相似的,由式(2)可近似得出
需要说明的是,由于经纬仪测量的是机械臂相对于双经纬仪水平连线的夹角,而不是机械臂相对于北向的真方位,因此在未知北向角的情况下,从一次测量中无法求出方位安装误差角,必须利用多次测量来实现,具体标定步骤如下:
在一具体实施例中,如图4所示,上述的步骤S202,具体包括如下步骤:
S301:通过单标杆法进行标定点位确定,得到第一基准点位及第二基准点位;
S302:对第一基准点位及第二基准点位进行方位角计算,得到基准点方位角;
S303:基于预设的多个机械臂朝向,依次对机械臂进行寻北密位值计算,得到多个寻北密位数据;
S304:通过多个寻北密位数据及基准点方位角进行坐标北真值误差标定,得到第二误差标定数据。
具体的,在对捷联惯导进行精度参数标定时,标定过程中只需要两个基准点,第一个基准点为目标载体所在位置的标准坐标点,第二个基准点为距离该目标载体所在位置1000m外的标杆标准坐标点,本申请实施例中,只需通过两个基准点即可标定东南西北四个方向的安装误差值,同时可根据四个方向的寻北值比较,对多个寻北密位数据及基准点方位角进行坐标北真值误差标定,得到第二误差标定数据。
需要说明的是,在一具体实施例中,上述的步骤S304,具体包括如下步骤:
(1)通过多个寻北密位数据依次对每一机械臂朝向进行安装误差标定,得到与每一机械臂朝向对应的误差标定数据;
(2)基于基准点方位角,对与每一机械臂朝向对应的误差标定数据进行数据融合处理,得到第二误差标定数据。
具体的,通过多个寻北密位数据依次对每一机械臂朝向进行安装误差标定,其中,在标定过程中只需要两个标准点,即停车点的标准坐标点Q及1000m外的标杆标准坐标点E,即可标定东南西北四个方向的安装误差值,同时可根据四个方向的寻北值比较,可以对该捷联惯导中两个水平陀螺的零偏进行修正。
事前准备标准坐标点Q和距离Q点大于1000米的标杆E(E点坐标需事先测得),点Q到点E间的坐标北为,调整目标载体和机械臂处于大致水平状态/>,目标载体回转中心对准标准坐标点Q,机械臂指向北向(±50密位),寻北3-5次,寻北结果求均值记为/>密位,并记录最后一次寻北结果减去均值的结果为/>密位,进入方位保持,转动目标载体或机械臂,用瞄镜瞄准标杆E,记录此时惯导方位值/>,则北向机械臂转向误差为:
进一步对,将机械臂指向南向(±50密位),记录保持值密位,寻北3-5次,记录寻北结果,求3-5次寻北结果均值/>,并记录最后一次寻北结果减去均值的结果为/>密位,进入方位保持,转动目标载体或机械臂,用瞄镜瞄准标杆E,记录此时惯导方位值/>。
则南向机械臂转向误差为:
同理可得,东西两个方向机械臂的方位误差为:
则,机械臂的方位误差为:
在上述标定过程中,可以对捷联惯导中两个水平陀螺进行零偏修正,进一步提高惯导定向精度。需要说明的是,在南北两个方向寻北和瞄杆工作完成后即可对X方向陀螺的零偏进行修正。
具体的,服务器计算载体系x轴陀螺漂移为
相应地,完成东西向寻北及瞄杆工作,计算载体系y轴陀螺漂移为:
在一具体实施例中,如图5所示,上述的步骤S103,具体包括如下步骤:
S401:对误差标定数据集合及参数标定数据集合进行姿态角信息提取,得到待匹配姿态角信息;
S402:通过待匹配姿态角信息进行误差嵌套关系分析,得到目标嵌套关系;
S403:基于目标嵌套关系进行数据关联关系生成,得到数据关联关系。
需要说明的是,服务器启动定位定向导航设备并进行寻北试验,待寻北完毕后通过预知的操控标校界面确定标定起始点坐标,使得定位定向导航设备进入标定状态,然后控制该目标载体沿较为平直的路段行驶约3km准确停在另一标准坐标点上,此时记录定位定向导航设备在该测量点定位坐标值/>。并通过操控标校界面确定标定终点坐标/>,进一步的,服务器对标定终点坐标/>及测量点定位坐标值/>进行精度参数标定,得到参数标定数据集合,其中,该参数标定数据集合包括里程系数、航向安装误差、高低角误差。
需要说明的是,两点法标定与定位相关参数基本原理为:
需要说明的是,在通过数据关联关系进行流程顺序分析,得到多个流程排序结果时,具体进行如下分析:
其中,从导航系到机械臂系转换矩阵,从而得出机械臂系下的姿态角,经标校捷联惯导与目标载体的安装误差为/>(其中/>为方位安装误差角,/>为俯仰安装误差角),从导航系N到目标载体系M转换矩阵/>,从而得出目标载体系下的姿态角/>。
进一步的,服务器对该多个姿态角进行关联关系分析,确定对应的数据关联关系,进而服务器根据该数据关联关系进行嵌套关系分析,确定对应的数据嵌套关系,并根据该数据嵌套关系进行标定流程执行顺序分析,确定多个流程排序结果,基于多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺。
本发明实施例还提供了一种误差标定工艺生成***,如图6所示,该误差标定工艺生成装置具体包括:
误差标定模块501,用于对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合;
参数标定模块502,用于对所述捷联惯导进行精度参数标定,得到参数标定数据集合;
关系分析模块503,用于对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系;
顺序分析模块504,用于通过所述数据关联关系进行流程顺序分析,得到多个流程排序结果;
工艺生成模块505,用于基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺。
上述各个模块的更进一步的功能描述与上述对应方法实施例相同,在此不再赘述,通过上述各个组成部分的协同合作,对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合,在此过程中中无需引入坐标北真值,只需用双经纬仪测得机械臂转向过程中的相对航向变化,再与惯导的相对变化量即可标定出捷联惯导与机械臂的航向安装误差角,进而对所述捷联惯导进行精度参数标定,得到参数标定数据集合,对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系,通过所述数据关联关系进行流程顺序分析,得到多个流程排序结果,基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺,本申请方案,在简化标校工艺流程的同时,还可以增加标校工艺程序的灵活性。
以上实施例仅用以说明本发明的技术方案而非对其限制,尽管参照上述实施例对本发明进行了详细的说明,所属领域的普通技术人员应当理解:依然可以对本发明的具体实施方式进行修改或者等同替换,而未脱离本发明精神和范围的任何修改或者等同替换,其均应涵盖在本发明的权利要求范围当中。
Claims (4)
1.一种误差标定工艺生成方法,其特征在于,包括如下步骤:
对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合,其中,所述对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合步骤,包括:通过两点法对所述机械臂上的所述捷联惯导进行安装误差标定,得到第一误差标定数据;通过单标杆法对所述机械臂上的所述捷联惯导进行坐标北真值误差标定,得到第二误差标定数据;将所述第一误差标定数据及所述第二误差标定数据合并为所述误差标定数据集合;其中,所述通过两点法对所述机械臂上的所述捷联惯导进行安装误差标定,得到第一误差标定数据步骤,包括:通过两点法对所述机械臂进行标记点位置分析,确定标记点位置信息集合;基于所述标记点位置信息集合,通过预置的第一经纬仪及预置的第二经纬仪进行坐标系构建,得到标记点坐标系;通过所述第一经纬仪及所述第二经纬仪进行姿态角数据采集,得到目标姿态角信息;基于所述标记点坐标系及所述标记点位置信息集合,对所述目标姿态角信息进行安装误差标定,得到第一误差标定数据;
所述通过单标杆法对所述机械臂上的所述捷联惯导进行坐标北真值误差标定,得到第二误差标定数据步骤,包括:通过单标杆法进行标定点位确定,得到第一基准点位及第二基准点位;对所述第一基准点位及所述第二基准点位进行方位角计算,得到基准点方位角;基于预设的多个机械臂朝向,依次对所述机械臂进行寻北密位值计算,得到多个寻北密位数据;通过所述多个寻北密位数据及所述基准点方位角进行坐标北真值误差标定,得到第二误差标定数据;
对所述捷联惯导进行精度参数标定,得到参数标定数据集合,其中,所述参数标定数据集合包括里程系数、航向安装误差、高低角误差;
对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系,其中,对所述误差标定数据集合及所述参数标定数据集合进行姿态角信息提取,得到待匹配姿态角信息;通过所述待匹配姿态角信息进行误差嵌套关系分析,得到目标嵌套关系;基于所述目标嵌套关系进行数据关联关系生成,得到数据关联关系;
通过所述数据关联关系进行流程顺序分析,得到多个流程排序结果,具体的,设捷联惯导解算输出姿态为(P,R,H),其中,需要说明的是,P、R、H分别为机械臂对应的三个方向的姿态角,则从导航系N到载体系B转换矩阵为,如下所示:
其中,从导航系到机械臂系转换矩阵,从而得出机械臂系下的姿态角,经标校捷联惯导与目标载体的安装误差为/>,其中,/>为方位安装误差角,/>为俯仰安装误差角,从导航系N到目标载体系M转换矩阵/>,从而得出目标载体系下的姿态角/>;
基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺。
2.根据权利要求1所述的误差标定工艺生成方法,其特征在于,所述基于所述标记点坐标系及所述标记点位置信息集合,对所述目标姿态角信息进行安装误差标定,得到第一误差标定数据步骤,包括:
基于所述标记点坐标系,对所述目标姿态角信息及所述标记点位置信息集合进行标记点坐标计算,得到目标标记点坐标集合;
通过所述目标标记点坐标集合进行安装误差标定,得到第一误差标定数据。
3.根据权利要求1所述的误差标定工艺生成方法,其特征在于,所述通过所述多个寻北密位数据及所述基准点方位角进行坐标北真值误差标定,得到第二误差标定数据步骤,包括:
通过所述多个寻北密位数据依次对每一所述机械臂朝向进行安装误差标定,得到与每一所述机械臂朝向对应的误差标定数据;
基于所述基准点方位角,对与每一所述机械臂朝向对应的误差标定数据进行数据融合处理,得到第二误差标定数据。
4.一种误差标定工艺生成***,用以执行如权利要求1至3任一项所述的误差标定工艺生成方法,其特征在于,包括:
误差标定模块,用于对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合,其中,所述对安装在目标载体中机械臂上的捷联惯导进行误差标定,得到误差标定数据集合步骤,包括:通过两点法对所述机械臂上的所述捷联惯导进行安装误差标定,得到第一误差标定数据;通过单标杆法对所述机械臂上的所述捷联惯导进行坐标北真值误差标定,得到第二误差标定数据;将所述第一误差标定数据及所述第二误差标定数据合并为所述误差标定数据集合,其中,所述通过两点法对所述机械臂上的所述捷联惯导进行安装误差标定,得到第一误差标定数据步骤,包括:通过两点法对所述机械臂进行标记点位置分析,确定标记点位置信息集合;基于所述标记点位置信息集合,通过预置的第一经纬仪及预置的第二经纬仪进行坐标系构建,得到标记点坐标系;通过所述第一经纬仪及所述第二经纬仪进行姿态角数据采集,得到目标姿态角信息;基于所述标记点坐标系及所述标记点位置信息集合,对所述目标姿态角信息进行安装误差标定,得到第一误差标定数据;
所述通过单标杆法对所述机械臂上的所述捷联惯导进行坐标北真值误差标定,得到第二误差标定数据步骤,包括:通过单标杆法进行标定点位确定,得到第一基准点位及第二基准点位;对所述第一基准点位及所述第二基准点位进行方位角计算,得到基准点方位角;基于预设的多个机械臂朝向,依次对所述机械臂进行寻北密位值计算,得到多个寻北密位数据;通过所述多个寻北密位数据及所述基准点方位角进行坐标北真值误差标定,得到第二误差标定数据;
参数标定模块,用于对所述捷联惯导进行精度参数标定,得到参数标定数据集合,其中,所述参数标定数据集合包括里程系数、航向安装误差、高低角误差;
关系分析模块,用于对所述误差标定数据集合及所述参数标定数据集合进行关联关系分析,确定数据关联关系,其中,对所述误差标定数据集合及所述参数标定数据集合进行姿态角信息提取,得到待匹配姿态角信息;通过所述待匹配姿态角信息进行误差嵌套关系分析,得到目标嵌套关系;基于所述目标嵌套关系进行数据关联关系生成,得到数据关联关系;
顺序分析模块,用于通过所述数据关联关系进行流程顺序分析,得到多个流程排序结果,具体的,设捷联惯导解算输出姿态为(P,R,H),其中,需要说明的是,P、R、H分别为机械臂对应的三个方向的姿态角,则从导航系N到载体系B转换矩阵为,如下所示:
其中,从导航系到机械臂系转换矩阵,从而得出机械臂系下的姿态角,经标校捷联惯导与目标载体的安装误差为/>,其中,/>为方位安装误差角,/>为俯仰安装误差角,从导航系N到目标载体系M转换矩阵/>,从而得出目标载体系下的姿态角/>;
基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺;
工艺生成模块,用于基于所述多个流程排序结果进行误差标定工艺生成,确定多个误差标定工艺。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310082015.6A CN115855116B (zh) | 2023-02-08 | 2023-02-08 | 误差标定工艺生成方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310082015.6A CN115855116B (zh) | 2023-02-08 | 2023-02-08 | 误差标定工艺生成方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115855116A CN115855116A (zh) | 2023-03-28 |
CN115855116B true CN115855116B (zh) | 2023-05-30 |
Family
ID=85657765
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310082015.6A Active CN115855116B (zh) | 2023-02-08 | 2023-02-08 | 误差标定工艺生成方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115855116B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105241478A (zh) * | 2015-10-13 | 2016-01-13 | 中国船舶重工集团公司第七一七研究所 | 一种单轴调制激光陀螺惯性导航***多坐标系标定方法 |
CN107186752A (zh) * | 2017-03-28 | 2017-09-22 | 江苏科技大学 | 一种波浪补偿打捞机器人*** |
CN107621254A (zh) * | 2017-09-10 | 2018-01-23 | 谢杰涛 | 一种身管轴线指向测试方法 |
CN112378399A (zh) * | 2020-07-16 | 2021-02-19 | 西安科技大学 | 基于捷联惯导和数字全站仪的煤矿巷道掘进机器人精确定位定向方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104154928B (zh) * | 2014-05-26 | 2017-02-01 | 北京航天控制仪器研究所 | 一种适用于惯性平台内置式星敏感器的安装误差标定方法 |
CN104613981A (zh) * | 2014-12-17 | 2015-05-13 | 中国人民解放军63863部队 | 一种惯导动态定向精度测试*** |
CN109781139A (zh) * | 2017-11-13 | 2019-05-21 | 中航通飞华南飞机工业有限公司 | 惯性基准***校准标定方法 |
CN207751467U (zh) * | 2017-12-12 | 2018-08-21 | 中国人民解放军63981部队 | 一种定向管随动精度检测设备 |
CN109556459B (zh) * | 2019-01-22 | 2024-02-27 | 中国人民解放军陆军工程大学 | 一种火箭炮惯导寻北精度检测***和方法 |
CN110646016B (zh) * | 2019-11-11 | 2021-04-13 | 北京航空航天大学 | 基于经纬仪与视觉辅助柔性基线分布式pos标校方法和装置 |
CN111537002B (zh) * | 2020-06-16 | 2022-05-24 | 北京航天发射技术研究所 | 一种激光捷联惯组安装误差的标定方法和定向方法 |
CN114460619A (zh) * | 2022-02-18 | 2022-05-10 | 中国船舶重工集团公司第七0七研究所 | 一种基于光学差分gps组合的高精度调炮检测方法 |
CN115615430B (zh) * | 2022-12-21 | 2023-03-10 | 中国船舶集团有限公司第七〇七研究所 | 基于捷联惯导的定位数据修正方法及*** |
-
2023
- 2023-02-08 CN CN202310082015.6A patent/CN115855116B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105241478A (zh) * | 2015-10-13 | 2016-01-13 | 中国船舶重工集团公司第七一七研究所 | 一种单轴调制激光陀螺惯性导航***多坐标系标定方法 |
CN107186752A (zh) * | 2017-03-28 | 2017-09-22 | 江苏科技大学 | 一种波浪补偿打捞机器人*** |
CN107621254A (zh) * | 2017-09-10 | 2018-01-23 | 谢杰涛 | 一种身管轴线指向测试方法 |
CN112378399A (zh) * | 2020-07-16 | 2021-02-19 | 西安科技大学 | 基于捷联惯导和数字全站仪的煤矿巷道掘进机器人精确定位定向方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115855116A (zh) | 2023-03-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107734457B (zh) | 智慧停车场导航***及方法 | |
CN101608920B (zh) | 一种组合式空间位姿精密动态测量装置及方法 | |
CN110631574B (zh) | 一种惯性/里程计/rtk多信息融合方法 | |
CN108458714B (zh) | 一种姿态检测***中不含重力加速度的欧拉角求解方法 | |
CN110926468A (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN112378399B (zh) | 基于捷联惯导和数字全站仪的煤矿巷道掘进机器人精确定位定向方法 | |
CN115615430B (zh) | 基于捷联惯导的定位数据修正方法及*** | |
CN110617795B (zh) | 一种利用智能终端的传感器实现室外高程测量的方法 | |
CN110057356B (zh) | 一种隧道内车辆定位方法及装置 | |
CN111637888A (zh) | 基于惯导和激光雷达单点测距的掘进机定位方法及*** | |
CN111121758B (zh) | 室内磁地图的快速建模与可信定位方法 | |
CN110361003A (zh) | 信息融合方法、装置、计算机设备和计算机可读存储介质 | |
CN115855116B (zh) | 误差标定工艺生成方法及*** | |
CN109945857B (zh) | 一种面向不动产实地测量的车载惯性定位方法及其装置 | |
CN111189446A (zh) | 一种基于无线电的组合导航方法 | |
CN114397480B (zh) | 声学多普勒测速仪误差估计方法、装置及*** | |
CN112965091B (zh) | 一种农业机器人定位方法及*** | |
CN113063397B (zh) | 一种隧道洞壁节理结构面产状测量方法 | |
CN113484843A (zh) | 一种激光雷达与组合导航间外参数的确定方法及装置 | |
CN113670297A (zh) | 一种基于mems和轮式里程计的离线定位方法 | |
CN113551688A (zh) | 车载定位定向导航设备无依托快速免拆卸标定方法及装置 | |
CN113252073A (zh) | 一种应用于目标定位***的现场标定方法及装置 | |
CN111912425A (zh) | 管线测量***与方法 | |
CN118225086B (zh) | 一种惯性系下位姿精密积分解算方法及*** | |
CN112284356B (zh) | 一种基于rtk的墙角坐标自动测量方法 |
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 |