Autonomous deviation rectification control method for underground support carrying robot
Through the fuzzy PID controller and parallel master-slave control structure, the problem of the downhole bracket handling robot deviating from the route in the tunnel is solved, and the accurate and stable operation of the downhole bracket handling robot in the nonlinear system is achieved, ensuring that it drives according to the preset route .
Patent Information
- Application Number
- CN202411248563.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-06
- Publication Date
- 2024-12-06
AI Technical Summary
The underground bracket handling robot is prone to deviating from the preset route when it is operated independently in the tunnel. It is mainly due to external factors such as the inclination of the tunnel, unevenness of the concave and convexity of the road surface that affects the track, resulting in inconsistent track speeds, which in turn leads to deviation.
The fuzzy PID controller is used to control the crawler hydraulic system. By roughly calculating the impact of slope and potholes on speed, measuring the degree of deviation between the vehicle body and the preset route, using gyroscope sensors and hydraulic systems to control the crawler speed difference, combined with Parallel with master-slave control structure to ensure the synchronization of track speed and correct the vehicle attitude.
Effectively solve the problems of poor anti-interference and slow tracking speed of downhole support handling robots in nonlinear systems, and realize that the downhole support handling robots can accurately, reliably and stably drive at the expected track speed within the specified time, ensuring that they are preset Route running.
Smart Images

Figure CN119088031A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of deviation correction of support handling robots, and in particular relates to an autonomous deviation correction control method for a downhole support handling robot. Background Art
[0002] The coal mine underground support handling robot is used to transport the advance support supports in the fully-mechanized mining working face. It is a key technical equipment for safe and efficient transportation in coal mines. However, there are the following problems: the underground working environment in coal mines is complex and dangerous; the traditional manually operated underground support handling robot has low handling efficiency and requires the collaboration of two people; the distance is long and the construction procedures are cumbersome.
[0003] In order to solve the above problems, a solution for unmanned autonomous operation of underground support handling robots was proposed. However, when underground support handling robots operate autonomously in tunnels, they may deviate from the preset route. Through research on the deviation problem of underground support handling robots, it was found that it was mainly due to the influence of external factors on the tracks of underground support handling robots, which in turn caused the underground support handling robots to deviate from the preset route.
[0004] There are three main external factors that cause the deviation phenomenon: 1. When the road surface of the underground tunnel is tilted, the underground support handling robot will deviate to the lower side of the track due to overload. 2. When the road surface of the underground tunnel is uneven and has potholes, the forces on the tracks on both sides are inconsistent during driving, resulting in differences in the speed of the tracks on both sides, which in turn causes the underground support handling robot to deviate. 3. Different road roughness and road adhesion coefficients can also cause the underground support handling robot to deviate.
[0005] Therefore, based on the interaction mechanism between the tracks of the underground support handling robot and the ground, it is critical to study the influence of the underground tunnel road surface on its deviation and realize the autonomous correction control of the underground support handling robot to ensure that it walks along the preset route. In order to solve the above problems, an autonomous correction control method for the underground support handling robot is urgently needed. Summary of the invention
[0006] The purpose of the present invention is to solve the problem that when a downhole support handling robot is operating autonomously in a tunnel, it may deviate from a preset route. Through research on the problem of downhole support handling robots running off the track, it is found that the problem is mainly caused by external factors affecting the tracks of the downhole support handling robot, which in turn causes the downhole support handling robot to deviate from the preset route. A method for autonomous deviation correction control of downhole support handling robots is proposed.
[0007] In order to achieve the above-mentioned purpose, the present invention adopts the following technical solution: an autonomous deviation correction control method for a downhole support handling robot, comprising the following steps:
[0008] S1. Start the vehicle;
[0009] S2. Roughly calculate the effect of slope and potholes on track resistance on speed;
[0010] S3, using fuzzy PID controller to control the crawler hydraulic system, and then control the crawler speed difference to achieve deviation correction;
[0011] S4, determining the degree of deviation between the vehicle body and the preset route;
[0012] S5, measuring the difference between the actual yaw angular velocity and the expected yaw angular velocity (0 rad / s), and then controlling the speed difference of the crawler to achieve the purpose of deviation correction;
[0013] S6. Encrypt and save all types of data in the above process.
[0014] As a further description of the above technical solution:
[0015] In S1, the vehicle is started and the yaw angular velocity ψ of the bracket transporting robot is obtained.
[0016] As a further description of the above technical solution:
[0017] In S2, the influence of the slope and potholes on the resistance of the track on the speed is roughly calculated, and the speed influence value can be estimated by integrating the acceleration a using the formula F=Ma.
[0018] As a further description of the above technical solution:
[0019] In S3, a fuzzy PID controller is used to control the crawler hydraulic system, and then the crawler speed difference is controlled to achieve deviation correction. The fuzzy PID control principle is to use fuzzy language rules and fuzzy logic to calculate the three control parameters P, I, and D, and use these three parameters to perform PID control.
[0020] As a further description of the above technical solution:
[0021] In S3, the characteristic of fuzzy PID control is that it can achieve the effect of precise control without building an accurate mathematical model. The specific process is as follows:
[0022] A1. Determine fuzzy language variables. According to the crawler speed control requirements, select the deviation E between the expected crawler speed and the actual crawler speed and the rate of change of the deviation over time Ec as input variables. PID control adjustment values Kp, Ki and Kd are used as output variables of fuzzy processing. Considering the working conditions of the underground support handling robot, the fuzzy domain of the five variables E, Ec, Kp, Ki and Kd of this system is {±5, 4, 3, 2, 1, 0}, and the fuzzy sets are {NL, NS, ZO, PS, PL}. The PID parameter setting values Kp'=1, Ki'=4, Kd'=0.001, and the proportional factors of Kp, Ki and Kd are determined to be 0.1, 1 and 0.001 respectively.
[0023] A2. Fuzzification of variables and determination of membership functions can effectively solve the fuzzy control problem. The widely used membership functions are Gaussian and triangular. In view of the fact that the crawler of the underground support handling robot is affected by resistance and the actual speed is constantly changing, the triangular membership function is more suitable;
[0024] A3. Generate fuzzy control rule surface through established fuzzy control rules;
[0025] A4. Defuzzification. Defuzzification is to obtain specific numerical values from the fuzzified results through specific methods. Commonly used methods include the centroid method, the maximum membership method and the weighted average method. This time, the centroid method is used to solve the specific numerical values after fuzzification. The output of the defuzzification by the centroid method is the correction value Kp, Ki, Kd of each parameter. The pre-set parameters must also be adjusted by the PID controller. The final output control parameters are the PID control parameters KP, KI, KD obtained by measuring the deviation and the deviation change rate.
[0026] As a further description of the above technical solution:
[0027] In S4, the degree of deviation of the vehicle body from the preset route is determined, that is, the yaw angular velocity of the vehicle body is measured using a gyro sensor.
[0028] As a further description of the above technical solution:
[0029] In S4, the yaw angular velocity refers to the degree of deflection of the scaffold handling robot around the vertical axis, which can be used to measure the change in the motion posture of the scaffold handling robot. When there is a deviation in the synchronous control of the left and right tracks of the scaffold handling robot to achieve the desired speed, yaw will occur, and the scaffold handling robot will deviate. The deviation is corrected by introducing the yaw angular velocity control amount. The master-slave control structure is adopted in the speed correction control module. The deviation and deviation rate of the desired yaw angular velocity and the actual yaw angular velocity are input to the fuzzy PID controller based on the driving speed of the right track. The obtained speed correction adjustment amount is input to the hydraulic drive system of the right track to achieve timely correction of the vehicle posture. The desired yaw angular velocity of the scaffold handling robot is 0 rad / s.
[0030] As a further description of the above technical solution:
[0031] In S5, after measuring the difference between the actual yaw angular velocity and the expected yaw angular velocity (0 rad / s), a controller is used to control the crawler hydraulic system, and then the speed difference of the crawler is controlled to achieve the purpose of correction. The overall control structure adopts a combination of parallel control and master-slave control. Since the hydraulic systems on both sides drive the crawlers independently and do not affect each other, the application of parallel control can better achieve synchronization accuracy. Taking the right crawler speed as the reference, a speed controller is introduced into the left crawler. Its working principle is to compare the expected crawler travel speed value, the speed error estimation and the actual crawler travel speed value, and determine the left and right crawler speed adjustment amount Ve through the control algorithm, and transmit the corresponding electrical signal to the hydraulic system, so as to achieve the crawler travel speed following the expected crawler travel speed, and ensure the synchronization of the crawler speeds on both sides.
[0032] As a further description of the above technical solution:
[0033] In the above S5, the performance of control elements cannot be guaranteed to be completely consistent, and the left and right crawler hydraulic systems are subject to different load torque interferences on the working road surface, resulting in some differences in speed on both sides; parallel control is used to achieve the difference in crawler driving speeds generated by the synchronization process of speed following, and master-slave control is used to introduce a speed correction module, and the driving speed of the right crawler is used as the ideal output, and the yaw angular velocity generated by the difference between the driving speeds of the left crawler and the right crawler is used as the control quantity. When the vehicle yaw angular velocity is not 0 rad / s, the speed correction control module starts to work, and the speed correction amount ΔV is determined by the control algorithm. 修 , and acts on the hydraulic system of the left track, so that the vehicle can correct its posture in time; the two control modules use their own control methods to coordinate and distribute the output control quantity to the hydraulic valve-controlled motor speed control system to adapt to the interference of the left and right track speeds by the working road surface, thereby accurately controlling the vehicle's movement state and realizing rapid deviation correction control of the bracket handling robot.
[0034] As a further description of the above technical solution:
[0035] In S6, various types of data in the above process are encrypted and stored, and the encryption algorithm adopts one or more of MD5 and improved RSA algorithms.
[0036] In summary, due to the adoption of the above technical solution, the beneficial effects of the present invention are:
[0037] In the present invention, the method adopts a master-slave control structure. When the downhole support transport robot deviates, the speed difference of the crawlers on both sides of the downhole support transport robot is controlled by controlling the hydraulic system of the crawlers on both sides of the downhole support transport robot, thereby achieving the purpose of deviation correction. Among them, the fuzzy PID control method is adopted to effectively solve the problems of poor anti-interference and slow tracking speed of the PID controller in the nonlinear system. The fuzzy PID control is more suitable for the driving speed control system of the downhole support transport robot, which can make it travel accurately, reliably and stably at the expected crawler speed within the specified time. BRIEF DESCRIPTION OF THE DRAWINGS
[0038] Figure 1 The present invention is a flow chart of an autonomous deviation correction control method for an underground support handling robot.
[0039] Figure 2 This is a structural framework diagram of an autonomous deviation correction control system for an underground support handling robot.
[0040] Figure 3 This is a surface diagram of the Kp fuzzy control rule in the autonomous deviation correction control method of an underground support handling robot.
[0041] Figure 4 This is a surface diagram of the Ki fuzzy control rules in the autonomous deviation correction control method of an underground support handling robot.
[0042] Figure 5 This is a surface diagram of the Kd fuzzy control rule in the autonomous deviation correction control method of an underground support handling robot. DETAILED DESCRIPTION
[0043] 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.
[0044] See also Figure 1-Figure 5The present invention provides a technical solution: an autonomous deviation correction control method for a downhole support handling robot, comprising the following steps:
[0045] S1. Start the vehicle and obtain the yaw angular velocity ψ of the bracket handling robot;
[0046] S2. Roughly calculate the effect of the slope and potholes on the track resistance on the speed. Use the formula F = Ma to integrate the acceleration a to estimate the speed impact value;
[0047] S3. Use the fuzzy PID controller to control the crawler hydraulic system, and then control the crawler speed difference to achieve deviation correction. The fuzzy PID control principle is to use fuzzy language rules and fuzzy logic to calculate the three control parameters P, I, and D, and use these three parameters to perform PID control. The characteristic of fuzzy PID control is that it can achieve precise control without building an accurate mathematical model. The specific process is:
[0048] A1. Determine fuzzy language variables. According to the crawler speed control requirements, select the deviation E between the expected crawler speed and the actual crawler speed and the rate of change of the deviation over time Ec as input variables. PID control adjustment values Kp, Ki and Kd are used as output variables of fuzzy processing. Considering the working conditions of the underground support handling robot, the fuzzy domain of the five variables E, Ec, Kp, Ki and Kd of this system is {±5, 4, 3, 2, 1, 0}, and the fuzzy sets are {NL, NS, ZO, PS, PL}. The PID parameter setting values Kp'=1, Ki'=4, Kd'=0.001, and the proportional factors of Kp, Ki and Kd are determined to be 0.1, 1 and 0.001 respectively.
[0049] A2. Fuzzification of variables and determination of membership functions can effectively solve the fuzzy control problem. The widely used membership functions are Gaussian and triangular. In view of the fact that the crawler of the underground support handling robot is affected by resistance and the actual speed is constantly changing, the triangular membership function is more suitable;
[0050] A3. Generate fuzzy control rule surface through established fuzzy control rules;
[0051] A4. Defuzzification. Defuzzification is to obtain specific values from the fuzzified results through specific methods. Commonly used methods include the centroid method, the maximum membership method and the weighted average method. This time, the centroid method is used to solve the specific values after fuzzification. The output of the centroid defuzzification is the correction value Kp, Ki, Kd of each parameter. The PID controller is also required to adjust the pre-set parameters. The final output control parameters are obtained by measuring the deviation and the deviation change rate. The PID control parameters KP, KI, KD are obtained after solving the values;
[0052] S4. Determine the degree of deviation of the vehicle body from the preset route, that is, use the gyroscope sensor to measure the yaw angular velocity of the vehicle body. The yaw angular velocity refers to the degree of deflection of the bracket handling robot around the vertical axis, which can be used to measure the change of the motion posture of the bracket handling robot. When the left and right crawler driving speeds of the bracket handling robot deviate in the synchronous control of the desired speed, yaw will occur, and the bracket handling robot will deviate. The deviation is corrected by introducing the yaw angular velocity control amount. The master-slave control structure is adopted in the speed correction control module. The driving speed of the right crawler is used as the reference. The deviation and deviation rate of the desired yaw angular velocity and the actual yaw angular velocity are input to the fuzzy PID controller. The obtained speed correction adjustment amount is input to the hydraulic drive system of the right crawler to realize timely correction of the vehicle posture. The desired yaw angular velocity of the bracket handling robot is 0rad / s.
[0053] S5. After measuring the difference between the actual yaw angular velocity and the expected yaw angular velocity (0rad / s), a controller is used to control the crawler hydraulic system, and then the speed difference of the crawler is controlled to achieve the purpose of deviation correction. The overall control structure adopts a combination of parallel control and master-slave control. Since the hydraulic systems on both sides drive the crawlers independently and do not affect each other, the application of parallel control can better achieve synchronization accuracy. Taking the right crawler speed as the reference, the left crawler introduces a speed controller. Its working principle is to compare the expected crawler travel speed value, the speed error estimation and the actual crawler travel speed value, and determine the left and right crawler speed adjustment value Ve through the control algorithm, and transmit the corresponding electrical signal to the hydraulic system, thereby achieving The crawler speed follows the expected crawler speed to ensure the synchronization of the crawler speeds on both sides. The performance of the control components cannot be guaranteed to be completely consistent, and the left and right crawler hydraulic systems are subject to different load torque interferences on the working road surface, resulting in some differences in the speeds on both sides. The speed difference caused by the crawler speed difference generated by the synchronization process of speed following is achieved by parallel control. The master-slave control is adopted, and the speed correction module is introduced. The speed of the right crawler is taken as the ideal output, and the yaw angular velocity generated by the difference between the left crawler speed and the right crawler speed is taken as the control quantity. When the vehicle yaw angular velocity is not 0rad / s, the speed correction control module starts to work, and the speed correction value ΔV is determined by the control algorithm. 修 , and acts on the hydraulic system of the left crawler, so that the vehicle can correct its posture in time; the two control modules use their own control methods to coordinate and distribute the output control quantity to the hydraulic valve-controlled motor speed control system to adapt to the interference of the left and right crawler speeds on the working road surface, so as to accurately control the vehicle's motion state and realize the rapid deviation correction control of the bracket handling robot;
[0054] S6. Encrypt and save all kinds of data in the above process, and use the improved RSA algorithm as the encryption algorithm.
[0055] In this embodiment, the method adopts a master-slave control structure. When the downhole support transport robot deviates, the speed difference of the tracks on both sides of the downhole support transport robot is controlled by controlling the hydraulic system of the tracks on both sides of the downhole support transport robot, thereby achieving the purpose of correction.
[0056] It should be noted that:
[0057] In S3, the fuzzy PID controller is used to control the crawler hydraulic system, and then the crawler speed difference is controlled to achieve deviation correction.
[0058] In A3, a fuzzy control rule surface is established. The Kp fuzzy control rule surface diagram is shown in Figure 3 , Ki fuzzy control rule surface diagram can be seen in Figure 4 , Kd fuzzy control rule surface diagram can be seen in Figure 5 .
[0059] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can make equivalent replacements or changes according to the technical scheme and inventive concept of the present invention within the technical scope disclosed by the present invention, which should be covered by the protection scope of the present invention.
Claims
1. An autonomous deviation correction control method for a downhole support handling robot, characterized in that: The steps include: S1. Start the vehicle; S2. Roughly calculate the effect of slope and potholes on track resistance on speed; S3, using fuzzy PID controller to control the crawler hydraulic system, and then control the crawler speed difference to achieve deviation correction; S4, determining the degree of deviation between the vehicle body and the preset route; S5, measuring the difference between the actual yaw angular velocity and the expected yaw angular velocity (0 rad / s), and then controlling the speed difference of the crawler to achieve the purpose of deviation correction; S6. Encrypt and save all types of data in the above process.
2. The autonomous deviation correction control method for a downhole support handling robot according to claim 1 is characterized in that: In S1, the vehicle is started and the yaw angular velocity ψ of the bracket transporting robot is obtained.
3. The autonomous deviation correction control method for a downhole support handling robot according to claim 1 is characterized in that: In S2, the influence of the slope and potholes on the resistance of the track on the speed is roughly calculated, and the speed influence value can be estimated by integrating the acceleration a using the formula F=Ma.
4. The autonomous deviation correction control method for a downhole support handling robot according to claim 1 is characterized in that: In S3, a fuzzy PID controller is used to control the crawler hydraulic system, and then the crawler speed difference is controlled to achieve deviation correction. The fuzzy PID control principle is to use fuzzy language rules and fuzzy logic to calculate the three control parameters P, I, and D, and use these three parameters to perform PID control.
5. The autonomous deviation correction control method for a downhole support handling robot according to claim 4 is characterized in that: In S3, the characteristic of fuzzy PID control is that it can achieve the effect of precise control without building an accurate mathematical model. The specific process is as follows: A1. Determine fuzzy language variables. According to the crawler speed control requirements, select the deviation E between the expected crawler speed and the actual crawler speed and the rate of change of the deviation over time Ec as input variables. PID control adjustment values Kp, Ki and Kd are used as output variables of fuzzy processing. Considering the working conditions of the underground support handling robot, the fuzzy domain of the five variables E, Ec, Kp, Ki and Kd of this system is {±5, 4, 3, 2, 1, 0}, and the fuzzy sets are {NL, NS, ZO, PS, PL}. The PID parameter setting values Kp'=1, Ki'=4, Kd'=0.001, and the proportional factors of Kp, Ki and Kd are determined to be 0.1, 1 and 0.001 respectively. A2. Fuzzification of variables and determination of membership functions can effectively solve the fuzzy control problem. The widely used membership functions are Gaussian and triangular. In view of the fact that the crawler of the underground support handling robot is affected by resistance and the actual speed is constantly changing, the triangular membership function is more suitable; A3. Generate fuzzy control rule surface through established fuzzy control rules; A4. Defuzzification. Defuzzification is to obtain specific numerical values from the fuzzified results through specific methods. Commonly used methods include the centroid method, the maximum membership method and the weighted average method. This time, the centroid method is used to solve the specific numerical values after fuzzification. The output of the defuzzification by the centroid method is the correction value Kp, Ki, Kd of each parameter. The pre-set parameters must also be adjusted by the PID controller. The final output control parameters are the PID control parameters KP, KI, KD obtained by measuring the deviation and the deviation change rate.
6. The autonomous deviation correction control method for a downhole support handling robot according to claim 1 is characterized in that: In S4, the degree of deviation of the vehicle body from the preset route is determined, that is, the yaw angular velocity of the vehicle body is measured using a gyro sensor.
7. The autonomous deviation correction control method for a downhole support handling robot according to claim 6 is characterized in that: In S4, the yaw angular velocity refers to the degree of deflection of the scaffold handling robot around the vertical axis, which can be used to measure the change in the motion posture of the scaffold handling robot. When there is a deviation in the synchronous control of the left and right tracks of the scaffold handling robot to achieve the desired speed, yaw will occur, and the scaffold handling robot will deviate. The deviation is corrected by introducing the yaw angular velocity control amount. The master-slave control structure is adopted in the speed correction control module. The deviation and deviation rate of the desired yaw angular velocity and the actual yaw angular velocity are input to the fuzzy PID controller based on the driving speed of the right track. The obtained speed correction adjustment amount is input to the hydraulic drive system of the right track to achieve timely correction of the vehicle posture. The desired yaw angular velocity of the scaffold handling robot is 0 rad / s.
8. The autonomous deviation correction control method for a downhole support handling robot according to claim 1 is characterized in that: In S5, after measuring the difference between the actual yaw angular velocity and the expected yaw angular velocity (0 rad / s), a controller is used to control the crawler hydraulic system, and then the speed difference of the crawler is controlled to achieve the purpose of correction. The overall control structure adopts a combination of parallel control and master-slave control. Since the hydraulic systems on both sides drive the crawlers independently and do not affect each other, the application of parallel control can better achieve synchronization accuracy. Taking the right crawler speed as the reference, a speed controller is introduced into the left crawler. Its working principle is to compare the expected crawler travel speed value, the speed error estimation and the actual crawler travel speed value, and determine the left and right crawler speed adjustment amount Ve through the control algorithm, and transmit the corresponding electrical signal to the hydraulic system, so as to achieve the crawler travel speed following the expected crawler travel speed, and ensure the synchronization of the crawler speeds on both sides.
9. The autonomous deviation correction control method for a downhole support handling robot according to claim 8, characterized in that: In the above S5, the performance of control elements cannot be guaranteed to be completely consistent, and the left and right crawler hydraulic systems are subject to different load torque interferences on the working road surface, resulting in some differences in speed on both sides; parallel control is used to achieve the difference in crawler driving speeds generated by the synchronization process of speed following, and master-slave control is used to introduce a speed correction module, and the driving speed of the right crawler is used as the ideal output, and the yaw angular velocity generated by the difference between the driving speeds of the left crawler and the right crawler is used as the control quantity. When the vehicle yaw angular velocity is not 0 rad / s, the speed correction control module starts to work, and the speed correction amount ΔV is determined by the control algorithm. 修 , and acts on the hydraulic system of the left track, so that the vehicle can correct its posture in time; the two control modules use their own control methods to coordinate and distribute the output control quantity to the hydraulic valve-controlled motor speed control system to adapt to the interference of the left and right track speeds by the working road surface, thereby accurately controlling the vehicle's movement state and realizing rapid deviation correction control of the bracket handling robot.
10. The autonomous deviation correction control method for a downhole support handling robot according to claim 1, characterized in that: In S6, various types of data in the above process are encrypted and stored, and the encryption algorithm adopts one or more of MD5 and improved RSA algorithms.
