CN118794439A - A walking positioning method and positioning system for an EMU undercarriage inspection robot - Google Patents
A walking positioning method and positioning system for an EMU undercarriage inspection robot Download PDFInfo
- Publication number
- CN118794439A CN118794439A CN202410777806.5A CN202410777806A CN118794439A CN 118794439 A CN118794439 A CN 118794439A CN 202410777806 A CN202410777806 A CN 202410777806A CN 118794439 A CN118794439 A CN 118794439A
- Authority
- CN
- China
- Prior art keywords
- positioning
- detection robot
- detected
- driven wheel
- value
- 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
- 238000000034 method Methods 0.000 title claims abstract description 46
- 238000007689 inspection Methods 0.000 title abstract description 27
- 238000005259 measurement Methods 0.000 claims abstract description 27
- 238000012937 correction Methods 0.000 claims abstract description 10
- 238000001514 detection method Methods 0.000 claims description 96
- 230000008569 process Effects 0.000 claims description 16
- 230000001133 acceleration Effects 0.000 claims description 11
- 230000000630 rising effect Effects 0.000 claims description 10
- 238000006073 displacement reaction Methods 0.000 claims description 9
- 229920002635 polyurethane Polymers 0.000 claims description 4
- 239000004814 polyurethane Substances 0.000 claims description 4
- 239000004952 Polyamide Substances 0.000 claims description 3
- 229920002647 polyamide Polymers 0.000 claims description 3
- 229920000915 polyvinyl chloride Polymers 0.000 claims description 3
- 239000004800 polyvinyl chloride Substances 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 238000012423 maintenance Methods 0.000 description 5
- 241000271559 Dromaiidae Species 0.000 description 4
- 230000001186 cumulative effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000005355 Hall effect Effects 0.000 description 1
- 101001121408 Homo sapiens L-amino-acid oxidase Proteins 0.000 description 1
- 102100026388 L-amino-acid oxidase Human genes 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 230000006698 induction Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000011900 installation process Methods 0.000 description 1
- 230000005389 magnetism Effects 0.000 description 1
- 239000003550 marker Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/40—Control within particular dimensions
- G05D1/43—Control of position or course in two dimensions
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/60—Intended control result
- G05D1/644—Optimisation of travel parameters, e.g. of energy consumption, journey time or distance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/60—Intended control result
- G05D1/65—Following a desired speed profile
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2109/00—Types of controlled vehicles
- G05D2109/10—Land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
一种动车组车底检测机器人行走定位方法及定位系统,涉及一种位置校准的方法和系统。目的是为了克服现有检测机器人行走无法精准到达目标位置的问题。定位方法步骤如下:步骤一、控制检测机器人沿直线路径从起点行走至终点,计算得到待检测位置对应的从动轮线性期望值φ;并获取在检测到第k个辅助定位点时,所采集的从动轮线性测量值xk;步骤二、控制检测机器人沿直线路径从终点向起点行走,并在再次检测到第k个辅助定位点时,获取对应的从动轮线性测量值yk;步骤三、通过下式计算得到待检测位置的校正值:p=φ‑xk+yk+δk;步骤四、根据待检测位置的校正值,继续控制检测机器人行走至待检测位置,完成检测机器人的行走定位。
A walking positioning method and positioning system for an undercarriage inspection robot for a multiple unit train relates to a method and system for position calibration. The purpose is to overcome the problem that the existing inspection robot cannot accurately reach the target position when walking. The positioning method steps are as follows: Step 1, control the inspection robot to walk from the starting point to the end point along a straight path, and calculate the linear expected value φ of the driven wheel corresponding to the position to be detected; and obtain the linear measurement value x k of the driven wheel collected when the kth auxiliary positioning point is detected; Step 2, control the inspection robot to walk from the end point to the starting point along a straight path, and obtain the corresponding linear measurement value y k of the driven wheel when the kth auxiliary positioning point is detected again; Step 3, calculate the correction value of the position to be detected by the following formula: p = φ-x k +y k +δ k ; Step 4, according to the correction value of the position to be detected, continue to control the inspection robot to walk to the position to be detected, and complete the walking positioning of the inspection robot.
Description
技术领域Technical Field
本发明涉及一种位置校准的方法和系统。The invention relates to a method and system for position calibration.
背景技术Background Art
随着近些年开行的动车组数量逐年增加,相应的动车所承担的检修作业任务越来越重,作业压力也越来越大。动车组日常检修以一级修为主,每次一级检修由1~2个检修作业小组完成,随着动车组数量和运行交路的逐步增加,动车组车底的检测机器人应运而生。而检测机器人检测车体部件需近距离拍摄图像,停靠目标位置出现偏差增加与动车组车底的碰撞风险以及图像拍摄角度偏差,因此对于检测机器人行走位置的精确度要求极高。With the increasing number of EMUs in operation in recent years, the corresponding maintenance tasks undertaken by EMUs have become increasingly heavy, and the operating pressure has also increased. The daily maintenance of EMUs is mainly first-level maintenance, and each first-level maintenance is completed by 1 to 2 maintenance teams. With the gradual increase in the number of EMUs and the number of operating routes, EMU undercarriage inspection robots have emerged. However, when the inspection robot inspects the body parts, it needs to take images at close range. The deviation of the target stop position increases the risk of collision with the undercarriage of the EMU and the deviation of the image shooting angle. Therefore, the accuracy of the walking position of the inspection robot is extremely high.
现有的检测机器人是通过主动轮上的编码器进行定位的,但是基于现有轨道情况及使用环境,主动轮打滑现象不可避免,只通过控制器写入编码器值驱动机器人行走无法精准到达目标位置。The existing inspection robot is positioned by the encoder on the driving wheel, but based on the existing track conditions and usage environment, driving wheel slippage is inevitable. Only by writing the encoder value through the controller to drive the robot to walk cannot accurately reach the target position.
发明内容Summary of the invention
本发明的目的是为了克服现有检测机器人行走无法精准到达目标位置的问题,提供了一种动车组车底检测机器人行走定位方法及定位系统。The purpose of the present invention is to overcome the problem that the existing inspection robot cannot accurately reach the target position when walking, and to provide a walking positioning method and a positioning system for an EMU underbody inspection robot.
本发明提供一种动车组车底检测机器人行走定位方法,基于检测机器人实现,检测机器人包括主动轮和从动轮;The present invention provides a walking and positioning method for an EMU vehicle bottom detection robot, which is implemented based on the detection robot, and the detection robot includes a driving wheel and a driven wheel;
步骤如下:Here are the steps:
步骤一、控制检测机器人沿直线路径从起点行走至终点,计算得到待检测位置对应的从动轮线性期望值并获取在检测到第k个辅助定位点时,所采集的从动轮线性测量值xk;Step 1: Control the detection robot to walk along a straight line from the starting point to the end point, and calculate the linear expected value of the driven wheel corresponding to the position to be detected and obtaining the linear measurement value x k of the driven wheel collected when the kth auxiliary positioning point is detected;
待检测位置是检测机器人通过扫描完整动车组车底后识别获得;The position to be inspected is identified by the inspection robot after scanning the complete bottom of the EMU;
辅助定位点的数量为n个,n个辅助定位点等间距设置在直线路径上;The number of auxiliary positioning points is n, and the n auxiliary positioning points are set at equal intervals on the straight path;
第k个辅助定位点是与待检测位置相邻的靠近终点侧的辅助定位点,且1≤k≤n;The kth auxiliary positioning point is an auxiliary positioning point adjacent to the position to be detected and close to the end point, and 1≤k≤n;
从动轮线性期望值是根据从动轮期望转数得到的从动轮位移,从动轮线性测量值是根据从动轮实际转数得到的从动轮位移;The driven wheel linear expected value is the driven wheel displacement obtained according to the expected number of rotations of the driven wheel, and the driven wheel linear measured value is the driven wheel displacement obtained according to the actual number of rotations of the driven wheel;
步骤二、控制检测机器人沿直线路径从终点向起点行走,并在再次检测到第k个辅助定位点时,获取对应的从动轮线性测量值yk;Step 2: Control the detection robot to walk along a straight path from the end point to the starting point, and when the kth auxiliary positioning point is detected again, obtain the corresponding driven wheel linear measurement value y k ;
步骤三、通过下式计算得到待检测位置的校正值:Step 3: Calculate the correction value of the position to be detected by the following formula:
其中,δk为第k个辅助定位点的往返偏差值;Wherein, δ k is the round-trip deviation value of the kth auxiliary positioning point;
步骤四、根据待检测位置的校正值,继续控制检测机器人行走至待检测位置,完成检测机器人的行走定位。Step 4: According to the correction value of the position to be detected, continue to control the detection robot to walk to the position to be detected, and complete the walking positioning of the detection robot.
进一步地,获取任一辅助定位点的往返偏差值的过程如下:Furthermore, the process of obtaining the round-trip deviation value of any auxiliary positioning point is as follows:
步骤三一、控制检测机器人沿直线路径从起点行走至终点,并在检测到任一辅助定位点时,获取对应的从动轮线性测量值an;Step 31: Control the detection robot to walk along a straight path from the starting point to the end point, and when any auxiliary positioning point is detected, obtain the corresponding driven wheel linear measurement value a n ;
步骤三二、控制检测机器人沿直线路径从终点行走至起点;并在再次检测到任一辅助定位点时,获取对应的从动轮线性测量值bn;Step 32: Control the detection robot to walk along a straight path from the end point to the starting point; and when any auxiliary positioning point is detected again, obtain the corresponding driven wheel linear measurement value bn;
步骤三三、通过下式计算得到任意辅助定位点的往返偏差值:Step 3. Calculate the round-trip deviation value of any auxiliary positioning point using the following formula:
δn=an-bn。δ n = a n - b n .
进一步地,获取任一辅助定位点的往返偏差值的过程还包括:Furthermore, the process of obtaining the round-trip deviation value of any auxiliary positioning point also includes:
步骤三四、返回并执行步骤三一~步骤三三,得到多个往返偏差值,并根据多个往返偏差值计算得到算术平均值,作为最终的往返偏差值。Step 34: Return and execute step 31 to step 33 to obtain multiple round-trip deviation values, and calculate the arithmetic mean based on the multiple round-trip deviation values as the final round-trip deviation value.
进一步地,步骤二还包括:Furthermore, step 2 also includes:
控制检测机器人以位置模式从终点行走至初定位位置;Control the detection robot to walk from the end point to the initial positioning position in a position mode;
位置模式为:先以设定的第一加速度加速行走至预设定的上限速度,再以所述上限速度匀速行走,最后以设定的第二加速度减速行走,直至速度为0;The position mode is: first accelerate to a preset upper limit speed with a set first acceleration, then walk at a constant speed with the upper limit speed, and finally decelerate with a set second acceleration until the speed reaches 0;
初定位位置为当主动轮线性测量值等于主动轮线性期望值时,检测机器人的位置;The initial positioning position is the position of the robot detected when the linear measurement value of the driving wheel is equal to the linear expected value of the driving wheel;
主动轮线性期望值通过从动轮线性期望值计算得到,主动轮线性测量值为根据主动轮实际转数得到的主动轮位移。The linear expected value of the driving wheel is calculated by the linear expected value of the driven wheel. It is calculated that the linear measurement value of the driving wheel is the driving wheel displacement obtained according to the actual number of revolutions of the driving wheel.
进一步地,步骤四还包括:Furthermore, step four also includes:
控制检测机器人以速度模式从初定位位置行走至待检测位置;Control the detection robot to move from the initial positioning position to the position to be detected in a speed mode;
速度模式为:以设定的匀速速度匀速行走。The speed mode is: walking at a constant speed at the set constant speed.
进一步地,从动轮的材质为聚氨酯、聚氯乙烯或聚酰胺中的至少一种。Furthermore, the material of the driven wheel is at least one of polyurethane, polyvinyl chloride or polyamide.
本发明还提供一种动车组车底检测机器人行走定位系统,包括控制器;The present invention also provides a walking positioning system for an EMU vehicle bottom detection robot, comprising a controller;
控制器,用于执行权利要求5的行走定位方法。A controller, used to execute the walking positioning method of claim 5.
进一步地,还包括第一编码器、第二编码器、多个磁性体和磁性检测装置;Furthermore, it also includes a first encoder, a second encoder, a plurality of magnetic bodies and a magnetic detection device;
第一编码器,用于实时获取主动轮线性测量值;The first encoder is used to obtain the linear measurement value of the driving wheel in real time;
第二编码器,用于实时获取从动轮线性测量值;The second encoder is used to obtain the linear measurement value of the driven wheel in real time;
磁性体,用于作为辅助定位点;A magnetic body, used as an auxiliary positioning point;
磁性检测装置,用于检测磁性体,并输出脉冲检测信号。The magnetic detection device is used to detect magnetic bodies and output pulse detection signals.
进一步地,多个磁性体和磁性检测装置均位于同一水平面上。Furthermore, the plurality of magnetic bodies and the magnetic detection devices are all located on the same horizontal plane.
进一步地,以脉冲检测信号上升沿所对应的时刻作为检测到相应辅助定位点的时刻。Furthermore, the time corresponding to the rising edge of the pulse detection signal is used as the time when the corresponding auxiliary positioning point is detected.
本发明的有益效果是:The beneficial effects of the present invention are:
本发明使用两个编码器加磁性体标记控制检测机器人的行走和定位,以主动轮及对应的第一编码器实现粗略位置定位,以从动轮及对应的第二编码器实现精确修正。避免了主动轮作为动力轮打滑而导致定位不准的问题,又通过多个磁性体将全程累积误差缩小到相邻两个磁性体之间。提升检测机器人行走定位精度,明显降低检测不准的风险。具备自学习、自校准功能,稳定性高,定位精度高。而对现有装置只需在原有轨道装置上等间隔安装磁性体,操作方便,降低了设备和人工成本。且适用于不同类型的铁路车辆和轨道环境,具有广泛应用前景。The present invention uses two encoders plus magnetic body marks to control the walking and positioning of the detection robot, uses the driving wheel and the corresponding first encoder to achieve rough position positioning, and uses the driven wheel and the corresponding second encoder to achieve precise correction. The problem of inaccurate positioning caused by the slipping of the driving wheel as a power wheel is avoided, and the cumulative error of the whole process is reduced to between two adjacent magnetic bodies through multiple magnetic bodies. The walking positioning accuracy of the detection robot is improved, and the risk of inaccurate detection is significantly reduced. It has self-learning and self-calibration functions, high stability and high positioning accuracy. For the existing device, it only needs to install magnetic bodies at equal intervals on the original track device, which is easy to operate and reduces equipment and labor costs. It is suitable for different types of railway vehicles and track environments and has broad application prospects.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
图1为本发明的一种动车组车底检测机器人行走定位系统中电气结构示意图;FIG1 is a schematic diagram of an electrical structure of a walking positioning system of a motor vehicle underbody inspection robot according to the present invention;
图2为本发明的一种动车组车底检测机器人行走定位系统中磁性检测装置与检测机器人配合的结构示意图。FIG. 2 is a schematic structural diagram of the cooperation between a magnetic detection device and a detection robot in a walking positioning system of an EMU undercarriage detection robot according to the present invention.
具体实施方式DETAILED DESCRIPTION
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments may be combined with each other.
下面结合附图和具体实施例对本发明作进一步说明,但不作为本发明的限定。The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments, but they are not intended to limit the present invention.
具体实施方式一Specific implementation method 1
本实施方式的一种动车组车底检测机器人行走定位方法,基于检测机器人实现,检测机器人包括主动轮和从动轮;A walking positioning method of a vehicle bottom inspection robot of an EMU in this embodiment is implemented based on the inspection robot, and the inspection robot includes a driving wheel and a driven wheel;
步骤如下:Here are the steps:
步骤一、控制检测机器人沿直线路径从起点行走至终点,计算得到待检测位置对应的从动轮线性期望值并获取在检测到第k个辅助定位点时,所采集的从动轮线性测量值xk;Step 1: Control the detection robot to walk along a straight line from the starting point to the end point, and calculate the linear expected value of the driven wheel corresponding to the position to be detected and obtaining the linear measurement value x k of the driven wheel collected when the kth auxiliary positioning point is detected;
待检测位置是检测机器人通过扫描完整动车组车底后识别获得;The position to be inspected is identified by the inspection robot after scanning the complete bottom of the EMU;
辅助定位点的数量为n个,n个辅助定位点等间距设置在直线路径上;The number of auxiliary positioning points is n, and the n auxiliary positioning points are set at equal intervals on the straight path;
第k个辅助定位点是与待检测位置相邻的靠近终点侧的辅助定位点,且1≤k≤n;The kth auxiliary positioning point is an auxiliary positioning point adjacent to the position to be detected and close to the end point, and 1≤k≤n;
从动轮线性期望值是根据从动轮期望转数得到的从动轮位移,从动轮线性测量值是根据从动轮实际转数得到的从动轮位移;The driven wheel linear expected value is the driven wheel displacement obtained according to the expected number of rotations of the driven wheel, and the driven wheel linear measured value is the driven wheel displacement obtained according to the actual number of rotations of the driven wheel;
步骤二、控制检测机器人沿直线路径从终点向起点行走,并在再次检测到第k个辅助定位点时,获取对应的从动轮线性测量值yk;Step 2: Control the detection robot to walk along a straight path from the end point to the starting point, and when the kth auxiliary positioning point is detected again, obtain the corresponding driven wheel linear measurement value y k ;
步骤三、通过下式计算得到待检测位置的校正值:Step 3: Calculate the correction value of the position to be detected by the following formula:
其中,δk为第k个辅助定位点的往返偏差值;Wherein, δ k is the round-trip deviation value of the kth auxiliary positioning point;
步骤四、根据待检测位置的校正值,继续控制检测机器人行走至待检测位置,完成检测机器人的行走定位。Step 4: According to the correction value of the position to be detected, continue to control the detection robot to walk to the position to be detected, and complete the walking positioning of the detection robot.
具体实施方式二Specific implementation method 2
本实施方式是对实施方式一的进一步说明,本实施方式中,获取任一辅助定位点的往返偏差值的过程如下:This embodiment is a further explanation of the first embodiment. In this embodiment, the process of obtaining the round-trip deviation value of any auxiliary positioning point is as follows:
步骤三一、控制检测机器人沿直线路径从起点行走至终点,并在检测到任一辅助定位点时,获取对应的从动轮线性测量值an;Step 31: Control the detection robot to walk along a straight path from the starting point to the end point, and when any auxiliary positioning point is detected, obtain the corresponding driven wheel linear measurement value a n ;
步骤三二、控制检测机器人沿直线路径从终点行走至起点;并在再次检测到任一辅助定位点时,获取对应的从动轮线性测量值bn;Step 32: Control the detection robot to walk along a straight path from the end point to the starting point; and when any auxiliary positioning point is detected again, obtain the corresponding driven wheel linear measurement value bn;
步骤三三、通过下式计算得到任意辅助定位点的往返偏差值:Step 3. Calculate the round-trip deviation value of any auxiliary positioning point using the following formula:
δn=an-bn。δ n = a n - b n .
本实施方式的其他技术特征与实施方式一完全相同。The other technical features of this embodiment are exactly the same as those of the first embodiment.
具体实施方式三Specific implementation method three
本实施方式是对实施方式二的进一步说明,本实施方式中,获取任一辅助定位点的往返偏差值的过程还包括:This embodiment is a further description of the second embodiment. In this embodiment, the process of obtaining the round-trip deviation value of any auxiliary positioning point further includes:
步骤三四、返回并执行步骤三一~步骤三三,得到多个往返偏差值,并根据多个往返偏差值计算得到算术平均值,作为最终的往返偏差值。Step 34: Return and execute step 31 to step 33 to obtain multiple round-trip deviation values, and calculate the arithmetic mean based on the multiple round-trip deviation values as the final round-trip deviation value.
本实施方式的其他技术特征与实施方式二完全相同。The other technical features of this embodiment are exactly the same as those of the second embodiment.
具体实施方式四Specific implementation method four
本实施方式是对实施方式一、二或三的进一步说明,本实施方式中,步骤二还包括:This implementation is a further description of implementation one, two or three. In this implementation, step two further includes:
控制检测机器人以位置模式从终点行走至初定位位置;Control the detection robot to walk from the end point to the initial positioning position in a position mode;
位置模式为:先以设定的第一加速度加速行走至预设定的上限速度,再以所述上限速度匀速行走,最后以设定的第二加速度减速行走,直至速度为0;The position mode is: first accelerate to a preset upper limit speed with a set first acceleration, then walk at a constant speed with the upper limit speed, and finally decelerate with a set second acceleration until the speed reaches 0;
初定位位置为当主动轮线性测量值等于主动轮线性期望值时,检测机器人的位置;The initial positioning position is the position of the robot detected when the linear measurement value of the driving wheel is equal to the linear expected value of the driving wheel;
主动轮线性期望值通过从动轮线性期望值计算得到,主动轮线性测量值为根据主动轮实际转数得到的主动轮位移。The linear expected value of the driving wheel is calculated by the linear expected value of the driven wheel. It is calculated that the linear measurement value of the driving wheel is the driving wheel displacement obtained according to the actual number of revolutions of the driving wheel.
本实施方式的其他技术特征与实施方式一、二或三完全相同。The other technical features of this embodiment are exactly the same as those of embodiments one, two or three.
具体实施方式五Specific implementation method five
本实施方式是对实施方式四的进一步说明,本实施方式中,步骤四还包括:This implementation is a further description of the fourth implementation. In this implementation, step four also includes:
控制检测机器人以速度模式从初定位位置行走至待检测位置;Control the detection robot to move from the initial positioning position to the position to be detected in a speed mode;
速度模式为:以设定的匀速速度匀速行走。The speed mode is: walking at a constant speed at the set constant speed.
本实施方式的其他技术特征与实施方式四完全相同。The other technical features of this embodiment are exactly the same as those of embodiment 4.
具体实施方式六Specific implementation method 6
本实施方式是对实施方式五的进一步说明,本实施方式中,从动轮的材质为聚氨酯、聚氯乙烯或聚酰胺中的至少一种。This embodiment is a further description of the fifth embodiment. In this embodiment, the material of the driven wheel is at least one of polyurethane, polyvinyl chloride or polyamide.
本实施方式的其他技术特征与实施方式五完全相同。The other technical features of this embodiment are exactly the same as those of embodiment five.
具体实施方式七Specific implementation method seven
本实施方式的一种动车组车底检测机器人行走定位系统,包括控制器1;A walking and positioning system for an EMU undercarriage inspection robot according to this embodiment includes a controller 1;
控制器1,用于执行实施方式五的行走定位方法。The controller 1 is used to execute the walking positioning method of the fifth implementation mode.
具体实施方式八Specific implementation method eight
本实施方式是对实施方式七的进一步说明,本实施方式中,还包括第一编码器2、第二编码器3、多个磁性体4和磁性检测装置5;This embodiment is a further description of the seventh embodiment. In this embodiment, a first encoder 2, a second encoder 3, a plurality of magnetic bodies 4 and a magnetic detection device 5 are further included.
第一编码器2,用于实时获取主动轮线性测量值;The first encoder 2 is used to obtain the linear measurement value of the driving wheel in real time;
第二编码器3,用于实时获取从动轮线性测量值;The second encoder 3 is used to obtain the linear measurement value of the driven wheel in real time;
磁性体4,用于作为辅助定位点;A magnetic body 4, used as an auxiliary positioning point;
磁性检测装置5,用于检测磁性体4,并输出脉冲检测信号。The magnetic detection device 5 is used to detect the magnetic body 4 and output a pulse detection signal.
本实施方式的其他技术特征与实施方式七完全相同。The other technical features of this embodiment are exactly the same as those of embodiment seven.
具体实施方式九Specific implementation method nine
本实施方式是对实施方式八的进一步说明,本实施方式中,多个磁性体4和磁性检测装置5均位于同一水平面上。This embodiment is a further explanation of the eighth embodiment. In this embodiment, the plurality of magnetic bodies 4 and the magnetic detection device 5 are all located on the same horizontal plane.
本实施方式的其他技术特征与实施方式八完全相同。The other technical features of this embodiment are exactly the same as those of embodiment eight.
具体实施方式十Specific implementation method ten
本实施方式是对实施方式八或九的进一步说明,本实施方式中,以脉冲检测信号上升沿所对应的时刻作为检测到相应辅助定位点的时刻。This embodiment is a further explanation of the eighth or ninth embodiment. In this embodiment, the time corresponding to the rising edge of the pulse detection signal is used as the time when the corresponding auxiliary positioning point is detected.
本实施方式的其他技术特征与实施方式八或九完全相同。The other technical features of this embodiment are exactly the same as those of embodiment eight or nine.
具体实施例Specific embodiments
本发明的定位系统基于一种动车组车底的检测机器人,包括行走轨道、行走装置(主动轮6、从动轮7和带动主动轮6旋转的伺服电机)、检测机器人本体、必要的电源装置和通讯装置。检测机器人通过主动轮6和从动轮7在行走轨道上行走。The positioning system of the present invention is based on a detection robot for the bottom of a train, comprising a running track, a running device (a driving wheel 6, a driven wheel 7 and a servo motor driving the driving wheel 6 to rotate), a detection robot body, a necessary power supply device and a communication device. The detection robot walks on the running track through the driving wheel 6 and the driven wheel 7.
本发明的一种动车组车底检测机器人行走定位系统,包括:A walking positioning system for an EMU vehicle bottom detection robot of the present invention comprises:
控制器1(可以选用PLC),执行相应的方法。Controller 1 (PLC may be selected) executes corresponding methods.
第一编码器2,与主动轮6和主动轮驱动电机传动连接。The first encoder 2 is drivingly connected to the driving wheel 6 and the driving wheel driving motor.
第二编码器3,与从动轮7传动连接。行走轮,包括主动轮6和与之关联的从动轮7。The second encoder 3 is transmission-connected with the driven wheel 7. The travel wheel comprises a driving wheel 6 and a driven wheel 7 associated therewith.
磁性体4,等间隔内嵌在行走轨道中,作为辅助定位点。Magnetic bodies 4 are embedded in the running track at equal intervals to serve as auxiliary positioning points.
磁性检测装置5,设置在检测机器人底部贴近行走轨道端,利用霍尔效应原理检测轨道上布置的磁性体4;磁性体4与检测机器人上的磁性检测装置5安装高度保持一致,且在同一水平面。The magnetic detection device 5 is arranged at the bottom of the detection robot close to the end of the walking track, and uses the Hall effect principle to detect the magnetic body 4 arranged on the track; the installation height of the magnetic body 4 and the magnetic detection device 5 on the detection robot are consistent and in the same horizontal plane.
本发明的一种动车组车底检测机器人行走定位方法,应用环境为动车组车底检测,工作方式固定为检测机器人从起点出发,行走到终点位置,行走过程中扫描动车组车底,到达终点后计算获取动车组车底需检测的至少一个待检测位置;检测机器人从终点返回依次行进到待检测位置后停靠进行检测,全部检测完毕后返回起点,任务结束。具体包括以下步骤:The present invention provides a walking and positioning method for an EMU undercarriage inspection robot, the application environment of which is the undercarriage inspection of an EMU, and the working mode is fixed as follows: the inspection robot starts from a starting point and walks to a terminal position, scanning the undercarriage of the EMU during the walking process, and after reaching the terminal, calculates and obtains at least one position to be inspected under the EMU; the inspection robot returns from the terminal, moves to the positions to be inspected in turn, stops for inspection, and returns to the starting point after all inspections are completed, and the task is completed. Specifically, the following steps are included:
S1、初次使用前,首先进行自校准。根据待检测动车组车型确定检测机器人行走终点位置(起点到终点的距离必须超过动车组车长)。记录检测机器人从起点出发到达终点过程中磁性检测装置5装置感应到磁性体4上升沿时刻的第二编码器3的数值。(磁性检测装置5平时输出低电平,检测到磁性时输出高电平,产生上升沿,离开磁性体4后产生下降沿。以上升沿时刻对应的第二编码器3的数值为基准作为检测到磁性体4的时刻。由于磁性体4本身存在一定宽度以及磁场存在一定范围,导致检测机器人正向通过磁性体4感应产生的上升沿与反向通过同一磁性体4产生的上升沿本身存在一个固定的偏差,这是由磁性体4特性导致,不同磁性体4由于安装工艺和自身特性都不同,导致每一个磁性体4的往返偏差也不一样。因此需要进行校准。)从起点出发依次经过磁性体4获得磁性检测装置5感应上升沿时刻对应的第二编码器3的数值依次为a1,a2,a3,...an,若同一磁性体4产生多于一个的第二编码器3的数值,以第一个为准,下标值代表从起点出发所经过的磁性体4序列号。从终点返回依次经过磁性体4获得磁性检测装置5感应上升沿时刻对应的第二编码器3的数值bn,bn-1,bn-2,...b1,磁性检测装置5以不同方向接近同一磁性体4,感应信号存在固定的延时偏差,由此产生的编码器差值为a1-b1,a2-b2,a3-b3,…an-bn,多次重复上述校准流程取算术平均值记为δ1,δ2,δ3,…δn;不同车型重复上述操作。S1. Before the first use, first perform self-calibration. Determine the end point of the detection robot according to the type of train to be detected (the distance from the starting point to the end point must exceed the length of the train). Record the value of the second encoder 3 when the magnetic detection device 5 senses the rising edge of the magnetic body 4 during the process of the detection robot starting from the starting point and arriving at the end point. (The magnetic detection device 5 usually outputs a low level, and outputs a high level when detecting magnetism, generating a rising edge, and generating a falling edge after leaving the magnetic body 4. The value of the second encoder 3 corresponding to the rising edge is used as a reference as the moment when the magnetic body 4 is detected. Since the magnetic body 4 itself has a certain width and the magnetic field has a certain range, there is a fixed deviation between the rising edge induced by the detection robot passing through the magnetic body 4 in the forward direction and the rising edge generated by the reverse passing through the same magnetic body 4. This is caused by the characteristics of the magnetic body 4. Different magnetic bodies 4 have different installation processes and their own characteristics, resulting in different round-trip deviations for each magnetic body 4. Therefore, calibration is required.) Starting from the starting point, the values of the second encoder 3 corresponding to the rising edge induced by the magnetic detection device 5 passing through the magnetic body 4 in sequence are a1 , a2 , a3 , ...a n . If the same magnetic body 4 generates more than one value of the second encoder 3, the first one shall prevail. The subscript value represents the serial number of the magnetic body 4 passed from the starting point. Returning from the end point, the magnetic body 4 is passed in sequence to obtain the values bn , bn-1 , bn -2 , ... b1 of the second encoder 3 corresponding to the rising edge of the magnetic detection device 5. The magnetic detection device 5 approaches the same magnetic body 4 in different directions, and there is a fixed delay deviation in the induction signal. The resulting encoder difference is a1 - b1 , a2 - b2 , a3 - b3 , ...a n - bn . The above calibration process is repeated multiple times and the arithmetic average is recorded as δ1 , δ2 , δ3 , ... δn ; the above operation is repeated for different vehicle models.
由于检测机器人在从起点行走到终点的过程中,主要依赖于第一编码器2所检测主动轮6的实际转数进行定位,因此即使预先设定了一个终点(此终点作为期望终点),由于主动轮6的打滑缺陷,检测机器人实际无法精确到达期望终点。检测机器人首先从起点出发以位置模式并通过第一编码器2计量快速行走到期望终点所对应的实际位置,并可以在期望终点的后方(起点至终点方向)事先设置一个额外的终点磁性体,然后再控制检测机器人以速度模式行走到该终点磁性体位置处停止,此时终点磁性体的位置即为实际终点。由于在进行同一动车组检测时,终点磁性体的位置不变,进而保证多次校准时检测机器人起点、终点位置一致,一致性完好。Since the detection robot mainly relies on the actual number of revolutions of the driving wheel 6 detected by the first encoder 2 for positioning during the process of walking from the starting point to the end point, even if an end point is pre-set (this end point is the expected end point), due to the slip defect of the driving wheel 6, the detection robot cannot actually reach the expected end point accurately. The detection robot first starts from the starting point and walks quickly to the actual position corresponding to the expected end point in position mode and through the first encoder 2, and an additional end point magnetic body can be set in advance behind the expected end point (from the starting point to the end point), and then the detection robot is controlled to walk to the position of the end point magnetic body in speed mode and stop. At this time, the position of the end point magnetic body is the actual end point. Since the position of the end point magnetic body does not change when the same EMU is detected, it is ensured that the starting and end point positions of the detection robot are consistent during multiple calibrations, and the consistency is intact.
S2、使用过程中,每次检测机器人出发执行任务保证从固定起点出发,避免累积上一次任务行走误差;任务终点固定,以位置模式停靠位置后一个磁性体4位置为标识,保证往返行程一致;S2. During use, each time the detection robot sets out to perform a task, it is ensured to start from a fixed starting point to avoid accumulating walking errors from the previous task; the task end point is fixed, and the position of the magnetic body 4 after the position mode docking position is used as a marker to ensure that the round trip is consistent;
S3、正式开始执行任务,从起点出发,根据本次任务检测动车组车型确定终点位置,检测机器人以位置模式出发,设定第一编码器2的数值(期望终点),以主动轮6反馈第一编码器2的数值为依据,判断是否到达期望终点,过程中记录依次经过检测到各磁性体4时获得的第二编码器3的数值x1,x2,x3…xn,到达位置模式设定的期望终点的实际位置后,开始切换速度模式,行走至期望终点的实际位置后第一个终点磁性体(实际终点)停止。S3. Officially start the mission, starting from the starting point, determine the end point according to the EMU model detected in this mission, the detection robot starts in the position mode, sets the value of the first encoder 2 (the expected end point), and judges whether the expected end point has been reached based on the value of the first encoder 2 fed back by the driving wheel 6. During the process, the values x1 , x2 , x3 ... xn of the second encoder 3 obtained when each magnetic body 4 is detected are recorded in sequence. After reaching the actual position of the expected end point set in the position mode, start switching the speed mode, and stop at the first end point magnetic body (actual end point) after walking to the actual position of the expected end point.
计算动车组车底待检测位置对应的第二编码器3的数值确定待检测位置后经过的第一个磁性体4对应的第二编码器3值,假定xk,则判定目标位置距离第k个磁性体4距离检测机器人从终点出发,首先以位置模式行走,设定目标位置函数f为第二编码器3的数值转换第一编码器2的数值公式,转换计算得到的位置作为期望的初定位位置,控制器利用期望的初定位位置控制主动轮行走。位置模式结束后定位系统获取行进过程中最后经过的磁性体4(即第k个磁性体4)所对应的第二编码器3的数值yk,则依据公式计算得到待检测位置的精确位置,并通过第二编码器3进行计量控制检测机器人以速度模式从当前位置低速行走,实时获取第二编码器3的数值,到达上述待检测位置的精确位置后速度降为0,停止在准确的待检测位置。Calculate the value of the second encoder 3 corresponding to the position to be detected under the EMU Determine the value of the second encoder 3 corresponding to the first magnetic body 4 that passes after the position to be detected. Assuming x k , determine the distance between the target position and the kth magnetic body 4 The detection robot starts from the end point and first walks in position mode to set the target position Function f is the numerical formula for converting the value of the second encoder 3 into the numerical formula of the first encoder 2. The position obtained by the conversion calculation is used as the desired initial positioning position. The controller uses the desired initial positioning position to control the driving wheel to walk. After the position mode ends, the positioning system obtains the numerical value y k of the second encoder 3 corresponding to the last magnetic body 4 (i.e., the kth magnetic body 4) passed during the travel process. Then, according to the formula The precise position of the position to be detected is calculated, and the second encoder 3 is used to control the detection robot to walk at a low speed from the current position in speed mode, and the value of the second encoder 3 is obtained in real time. After reaching the precise position of the above-mentioned position to be detected, the speed drops to 0 and stops at the accurate position to be detected.
S4、磁性体4等间隔安装在行走轨道上,将整个检测机器人行走路径切分成多个小块,将待检测位置定位到距离某个磁性体4的距离,将全程累积误差缩小到每两个磁性体4之间距离的误差;S4 and magnetic bodies 4 are installed on the walking track at equal intervals, the entire walking path of the detection robot is divided into multiple small blocks, the position to be detected is located at the distance from a certain magnetic body 4, and the cumulative error of the whole process is reduced to the error of the distance between every two magnetic bodies 4;
S5、以检测机器人从终点返回行走到待检测位置前磁性检测装置5感应到最近一个磁性体4的编码器数据作为判定磁性体4,避免行走过程中磁性体4感应丢失,无法精确定位。若从终点行进到目标位置过程中无磁性体4的信号,则以理论目标位置为准,不予修正;S5, the encoder data of the nearest magnetic body 4 sensed by the magnetic detection device 5 before the detection robot returns from the end point to the position to be detected is used as the determination of the magnetic body 4, so as to avoid the loss of the magnetic body 4 sensing during the walking process and the inability to accurately locate. If there is no signal of the magnetic body 4 during the process from the end point to the target position, the theoretical target position shall prevail and no correction shall be made;
S6、当检测机器人达到修正位置后,发送移动完成状态。S6. When the detection robot reaches the corrected position, it sends the movement completion status.
S7、精确到达目标位置后待检测动作完成后重复S3操作执行后续检测任务,全部完成后返回起点。S7: After reaching the target position accurately and waiting for the detection action to be completed, repeat S3 to perform subsequent detection tasks, and return to the starting point after all are completed.
实际位置与目标的标记位置符合,为实际位置与目标标记位置的距离差值小于5mm时。The actual position is consistent with the target's marked position when the distance difference between the actual position and the target's marked position is less than 5 mm.
综上,行走方式分为位置模式与速度模式,位置模式负责检测机器人快速行走至一个非精确的大概位置(初定位位置),直接通过控制器1将初定位位置写入第一编码器2,控制器1在检测机器人启动时通过相应的距离和载荷情况,选择对应曲线函数,确定一个非特定的加速度函数斜坡(第一加速度),以在设定的加速距离内曲线加速达到行走速度,驱动主动轮6行走,在移动过程中实时计算第一编码器2所测得的主动轮线性测量值与初定位位置之差,当距离行驶到减速距离时(第二加速度),选择相对应的减速斜坡函数曲线,以一个非特定的加速度函数斜坡,降低行驶速度,最后当初定位位置的实际位置与初定为位置的目标位置符合时,行驶速度降为0,停止在初定位位置;速度模式负责修正定位,控制器1控制伺服电机以低速匀速驱动检测机器人行走,实时获取从动轮7反馈给第二编码器3的脉冲值(从动轮线性测量值),当第二编码器3反馈的脉冲值(从动轮线性测量值)达到设定的精确待检测位置时检测机器人速度降为0,停止在当前的待检测位置,速度模式结束。In summary, the walking modes are divided into position mode and speed mode. The position mode is responsible for detecting that the robot walks quickly to an imprecise approximate position (initial positioning position), and directly writes the initial positioning position into the first encoder 2 through the controller 1. When detecting the start of the robot, the controller 1 selects the corresponding curve function through the corresponding distance and load conditions, and determines a non-specific acceleration function slope (first acceleration) to accelerate the curve within the set acceleration distance to reach the walking speed, drive the driving wheel 6 to walk, and calculate the difference between the linear measurement value of the driving wheel measured by the first encoder 2 and the initial positioning position in real time during the movement. When the distance travels to the deceleration distance (second acceleration ), select the corresponding deceleration ramp function curve, use a non-specific acceleration function ramp to reduce the driving speed, and finally when the actual position of the initial positioning position matches the target position initially determined, the driving speed drops to 0 and stops at the initial positioning position; the speed mode is responsible for correcting the positioning, the controller 1 controls the servo motor to drive the detection robot to walk at a low and uniform speed, and obtains the pulse value (driven wheel linear measurement value) fed back by the driven wheel 7 to the second encoder 3 in real time. When the pulse value (driven wheel linear measurement value) fed back by the second encoder 3 reaches the set precise position to be detected, the detection robot speed drops to 0 and stops at the current position to be detected, and the speed mode ends.
从动轮材质采用聚氨酯,加之从动轮作为非动力轮,明显减少行走过程中打滑引起的位置错误,定位系统通过逻辑算法实现对行走目标位置的计算及修正。通过回原接近开关和回原定位标识的配合,确保检测机器人每次是从同一起点出发,任务结束后回到起点。The driven wheel is made of polyurethane and is a non-powered wheel, which significantly reduces the position error caused by slipping during walking. The positioning system calculates and corrects the walking target position through a logical algorithm. The coordination of the return-to-origin proximity switch and the return-to-origin positioning mark ensures that the inspection robot starts from the same starting point every time and returns to the starting point after the task is completed.
虽然在本文中参照了特定的实施方式来描述本发明,但是应该理解的是,这些实施例仅仅是本发明的原理和应用的示例。因此应该理解的是,可以对示例性的实施例进行许多修改,并且可以设计出其他的布置,只要不偏离所附权利要求所限定的本发明的精神和范围。应该理解的是,可以通过不同于原始权利要求所描述的方式来结合不同的从属权利要求和本文中的特征。还可以理解的是,结合单独实施例所描述的特征可以使用在其他实施例中。Although the present invention is described herein with reference to specific embodiments, it should be understood that these embodiments are merely examples of the principles and applications of the present invention. It should therefore be understood that many modifications may be made to the exemplary embodiments and that other arrangements may be devised without departing from the spirit and scope of the present invention as defined by the appended claims. It should be understood that the features of the various dependent claims and herein may be combined in a manner different from that described in the original claims. It should also be understood that the features described in conjunction with the individual embodiments may be used in other embodiments.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410777806.5A CN118794439A (en) | 2024-06-17 | 2024-06-17 | A walking positioning method and positioning system for an EMU undercarriage inspection robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410777806.5A CN118794439A (en) | 2024-06-17 | 2024-06-17 | A walking positioning method and positioning system for an EMU undercarriage inspection robot |
Publications (1)
Publication Number | Publication Date |
---|---|
CN118794439A true CN118794439A (en) | 2024-10-18 |
Family
ID=93026211
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202410777806.5A Pending CN118794439A (en) | 2024-06-17 | 2024-06-17 | A walking positioning method and positioning system for an EMU undercarriage inspection robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN118794439A (en) |
-
2024
- 2024-06-17 CN CN202410777806.5A patent/CN118794439A/en active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1959578B (en) | Control device for movable body | |
CN105631616B (en) | Intelligent positioning system and positioning method for warehousing and logistics | |
JP6599543B2 (en) | Automated guided vehicle | |
TW200825645A (en) | Running carriage, method of controlling the same, and running carriage system | |
TWI395077B (en) | Walking trolley and walking trolley system | |
JP2006227673A (en) | Autonomous travel device | |
JP5553220B2 (en) | Moving body | |
JP5561730B2 (en) | Guidance control system and guidance control method for moving body | |
CN114735384B (en) | Vehicle travel positioning system, method, computer device, and computer-readable storage medium | |
CN118794439A (en) | A walking positioning method and positioning system for an EMU undercarriage inspection robot | |
SE532430C2 (en) | Method and apparatus for determining the reliability of an estimated position for a mining and / or construction machine | |
JP2010262461A (en) | Mobile object | |
JP4697262B2 (en) | Traveling vehicle and traveling vehicle system | |
KR101356046B1 (en) | Moving body system and method for determining in position of moving body | |
CN202255344U (en) | Meshing line large-specification gear measuring center | |
CN111413991B (en) | Robot navigation positioning method and system | |
JP2704266B2 (en) | Travel control device for automatic guided vehicles | |
KR102234770B1 (en) | Autonomous driving robot equipped with a plurality of real sensors and driving method | |
CN115328011A (en) | Detection and calibration control method for stroke and position of operating mechanism | |
JPH1195837A (en) | Method for determining initial truck position and attitude angle of gyro guide type automated guided vehicle, and method for improving travel stability at position correction | |
JP6332510B2 (en) | Position detection method for automated guided vehicles | |
JP2007200062A (en) | Controller for movable body | |
CN111582426A (en) | Accurate checking method for shuttle vehicle | |
CN111045404A (en) | Narrow roadway positioning stacking vehicle, positioning system and positioning method of stacking vehicle | |
CN102322838A (en) | Meshing line large-specification gear measurement center |
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 |