Obstacle avoidance and collaborative control method for unmanned road roller
Through the comprehensive calculation of the gravitational potential field and the repulsive potential field, combined with the coordinated attraction potential field, the problem of emergency stop and emergency start-up during obstacle avoidance by unmanned road rollers is solved, the coordination and dynamic path adjustment of the construction process is achieved, and the construction is improved Quality and equipment life.
Patent Information
- Application Number
- CN202411136808.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-19
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-08-19
AI Technical Summary
Unmanned road rollers are prone to stop and get up quickly when avoiding obstacles, which affects the quality of the construction road surface and the life of mechanical equipment, and lacks the ability to coordinate construction consistency and dynamic path adjustment, resulting in construction efficiency and quality problems.
Through the comprehensive calculation of the gravitational potential field and the repulsive potential field, virtual forces are generated to control the movement of the roller, avoid emergency stops and starts up quickly, and a coordinated attraction potential field is introduced to ensure construction consistency and dynamic path adjustment.
It effectively avoids emergency stops and starts, ensures construction quality and safety, ensures coordinatedness and dynamic speed adjustment of the construction process, and extends the service life of the equipment.
Smart Images

Figure CN118672274B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of obstacle avoidance for road rollers, and in particular to an obstacle avoidance and cooperative control method for an unmanned road roller. Background Art
[0002] By replacing manual operations, unmanned construction machinery can work continuously and efficiently in harsh environments, reducing health risks to operators and errors in human operations, thereby improving construction quality and safety. Unmanned construction machinery must have the ability to perceive obstacles in the surrounding environment in real time in order to make accurate judgments and decisions in complex construction sites to avoid collisions and other potential dangers; while achieving obstacle perception, it is also crucial to ensure the coordinated consistency and quality of construction; unmanned construction machinery must not only be able to independently perceive and avoid obstacles, but also need to maintain coordination and consistency in the overall construction plan; for example, when multiple unmanned machines work together on the same construction road, they need to use communication and collaborative control algorithms to ensure the smooth completion of their respective tasks, and avoid construction delays or quality problems caused by improper collaborative control.
[0003] In addition, unmanned construction machinery has the following three disadvantages:
[0004] Disadvantages 1. The obstacle avoidance algorithm will cause the roller to stop and start suddenly, affecting the quality of the construction road surface: When the obstacle avoidance algorithm of the unmanned roller encounters an obstacle, it will often take the approach of stopping and starting suddenly to avoid collision; this sudden operation may cause the roller to apply uneven pressure to the construction road surface, thereby affecting the flatness and quality of the road surface; frequent sudden stops and starts may also cause additional wear on the mechanical system of the roller, shortening the service life of the equipment;
[0005] Disadvantage 2: Failure to consider the problem of consistency and synchronization of collaborative construction: The current technical solution mainly focuses on the obstacle perception and avoidance of a single unmanned machine, and lacks overall consideration of the collaborative construction of multiple mechanical equipment in the same rolling operation procedure; in the actual construction process, multiple unmanned machines need to work synchronously and coordinate to complete the overall construction task; if there is no effective coordination mechanism, it may lead to scheduling confusion, task duplication or omissions, etc. in the construction process, affecting construction efficiency and quality;
[0006] Disadvantage 3: Relative independence in obstacle avoidance and construction path planning: Existing unmanned construction machinery is relatively independent in obstacle avoidance and path planning, and lacks the ability to globally regulate the overall construction progress and speed. This limitation makes the operation of the machinery relatively rigid, and it is impossible to dynamically adjust the speed and operation rhythm according to the actual situation of the construction site;
[0007] Therefore, in order to solve the above problems, an obstacle avoidance and collaborative control method for an unmanned road roller is proposed. Summary of the invention
[0008] The object of the present invention is to provide an obstacle avoidance and cooperative control method for an unmanned road roller to solve the problems raised in the above-mentioned background technology.
[0009] To achieve the above object, the present invention provides the following technical solutions:
[0010] An obstacle avoidance and cooperative control method for an unmanned road roller, comprising:
[0011] Step S1, initializing the construction environment: determining the number of rollers, rolling area and operation mode;
[0012] Step S2, obtaining rolling operation data: obtaining the position of each roller by wireless communication, and determining the position of obstacles by millimeter wave radar;
[0013] Step S3, data aggregation and processing: aggregate the data stream to each roller, calculate the magnitude of the gravitational potential field and the magnitude of the repulsive potential field respectively, obtain the magnitude of the combined potential field superposition, and obtain the magnitude of the virtual force on the roller;
[0014] Step S4, control instruction generation: obtain virtual acceleration from virtual force, and then obtain reference values of roller speed and angular velocity, obtain reference acceleration from virtual force obtained from comprehensive potential field, obtain reference velocity by integrating reference acceleration and tracked by roller, obtain reference value of angular velocity at hinge by conversion and tracked by roller;
[0015] Step S5, control the movement of the roller: control the movement of the roller by the roller speed and angular velocity reference value and the reference value of the angular velocity at the hinge. After tracking the reference value to obtain the next state, return to step S2 for the next round of state calculation until the end of the rolling area is reached.
[0016] As a preferred solution, in step S3, calculating the magnitude of the gravitational potential field includes the following steps:
[0017] Step S3-1: The gravitational potential field is used to guide the roller to the target position. The target point position is generated by the B-spline curve. Each target position is , the current position of the roller is , gravitational potential field Defined as:
[0018] ;
[0019] in, is the coefficient of the gravitational potential field;
[0020] Step S3-2, calculate the force generated by the gravitational potential field according to the following formula:
[0021] ;
[0022] Step S3-3: Introduce the position difference between the two rollers as a factor in the gravitational potential field. Assume that the current positions of roller 1 and roller 2 are and The position of the roller is obtained by the vehicle-mounted RTK, and the rollers communicate with each other through wireless communication via the ground base station; the target position is The gravitational potential field consists of two parts: one is the traditional gravitational potential field, and the other is the cooperative attraction potential field between the two rollers. The calculation formula is:
[0023] ;
[0024] in, is the coefficient of the cooperative attractive potential field;
[0025] Step S3-4, calculate the force generated by cooperative attraction according to the following formula:
[0026] ;
[0027] ;
[0028] Step S3-5, calculate the total gravitational potential field according to the following formula:
[0029] For roller 1: ;
[0030] For Steamroller 2: ;
[0031] in, Respectively represent the current positions of roller 1 and roller 2, represents the total gravitational potential field function of roller 1, which is the superposition of the gravitational potential field of roller 1 and the cooperative attraction potential field. represents the total gravitational potential field function of roller 2, which is the superposition of the gravitational potential field and the cooperative attraction potential field of roller 2. represents the traditional part of the gravitational potential field function of the roller 1, whose potential field origin is at the target point, generating a gravitational force attracted to the target point, The traditional part of the gravitational potential field function of the roller 2 is represented by the potential field origin at the target point, generating a gravitational force that attracts the target point;
[0032] Step S3-6, calculate the force generated by the total gravity according to the following formula:
[0033] For roller 1:
[0034] ;
[0035] For Steamroller 2:
[0036] ;
[0037] in, represents the total force on roller 1 in the overall potential field, which is the resultant force generated by the gravitational potential field and the cooperative attraction potential field; represents the total force on roller 2 in the overall potential field, which is the resultant force of the forces generated by the gravitational potential field and the cooperative attraction potential field; represents the force generated by the gravitational potential field on the roller 1; represents the force generated by the gravitational potential field on roller 2; represents the force generated by the cooperative attractive potential field on the roller 1; It represents the force generated by the cooperative attractive potential field on the road roller 2.
[0038] As a preferred solution, in step S3, calculating the magnitude of the repulsive potential field includes the following steps:
[0039] Step S3-7: The repulsive potential field is used to avoid obstacles. Assume that the obstacle position is , repulsive potential field Defined as:
[0040] ;
[0041] in, is the coefficient of the repulsive potential field;
[0042] Step S3-8, calculate the force generated by the repulsive potential field according to the following formula:
[0043] ;
[0044] in, and For the two safety distances defined, is the preset emergency safety distance, and , when the distance between the roller and the obstacle Less than safe distance When the roller is at risk of colliding with an obstacle, it will be decelerated by a certain repulsive force until it is greater than the safe distance. When the repulsive force is 0.
[0045] As a preferred solution, in step S3, when the superposition size of the comprehensive potential field is obtained, the comprehensive potential field Calculated according to the following formula:
[0046] ;
[0047] in, Represents the total gravitational potential field function of the current roller; ) represents the repulsive potential field function of the current roller;
[0048] When the virtual force on the roller is obtained, the virtual force on the roller is Calculated according to the following formula:
[0049] ;
[0050] in, It represents the total gravitational force currently received by the roller, which is generated by the total gravitational potential field; Indicates the repulsive force currently received by the press.
[0051] As a preferred solution, according to the virtual force on the roller The control command reference for the road roller is realized by the following formula:
[0052] ;
[0053] in, is the acceleration reference of the roller, and m is the mass of the roller. At this time, the control reference of the roller is:
[0054] ;
[0055] .
[0056] It can be seen from the technical solution provided by the present invention that the obstacle avoidance and cooperative control method for an unmanned road roller provided by the present invention has the following beneficial effects:
[0057] 1. By designing a reasonable repulsive potential field, two safety distances are defined. One of the safety distances is a smaller value. When a human factor inadvertently breaks into the construction site, the roller is subjected to an infinite repulsive force and will stop urgently. When the distance between the roller and the obstacle is Less than safe distance When the roller hits an obstacle, it will be slowed down by a certain repulsive force until it is greater than the safe distance. When the repulsive force is 0, this design avoids the command-based emergency stop and start, ensuring the quality and safety of the construction process.
[0058] 2. By designing a collaborative attraction potential field, the collaborative consistency of the construction process can be ensured;
[0059] 3. Through the form of comprehensive potential field, obstacle avoidance and construction path planning are comprehensively considered, and the movement of the road roller is coordinated and controlled. The speed and operation rhythm can be dynamically adjusted according to the actual situation of the construction site. BRIEF DESCRIPTION OF THE DRAWINGS
[0060] Figure 1 A schematic diagram of a flow chart of an obstacle avoidance and cooperative control method for an unmanned road roller according to the present invention;
[0061] Figure 2 It is a geometrical schematic diagram of the articulated vehicle during stable steering in the present invention;
[0062] Figure 3 It is a schematic diagram of the geometric model of stable steering of the road roller in the present invention;
[0063] Figure 4 This is a diagram of information interaction and communication of a roller cluster in the present invention. DETAILED DESCRIPTION
[0064] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not intended to limit the present invention.
[0065] In order to better understand the above technical solution, the above technical solution will be described in detail below in conjunction with the accompanying drawings and specific implementation methods.
[0066] like Figure 1-4 As shown, an embodiment of the present invention provides an obstacle avoidance and collaborative control method for an unmanned road roller, firstly:
[0067] First determine the steering geometry of the roller. The roller consists of two parts, front and rear, connected by a vertical hinge pin. The steering hydraulic cylinder controls the steering angle. Two steering cylinders are arranged on both sides of the hinge pin. The cylinder barrel and piston rod are hinged on the front and rear frames respectively. The roller has only three degrees of freedom in the longitudinal, lateral and yaw directions. For details, please refer to Figure 2 ;
[0068] A plane perpendicular to the ground is drawn through the front and rear wheel axes. The axis perpendicular to the ground at the intersection of the two planes is the instantaneous rotation axis of the vehicle (the projection point on the horizontal plane is O). Assume that the front and rear wheels roll around this axis without side slip, and the speed direction of the front and rear wheels is consistent with the orientation direction of the frame. This assumption is suitable for low vehicle speeds.
[0069] From the geometric model, we can know that the turning radius of the front wheel is:
[0070] ;
[0071] Similarly, the rear wheel turning radius:
[0072] ;
[0073] Assuming that the turning radius changes slowly due to the low speed, the rate of change of the front and rear vehicle azimuth angles is and It must be equal to the steering angular velocity of the front and rear vehicles; then the expression of the vehicle position change rate is:
[0074] ;
[0075] ;
[0076] Then determine the steering kinematics of the roller:
[0077] See also Figure 3 , when describing the motion of the vehicle, the origin is at the center of the two frames, is the angle between the front and rear vehicle bodies or the steering angle;
[0078] Determine the front and rear vehicle speeds as and , the velocity of the rear vehicle body is expressed in the reference coordinate system, and the obtained control point has the following coordinate change rate:
[0079]
[0080] Similarly, the coordinate change rate of the front vehicle's velocity is:
[0081]
[0082] Since the overall turning trajectory of an articulated vehicle is a fixed radius arc around the turning center 0, the driving trajectory of the rear vehicle will be consistent with that of the front vehicle; in addition, the speed of the front vehicle The direction is consistent with the speed direction of the whole vehicle, so the motion state vector of the whole vehicle can be represented by the posture of the front vehicle;
[0083] According to the physical relationship expressed by the kinematic model, the position and posture relationship of the front and rear wheels is expressed as follows:
[0084]
[0085] Assuming that there is no lateral and longitudinal slip during the movement of the roller, that is, the speed perpendicular to the driving speed of the front and rear vehicles is 0, it can be concluded that:
[0086]
[0087] Combining the above equations, we can get the kinematic model expression of the whole vehicle of the road roller:
[0088]
[0089] Among them, the state variables of the vehicle Respectively represent the lateral coordinates of the roller, the longitudinal coordinates, the vehicle posture and the rate of change of the rotation angle at the hinge, where the control variable is is the front wheel speed and the articulation angular velocity;
[0090] Also includes:
[0091] Step S1, initializing the construction environment: determining the number of rollers, rolling area and operation mode;
[0092] Step S2, obtaining rolling operation data: obtaining the position of each roller by wireless communication, and determining the position of obstacles by millimeter wave radar;
[0093] Step S3, data aggregation and processing: aggregate the data stream to each roller, calculate the magnitude of the gravitational potential field and the magnitude of the repulsive potential field respectively, obtain the magnitude of the combined potential field superposition, and obtain the magnitude of the virtual force on the roller;
[0094] Among them, calculating the magnitude of the gravitational potential field includes the following steps:
[0095] Step S3-1: The gravitational potential field is used to guide the roller to the target position. The target point position is generated by the B-spline curve. Each target position is , the current position of the roller is , gravitational potential field Defined as:
[0096] ;
[0097] in, is the coefficient of the gravitational potential field;
[0098] Step S3-2, calculate the force generated by the gravitational potential field according to the following formula:
[0099] ;
[0100] In order to improve the coordination consistency of the two rollers, the position difference between the two rollers is introduced as a factor in the gravitational potential field; if there are two rollers in the same rolling operation procedure (initial rolling, secondary rolling and final rolling), they will not only be attracted by the target position, but also attract each other to keep the construction progress relatively consistent;
[0101] Step S3-3: Introduce the position difference between the two rollers as a factor in the gravitational potential field. Assume that the current positions of roller 1 and roller 2 are and The position of the roller is obtained by the vehicle-mounted RTK, and the rollers communicate with each other through wireless communication via the ground base station; the target position is The gravitational potential field consists of two parts: one is the traditional gravitational potential field, and the other is the cooperative attraction potential field between the two rollers. The calculation formula is:
[0102] ;
[0103] in, is the coefficient of the cooperative attractive potential field;
[0104] Step S3-4, calculate the force generated by cooperative attraction according to the following formula:
[0105] ;
[0106] ;
[0107] Step S3-5, calculate the total gravitational potential field according to the following formula:
[0108] For roller 1: ;
[0109] For Steamroller 2: ;
[0110] in, Respectively represent the current positions of roller 1 and roller 2, represents the total gravitational potential field function of roller 1, which is the superposition of the gravitational potential field of roller 1 and the cooperative attraction potential field. represents the total gravitational potential field function of roller 2, which is the superposition of the gravitational potential field and the cooperative attraction potential field of roller 2. represents the traditional part of the gravitational potential field function of the roller 1, whose potential field origin is at the target point, generating a gravitational force attracted to the target point, The traditional part of the gravitational potential field function of the roller 2 is represented by the potential field origin at the target point, generating a gravitational force that attracts the target point;
[0111] Step S3-6, calculate the force generated by the total gravity according to the following formula:
[0112] For roller 1:
[0113] ;
[0114] For Steamroller 2:
[0115] ;
[0116] in, represents the total force on roller 1 in the overall potential field, which is the resultant force of the forces generated by the gravitational potential field and the cooperative attraction potential field; represents the total force on roller 2 in the overall potential field, which is the resultant force of the forces generated by the gravitational potential field and the cooperative attraction potential field; represents the force generated by the gravitational potential field on the roller 1; represents the force generated by the gravitational potential field on roller 2; represents the force generated by the cooperative attractive potential field on the roller 1; represents the force generated by the cooperative attractive potential field on roller 2;
[0117] Further, calculating the magnitude of the repulsive potential field includes the following steps:
[0118] Step S3-7: The repulsive potential field is used to avoid obstacles. Assume that the obstacle position is , repulsive potential field Defined as:
[0119] ;
[0120] in, is the coefficient of the repulsive potential field;
[0121] Step S3-8, calculate the force generated by the repulsive potential field according to the following formula:
[0122] ;
[0123] in, and For the two safety distances defined, is the preset emergency safety distance, and , when the distance between the roller and the obstacle Less than safe distance When the roller is at risk of colliding with an obstacle, it will be decelerated by a certain repulsive force until it is greater than the safe distance. When, the repulsive force will be 0;
[0124] Furthermore, when the size of the comprehensive potential field superposition is obtained, the comprehensive potential field Calculated according to the following formula:
[0125] ;
[0126] in, Represents the total gravitational potential field function of the current roller; ) represents the repulsive potential field function of the current roller;
[0127] When the virtual force on the roller is obtained, the virtual force on the roller is Calculated according to the following formula:
[0128] ;
[0129] in, It represents the total gravitational force currently received by the roller, which is generated by the total gravitational potential field; Indicates the repulsive force currently received by the press;
[0130] According to the virtual force on the roller The control command reference for the road roller is realized by the following formula:
[0131] ;
[0132] in, is the acceleration reference of the roller, and m is the mass of the roller. At this time, the control reference of the roller is:
[0133] ;
[0134] ;
[0135] in, represents the actual velocity vector of the roller 1; : represents the reference speed vector, which is the ideal speed that the roller should reach; It indicates the structural length of the roller, which is a fixed value; represents the reference angular velocity, which is the ideal angular velocity that the roller should achieve; Indicates the actual angular velocity of the roller;
[0136] Step S4, control instruction generation: obtain virtual acceleration from virtual force, and then obtain reference values of roller speed and angular velocity, obtain reference acceleration from virtual force obtained from comprehensive potential field, obtain reference velocity by integrating reference acceleration and tracked by roller, obtain reference value of angular velocity at hinge by conversion and tracked by roller;
[0137] Step S5, control the movement of the roller: control the movement of the roller by the roller speed and angular velocity reference value and the reference value of the angular velocity at the hinge. After tracking the reference value to obtain the next state, return to step S2 for the next round of state calculation until the end of the rolling area is reached.
[0138] Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the appended claims and their equivalents.
Claims
1. An obstacle avoidance and cooperative control method for an unmanned road roller, characterized in that: include: Step S1, initializing the construction environment: determining the number of rollers, rolling area and operation mode; Step S2, obtaining rolling operation data: obtaining the position of each roller by wireless communication, and determining the position of obstacles by millimeter wave radar; Step S3, data aggregation and processing: aggregate the data stream to each roller, calculate the magnitude of the gravitational potential field and the magnitude of the repulsive potential field respectively, obtain the magnitude of the combined potential field superposition, and obtain the magnitude of the virtual force on the roller; Step S4, control instruction generation: obtain virtual acceleration from virtual force, and then obtain reference values of roller speed and angular velocity, obtain reference acceleration from virtual force obtained from comprehensive potential field, obtain reference velocity by integrating reference acceleration and tracked by roller, obtain reference value of angular velocity at hinge by conversion and tracked by roller; Step S5, controlling the movement of the roller: controlling the movement of the roller by the roller speed and angular velocity reference value and the reference value of the angular velocity at the hinge, and after tracking the reference value to obtain the next state, returning to step S2 to perform the next round of state calculation until the end of the rolling area is reached; In step S3, calculating the magnitude of the gravitational potential field includes the following steps: Step S3-1: Gravitational potential field Defined as: ; in, is the target location, is the current position of the roller, is the coefficient of the gravitational potential field; Step S3-2, calculate the force generated by the gravitational potential field according to the following formula: ; Step S3-3: Introduce the position difference between the two rollers as a factor in the gravitational potential field. Assume that the current positions of roller 1 and roller 2 are and The position of the roller is obtained by the vehicle-mounted RTK, and the rollers communicate with each other through wireless communication via the ground base station; the target position is The gravitational potential field consists of two parts: one is the traditional gravitational potential field, and the other is the cooperative attraction potential field between the two rollers. The calculation formula is: ; in, is the coefficient of the cooperative attractive potential field; Step S3-4, calculate the force generated by cooperative attraction according to the following formula: ; ; Step S3-5, calculate the total gravitational potential field according to the following formula: For roller 1: ; For Steamroller 2: ; in, Respectively represent the current positions of roller 1 and roller 2, represents the total gravitational potential field function of roller 1, which is the superposition of the gravitational potential field of roller 1 and the cooperative attraction potential field. represents the total gravitational potential field function of roller 2, which is the superposition of the gravitational potential field and the cooperative attraction potential field of roller 2. represents the traditional part of the gravitational potential field function of the roller 1, whose potential field origin is at the target point, generating a gravitational force attracted to the target point, The traditional part of the gravitational potential field function of the roller 2 is represented by the potential field origin at the target point, generating a gravitational force that attracts the target point; Step S3-6, calculate the force generated by the total gravity according to the following formula: For roller 1: ; For Steamroller 2: ; in, represents the total force on roller 1 in the overall potential field, which is the resultant force generated by the gravitational potential field and the cooperative attraction potential field; represents the total force on roller 2 in the overall potential field, which is the resultant force of the forces generated by the gravitational potential field and the cooperative attraction potential field; represents the force generated by the gravitational potential field on the roller 1; represents the force generated by the gravitational potential field on roller 2; represents the force generated by the cooperative attractive potential field on the roller 1; It represents the force generated by the cooperative attractive potential field on the road roller 2.
2. The obstacle avoidance and cooperative control method for an unmanned road roller according to claim 1, characterized in that: In step S3, calculating the magnitude of the repulsive potential field comprises the following steps: Step S3-7: The repulsive potential field is used to avoid obstacles. Assume that the obstacle position is , repulsive potential field Defined as: ; in, is the coefficient of the repulsive potential field; Step S3-8, calculate the force generated by the repulsive potential field according to the following formula: ; in, and For the two safety distances defined, is the preset emergency safety distance, and , when the distance between the roller and the obstacle Less than safe distance When the roller is at risk of colliding with an obstacle, it will be decelerated by a certain repulsive force until it is greater than the safe distance. When the repulsive force is 0.
3. The obstacle avoidance and cooperative control method for an unmanned road roller according to claim 2, characterized in that: In step S3, when the superposition size of the comprehensive potential field is obtained, the comprehensive potential field Calculated according to the following formula: ; in, Represents the total gravitational potential field function of the current roller; Represents the repulsive potential field function of the current roller; When the virtual force on the roller is obtained, the virtual force on the roller is Calculated according to the following formula: ; in, It represents the total gravitational force currently received by the roller, which is generated by the total gravitational potential field; Indicates the repulsive force currently received by the press.
4. The obstacle avoidance and cooperative control method for an unmanned road roller according to claim 3, characterized in that: According to the virtual force on the roller The control command reference for the road roller is realized by the following formula: ; in, is the acceleration reference of the roller, and m is the mass of the roller. At this time, the control reference of the roller is: ; ; in, represents the actual velocity vector of the roller 1; : represents the reference speed vector, which is the ideal speed that the roller should reach; It indicates the structural length of the roller, which is a fixed value; represents the reference angular velocity, which is the ideal angular velocity that the roller should achieve; Indicates the actual angular velocity of the roller.
