CN115574843A - 采煤机惯性导航精度测评系统及测评方法、移动载体 - Google Patents
采煤机惯性导航精度测评系统及测评方法、移动载体 Download PDFInfo
- Publication number
- CN115574843A CN115574843A CN202211339102.7A CN202211339102A CN115574843A CN 115574843 A CN115574843 A CN 115574843A CN 202211339102 A CN202211339102 A CN 202211339102A CN 115574843 A CN115574843 A CN 115574843A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- track
- mobile carrier
- carrier
- data
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明涉及采煤机惯性导航精度测评系统及测评方法、移动载体。惯性导航精度测评系统包括:移动载体,待测的惯性导航设置在移动载体上,并且还设置有标杆组合导航系统以及用于控制移动载体的启停和速度的电控箱;轨道用以模拟采煤机的运行轨迹,移动载体能够在轨道的两端之间沿轨道往复运行;上位机用于接收和处理来自惯性导航的第一测量数据以及来自标杆组合导航系统的第二测量数据,并且,基于第一测量数据生成移动载体的第一运行轨迹作为待测数据,基于第二测量数据生成移动载体的第二运行轨迹作为基准数据,评估惯性导航的精度。本发明可以实现惯性导航的长时间在井下慢速反复测试、重复验证,使测评数据更精确、可靠。
Description
【技术领域】
本发明涉及惯性导航技术领域,具体地,本发明涉及采煤机惯性导航精度测评系统及测评方法、移动载体。
【背景技术】
惯性导航技术是无源导航,导航设备不需要向外界发射任何信号,也不需要实时接收外界信号,只需要给导航系统提供一次初始的位置,导航系统就可以在任何外界环境下(比如振动、冲击、湿热、雾气、粉尘等)连续测量的位置和姿态,无惧地形的起伏和倾斜,并根据需要按照要求进行信息输出。
惯性导航系统以其可以提供导航信息的全面性和自主性,使其在生产作业环境非常恶劣的矿井中采煤机定位上的应用成为可能。采煤机在井下作业需要铺设轨道,在实际采煤过程中,采煤机采煤时进刀需要一定的角度,因此需要对轨道进行调整,但实际的调整会有误差。由于采煤的工作面很长,该误差会不断累积,使得轨道弯曲不平。采煤机惯性导航通过测算采煤机的运行轨迹,能够反推实际轨道的曲线,从而对轨道进行补偿,以维持轨道的在可接受的范围内保持动态平衡。
因此,采煤机惯性导航的精度对于煤矿的开采显得尤为重要。目前现有的惯性导航的精度测评中,如授权公告号为CN108896042B、授权公告日为2021年6月29日的中国发明专利,将测试设备带坐标的步行结果信息与采用RTK-GNSS(实时动态测量-全球导航卫星系统)的定位设备的步行结果信息进行对比,得出误差统计。在实际煤矿井下进行采煤机惯性导航精度测评时,无法接收GNSS信号,从而无法对RTK-GNSS进行定位,因此在煤矿井下环境中无法采用RTK-GNSS对惯性导航的精度进行测评。
因此,亟需一种能够在煤矿井下进行采煤机惯性导航的精度测评的测评系统及测评方法、移动载体。
【发明内容】
有鉴于此,本发明提供了采煤机惯性导航精度测评系统及测评方法、移动载体,从而解决或者至少缓解了现有技术中存在的上述问题和其它方面的问题中的一个或多个。
为了实现前述目的,本发明的第一方面提供了一种采煤机惯性导航精度测评系统,其中,所述惯性导航精度测评系统包括:
移动载体,待测的惯性导航设置在所述移动载体上,并且在所述移动载体上还设置有标杆组合导航系统以及用于控制所述移动载体的启停和速度的电控箱;
固定的轨道,所述轨道用以模拟采煤机的运行轨迹,所述移动载体能够在所述轨道的两端之间沿所述轨道往复运行;以及
上位机,所述上位机用于接收和处理来自所述惯性导航的第一测量数据以及来自所述标杆组合导航系统的第二测量数据,并且,基于所述第一测量数据生成所述移动载体的第一运行轨迹作为待测数据,基于所述第二测量数据生成所述移动载体的第二运行轨迹作为基准数据,并且基于所述待测数据和所述基准数据评估所述惯性导航的精度。
在如前所述的惯性导航精度测评系统中,可选地,所述上位机设置在所述移动载体上或者相对于所述移动载体远程设置。
在如前所述的惯性导航精度测评系统中,可选地,所述标杆组合导航系统叠置在所述惯性导航上。
在如前所述的惯性导航精度测评系统中,可选地,所述惯性导航的位置贴近所述轨道。
在如前所述的惯性导航精度测评系统中,可选地,所述移动载体具有前轮、后轮及载体平台,所述前轮和后轮能够沿所述轨道行进并且分别位于所述载体平台的前后两端处,所述载体平台紧邻地凹入在所述前轮和所述后轮之间,并且所述惯性导航设置在所述载体平台上。
在如前所述的惯性导航精度测评系统中,可选地,所述轨道的两端处均设置有限位装置,在所述移动载体上设置有限位开关,当所述移动载体运行到所述轨道的两端时,所述限位装置触发所述限位开关从而触发所述电控箱停止所述移动载体或者使所述移动载体反向移动。
为了实现前述目的,本发明的第二方面提供了一种移动载体,其特征在于,所述移动载体用于采煤机惯性导航精度测评系统,所述惯性导航精度测评系统包括:
所述移动载体、待测的惯性导航以及标杆组合导航系统;
固定的轨道,所述轨道用以模拟采煤机的运行轨迹,所述移动载体能够在所述轨道的两端之间沿所述轨道往复运行;
上位机,所述上位机用于接收和处理来自所述惯性导航的第一测量数据以及来自所述标杆组合导航系统的第二测量数据,并且基于所述第一测量数据生成所述移动载体的第一运行轨迹作为待测数据,基于所述第二测量数据生成所述移动载体的第二运行轨迹作为基准数据,并且基于所述待测数据和所述基准数据评估所述惯性导航的精度
其中,所述惯性导航和所述标杆组合导航系统设置在所述移动载体上,并且在所述移动载体上还设置有用于控制所述移动载体的启停和速度的电控箱。
在如前所述的移动载体中,可选地,所述移动载体上还设置有所述上位机。
在如前所述的移动载体中,可选地,所述移动载体具有前轮、后轮及载体平台,所述前轮和后轮能够沿所述轨道行进并且分别位于所述载体平台的前后两端处,所述载体平台紧邻地凹入在所述前轮和所述后轮之间,并且所述惯性导航设置在所述载体平台上,使得所述惯性导航的位置始终贴近所述轨道。
为了实现前述目的,本发明的第三方面提供了一种采煤机惯性导航精度测评方法,其中,所述惯性导航测评方法包括以下步骤:
步骤A:设置移动载体及固定的轨道,所述移动载体能够在所述轨道的两端之间沿所述轨道往复运行,在所述移动载体上装载有待测的惯性导航和标杆组合导航系统,所述轨道用于模拟采煤机的运行轨迹;
步骤B:所述移动载体上电,并且所述惯性导航和所述标杆组合导航系统在静止状态同时进行初始对准解算;
步骤C:启动所述移动载体在所述轨道的两端之间沿所述轨道往复运行,同时记录所述惯性导航的第一测量数据与所述标杆组合导航系统的第二测量数据;
步骤D:基于所述第一测量数据生成所述移动载体的第一运行轨迹作为待测数据,基于所述第二测量数据生成所述移动载体的第二运行轨迹作为基准数据,并且基于所述待测数据和所述基准数据评估所述惯性导航的精度。
在如前所述的惯性导航精度测评方法中,可选地,所述移动载体的运行速度在3米每分钟至20米每分钟之间,每次测试的时间周期在6至8小时之间。
在如前所述的惯性导航精度测评方法中,可选地,所述惯性导航始终贴近所述轨道设置于所述移动载体。
在如前所述的惯性导航精度测评方法中,可选地,所述移动载体具有前轮、后轮及载体平台,所述前轮和后轮能够沿所述轨道行进并且分别位于所述载体平台的前后两端处,所述载体平台紧邻地凹入在所述前轮和所述后轮之间,并且所述惯性导航设置在所述载体平台上。
在如前所述的惯性导航精度测评方法中,可选地,所述步骤D为在线或者离线进行。
在如前所述的惯性导航精度测评方法中,可选地,在所述步骤D中,对所述待测数据与所述基准数据进行偏差计算统计,所述偏差计算统计包括整体轨迹偏差的均方根误差和偏差最大值。
在如前所述的惯性导航精度测评方法中,可选地,在所述步骤D中,将所述待测数据与所述基准数据的起点和终点分别对齐,然后统计包括整体轨迹偏差的均方根误差和偏差最大值。
在如前所述的惯性导航精度测评方法中,可选地,在所述步骤D中,将所述惯性导航两次测量的所述待测数据进行偏差计算统计,所述偏差计算统计包括整体轨迹偏差的均方根误差和偏差最大值。
本发明的采煤机惯性导航精度测评系统及测评方法,通过移动载体、固定的轨道的相互配合模拟采煤机在井下作业的状况与环境,采用能够在煤矿井下作业的标杆组合导航系统,并且根据该标杆组合导航系统的数据,以测评惯性导航的精度。基于上述采煤机惯性导航精度测评系统、测评方法,本发明的同时提供了一种移动载体,该移动载体适用于上述采煤机惯性导航精度测评系统以实现其有益效果和优点。本发明可以实现惯性导航的长时间井下慢速反复测试、重复验证,使测评数据更精确、可靠。
【附图说明】
参照附图,本发明的公开内容将更加显然。应当了解,这些附图仅仅用于说明的目的,而并非意在对本发明的保护范围构成限制。图中:
图1为本发明的采煤机惯性导航精度测评系统的一个实施例的示意图,其中示出了移动载体及轨道;
图2为图1中移动载体在轨道的弯曲段的示意图;
图3为本发明的移动载体的另一实施例在轨道的弯曲段的示意图;
图4为本发明的采煤机惯性导航精度测评方法的一个实施例的流程图;
图5为本发明的采煤机惯性导航精度测评轨迹整体绝对偏差评估示意图;
图6为本发明的采煤机惯性导航精度测评轨迹偏离度评估示意图;以及
图7为本发明的采煤机惯性导航精度测评轨迹重复度评估示意图。
附图标记:10-移动载体;11-前轮;12-后轮;13-载体平台;14-限位开关;20-惯性导航;30-标杆组合导航系统;40-电控箱;50-上机位;60-轨道;61-限位装置;A-起点;B-真实终点;B’-计算终点;n-点位。
【具体实施方式】
参照附图和具体实施例,下面将以示例方式来说明根据本发明的采煤机惯性导航精度测评系统及测评方法、移动载体。此外,对于在本文提及的实施例中予以描述或隐含的任意单个技术特征,或者被显示或隐含在各附图中的任意单个技术特征,本发明仍然允许在这些技术特征(或其等同物)之间继续进行任意组合或者删减而不存在任何的技术障碍,从而应当认为这些根据本发明的更多实施例也是在本文的记载范围之内。
还需要说明的是,术语“上”、“下”、“前”、“后”、“高”、“低”等指示的方位或位置关系为基于附图所示即采煤机惯性导航精度测评系统中移动载体的相对上下、前后、高低方向的方位或位置关系,仅是为了便于描述本公开和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本公开的限制。在本公开的描述中,“多个”的含义是至少两个,例如两个、三个或更多等,除非另有明确具体的限定。
图1为本发明的采煤机惯性导航精度测评系统的一个实施例的示意图,其中示出了移动载体。图2为图1中移动载体在轨道的弯曲段的示意图;图3为本发明的移动载体的另一实施例在轨道的弯曲段的示意图。
从图中可以看出,所述惯性导航精度测评系统包括移动载体10、轨道60以及上位机50。在移动载体10上设置有标杆组合导航系统30,在图中的实施例中,该标杆组合导航系统30为无源导航系统,不必在外部搭建基站,因此该标杆组合导航系统30,可以节省校准步骤以及测评空间。
具体地,该标杆组合导航系统30可以为惯性导航,该惯性导航为常用、其精度已得到本领域认可的导航系统。该惯性导航精度高、技术全面,可以实时监测采煤机的轨迹,从而得到精准的监测数据,并能实现在煤矿井下对待测的惯性导航进行精度测评。由于惯性导航为无源导航技术,不需要向外界发射任何信号,也不需要实时接收外界信号,因此不需要设置外部基站。并且该惯性导航可以根据需要按照要求进行信息输出,因此其能够在煤矿井下运行,并且采用本领域认可的惯性导航可以得到更精确的数据。
在可选的实施例中,标杆组合导航系统30也可以采用其他无源导航系统。
所述移动载体10用以模拟采煤机,其能够沿轨道60往复运行。惯性导航20设置在该移动载体10上。在移动载体10往复运行于轨道60上的同时,惯性导航20能够监测该移动载体10的运行轨迹,并将所监测出的数据输出为第一测量数据。
移动载体10的具体形式不限。如图2的实施例中,其可以呈小车的形式,包括车轮和其所承载的载体平台13,各种部件如惯性导航20、标杆组合导航系统 30、电控箱 40、上位机50等可以布置在载体平台上。小车能够通过车轮在轨道60上行走。从图2的实施例可以清楚地看出,载体平台13较长,使得前轮11与后轮12之间的距离也较长,从而使得在移动载体13上的惯性导航20在轨道60的弯曲段上略偏离轨道60,从而使得惯性导航20在轨道60的弯曲段上测得的数据略有偏差。为了解决上述问题,可以采用如图3的实施例,仅将惯性导航20设置在车轮之间的载体平台13上,以缩短载体平台、缩短前后车轮之间的距离,使前后车轮之间的距离基本上等于惯性导航的长度,减小惯性导航20相对于轨道60的偏离,从而提高其测量精度。标杆组合导航系统30可以设置在惯性导航20顶上;其它部件例如电控箱40、上位机50等可以设置在移动载体10的前端或后端、而不设置在前后车轮之间。标杆组合导航系统30的位置靠近惯性导航,有利于增加测评的准确性。
根据图1的实施例中,轨道60为固定的轨道。相对于非固定轨道每次都要标杆组合导航系统、或者在一些测评方法中使用RTK-GNSS移动站、全站仪的棱镜去做基准数值然后用惯性导航与其对比而言,本实施例中的固定轨道,则可以重复利用,使用方便且成本低,在建立起实验平台后可以重复多次使用,并且避免了不同操作人员操作标杆组合导航系统或者RTK-GNSS移动站、棱镜的水平不同导致的误差波动。在本实施例中,固定轨道将把测试的过程标准化,对操作人员要求低,有利于得出更加客观的结果。
在不同的实施例中,其可以为弯的轨道,用以模拟采煤机在井下作业时所可能的起伏、弯曲的运行轨迹。从图中可以看出,该轨道60可以具有高低起伏段,也可以具有左右弯曲段,并且还可以同时具有高低起伏和左右弯曲的段。在此,并不排除轨道60具有局部的直段。
该移动载体10能够在该轨道60的两端之间沿轨道60往复运行,用以模拟采煤机在井下作业的实际运行状况。该固定的轨道60能够固定移动载体10的运行路线,以减少运行路线对惯性导航20精度测评的影响,再通过移动载体10的往复运行,对惯性导航20的进行反复测试、重复验证,使测评数据更精确、可靠。
在实际运用中,还可以对固定轨道60进行建模,可以更具象地对比惯性导航20所测出的轨迹的精确度。在可选的实施例中,轨道60也可以为可移动的轨道,以模拟矿下采煤机的可推动的轨道。并且该轨道60可以为单轨道,该单轨道结构简单、材料节省,通过移动载体10抱紧轨道,其能够随着该轨道60的高低起伏平稳地上坡和下坡,不易侧翻。在采煤机惯性导航精度测评中,移动载体10运行越平稳,就越能排除移动载体10的晃动对于测评结果的影响,从而能够更精确测评出惯性导航20的精度。
在可选的实施例中,该轨道60也可以为双轨道、多轨道等。在一些情况下,相应的移动载体10可以具有相对简单的结构设计,有益于简化制造难度、节省成本。
在可选的实施例中,该轨道60可以由主支撑杆固定,该主支撑杆的上端连接该轨道60,该主支撑杆的下端垂直固定在地面上。为了让轨道60更稳固地固定在地面上,可以再设置一根或两根辅支撑杆,交叉固定在主支撑杆上,形成三角支撑。在具体运用中,该轨道60的高处可以采用上述三角支撑固定,在该轨道60的低处,可以仅采用两根支撑杆固定,以节省材料。
可选地,在实际运用中也可以采用更多根支撑杆进行固定,该些支撑杆相互形成夹角,使轨道60能更牢固地固定在地面上。需要说明的是,上述的支撑杆的连接和固定方式可以为螺栓连接,也可以为绑定、铆钉、焊接等。
在图1的实施例中,如前所述,在移动载体10上还设置有电控箱40,用于控制移动载体10的启停和速度。工作人员可以对该电控箱进行远程控制、远程调节,或者通过计算机程序进行自行调节。
为了配合电控箱40的操作,轨道60的两端处可以均设置有限位装置61。相对应地,移动载体10上可以设置有限位开关14。当移动载体10运行到轨道60的两端时,限位装置61触发相应的限位开关14,从而触发电控箱40停止该移动载体10或者使该移动载体10反向移动。该电控箱40可以通过设置在其上的控制面板进行控制,也可以通过例如手机等移动终端进行远程控制。在其它实施例中,限位装置61也可以设置在轨道两端的侧旁能够触发限位开关14处。
从图中还可以看出,该移动载体10具有前轮11、后轮12,所述前轮11和所述后轮12能够沿轨道60行进,从而使得移动载体10沿轨道运行。在可选的实施例中,可以在前轮11和后轮12上各自分别安装电机,该移动载体10运行时,前后两个电机同时开启引导前轮11和后轮12转动,以保证该移动载体10运行的速度稳定。
在具体实施过程中,在该移动载体10上还可以进一步安装轮速编码器,该轮速编码器可以实时监控移动载体10的瞬时速度。该轮速编码器可以采用电池进行无源供电,从而不会对移动载体10在轨道60运行产生阻碍。在可选的实施例中,移动载体10也可以设置其它数量的一个或多个轮子,只要能够确保移动载体10在轨道60上平稳地运行即可。
根据图1的实施例,该移动载体10还具有载体平台13。如图中所示,所述前轮11和所述后轮12分别位于载体平台13的前后两端处,惯性导航20设置在该载体平台13上,位于前轮11和后轮12之间。该载体平台13紧邻地凹入在前轮11和后轮12之间,既能够缩小整个移动载体10的长度尺寸,又能够更加贴近轨道60,并且在该移动载体10运行过程中保持平稳。因此,在该载体平台13上的惯性导航20的位置也始终贴近轨道60,以确保惯性导航20在测评过程中能够尽量贴近轨道60、使其运行轨迹贴合轨道的轨迹。
根据该实施例,以标杆组合导航系统30所测出第二测量数据为基准数据,该基准数据能精准的表明移动载体10的运动轨迹。基于第一测量数据生成移动载体10的第一运行轨迹作为待测数据,基于第二测量数据生成移动载体10的第二运行轨迹作为基准数据,并且基于该待测数据和基准数据可以评估惯性导航20的精度,由于基准数据的精确性,从而得到的评估数据更为可靠。该评估测评可以为在线或者离线进行,在实际测评过程中,可以根据具体需要进行选择。这些计算可以在上位机中进行;或者可以在与上位机连接的其它计算机或笔记本上进行;或者部分在上位机中进行部分在与其连接的其它计算机或笔记本上进行,并且可以在计算机或笔记本上进行直观的显示。
由于惯性导航的原理是测量XYZ三轴的角速度和加速度,该角速度测出来的时间积分就是角度,然后加速度测出来的时间积分是距离,通过距离和角度绘制挖煤机的行径路线。然后通过每个时刻挖煤机的速度和距离以及方向绘制出采煤机的运行的曲线来反推轨道的曲线。
根据惯性导航20的运算方法,可以得知移动载体10的运行速度越慢,会导致惯性导航20的精度越低。在该实施例中,为了更进一步测得惯性导航20的精度,设置移动载体10以较慢的速度在固定轨道上运行,该运行速度可以在3米每分钟至20米每分钟之间,以测评惯性导航20在低速情况下的精度。该运行速度同时也模拟了采煤机在井下作业时的运行速度,因此所监测出的第一测量数据更贴近实际情况,该测评数据能更精确地反映惯性导航20的精度,方便研发人员对惯性导航20进行调试。
在该实施例中,采煤机惯性导航精度测评系统每次测试的时间周期可以在6至8小时之间,以模拟真实井下采煤机的运行时间,即煤矿工人换班断电的时间。并且,本发明的采煤机惯性导航精度测评系统能够长时间慢速反复测试,在模拟采煤机在井下作业的同时进行重复验证,使测评数据更精确、可靠。在实际测试过程中,可以根据具体测评内容选择测试时间,可以选在0至8小时之间的任意时间。
根据图中的实施例,所述惯性导航精度测评系统还包括上位机50,该上位机50可以用于接收和处理来自惯性导航20的第一测量数据以及来自标杆组合导航系统30的第二测量数据,并且,基于第一测量数据生成移动载体10的第一运行轨迹作为待测数据,基于第二测量数据生成移动载体10的第二运行轨迹作为基准数据,并且基于待测数据和基准数据评估惯性导航20的精度。
该上位机50可以如图中实施例设置在移动载体10上,直接与设置在移动载体10上的惯性导航20和标杆组合导航系统30连接,以显示惯性导航20的第一测量数据生成移动载体10的第一运行轨迹曲线,和标杆组合导航系统30的第二测量数据生成移动载体10的第二运行轨迹曲线。
在可选的实施例中,该上位机50也可以在相对于移动载体10远程设置,以远程观察惯性导航20与标杆组合导航系统30所监测到的移动载体10的运行情况,并且基于待测数据和基准数据评估惯性导航20的精度。该上位机50可以为电脑,也可以为移动设备等。
根据上述的惯性导航精度测评系统,本发明进一步提供了采煤机惯性导航精度测评方法。图4为本发明的采煤机惯性导航精度测评方法的一个实施例的流程图。由于该实施例的惯性导航精度测评方法采用上述的惯性导航精度测评系统,因此也具有上述测评系统的所有优点。
如图4所示,该实施例的惯性导航精度测评方法包括以下步骤:
步骤A:设置移动载体10及固定的轨道60,移动载体10能够在轨道60的两端之间沿轨道60往复运行。该移动载体10用以模拟采煤机,移动载体10的限位开关14触碰到位于轨道60两端的限位装置61时,触发电控箱40以停止移动载体10。此时,可以由测评人员发送信号,使移动载体10向反方向移动,或者电控箱40自动发送信号使移动载体10反向移动。移动载体10的往复运行,能够实现惯性导航精度的反复测试、反复验证,从而得到更可靠的测评数据。
在移动载体10上装载有待测的惯性导航20、标杆组合导航系统30,轨道60用于模拟采煤机的运行轨迹。移动载体10的载体平台13紧邻地凹入在前轮11和后轮12之间(如图1所示),该载体平台13的这种结构更贴近轨道60,并且惯性导航20设置在载体平台13上,因此,相对于未将载体平台13凹入的情形,该惯性导航20始终贴近轨道60,能够更精确地进行监测。
步骤B:移动载体10上电。惯性导航20和标杆组合导航系统30启动,该惯性导航20和该标杆组合导航系统30在静止状态同时进行初始对准解算。
在可选的实施例中,该标杆组合导航系统30可以采用惯性导航系统,在静止状态进行初始对准解算,从而获得移动载体10的初始空间位置。在实际测评过程中,也可以采用其他无源导航系统,只要能够在井下作业即可。
来自惯性导航20的第一测量数据与来自标杆组合导航系统30的第二测量数据进行对比,以测评惯性导航20的精度。
步骤C:启动移动载体10。
移动载体10的运行速度在3米每分钟至20米每分钟之间,每次测试的时间周期在6至8小时之间,以模拟采煤机在井下实际的运行速度和工作时间。在实际测试过程中,可以根据具体测评内容选择测试时间,可以选在0至8小时之间的任意时间。
在测评时,惯性导航20在轨道60的两端之间沿轨道60往复运行移动载体10。同时上位机50记录在点位处惯性导航20的第一测量数据与标杆组合导航系统30的第二测量数据。
在可选的实施例中,该标杆组合导航系统30可以采用惯性导航系统,当移动载体10运行时,惯性导航系统监测移动载体10的运行轨迹,并生成移动载体10的运行轨迹曲线,并通过惯性导航服务器上传到上位机50。在实际测评过程中,也可以采用其他无源导航系统,只要能够在井下作业即可。
步骤D:基于第一测量数据生成移动载体10的第一运行轨迹作为待测数据,基于第二测量数据生成移动载体10的第二运行轨迹作为基准数据。上位机50将基于待测数据和基准数据,评估惯性导航20的精度。在此需要说明的是,上位机50的评估测评可以为在线或者离线进行,即在测量的同时评估或者在测量时存储数据然后在测量结束后评估。在实际测评过程中,可以根据具体需要进行选择。
该评估方法可以分为轨迹整体绝对偏差评估、轨迹偏离度评估以及轨迹重复度评估。
图5为本发明的采煤机惯性导航精度测评轨迹整体绝对偏差评估示意图。如图,在轨迹整体绝对偏差评估中,对待测数据A B’线段与基准数据AB线段的所有轨迹点位n进行偏差计算统计,统计在所有点位n处的均方根误差和偏差最大值。该方法对待测数据A B’线段与基准数据AB线段进行严格时间同步。需要说明的是,轨迹整体绝对偏差评估不仅包含起点A到真实终点B和计算终点B’的积分累积误差,同时还包含起点A处的初始对准航向误差导致的整体旋转偏差。
图6为本发明的采煤机惯性导航精度测评轨迹偏离度评估示意图。如图,在轨迹偏离度评估中,需要将待测数据与基准数据的起点A和终点B和B’分别对齐,然后统计在所有点位n处的均方根误差和偏差最大值。该方法的待测数据与基准数据进行严格时间同步。需要说明的是,轨迹的偏离度误差仅与起点到终点的待测数据与基准数据积分解算累积误差相关。
图7为本发明的采煤机惯性导航精度测评轨迹重复度评估示意图。如图,轨迹重复度评估中,需要移动载体10在固定的轨道60上来回运行。记录每一次移动载体10运行解算的轨迹,统计每一次轨迹各点相对其余轨迹对应各点的均方根误差和偏差最大值。需要说明的是,轨迹的偏离度误差仅与起点A到终点B的待测数据与基准数据积分解算累积误差相关,与初始对准误差无关。可选地,该评估方法将惯性导航20两次测量的待测数据进行偏差计算统计,偏差计算统计包括整体轨迹偏差的均方根误差和偏差最大值。在实际测评过程中,可以对惯性导航20多次测量数据进行偏差计算统计,以重复验证,使测评数据更精确、可靠。
本发明的采煤机惯性导航精度测评系统,通过移动载体10、固定的轨道60的相互配合模拟采煤机在井下作业的状况与环境,并且将惯性导航20与标杆组合导航系统30测出的数据进行对比,更精准地评估惯性导航20的精度,以方便研发人员的后续研发以及调试。另外,通过采用标杆组合导航系统,也避免了例如在采用RTK-GNSS测绘系统及全站仪时人工操作的不确定性,有利于得出更加客观的结果。
在图5至图7中,n、n-1、n-2、n-3、n-4、n-5分别表示不同的测量点位。
本发明同时提供了用于上述采煤机惯性导航精度测评系统的移动载体10,该移动载体10适用于上述采煤机惯性导航精度测评系统以实现其所有优点。
进一步地,本发明还提供了根据上述采煤机惯性导航精度测评系统的精度测评方法,通过该精度测评方法能够更精确地获得测评数值。
综上所述,本发明可以实现对惯性导航20的长时间慢速反复动态测试,在模拟采煤机真实井下作业的同时进行重复验证,使测评数据更精确、可靠。
本发明的技术范围不仅仅局限于上述说明书中的内容,本领域技术人员可以在不脱离本发明技术思想的前提下,对上述实施方式进行多种变形和修改,而这些变形和修改均应当属于本发明的范围内。
Claims (17)
1.一种采煤机惯性导航精度测评系统,其特征在于,所述惯性导航精度测评系统包括:
移动载体,待测的惯性导航设置在所述移动载体上,并且在所述移动载体上还设置有标杆组合导航系统以及用于控制所述移动载体的启停和速度的电控箱;
固定的轨道,所述轨道用以模拟采煤机的运行轨迹,所述移动载体能够在所述轨道的两端之间沿所述轨道往复运行;以及
上位机,所述上位机用于接收和处理来自所述惯性导航的第一测量数据以及来自所述标杆组合导航系统的第二测量数据,并且,基于所述第一测量数据生成所述移动载体的第一运行轨迹作为待测数据,基于所述第二测量数据生成所述移动载体的第二运行轨迹作为基准数据,并且基于所述待测数据和所述基准数据评估所述惯性导航的精度。
2.如权利要求1所述的惯性导航精度测评系统,其中,所述上位机设置在所述移动载体上或者相对于所述移动载体远程设置。
3.如权利要求1所述的惯性导航精度测评系统,其中,所述标杆组合导航系统叠置在所述惯性导航上。
4.如权利要求1所述的惯性导航精度测评系统,其中,所述惯性导航的位置贴近所述轨道。
5.如权利要求4所述的惯性导航精度测评系统,其中,所述移动载体具有前轮、后轮及载体平台,所述前轮和后轮能够沿所述轨道行进并且分别位于所述载体平台的前后两端处,所述载体平台紧邻地凹入在所述前轮和所述后轮之间,并且所述惯性导航设置在所述载体平台上。
6.如权利要求1所述的惯性导航精度测评系统,其中,所述轨道的两端处均设置有限位装置,在所述移动载体上设置有限位开关,当所述移动载体运行到所述轨道的两端时,所述限位装置触发所述限位开关从而触发所述电控箱停止所述移动载体或者使所述移动载体反向移动。
7.一种移动载体,其特征在于,所述移动载体用于采煤机惯性导航精度测评系统,所述惯性导航精度测评系统包括:
所述移动载体、待测的惯性导航以及标杆组合导航系统;
固定的轨道,所述轨道用以模拟采煤机的运行轨迹,所述移动载体能够在所述轨道的两端之间沿所述轨道往复运行;
上位机,所述上位机用于接收和处理来自所述惯性导航的第一测量数据以及来自所述标杆组合导航系统的第二测量数据,并且基于所述第一测量数据生成所述移动载体的第一运行轨迹作为待测数据,基于所述第二测量数据生成所述移动载体的第二运行轨迹作为基准数据,并且基于所述待测数据和所述基准数据评估所述惯性导航的精度其中,所述惯性导航和所述标杆组合导航系统设置在所述移动载体上,并且在所述移动载体上还设置有用于控制所述移动载体的启停和速度的电控箱。
8.如权利要求7所述的移动载体,其中,所述移动载体上还设置有所述上位机。
9.如权利要求7所述的移动载体,其中,所述移动载体具有前轮、后轮及载体平台,所述前轮和后轮能够沿所述轨道行进并且分别位于所述载体平台的前后两端处,所述载体平台紧邻地凹入在所述前轮和所述后轮之间,并且所述惯性导航设置在所述载体平台上,使得所述惯性导航的位置始终贴近所述轨道。
10.一种采煤机惯性导航精度测评方法,其特征在于,所述惯性导航测评方法包括以下步骤:
步骤A:设置移动载体及固定的轨道,所述移动载体能够在所述轨道的两端之间沿所述轨道往复运行,在所述移动载体上装载有待测的惯性导航和标杆组合导航系统,所述轨道用于模拟采煤机的运行轨迹;
步骤B:所述移动载体上电,并且所述惯性导航和所述标杆组合导航系统在静止状态同时进行初始对准解算;
步骤C:启动所述移动载体在所述轨道的两端之间沿所述轨道往复运行,同时记录所述惯性导航的第一测量数据与所述标杆组合导航系统的第二测量数据;
步骤D:基于所述第一测量数据生成所述移动载体的第一运行轨迹作为待测数据,基于所述第二测量数据生成所述移动载体的第二运行轨迹作为基准数据,并且基于所述待测数据和所述基准数据评估所述惯性导航的精度。
11.如权利要求10所述的惯性导航精度测评方法,其中,所述移动载体的运行速度在3米每分钟至20米每分钟之间,每次测试的时间周期在6至8小时之间。
12.如权利要求10所述的惯性导航精度测评方法,其中,所述惯性导航始终贴近所述轨道设置于所述移动载体。
13.如权利要求12所述的惯性导航精度测评方法,其中,所述移动载体具有前轮、后轮及载体平台,所述前轮和后轮能够沿所述轨道行进并且分别位于所述载体平台的前后两端处,所述载体平台紧邻地凹入在所述前轮和所述后轮之间,并且所述惯性导航设置在所述载体平台上。
14.如权利要求10所述的惯性导航精度测评方法,其中,所述步骤D为在线或者离线进行。
15.如权利要求10至14中任一项所述的惯性导航精度测评方法,其中,在所述步骤D中,对所述待测数据与所述基准数据进行偏差计算统计,所述偏差计算统计包括整体轨迹偏差的均方根误差和偏差最大值。
16.如权利要求10至14中任一项所述的惯性导航精度测评方法,其中,在所述步骤D中,将所述待测数据与所述基准数据的起点和终点分别对齐,然后统计包括整体轨迹偏差的均方根误差和偏差最大值。
17.如权利要求10至14中任一项所述的惯性导航精度测评方法,其中,在所述步骤D中,将所述惯性导航两次测量的所述待测数据进行偏差计算统计,所述偏差计算统计包括整体轨迹偏差的均方根误差和偏差最大值。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211339102.7A CN115574843A (zh) | 2022-10-28 | 2022-10-28 | 采煤机惯性导航精度测评系统及测评方法、移动载体 |
PCT/CN2023/083421 WO2024087479A1 (zh) | 2022-10-28 | 2023-03-23 | 采煤机惯性导航精度测评系统及测评方法、移动载体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211339102.7A CN115574843A (zh) | 2022-10-28 | 2022-10-28 | 采煤机惯性导航精度测评系统及测评方法、移动载体 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115574843A true CN115574843A (zh) | 2023-01-06 |
Family
ID=84586540
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211339102.7A Pending CN115574843A (zh) | 2022-10-28 | 2022-10-28 | 采煤机惯性导航精度测评系统及测评方法、移动载体 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN115574843A (zh) |
WO (1) | WO2024087479A1 (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024087496A1 (zh) * | 2022-10-28 | 2024-05-02 | 中煤科工集团上海有限公司 | 采煤机惯性导航精度测评系统及其精度测评方法 |
WO2024087479A1 (zh) * | 2022-10-28 | 2024-05-02 | 中煤科工集团上海有限公司 | 采煤机惯性导航精度测评系统及测评方法、移动载体 |
WO2024087497A1 (zh) * | 2022-10-28 | 2024-05-02 | 中煤科工集团上海有限公司 | 用于采煤机惯性导航精度测评系统的轨道及测评系统 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1069219A (ja) * | 1996-08-28 | 1998-03-10 | Honda Motor Co Ltd | 自動走行路および自動走行システム |
RU2469273C1 (ru) * | 2011-07-04 | 2012-12-10 | Открытое акционерное общество "Завод им. В.А. Дегтярева" | Способ формирования локальных геодезических сетей и определения координат целей с использованием метода относительных определений параметров |
US8560149B1 (en) * | 2012-09-20 | 2013-10-15 | Honeywell International Inc. | Systems and methods for takeoff assistance and analysis |
US20180094946A1 (en) * | 2016-10-03 | 2018-04-05 | Government Of The United States Of America, As Represented By The Secretary Of Commerce | Inertial measurement unit and diagnostic system |
CN108731672A (zh) * | 2018-05-30 | 2018-11-02 | 中国矿业大学 | 基于双目视觉及惯性导航的采煤机姿态检测系统及方法 |
CN111412911A (zh) * | 2020-04-07 | 2020-07-14 | 中国煤炭科工集团太原研究院有限公司 | 一种煤矿井下连续采煤机器人多传感器组合导航系统 |
CN114514411A (zh) * | 2019-10-08 | 2022-05-17 | 移动眼视觉科技有限公司 | 用于交通工具导航的系统和方法 |
CN114593730A (zh) * | 2020-12-07 | 2022-06-07 | 北斗天地股份有限公司 | 一种定位导航系统 |
CN114964227A (zh) * | 2022-04-21 | 2022-08-30 | 中煤科工集团上海有限公司 | 基于深度相机定位修正的采煤机组合导航定位系统及方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105300410B (zh) * | 2015-12-01 | 2018-01-12 | 中国矿业大学 | 采煤机惯性导航定位误差校准装置及方法 |
CN205280095U (zh) * | 2015-12-01 | 2016-06-01 | 中国矿业大学 | 采煤机惯性导航定位误差校准装置 |
US10838427B2 (en) * | 2016-10-26 | 2020-11-17 | The Charles Stark Draper Laboratory, Inc. | Vision-aided inertial navigation with loop closure |
CN107270901B (zh) * | 2017-08-17 | 2020-02-14 | 中国矿业大学 | 融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法 |
CN110398258B (zh) * | 2019-08-13 | 2021-04-20 | 广州广电计量检测股份有限公司 | 一种惯性导航系统的性能测试装置及方法 |
CN114739426A (zh) * | 2022-04-21 | 2022-07-12 | 之江实验室 | 基于可便携移动uwb基站台的采煤机定位修正系统及方法 |
CN115574843A (zh) * | 2022-10-28 | 2023-01-06 | 中煤科工集团上海有限公司 | 采煤机惯性导航精度测评系统及测评方法、移动载体 |
-
2022
- 2022-10-28 CN CN202211339102.7A patent/CN115574843A/zh active Pending
-
2023
- 2023-03-23 WO PCT/CN2023/083421 patent/WO2024087479A1/zh unknown
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1069219A (ja) * | 1996-08-28 | 1998-03-10 | Honda Motor Co Ltd | 自動走行路および自動走行システム |
RU2469273C1 (ru) * | 2011-07-04 | 2012-12-10 | Открытое акционерное общество "Завод им. В.А. Дегтярева" | Способ формирования локальных геодезических сетей и определения координат целей с использованием метода относительных определений параметров |
US8560149B1 (en) * | 2012-09-20 | 2013-10-15 | Honeywell International Inc. | Systems and methods for takeoff assistance and analysis |
US20180094946A1 (en) * | 2016-10-03 | 2018-04-05 | Government Of The United States Of America, As Represented By The Secretary Of Commerce | Inertial measurement unit and diagnostic system |
CN108731672A (zh) * | 2018-05-30 | 2018-11-02 | 中国矿业大学 | 基于双目视觉及惯性导航的采煤机姿态检测系统及方法 |
CN114514411A (zh) * | 2019-10-08 | 2022-05-17 | 移动眼视觉科技有限公司 | 用于交通工具导航的系统和方法 |
CN111412911A (zh) * | 2020-04-07 | 2020-07-14 | 中国煤炭科工集团太原研究院有限公司 | 一种煤矿井下连续采煤机器人多传感器组合导航系统 |
CN114593730A (zh) * | 2020-12-07 | 2022-06-07 | 北斗天地股份有限公司 | 一种定位导航系统 |
CN114964227A (zh) * | 2022-04-21 | 2022-08-30 | 中煤科工集团上海有限公司 | 基于深度相机定位修正的采煤机组合导航定位系统及方法 |
Non-Patent Citations (1)
Title |
---|
司垒 等: "基于差分式惯性传感组件的采煤机位姿解算法", 《振动、测试与诊断》, vol. 41, no. 2, pages 220 - 227 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024087496A1 (zh) * | 2022-10-28 | 2024-05-02 | 中煤科工集团上海有限公司 | 采煤机惯性导航精度测评系统及其精度测评方法 |
WO2024087479A1 (zh) * | 2022-10-28 | 2024-05-02 | 中煤科工集团上海有限公司 | 采煤机惯性导航精度测评系统及测评方法、移动载体 |
WO2024087497A1 (zh) * | 2022-10-28 | 2024-05-02 | 中煤科工集团上海有限公司 | 用于采煤机惯性导航精度测评系统的轨道及测评系统 |
Also Published As
Publication number | Publication date |
---|---|
WO2024087479A1 (zh) | 2024-05-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115574843A (zh) | 采煤机惯性导航精度测评系统及测评方法、移动载体 | |
CN115790646A (zh) | 采煤机惯性导航精度测评系统及测评方法、移动载体 | |
CN115540911A (zh) | 采煤机惯性导航精度测评系统及测评方法、移动载体 | |
CN115540912A (zh) | 采煤机惯性导航精度测评系统及其精度测评方法 | |
CN102337710B (zh) | 一种gps轨道不平顺检测系统及其检测方法 | |
CN115876223A (zh) | 采煤机惯性导航精度测评系统及测评方法、移动载体 | |
CN102390405B (zh) | 用于轨道参数约束测量的检测方法及轨道检查仪 | |
CN102636140B (zh) | 测量空间六自由度运动的伸缩拉杆式并联装置 | |
EP2878920A1 (en) | Calibration of a coordinate measuring machine using a calibration laser head at the tool centre point | |
WO2024087497A1 (zh) | 用于采煤机惯性导航精度测评系统的轨道及测评系统 | |
CN101644756B (zh) | 直线型gps动态定位精度检定仪及其检定方法 | |
KR20140044754A (ko) | 골프스윙 해석장치 및 골프스윙 해석방법 | |
CN103017690A (zh) | 一种测量超长导轨直线度的方法 | |
CN112305570B (zh) | 一种导航定位设备的动态性能测试系统及测试方法 | |
CN115597535B (zh) | 基于惯性导航的高速磁悬浮轨道不平顺检测系统及方法 | |
CN202124809U (zh) | 轨道几何形位检测成套体系装置 | |
CN201354440Y (zh) | 采用便携式激光测距仪的轨道三维约束测量装置 | |
CN109506677A (zh) | 基于轨道小车的高精度测试验证系统及方法 | |
CN107036795B (zh) | 一种多功能调试平台 | |
CN106500649A (zh) | 一种基于惯性测量与轨道信标组合技术的矿井下车辆轨道变形监测方法 | |
CN110497931A (zh) | 一种岔区轨道状态检测方法 | |
CN209382013U (zh) | 卫星定位与惯导一体化的轨检小车 | |
EP2817473A1 (en) | Apparatus for aligning drilling machines | |
JP2011007502A (ja) | 削孔位置計測方法およびシステム | |
US11592457B2 (en) | Methods and systems for tunnel profiling |
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 |