CN117724483A - Route planning method for coal mine robots - Google Patents

Route planning method for coal mine robots Download PDF

Info

Publication number
CN117724483A
CN117724483A CN202311677436.XA CN202311677436A CN117724483A CN 117724483 A CN117724483 A CN 117724483A CN 202311677436 A CN202311677436 A CN 202311677436A CN 117724483 A CN117724483 A CN 117724483A
Authority
CN
China
Prior art keywords
alternative route
route
value
preset
coal mine
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
Application number
CN202311677436.XA
Other languages
Chinese (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.)
China Coal Science And Industry Robot Technology Co ltd
Guoneng Yulin Energy Co ltd
Shenyang Research Institute Co Ltd of CCTEG
Original Assignee
China Coal Science And Industry Robot Technology Co ltd
Guoneng Yulin Energy Co ltd
Shenyang Research Institute Co Ltd of CCTEG
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 China Coal Science And Industry Robot Technology Co ltd, Guoneng Yulin Energy Co ltd, Shenyang Research Institute Co Ltd of CCTEG filed Critical China Coal Science And Industry Robot Technology Co ltd
Priority to CN202311677436.XA priority Critical patent/CN117724483A/en
Publication of CN117724483A publication Critical patent/CN117724483A/en
Pending legal-status Critical Current

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a route planning method for a coal mine robot, and relates to the technical field of coal mine robots; the method is used for solving the problems that the existing route planning method usually considers the length of the route, only focuses on the optimization of a single target, ignores the influence of underground pavement and environment on a coal mine robot and lacks comprehensive consideration of multiple targets; the method has the advantages that the stability values of the alternative routes are analyzed, the influence of environmental factors in the alternative routes on the coal mine robots is considered, meanwhile, the influence of the charging times of the coal mine robots in the running process on the running efficiency of the coal mine robots is estimated, the situation that the coal mine robots cannot normally finish working tasks due to the change of the environment under a mine is avoided, the adaptability of the coal mine robots in the coal mine routes is improved, the running routes of the coal mine robots are determined according to the selection values, the set number of routes are selected as emergency routes, and the efficiency, the safety and the stability of the routes are comprehensively considered for the mine emergency.

Description

用于煤矿机器人的路线规划方法Route planning method for coal mine robots

技术领域Technical field

本发明涉及煤矿机器人技术领域,具体为用于煤矿机器人的路线规划方法。The invention relates to the technical field of coal mine robots, specifically a route planning method for coal mine robots.

背景技术Background technique

机器人是一种具有高度灵活性的自动化机器,具备一些与人或生物相似的智能能力,机器人是自动执行工作的机器装置,既可以接受人类指挥,又可以运行预先编排的程序,也可以根据以人工智能技术制定的原则纲领行动,它的任务是协助或取代人类的工作,它是高级整合控制论、机械电子、计算机、材料和仿生学的产物,在工业、医学、农业、服务业、建筑业甚至军事等领域中均有重要用途。A robot is a highly flexible automated machine with some intelligent capabilities similar to humans or living things. A robot is a machine device that automatically performs work. It can accept human command, run pre-programmed programs, and can also perform tasks according to previous instructions. The principle program action formulated by artificial intelligence technology. Its mission is to assist or replace human work. It is the product of advanced integration of cybernetics, mechanical electronics, computers, materials and bionics. It is used in industry, medicine, agriculture, service industry, construction It has important uses in industry and even military fields.

煤矿机器人作为煤矿领域的新兴产物,可替代人工完成巡检和维修的任务,保障矿工的生命安全,煤矿机器人在执行任务之前需要制定一条路线,使得煤矿机器人按照制定的路线行进,但由于矿井下环境错综复杂,变化难以预测,现有的路线规划方法往往考虑路程用时长短,只关注单一目标的优化,却忽略了矿井下路面和环境对煤矿机器人造成的影响,缺乏对多目标的综合考虑。As an emerging product in the field of coal mines, coal mine robots can replace manual inspection and maintenance tasks to ensure the safety of miners. Coal mine robots need to formulate a route before performing tasks so that the coal mine robots can travel according to the planned route. However, due to the underground mine The environment is complex and changes are difficult to predict. Existing route planning methods often consider the length of the journey and only focus on the optimization of a single goal, but ignore the impact of the underground road surface and environment on coal mine robots, and lack comprehensive consideration of multiple goals.

发明内容Contents of the invention

本发明的目的在于提供用于煤矿机器人的路线规划方法,以解决上述背景技术提出的问题。The purpose of the present invention is to provide a route planning method for a coal mine robot to solve the problems raised by the above background technology.

本发明的目的可以通过以下技术方案实现:The object of the present invention can be achieved through the following technical solutions:

用于煤矿机器人的路线规划方法,包括以下步骤:The route planning method for coal mine robots includes the following steps:

步骤一、对煤矿机器人的起始位置和目标位置进行标记,基于起始位置和目标位置生成路线,将生成的路线记为备选路线,获取备选路线的二维平面图,对备选路线的长度进行计算并记为Li,i为备选路线的编号,i的取值范围为正整数;Step 1: Mark the starting position and target position of the coal mine robot, generate a route based on the starting position and the target position, record the generated route as an alternative route, obtain a two-dimensional plan view of the alternative route, and analyze the The length is calculated and recorded as Li, i is the number of the alternative route, and the value range of i is a positive integer;

步骤二、对备选路线布设若干检测点,获取检测点的环境参数,对检测点的环境参数进行分析得到检测点的异常值,将检测点的异常值与预设的异常值阈值进行对比,若检测点的异常值大于预设的异常值阈值则将检测点标记为异常环境检测点,反之则将检测点标记为正常环境监测点,将相邻的环境异常检测点进行连接得到环境异常路段,将相邻的正常环境检测点进行连接得到正常环境路段,计算备选路线中环境异常路段和环境正常路段的总长度,由此对备选路线的环境进行分析得到备选路线的环稳值;Step 2: Arrange a number of detection points on the alternative route, obtain the environmental parameters of the detection points, analyze the environmental parameters of the detection points to obtain the abnormal values of the detection points, and compare the abnormal values of the detection points with the preset abnormal value thresholds. If the abnormal value of the detection point is greater than the preset abnormal value threshold, the detection point will be marked as an abnormal environment detection point. Otherwise, the detection point will be marked as a normal environment monitoring point. The adjacent environmental abnormality detection points will be connected to obtain the abnormal environmental road section. , connect adjacent normal environment detection points to obtain normal environment road sections, calculate the total length of the abnormal environment road sections and normal environment road sections in the alternative route, and thereby analyze the environment of the alternative route to obtain the environmental stability value of the alternative route ;

优选地,对备选路线的环境进行分析,分析过程如下:Preferably, the environment of the alternative route is analyzed, and the analysis process is as follows:

按照预设的检测距离对备选路线布设若干均匀的检测点,通过传感器按照预设的采集时长对检测点的环境参数进行若干次采集,所述环境参数包括检测点的空气密度、粉尘浓度、湿度和温度,从若干次采集的环境参数中选取第一环境参数和第二环境参数,所述第一环境参数为多次采集的环境参数中的最大值,具体为最大空气密度Pij、最大粉尘浓度Fij、最大湿度Sij和最大温度Cij,第二环境参数为多次采集的环境数据中的最小值,具体为最小空气密度pij、最小粉尘浓度fij、最小湿度sij和最小温度cij,j为备选路线上检测点的编号,j=1,2,...,m,m的取值范围为正整数,通过分析得到检测点的异常值YCij,将检测点的异常值与预设的异常值阈值进行对比,若检测点的异常值大于预设的异常值阈值,则将检测点标记为异常环境检测点,若检测点的异常值小于预设的异常值阈值,则将检测点标记为正常环境检测点,统计异常环境检测点的数量Ni;A number of uniform detection points are arranged on the alternative route according to the preset detection distance, and the environmental parameters of the detection points are collected several times by the sensor according to the preset collection time. The environmental parameters include air density, dust concentration, Humidity and temperature, select the first environmental parameter and the second environmental parameter from the environmental parameters collected multiple times. The first environmental parameter is the maximum value among the environmental parameters collected multiple times, specifically the maximum air density Pij, the maximum dust concentration Fij, maximum humidity Sij and maximum temperature Cij, the second environmental parameter is the minimum value among the environmental data collected multiple times, specifically the minimum air density pij, minimum dust concentration fij, minimum humidity sij and minimum temperature cij, j is the backup Select the number of the detection point on the line, j=1,2,...,m, the value range of m is a positive integer, obtain the abnormal value YCij of the detection point through analysis, and compare the abnormal value of the detection point with the preset abnormality If the abnormal value of the detection point is greater than the preset abnormal value threshold, the detection point will be marked as an abnormal environment detection point. If the abnormal value of the detection point is less than the preset abnormal value threshold, the detection point will be marked as Normal environment detection points, count the number Ni of abnormal environment detection points;

所述分析得到检测点的异常值YCij,具体为:The analysis obtains the abnormal value YCij of the detection point, specifically:

其中,Δρ1为预设的空气密度允许差,Δρ2为预设的粉尘浓度允许差,Δρ3为预设的湿度允许差,Δρ4为预设的温度允许差,a1为预设的空气密度权重因子,a2为预设的粉尘浓度权重因子,a3为预设的湿度权重因子,a4为预设的温度权重因子;Among them, Δρ1 is the preset air density allowable difference, Δρ2 is the preset dust concentration allowable difference, Δρ3 is the preset humidity allowable difference, Δρ4 is the preset temperature allowable difference, a1 is the preset air density weight factor, a2 is the preset dust concentration weighting factor, a3 is the preset humidity weighting factor, and a4 is the preset temperature weighting factor;

将相邻的异常环境检测点进行连接得到异常环境路段,对异常环境路段的长度进行计算并求和得到异常环境路段的总长度,从数据库中获取煤矿机器人的续航里程XH,通过分析得到煤矿机器人在该备用路线上预估的充电次数ni,若备选路线的长度的二倍除以续航里程存在小数,则向上取整,通过进一步分析得到备选路线的环稳值HWi,备选路线的环稳值越大说明该路线上的环境越复杂,对煤矿机器人的行进效率及相关设备运行有较大的影响,备选路线的环稳值越小说明该路线上的环境比较稳定,煤矿机器人的相关设备不会出现因为环境影响而无法工作的情况;Connect the adjacent abnormal environment detection points to obtain the abnormal environment section, calculate and sum the length of the abnormal environment section to obtain the total length of the abnormal environment section, obtain the cruising range XH of the coal mine robot from the database, and obtain the coal mine robot through analysis For the estimated number of charging times ni on the alternative route, if there is a decimal when twice the length of the alternative route is divided by the cruising range, it is rounded up. Through further analysis, the environmental stability value HWi of the alternative route is obtained. The larger the environmental stability value of the alternative route, the more complex the environment on the route is, which has a greater impact on the traveling efficiency of the coal mine robot and the operation of related equipment. The smaller the environmental stability value of the alternative route, the smaller the environmental stability value of the alternative route, which indicates that the environment on the route is relatively stable. The relevant equipment will not be unable to work due to environmental influences;

所述通过进一步分析得到备选路线的环稳值HWi,具体为:Through further analysis, the environmental stability value HWi of the alternative route is obtained, specifically:

其中,Hi为异常环境路段的总长度,e为自然常数,b1为预设的异常环境检测点数量权重因子,b2为预设的异常环境路段长度权重因子,b3为预设的充电次数权重因子;Among them, Hi is the total length of the abnormal environment section, e is a natural constant, b1 is the preset weight factor for the number of abnormal environment detection points, b2 is the preset weight factor for the length of the abnormal environment section, and b3 is the preset weight factor for the number of charging times. ;

步骤三、对备选路线的路面进行分析得到路平值,对检测点的图像进行采集,根据检测点的图像建立备选路线的三维模型,对备选路线的三维模型分析得到备选路线中各路段类型的长度,获取备选路线的二维平面图,对二维平面图进一步分析得到备选路线的弯曲路段,根据弯曲路段得到备选路线的弯曲度,基于各路段类型的长度和备选路线的弯曲度对备选路线的路面进行分析得到路平值,其中,各路段类型包括平面路段、上坡路段和下坡路段;Step 3: Analyze the road surface of the alternative route to obtain the road level value, collect the image of the detection point, establish a three-dimensional model of the alternative route based on the image of the detection point, analyze the three-dimensional model of the alternative route, and obtain the The length of each road segment type is obtained, and the two-dimensional plan view of the alternative route is obtained. The two-dimensional plan view is further analyzed to obtain the curved road section of the alternative route. The curvature of the alternative route is obtained based on the curved road section. Based on the length of each road section type and the alternative route The curvature of the road surface of the alternative route is analyzed to obtain the road level value, where each road section type includes a flat road section, an uphill road section and a downhill road section;

优选地,对备选路线的路面进行分析,分析过程如下:Preferably, the road surface of the alternative route is analyzed, and the analysis process is as follows:

通过高清摄像头对备选路线中检测点的图像进行采集,根据检测点的图像建立备选路线的三维模型,在备选路线的三维模型中将检测点的位置进行标记,对备选路线的三维模型中检测点对应的矿井高度进行测量得到检测点对应的矿井高度,将检测点的矿井高度与设定的矿井高度区间进行对比,当检测点的矿井高度属于设定的矿井高度区间时,则将检测点标记为平路点,当检测点的矿井高度小于设定的矿井高度区间时,则将检测点标记为上坡点,当检测点的矿井高度大于预设的矿井高度区间时,则将检测点标记为下坡点,由此得到备选路线中的平路点、上坡点和下坡点;Collect images of detection points in the alternative route through high-definition cameras, establish a three-dimensional model of the alternative route based on the images of the detection points, mark the positions of the detection points in the three-dimensional model of the alternative route, and map the three-dimensional image of the alternative route The mine height corresponding to the detection point in the model is measured to obtain the mine height corresponding to the detection point, and the mine height of the detection point is compared with the set mine height interval. When the mine height of the detection point belongs to the set mine height interval, then Mark the detection point as a flat road point. When the mine height of the detection point is less than the set mine height interval, mark the detection point as an uphill point. When the mine height of the detection point is greater than the preset mine height interval, then Mark the detection point as a downhill point, thereby obtaining the flat points, uphill points and downhill points in the alternative route;

将相邻的平路点进行连接得到备选路线中的平缓路段,对平缓路段的长度进行统计并求和得到备选路线中平缓路段的总长度PHi,将相邻的上坡点进行连接得到备选路线中的上坡路段,对上坡路段的长度进行统计并求和得到备选路线中上坡路段的总长度SPi,将相邻的下坡点进行连接得到备选路线中的下坡路段,对下坡路段的长度进行统计并求和得到备选路线中下坡路段的总长度XPi;Connect the adjacent flat road points to obtain the gentle road sections in the alternative route. Count the lengths of the gentle road sections and sum them up to obtain the total length PHi of the gentle road sections in the alternative route. Connect the adjacent uphill points to obtain For the uphill sections in the alternative route, the lengths of the uphill sections are counted and summed to obtain the total length SPi of the uphill sections in the alternative route. The adjacent downhill points are connected to obtain the downhill sections in the alternative route. For the downhill sections The lengths of the segments are counted and summed to obtain the total length XPi of the downhill segments in the alternative route;

获取备选路线的二维平面图,从备选路线的二维平面图中获取备选路线对应的中心线,从中心线中识别弯曲路段并计算弯曲路段的长度,标记弯曲路段的起始点和结束点,对弯曲路段起始点和结束点之间的直线距离进行计算得到弯曲路段对应的直线距离,将弯曲路段的长度与弯曲路段的直线距离进行对比,得到弯曲路段的长度与弯曲路段的直线距离之间的比例值,将该比例值与预设的比例值对应的弯曲度进行匹配得到弯曲路段的弯曲度WQk,k为备选路线中弯曲路段的编号,k=1,2,...r,r取值范围为大于1的正整数;通过分析得到备选路线的路平值LPi,备选路线的路平值越大说明备选路线比较平缓,煤矿机器人在该路线上行进时其功耗较小,能够更快的到达目标位置,备选路线的路平值越小说明备选路线比较崎岖,煤矿机器人在该路线上行进需要花费更多的时间进行转向和上下坡,煤矿机器人的功耗也随之增加,到达目标位置的时间也更长;Obtain the two-dimensional plan view of the alternative route, obtain the center line corresponding to the alternative route from the two-dimensional plan view of the alternative route, identify the curved road section from the center line and calculate the length of the curved road section, mark the starting point and end point of the curved road section , calculate the straight-line distance between the starting point and the end point of the curved road section to obtain the straight-line distance corresponding to the curved road section, compare the length of the curved road section with the straight-line distance of the curved road section, and obtain the length of the curved road section and the straight-line distance of the curved road section. The proportion value between the proportion value and the curvature corresponding to the preset proportion value is matched to obtain the curvature WQk of the curved road section, k is the number of the curved road section in the alternative route, k=1,2,...r , the value range of r is a positive integer greater than 1; through analysis, the road level value LPi of the alternative route is obtained. The larger the road level value of the alternative route, it means that the alternative route is relatively gentle. When the coal mine robot travels on this route, its power is It consumes less energy and can reach the target location faster. The smaller the road level value of the alternative route, the more rugged the alternative route is. The coal mining robot will need to spend more time turning and going up and downhill when traveling on this route. Power consumption also increases and it takes longer to reach the target location;

所述通过分析得到备选路线的路平值LPi,具体为:The road level value LPi of the alternative route is obtained through the analysis, specifically:

其中,c1为预设的平缓路段权重因子,c2为预设的坡段权重因子,c3为预设的弯曲度权重因子;Among them, c1 is the preset weight factor for gentle road sections, c2 is the preset weight factor for slope sections, and c3 is the preset weight factor for curvature;

步骤四、基于备选路线的环稳值和路平值分析得到备选路线的选择值,将备选路线的选择值与预设的选择值阈值进行对比,若备选路线的选择值小于预设的选择值阈值则将备选路线标记为优选路线,反之则将备选路线标记为淘汰路线,以此对备选路线进行筛选,从筛选后的备选路线中选择设定数量的备选路线作为煤矿机器人的行进路线;Step 4: Obtain the selection value of the alternative route based on the analysis of the environmental stability value and road level value of the alternative route. Compare the selection value of the alternative route with the preset selection value threshold. If the selection value of the alternative route is less than the preset selection value threshold, If the selection value threshold is set, the alternative route will be marked as the preferred route, otherwise, the alternative route will be marked as the eliminated route, so as to filter the alternative routes and select a set number of alternatives from the filtered alternative routes. The route serves as the traveling route of the coal mine robot;

优选地,基于备选路线的环稳值和路平值分析得到备选路线的选择值,分析过程如下:Preferably, the selection value of the alternative route is obtained based on the analysis of the environmental stability value and the road level value of the alternative route. The analysis process is as follows:

获取备选路线的环稳值和路平值,对备选路线的长度进行归一化处理,分析得到备选路线的选择值XZi,将备选路线的选择值与预设的选择值阈值进行对比,若备选路线的选择值小于预设的选择值阈值,则将备选路线标记为优选路线,若备选路线的选择值大于预设的选择值阈值,则将备选路线标记为淘汰路线;Obtain the environmental stability value and road level value of the alternative route, normalize the length of the alternative route, analyze and obtain the selection value XZi of the alternative route, and compare the selection value of the alternative route with the preset selection value threshold In contrast, if the selection value of the alternative route is less than the preset selection value threshold, the alternative route is marked as the preferred route; if the selection value of the alternative route is greater than the preset selection value threshold, the alternative route is marked as eliminated. route;

所述得到备选路线的选择值XZi,具体为:The selection value XZi of the alternative route is obtained, specifically:

XZi=HWi*d1+(1/LPi)*d2+Li*d3XZi=HWi*d1+(1/LPi)*d2+Li*d3

其中,d1为预设的选择值第一转换因子,d2为预设的选择值第二转换因子,d3为预设的选择值第三转换因子;Among them, d1 is the preset first conversion factor of the selection value, d2 is the preset second conversion factor of the selection value, and d3 is the preset third conversion factor of the selection value;

将优选路线对应的选择值按照从大到小的顺序进行排列得到选择值列表,从选择值列表中选取最大选择值对应的优选路线作为煤矿机器人的行进路线,将煤矿机器人对应行进路线的选择值从选择值列表中删除后,从选择值列表中选择设定数量的优选路线作为煤矿机器人的应急路线,将行进路线和应急路线发送至煤矿机器人的接收端。Arrange the selection values corresponding to the preferred route in order from large to small to obtain a selection value list. Select the preferred route corresponding to the maximum selection value from the selection value list as the traveling route of the coal mine robot. Add the selection values corresponding to the traveling route of the coal mine robot. After being deleted from the selection value list, select a set number of preferred routes from the selection value list as the emergency route of the coal mine robot, and send the travel route and emergency route to the receiving end of the coal mine robot.

本发明的有益效果:Beneficial effects of the present invention:

1.通过对备选路线的环稳值进行分析,考虑备选路线中环境因素给煤矿机器人带来的影响,同时预估煤矿机器人在行进过程中的充电次数对其行进效率的影响,避免矿井下环境的变化导致煤矿机器人无法正常完成工作任务的情况发生,提高煤矿机器人在煤矿路线中的适应性;1. By analyzing the environmental stability value of the alternative route, consider the impact of environmental factors on the coal mine robot in the alternative route, and at the same time estimate the impact of the number of charging times of the coal mine robot on its travel efficiency to avoid mine Changes in the environment cause the coal mine robot to be unable to complete its tasks normally, and improve the adaptability of the coal mine robot in the coal mine route;

2.通过对备选路线的路平值进行分析,计算备选路线中各路段类型的长度,考虑坡段对机器人行进效率的影响,选择长度较短、路面平整度较高和环境稳定性较好的路线,从而更好地完成煤矿任务;2. By analyzing the road level value of the alternative route, calculate the length of each road section type in the alternative route, consider the impact of slope sections on the robot's traveling efficiency, and select a route with shorter length, higher road surface smoothness and better environmental stability. Good routes to better complete coal mine tasks;

3.通过备选路线的长度、环稳值和路平值分析得到备选路线的选择值,根据选择值确定煤矿机器人的行进路线,并选择设定数量的路线作为应急路线,以应对矿井突发情况,综合考虑路线的效率、安全性和稳定性。3. Obtain the selection value of the alternative route by analyzing the length, environmental stability value and road level value of the alternative route, determine the traveling route of the coal mine robot based on the selection value, and select a set number of routes as emergency routes to cope with mine emergencies. situation, and comprehensively consider the efficiency, safety and stability of the route.

附图说明Description of the drawings

图1本发明实施例用于煤矿机器人的路线规划方法流程图。Figure 1 is a flow chart of a route planning method for coal mine robots according to an embodiment of the present invention.

具体实施方式Detailed ways

下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述;The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention;

请参阅图1所示,本发明为用于煤矿机器人的路线规划方法,包括以下步骤:Please refer to Figure 1. The present invention is a route planning method for coal mine robots, which includes the following steps:

对煤矿机器人的起始位置和目标位置进行标记,基于起始位置和目标位置生成路线,将生成的路线记为备选路线,获取备选路线的二维平面图,对备选路线的长度进行计算并记为Li,i为备选路线的编号,i的取值范围为正整数;Mark the starting position and target position of the coal mine robot, generate a route based on the starting position and target position, record the generated route as an alternative route, obtain a two-dimensional plan view of the alternative route, and calculate the length of the alternative route And recorded as Li, i is the number of the alternative route, and the value range of i is a positive integer;

对备选路线的环境进行分析得到环稳值,分析过程如下:Analyze the environment of the alternative route to obtain the environmental stability value. The analysis process is as follows:

按照预设的检测距离对备选路线布设若干均匀的检测点,通过传感器按照预设的采集时长对检测点的环境参数进行若干次采集,环境参数包括检测点的空气密度、粉尘浓度、湿度和温度,从若干次采集的环境参数中选取第一环境参数和第二环境参数,第一环境参数为多次采集的环境参数中的最大值,具体为最大空气密度Pij、最大粉尘浓度Fij、最大湿度Sij和最大温度Cij,第二环境参数为多次采集的环境数据中的最小值,具体为最小空气密度pij、最小粉尘浓度fij、最小湿度sij和最小温度cij,j为备选路线上检测点的编号,j=1,2,...,m,m的取值范围为正整数,通过公式:A number of uniform detection points are arranged on the alternative route according to the preset detection distance, and the environmental parameters of the detection points are collected several times by the sensor according to the preset collection time. The environmental parameters include air density, dust concentration, humidity and Temperature, select the first environmental parameter and the second environmental parameter from several environmental parameters collected multiple times. The first environmental parameter is the maximum value among the environmental parameters collected multiple times, specifically the maximum air density Pij, the maximum dust concentration Fij, the maximum Humidity Sij and maximum temperature Cij, the second environmental parameter is the minimum value among the environmental data collected multiple times, specifically the minimum air density pij, minimum dust concentration fij, minimum humidity sij and minimum temperature cij, j is the detection on the alternative route The number of the point, j=1,2,...,m, the value range of m is a positive integer, through the formula:

计算得到检测点的异常值YCij,Δρ1为预设的空气密度允许差,Δρ2为预设的粉尘浓度允许差,Δρ3为预设的湿度允许差,Δρ4为预设的温度允许差,a1为预设的空气密度权重因子,a2为预设的粉尘浓度权重因子,a3为预设的湿度权重因子,a4为预设的温度权重因子,将检测点的异常值与预设的异常值阈值进行对比,若检测点的异常值大于预设的异常值阈值,则将检测点标记为异常环境检测点,若检测点的异常值小于预设的异常值阈值,反之则将检测点标记为正常环境检测点,统计异常环境检测点的数量Ni;所述异常值阈值根据实际情况进行设置,阈值大小的设置越接近真实情况,结果就越准确;Calculate the abnormal value YCij of the detection point, Δρ1 is the preset air density allowable difference, Δρ2 is the preset dust concentration allowable difference, Δρ3 is the preset humidity allowable difference, Δρ4 is the preset temperature allowable difference, a1 is the preset temperature allowable difference Assume the air density weighting factor, a2 is the preset dust concentration weighting factor, a3 is the preset humidity weighting factor, a4 is the preset temperature weighting factor, compare the abnormal value of the detection point with the preset abnormal value threshold , if the abnormal value of the detection point is greater than the preset abnormal value threshold, the detection point will be marked as an abnormal environment detection point; if the abnormal value of the detection point is less than the preset abnormal value threshold, otherwise the detection point will be marked as a normal environment detection point points, count the number Ni of abnormal environment detection points; the abnormal value threshold is set according to the actual situation. The closer the threshold size is set to the real situation, the more accurate the result will be;

本发明通过对备选路线中检测点的异常值进行分析得到正常环境检测点和异常检测点,由此对备选路线中总体的环境进行一个较为准确的评估,初步判断备选路线中的环境条件是否符合煤矿机器人的安全要求,进一步判断备选路线的环境条件对煤矿机器人运行效率的影响,从而优化对煤矿机器人路线的选择,提高煤矿机器人的运行效率。The present invention obtains normal environment detection points and abnormal detection points by analyzing the abnormal values of detection points in the alternative route, thereby making a more accurate assessment of the overall environment in the alternative route and preliminarily judging the environment in the alternative route. Whether the conditions meet the safety requirements of the coal mine robot, and further determine the impact of the environmental conditions of the alternative route on the operating efficiency of the coal mine robot, thereby optimizing the selection of the coal mine robot route and improving the operating efficiency of the coal mine robot.

将相邻的异常环境检测点进行连接得到异常环境路段,对异常环境路段的长度进行计算并求和得到异常环境路段的总长度,从设置在服务器内或者主机内的数据库中获取煤矿机器人的续航里程XH,通过计算式ni=2Li/XH+α得到煤矿机器人在该备用路线上预估的充电次数ni,α为预设的充电补偿次数,若备选路线的长度的二倍除以续航里程存在小数,则向上取整,通过公式:Connect the adjacent abnormal environment detection points to obtain the abnormal environment section, calculate and sum the length of the abnormal environment section to obtain the total length of the abnormal environment section, and obtain the battery life of the coal mine robot from the database set in the server or host. Mileage If there are decimals, round them up and use the formula:

计算得到备选路线的环稳值HWi,Hi为异常环境路段的总长度,e为自然常数,b1为预设的异常环境检测点数量权重因子,b2为预设的异常环境路段长度权重因子,b3为预设的充电次数权重因子,备选路线的环稳值越大说明该路线上的环境越复杂,对煤矿机器人的行进效率及相关设备运行有较大的影响,备选路线的环稳值越小说明该路线上的环境比较稳定,煤矿机器人的相关设备不会出现因为环境影响而无法工作的情况;Calculate the environmental stability value HWi of the alternative route, Hi is the total length of the abnormal environment section, e is a natural constant, b1 is the preset weight factor for the number of abnormal environment detection points, b2 is the preset weight factor for the length of the abnormal environment section, b3 is the preset weighting factor for the number of charging times. The larger the environmental stability value of the alternative route, the more complex the environment on the route is. It has a greater impact on the traveling efficiency of the coal mine robot and the operation of related equipment. The environmental stability of the alternative route is The smaller the value, the more stable the environment along the route is, and the relevant equipment of the coal mine robot will not be unable to work due to environmental effects;

需要说明的是,若备选路线的长度的二倍除以续航里程存在小数,则向上取整,例如续航里程为40KM,路线长度为20KM,预估的充电次数=30*2/40+1=2.5次,2.5向上取整为3,用符号表示为说明预估当前备选路线上煤矿机器人最少需要充电,两次才能完成该备选路线上的往返,例如续航里程为20KM,路线长度为34.6KM,预估的充电次数=34.6*2/40+0=3.46次,3.46向上取整为4,用符号表示为/>说明预估当前备选路线上煤矿机器人最少需要充电四次才能完成该备选路线上的往返。It should be noted that if there is a decimal when dividing twice the length of the alternative route by the cruising range, round up. For example, the cruising range is 40KM, the route length is 20KM, and the estimated number of charges = 30*2/40+1 =2.5 times, 2.5 is rounded up to 3, expressed in symbols as Explain that it is estimated that the coal mining robot on the current alternative route needs to be charged at least twice to complete the round trip on the alternative route. For example, the cruising range is 20KM, the route length is 34.6KM, and the estimated number of charging times = 34.6*2/40+ 0 = 3.46 times, 3.46 is rounded up to 4, and the symbol is /> It is estimated that the coal mine robot on the current alternative route needs to be charged at least four times to complete the round trip on the alternative route.

对备选路线的路面进行分析得到路平值,分析过程如下:Analyze the road surface of the alternative route to obtain the road level value. The analysis process is as follows:

通过高清摄像头对备选路线中检测点的图像进行采集,根据检测点的图像建立备选路线的三维模型,在备选路线的三维模型中将检测点的位置进行标记,对备选路线的三维模型中检测点对应的矿井高度进行测量得到检测点对应的矿井高度,将检测点的矿井高度与设定的矿井高度区间进行对比,当检测点的矿井高度属于设定的矿井高度区间时,则将检测点标记为平路点,当检测点的矿井高度小于设定的矿井高度区间时,则将检测点标记为上坡点,当检测点的矿井高度大于预设的矿井高度区间时,则将检测点标记为下坡点,由此得到备选路线中的平路点、上坡点和下坡点;Collect images of detection points in the alternative route through high-definition cameras, establish a three-dimensional model of the alternative route based on the images of the detection points, mark the positions of the detection points in the three-dimensional model of the alternative route, and map the three-dimensional image of the alternative route The mine height corresponding to the detection point in the model is measured to obtain the mine height corresponding to the detection point, and the mine height of the detection point is compared with the set mine height interval. When the mine height of the detection point belongs to the set mine height interval, then Mark the detection point as a flat road point. When the mine height of the detection point is less than the set mine height interval, mark the detection point as an uphill point. When the mine height of the detection point is greater than the preset mine height interval, then Mark the detection point as a downhill point, thereby obtaining the flat points, uphill points and downhill points in the alternative route;

本发明通过对备选路线对应三维模型中检测点的矿井高度进行测量,根据检测点的矿井高度将检测点划分为平路点、上坡点和下坡点并由此得到各路段类型,了解不同备选路线中各路段类型的占比,根据任务要求和煤矿机器人性能,可以对备选路线设置不同的约束条件和优先级,为煤矿机器人行驶策略的优化提供依据。This invention measures the mine height of the detection point in the three-dimensional model corresponding to the alternative route, and divides the detection point into flat road points, uphill points and downhill points according to the mine height of the detection point, and thereby obtains the type of each road section, and understands According to the proportion of each road segment type in different alternative routes, according to the task requirements and the performance of the coal mine robot, different constraints and priorities can be set for the alternative routes, providing a basis for the optimization of the coal mine robot's driving strategy.

将相邻的平路点进行连接得到备选路线中的平缓路段,对平缓路段的长度进行统计并求和得到备选路线中平缓路段的总长度PHi,将相邻的上坡点进行连接得到备选路线中的上坡路段,对上坡路段的长度进行统计并求和得到备选路线中上坡路段的总长度SPi,将相邻的下坡点进行连接得到备选路线中的下坡路段,对下坡路段的长度进行统计并求和得到备选路线中下坡路段的总长度XPi;Connect the adjacent flat road points to obtain the gentle road sections in the alternative route. Count the lengths of the gentle road sections and sum them up to obtain the total length PHi of the gentle road sections in the alternative route. Connect the adjacent uphill points to obtain For the uphill sections in the alternative route, the lengths of the uphill sections are counted and summed to obtain the total length SPi of the uphill sections in the alternative route. The adjacent downhill points are connected to obtain the downhill sections in the alternative route. For the downhill sections The lengths of the segments are counted and summed to obtain the total length XPi of the downhill segments in the alternative route;

获取备选路线的二维平面图,从备选路线的二维平面图中获取备选路线对应的中心线,从中心线中识别弯曲路段并计算弯曲路段的长度,标记弯曲路段的起始点和结束点,对弯曲路段起始点和结束点之间的直线距离进行计算得到弯曲路段对应的直线距离,将弯曲路段的长度与弯曲路段的直线距离进行对比,得到弯曲路段的长度与弯曲路段的直线距离之间的比例值,将该比例值与预设的比例值对应的弯曲度进行匹配得到弯曲路段的弯曲度WQk,k为备选路线中弯曲路段的编号,k=1,2,...r,r取值范围为大于1的正整数;Obtain the two-dimensional plan view of the alternative route, obtain the center line corresponding to the alternative route from the two-dimensional plan view of the alternative route, identify the curved road section from the center line and calculate the length of the curved road section, mark the starting point and end point of the curved road section , calculate the straight-line distance between the starting point and the end point of the curved road section to obtain the straight-line distance corresponding to the curved road section, compare the length of the curved road section with the straight-line distance of the curved road section, and obtain the length of the curved road section and the straight-line distance of the curved road section. The proportion value between the proportion value and the curvature corresponding to the preset proportion value is matched to obtain the curvature WQk of the curved road section, k is the number of the curved road section in the alternative route, k=1,2,...r , the value range of r is a positive integer greater than 1;

根据公式:According to the formula:

计算得到备选路线的路平值LPi,c1为预设的平缓路段权重因子,c2为预设的坡段权重因子,c3为预设的弯曲度权重因子,备选路线的路平值越大说明备选路线比较平缓,煤矿机器人在该路线上行进时其功耗较小,能够更快的到达目标位置,备选路线的路平值越小说明备选路线比较崎岖,煤矿机器人在该路线上行进需要花费更多的时间进行转向和上下坡,煤矿机器人的功耗也随之增加,到达目标位置的时间也更长;Calculate the road level value LPi of the alternative route. c1 is the preset gentle road section weight factor, c2 is the preset slope section weight factor, and c3 is the preset curvature weight factor. The greater the road level value of the alternative route. It means that the alternative route is relatively gentle. When the coal mine robot travels on this route, its power consumption is smaller and it can reach the target position faster. The smaller the road level value of the alternative route, it means that the alternative route is relatively rough. The coal mine robot can reach the target position faster. Traveling upward requires more time to turn and go up and down slopes. The power consumption of the coal mining robot also increases, and it takes longer to reach the target location;

进一步地,本发明通过对备选路线的路平值进行分析,初步判断备选路线的平坦程度和弯曲程度,从而进行路线评估和选择,提高煤矿机器人在煤矿路线中的适应性和稳定性。基于备选路线的环稳值和路平值分析得到备选路线的选择值,分析过程如下:Furthermore, the present invention preliminarily determines the flatness and curvature of the alternative route by analyzing the road level value of the alternative route, thereby conducting route evaluation and selection, and improving the adaptability and stability of the coal mine robot in the coal mine route. Based on the analysis of the environmental stability value and road level value of the alternative route, the selection value of the alternative route is obtained. The analysis process is as follows:

获取备选路线的环稳值和路平值,对备选路线的长度进行归一化处理,根据公式XZi=HWi*d1+(1/LPi)*d2+Li*d3计算得到备选路线的选择值XZi,d1为预设的选择值第一转换因子,d2为预设的选择值第二转换因子,d3为预设的选择值第三转换因子,将备选路线的选择值与预设的选择值阈值进行对比,若备选路线的选择值小于预设的选择值阈值,则将备选路线标记为优选路线,若备选路线的选择值大于预设的选择值阈值,则将备选路线标记为淘汰路线;Obtain the environmental stability value and road level value of the alternative route, normalize the length of the alternative route, and calculate the selection of the alternative route according to the formula XZi=HWi*d1+(1/LPi)*d2+Li*d3 Value The selection value threshold is compared. If the selection value of the alternative route is less than the preset selection value threshold, the alternative route will be marked as the preferred route. If the selection value of the alternative route is greater than the preset selection value threshold, the alternative route will be marked as the preferred route. The route is marked as an elimination route;

本发明通过将备选路线的环稳值、路平值和长度分析并对煤矿机器人的路线进行规划,综合考虑备用路线的效率、安全性和稳定性,选择长度较短、路面平整度较高和环境稳定性较好的路线,可以提高机器人的行驶效率、安全性和稳定性,从而更好地完成煤矿任务。By analyzing the environmental stability value, road level value and length of the alternative route and planning the route of the coal mine robot, the invention comprehensively considers the efficiency, safety and stability of the alternative route and selects a shorter length and higher road surface smoothness. Routes with better environmental stability can improve the driving efficiency, safety and stability of the robot, thereby better completing coal mine tasks.

将优选路线对应的选择值按照从大到小的顺序进行排列得到选择值列表,从选择值列表中选取最大选择值对应的优选路线作为煤矿机器人的行进路线,将煤矿机器人对应行进路线的选择值从选择值列表中删除后,从选择值列表中选择设定数量的优选路线作为煤矿机器人的应急路线,将行进路线和应急路线发送至煤矿机器人的接收端。Arrange the selection values corresponding to the preferred route in order from large to small to obtain a selection value list. Select the preferred route corresponding to the maximum selection value from the selection value list as the traveling route of the coal mine robot. Add the selection values corresponding to the traveling route of the coal mine robot. After being deleted from the selection value list, select a set number of preferred routes from the selection value list as the emergency route of the coal mine robot, and send the travel route and emergency route to the receiving end of the coal mine robot.

本发明通过根据备选路线的选择值对煤矿机器人的行进路线和应急路线进行制定,可以在突发情况下及时切换路线,保障煤矿机器人的使用安全,并且减少煤矿机器人遭受损坏的风险,降低因煤矿机器人意外情况损坏而导致的维护成本增加的问题。By formulating the traveling route and emergency route of the coal mine robot according to the selection value of the alternative route, the present invention can switch routes in time in an emergency, ensure the safety of the coal mine robot, and reduce the risk of damage to the coal mine robot. The problem of increased maintenance costs caused by accidental damage to coal mine robots.

Claims (10)

1.用于煤矿机器人的路线规划方法,其特征在于,具体包括以下步骤:1. A route planning method for coal mine robots, which is characterized in that it specifically includes the following steps: 步骤一、对煤矿机器人的起始位置和目标位置进行标记,基于起始位置和目标位置生成路线,将生成的路线记为备选路线,获取备选路线的二维平面图,对备选路线的长度进行计算并记为Li,i为备选路线的编号,i的取值范围为正整数;Step 1: Mark the starting position and target position of the coal mine robot, generate a route based on the starting position and the target position, record the generated route as an alternative route, obtain a two-dimensional plan view of the alternative route, and analyze the The length is calculated and recorded as Li, i is the number of the alternative route, and the value range of i is a positive integer; 步骤二、对备选路线布设若干检测点,获取检测点的环境参数,对检测点的环境参数进行分析得到检测点的异常值,将检测点的异常值与预设的异常值阈值进行对比,若检测点的异常值大于预设的异常值阈值则将检测点标记为异常环境检测点,反之则将检测点标记为正常环境监测点,将相邻的环境异常检测点进行连接得到环境异常路段,将相邻的正常环境检测点进行连接得到正常环境路段,计算备选路线中环境异常路段和环境正常路段的总长度,由此对备选路线的环境进行分析得到备选路线的环稳值;Step 2: Arrange a number of detection points on the alternative route, obtain the environmental parameters of the detection points, analyze the environmental parameters of the detection points to obtain the abnormal values of the detection points, and compare the abnormal values of the detection points with the preset abnormal value thresholds. If the abnormal value of the detection point is greater than the preset abnormal value threshold, the detection point will be marked as an abnormal environment detection point. Otherwise, the detection point will be marked as a normal environment monitoring point. The adjacent environmental abnormality detection points will be connected to obtain the abnormal environmental road section. , connect adjacent normal environment detection points to obtain normal environment road sections, calculate the total length of the abnormal environment road sections and normal environment road sections in the alternative route, and thereby analyze the environment of the alternative route to obtain the environmental stability value of the alternative route ; 步骤三、对备选路线的路面进行分析得到路平值,对检测点的图像进行采集,根据检测点的图像建立备选路线的三维模型,对备选路线的三维模型分析得到备选路线中各路段类型的长度,获取备选路线的二维平面图,对二维平面图进一步分析得到备选路线的弯曲路段,根据弯曲路段得到备选路线的弯曲度,基于各路段类型的长度和备选路线的弯曲度对备选路线的路面进行分析得到路平值;Step 3: Analyze the road surface of the alternative route to obtain the road level value, collect the image of the detection point, establish a three-dimensional model of the alternative route based on the image of the detection point, analyze the three-dimensional model of the alternative route, and obtain the The length of each road segment type is obtained, and the two-dimensional plan view of the alternative route is obtained. The two-dimensional plan view is further analyzed to obtain the curved road section of the alternative route. The curvature of the alternative route is obtained based on the curved road section. Based on the length of each road section type and the alternative route The curvature of the road surface of the alternative route is analyzed to obtain the road level value; 步骤四、基于备选路线的环稳值和路平值分析得到备选路线的选择值,将备选路线的选择值与预设的选择值阈值进行对比,若备选路线的选择值小于预设的选择值阈值则将备选路线标记为优选路线,反之则将备选路线标记为淘汰路线,以此对备选路线进行筛选,从筛选后的备选路线中选择设定数量的备选路线作为煤矿机器人的行进路线。Step 4: Obtain the selection value of the alternative route based on the analysis of the environmental stability value and road level value of the alternative route. Compare the selection value of the alternative route with the preset selection value threshold. If the selection value of the alternative route is less than the preset selection value threshold, If the selection value threshold is set, the alternative route will be marked as the preferred route, otherwise, the alternative route will be marked as the eliminated route, so as to filter the alternative routes and select a set number of alternatives from the filtered alternative routes. The route serves as the traveling route of the coal mine robot. 2.根据权利要求1所述的用于煤矿机器人的路线规划方法,其特征在于,所述各路段类型包括平面路段、上坡路段和下坡路段。2. The route planning method for coal mine robots according to claim 1, characterized in that the road section types include flat road sections, uphill road sections and downhill road sections. 3.根据权利要求1所述的用于煤矿机器人的路线规划方法,其特征在于,步骤二所述对备选路线的环境进行分析,分析过程如下:3. The route planning method for coal mine robots according to claim 1, characterized in that the environment of the alternative route is analyzed in step two, and the analysis process is as follows: 按照预设的检测距离对备选路线布设若干均匀的检测点,通过传感器按照预设的采集时长对检测点的环境参数进行若干次采集,从若干次采集的环境参数中选取第一环境参数和第二环境参数,通过分析得到检测点的异常值YCij,将检测点的异常值与预设的异常值阈值进行对比,若检测点的异常值大于预设的异常值阈值,则将检测点标记为异常环境检测点,若检测点的异常值小于预设的异常值阈值,则将检测点标记为正常环境检测点,统计异常环境检测点的数量Ni;Arrange several uniform detection points on the alternative route according to the preset detection distance, collect the environmental parameters of the detection points several times through the sensor according to the preset collection time, and select the first environmental parameter and the first environmental parameter from the environmental parameters collected several times. For the second environmental parameter, the abnormal value YCij of the detection point is obtained through analysis, and the abnormal value of the detection point is compared with the preset abnormal value threshold. If the abnormal value of the detection point is greater than the preset abnormal value threshold, the detection point is marked is an abnormal environment detection point. If the abnormal value of the detection point is less than the preset abnormal value threshold, the detection point will be marked as a normal environment detection point, and the number of abnormal environment detection points Ni will be counted; 将相邻的异常环境检测点进行连接得到异常环境路段,对异常环境路段的长度进行计算并求和得到异常环境路段的总长度,从数据库中获取煤矿机器人的续航里程XH,通过分析得到煤矿机器人在该备用路线上预估的充电次数ni,若备选路线的长度的二倍除以续航里程存在小数,则向上取整,通过进一步分析得到备选路线的环稳值HWi,备选路线的环稳值越大说明该路线上的环境越复杂,对煤矿机器人的行进效率及相关设备运行有较大的影响,备选路线的环稳值越小说明该路线上的环境比较稳定,煤矿机器人的相关设备不会出现因为环境影响而无法工作的情况。Connect the adjacent abnormal environment detection points to obtain the abnormal environment section, calculate and sum the length of the abnormal environment section to obtain the total length of the abnormal environment section, obtain the cruising range XH of the coal mine robot from the database, and obtain the coal mine robot through analysis For the estimated number of charging times ni on the alternative route, if there is a decimal when twice the length of the alternative route is divided by the cruising range, it is rounded up. Through further analysis, the environmental stability value HWi of the alternative route is obtained. The larger the environmental stability value of the alternative route, the more complex the environment on the route is, which has a greater impact on the traveling efficiency of the coal mine robot and the operation of related equipment. The smaller the environmental stability value of the alternative route, the smaller the environmental stability value of the alternative route, which indicates that the environment on the route is relatively stable. The relevant equipment will not be unable to work due to environmental influences. 4.根据权利要求3所述的用于煤矿机器人的路线规划方法,其特征在于,所述第一环境参数为多次采集的环境参数中的最大值,具体为最大空气密度Pij、最大粉尘浓度Fij、最大湿度Sij和最大温度Cij,第二环境参数为多次采集的环境数据中的最小值,具体为最小空气密度pij、最小粉尘浓度fij、最小湿度sij和最小温度cij,j为备选路线上检测点的编号,j=1,2,...,m,m的取值范围为正整数。4. The route planning method for coal mine robots according to claim 3, characterized in that the first environmental parameter is the maximum value among the environmental parameters collected multiple times, specifically the maximum air density Pij and the maximum dust concentration. Fij, maximum humidity Sij and maximum temperature Cij, the second environmental parameter is the minimum value among the environmental data collected multiple times, specifically the minimum air density pij, minimum dust concentration fij, minimum humidity sij and minimum temperature cij, j is an alternative The number of the detection point on the route, j=1,2,...,m, the value range of m is a positive integer. 5.根据权利要求3所述的用于煤矿机器人的路线规划方法,其特征在于,所述分析得到检测点的异常值YCij,具体为:5. The route planning method for coal mine robots according to claim 3, characterized in that the analysis obtains the abnormal value YCij of the detection point, specifically: 其中,Δρ1为预设的空气密度允许差,Δρ2为预设的粉尘浓度允许差,Δρ3为预设的湿度允许差,Δρ4为预设的温度允许差,a1为预设的空气密度权重因子,a2为预设的粉尘浓度权重因子,a3为预设的湿度权重因子,a4为预设的温度权重因子。Among them, Δρ1 is the preset air density allowable difference, Δρ2 is the preset dust concentration allowable difference, Δρ3 is the preset humidity allowable difference, Δρ4 is the preset temperature allowable difference, a1 is the preset air density weight factor, a2 is the preset dust concentration weighting factor, a3 is the preset humidity weighting factor, and a4 is the preset temperature weighting factor. 6.根据权利要求3所述的用于煤矿机器人的路线规划方法,其特征在于,所述通过进一步分析得到备选路线的环稳值HWi,具体为:6. The route planning method for coal mine robots according to claim 3, characterized in that the environmental stability value HWi of the alternative route is obtained through further analysis, specifically: 其中,Hi为异常环境路段的总长度,e为自然常数,b1为预设的异常环境检测点数量权重因子,b2为预设的异常环境路段长度权重因子,b3为预设的充电次数权重因子。Among them, Hi is the total length of the abnormal environment section, e is a natural constant, b1 is the preset weight factor for the number of abnormal environment detection points, b2 is the preset weight factor for the length of the abnormal environment section, and b3 is the preset weight factor for the number of charging times. . 7.根据权利要求1所述的用于煤矿机器人的路线规划方法,其特征在于,步骤三所述对备选路线的路面进行分析,分析过程如下:7. The route planning method for coal mine robots according to claim 1, characterized in that the road surface of the alternative route is analyzed in step three, and the analysis process is as follows: 通过高清摄像头对备选路线中检测点的图像进行采集,根据检测点的图像建立备选路线的三维模型,在备选路线的三维模型中将检测点的位置进行标记,对备选路线的三维模型中检测点对应的矿井高度进行测量得到检测点对应的矿井高度,将检测点的矿井高度与设定的矿井高度区间进行对比,当检测点的矿井高度属于设定的矿井高度区间时,则将检测点标记为平路点,当检测点的矿井高度小于设定的矿井高度区间时,则将检测点标记为上坡点,当检测点的矿井高度大于预设的矿井高度区间时,则将检测点标记为下坡点,由此得到备选路线中的平路点、上坡点和下坡点;Collect images of detection points in the alternative route through high-definition cameras, establish a three-dimensional model of the alternative route based on the images of the detection points, mark the positions of the detection points in the three-dimensional model of the alternative route, and map the three-dimensional image of the alternative route The mine height corresponding to the detection point in the model is measured to obtain the mine height corresponding to the detection point, and the mine height of the detection point is compared with the set mine height interval. When the mine height of the detection point belongs to the set mine height interval, then Mark the detection point as a flat road point. When the mine height of the detection point is less than the set mine height interval, mark the detection point as an uphill point. When the mine height of the detection point is greater than the preset mine height interval, then Mark the detection point as a downhill point, thereby obtaining the flat points, uphill points and downhill points in the alternative route; 将相邻的平路点进行连接得到备选路线中的平缓路段,对平缓路段的长度进行统计并求和得到备选路线中平缓路段的总长度PHi,将相邻的上坡点进行连接得到备选路线中的上坡路段,对上坡路段的长度进行统计并求和得到备选路线中上坡路段的总长度SPi,将相邻的下坡点进行连接得到备选路线中的下坡路段,对下坡路段的长度进行统计并求和得到备选路线中下坡路段的总长度XPi;Connect the adjacent flat road points to obtain the gentle road sections in the alternative route. Count the lengths of the gentle road sections and sum them up to obtain the total length PHi of the gentle road sections in the alternative route. Connect the adjacent uphill points to obtain For the uphill sections in the alternative route, the lengths of the uphill sections are counted and summed to obtain the total length SPi of the uphill sections in the alternative route. The adjacent downhill points are connected to obtain the downhill sections in the alternative route. For the downhill sections The lengths of the segments are counted and summed to obtain the total length XPi of the downhill segments in the alternative route; 获取备选路线的二维平面图,从备选路线的二维平面图中获取备选路线对应的中心线,从中心线中识别弯曲路段并计算弯曲路段的长度,标记弯曲路段的起始点和结束点,对弯曲路段起始点和结束点之间的直线距离进行计算得到弯曲路段对应的直线距离,将弯曲路段的长度与弯曲路段的直线距离进行对比,得到弯曲路段的长度与弯曲路段的直线距离之间的比例值,将该比例值与预设的比例值对应的弯曲度进行匹配得到弯曲路段的弯曲度WQk,k为备选路线中弯曲路段的编号,k=1,2,...r,r取值范围为大于1的正整数;通过分析得到备选路线的路平值LPi,备选路线的路平值越大说明备选路线比较平缓,煤矿机器人在该路线上行进时其功耗较小,能够更快的到达目标位置,备选路线的路平值越小说明备选路线比较崎岖,煤矿机器人在该路线上行进需要花费更多的时间进行转向和上下坡,煤矿机器人的功耗也随之增加,到达目标位置的时间也更长。Obtain the two-dimensional plan view of the alternative route, obtain the center line corresponding to the alternative route from the two-dimensional plan view of the alternative route, identify the curved road section from the center line and calculate the length of the curved road section, mark the starting point and end point of the curved road section , calculate the straight-line distance between the starting point and the end point of the curved road section to obtain the straight-line distance corresponding to the curved road section, compare the length of the curved road section with the straight-line distance of the curved road section, and obtain the length of the curved road section and the straight-line distance of the curved road section. The proportion value between the proportion value and the curvature corresponding to the preset proportion value is matched to obtain the curvature WQk of the curved road section, k is the number of the curved road section in the alternative route, k=1,2,...r , the value range of r is a positive integer greater than 1; the road level value LPi of the alternative route is obtained through analysis. The larger the road level value of the alternative route, it means that the alternative route is relatively gentle. When the coal mine robot travels on this route, its power is It consumes less energy and can reach the target location faster. The smaller the road level value of the alternative route, the more rugged the alternative route is. The coal mining robot needs to spend more time turning and going up and downhill on this route. The coal mining robot's Power consumption also increases and it takes longer to reach the target location. 8.根据权利要求7所述的用于煤矿机器人的路线规划方法,其特征在于,所述通过分析得到备选路线的路平值LPi,具体为:8. The route planning method for coal mine robots according to claim 7, characterized in that the road level value LPi of the alternative route is obtained through analysis, specifically: 其中,c1为预设的平缓路段权重因子,c2为预设的坡段权重因子,c3为预设的弯曲度权重因子。Among them, c1 is the preset weight factor for gentle road sections, c2 is the preset weight factor for slope sections, and c3 is the preset weight factor for curvature. 9.根据权利要求1所述的用于煤矿机器人的路线规划方法,其特征在于,步骤四所述基于备选路线的环稳值和路平值分析得到备选路线的选择值,分析过程如下:9. The route planning method for coal mine robots according to claim 1, characterized in that the selection value of the alternative route is obtained by analyzing the environmental stability value and road level value of the alternative route in step 4, and the analysis process is as follows : 获取备选路线的环稳值和路平值,对备选路线的长度进行归一化处理,分析得到备选路线的选择值XZi,将备选路线的选择值与预设的选择值阈值进行对比,若备选路线的选择值小于预设的选择值阈值,则将备选路线标记为优选路线,若备选路线的选择值大于预设的选择值阈值,则将备选路线标记为淘汰路线;Obtain the environmental stability value and road level value of the alternative route, normalize the length of the alternative route, analyze and obtain the selection value XZi of the alternative route, and compare the selection value of the alternative route with the preset selection value threshold In contrast, if the selection value of the alternative route is less than the preset selection value threshold, the alternative route is marked as the preferred route; if the selection value of the alternative route is greater than the preset selection value threshold, the alternative route is marked as eliminated. route; 将优选路线对应的选择值按照从大到小的顺序进行排列得到选择值列表,从选择值列表中选取最大选择值对应的优选路线作为煤矿机器人的行进路线,将煤矿机器人对应行进路线的选择值从选择值列表中删除后,从选择值列表中选择设定数量的优选路线作为煤矿机器人的应急路线,将行进路线和应急路线发送至煤矿机器人的接收端。Arrange the selection values corresponding to the preferred route in order from large to small to obtain a selection value list. Select the preferred route corresponding to the maximum selection value from the selection value list as the traveling route of the coal mine robot. Add the selection values corresponding to the traveling route of the coal mine robot. After being deleted from the selection value list, select a set number of preferred routes from the selection value list as the emergency route of the coal mine robot, and send the travel route and emergency route to the receiving end of the coal mine robot. 10.根据权利要求9所述的用于煤矿机器人的路线规划方法,其特征在于,所述得到备选路线的选择值XZi,具体为:10. The route planning method for coal mine robots according to claim 9, characterized in that the selection value XZi of the alternative route is obtained, specifically: XZi=HWi*d1+(1/LPi)*d2+Li*d3XZi=HWi*d1+(1/LPi)*d2+Li*d3 其中,d1为预设的选择值第一转换因子,d2为预设的选择值第二转换因子,d3为预设的选择值第三转换因子。Among them, d1 is the preset first conversion factor of the selection value, d2 is the preset second conversion factor of the selection value, and d3 is the preset third conversion factor of the selection value.
CN202311677436.XA 2023-12-08 2023-12-08 Route planning method for coal mine robots Pending CN117724483A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202311677436.XA CN117724483A (en) 2023-12-08 2023-12-08 Route planning method for coal mine robots

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202311677436.XA CN117724483A (en) 2023-12-08 2023-12-08 Route planning method for coal mine robots

Publications (1)

Publication Number Publication Date
CN117724483A true CN117724483A (en) 2024-03-19

Family

ID=90208081

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202311677436.XA Pending CN117724483A (en) 2023-12-08 2023-12-08 Route planning method for coal mine robots

Country Status (1)

Country Link
CN (1) CN117724483A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118915776A (en) * 2024-10-09 2024-11-08 宏景科技股份有限公司 Autonomous patrol and decision method of intelligent patrol robot in park

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118915776A (en) * 2024-10-09 2024-11-08 宏景科技股份有限公司 Autonomous patrol and decision method of intelligent patrol robot in park

Similar Documents

Publication Publication Date Title
CN107213990B (en) Performance evaluation and operation optimization system of electrostatic precipitator system
CN110667434A (en) Working condition-adaptive pure electric vehicle driving mileage estimation method and system
CN110610260A (en) Driving energy consumption prediction system, method, storage medium and device
CN113281671A (en) Lithium ion battery remaining service life prediction method and system based on IGS-SVM
CN117724483A (en) Route planning method for coal mine robots
CN118981629B (en) A new energy vehicle charging pile operation data analysis system based on big data
CN111552299A (en) An intelligent optimization management system and optimization method for the energy efficiency of a wind wing-assisted ship
CN115907076A (en) A system and method for probabilistic prediction of charging load in mountainous cities
CN110516935A (en) A cloud intelligent distribution method for the right of way of mine vehicle unmanned transportation system based on the device-edge-cloud architecture
CN116759355B (en) Wafer transmission control method and system
CN112686582A (en) Intelligent operation and maintenance system of comprehensive energy park based on multi-source heterogeneous data mining
CN105930922A (en) Continuation mileage prediction method for tour inspection robot of high tension transmission line
CN117128966A (en) A vehicle charging path planning method and equipment based on multi-factor coupling
CN117340872A (en) Motion verification control method and system for robot
CN114169774A (en) Mountain city charging station planning system, method and storage medium
CN106202965A (en) A kind of transmission line polling robot energy consumption Forecasting Methodology
CN118429834A (en) Unmanned aerial vehicle data acquisition method based on inspection data prediction
CN119274362A (en) A smart traffic signal control system
CN116433218A (en) Self-organizing mapping clustering-based mine mechanical equipment online health assessment method
CN205312815U (en) Security evaluation and early warning device of elevator operating mode
CN114333331A (en) Method and system for identifying vehicle passing information and vehicle weight of multi-lane bridge
CN114492921A (en) A charging facility planning system and method based on an intelligent transportation system
CN119294893A (en) Engineering construction quality analysis system and method based on data processing
CN118332275A (en) Mine exploitation ecological environment damage assessment method and system
CN117827798A (en) A method and system for constructing an electric vehicle charging safety feature database

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