CN111857157A - Method for adjusting motion path of vibratory roller and control system - Google Patents
Method for adjusting motion path of vibratory roller and control system Download PDFInfo
- Publication number
- CN111857157A CN111857157A CN202010768614.XA CN202010768614A CN111857157A CN 111857157 A CN111857157 A CN 111857157A CN 202010768614 A CN202010768614 A CN 202010768614A CN 111857157 A CN111857157 A CN 111857157A
- Authority
- CN
- China
- Prior art keywords
- vibratory roller
- vehicle body
- adjusting
- error
- course
- 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.)
- Withdrawn
Links
- 230000033001 locomotion Effects 0.000 title claims abstract description 36
- 238000000034 method Methods 0.000 title claims abstract description 30
- 229910000831 Steel Inorganic materials 0.000 claims description 56
- 239000010959 steel Substances 0.000 claims description 56
- 239000010720 hydraulic oil Substances 0.000 claims description 17
- 239000003921 oil Substances 0.000 claims description 16
- 230000008859 change Effects 0.000 claims description 12
- 230000001276 controlling effect Effects 0.000 claims description 8
- 230000001105 regulatory effect Effects 0.000 claims description 8
- 238000013016 damping Methods 0.000 claims description 7
- 238000006073 displacement reaction Methods 0.000 claims description 7
- 238000004422 calculation algorithm Methods 0.000 claims description 5
- 238000012546 transfer Methods 0.000 claims description 5
- 230000009471 action Effects 0.000 claims description 4
- 239000000126 substance Substances 0.000 claims description 4
- 230000000052 comparative effect Effects 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 230000003750 conditioning effect Effects 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 9
- 238000013139 quantization Methods 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000005096 rolling process Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000005056 compaction Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 230000001808 coupling effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000012850 discrimination method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000007788 liquid Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
The invention discloses a method for adjusting a motion path of a road roller, which is characterized by comprising the following steps of: planning and setting a straight track; determining the tracking error between the road roller and the track of a set straight line and calculating the expected body rotation angle variation according to the tracking errorCalculating the expected vehicle body turning angle variationAnd the angle deviation of the real-time angle variation of the vehicle bodyAnd adjusting the rotation angle of the vehicle body of the road roller through a steering system, and further adjusting the driving course and the position coordinate of the vibratory roller. The invention providesThe method for adjusting the movement path of the road roller realizes the control of the vibration error, and the vibration road roller adopting the method has better control performance under the condition of larger initial transverse error, and the control error has smaller overshoot and shorter corresponding time. The invention also provides a control system for the movement of the vibratory roller.
Description
Technical Field
The invention relates to the technical field of automatic driving, in particular to a method for adjusting a motion path of a vibratory roller and a control system.
Background
Vibratory rollers are highly efficient compaction machines and are widely used in the construction of roads and dams.
The front vibration steel wheel part of the vibratory roller is connected with the rear driving vehicle body through a central pin shaft. The vibrating wheel is used as both working wheel and walking wheel, is one of the important parts of vibrating road roller, and consists of mainly 4 parts, including vibrating steel wheel, vibration exciting mechanism, vibration damping system, walking mechanism, etc.
In order to meet the compaction working requirement of the vibratory roller in the construction operation process, an exciting mechanism of the vibratory roller generates violent vibration, so that operators can feel uncomfortable, the operation cost of the vibratory roller is reduced and the working efficiency of the vibratory roller is improved in order to avoid the influence of the vibration on operators of the vibratory roller, and a regulation method and a control system for the motion path of the vibratory roller are necessary to be designed, so that the vibration rolling error generated in the operation process of the vibratory roller is reduced.
Disclosure of Invention
In view of the above-mentioned drawbacks, the present invention provides a method for adjusting a motion path of a vibratory roller and a control system thereof, so as to solve the problem of large vibration error generated during the operation of the vibratory roller in the prior art.
The invention provides a method for adjusting a movement path of a road roller, which is characterized by comprising the following steps:
Specifically, the step 2 includes:
step 2.1, constructing an integral motion model of the vibratory roller:
wherein v is the speed of the vibrating steel wheel, omega is the course angular speed of the vibrating steel wheel,the vehicle body turning angle is shown, l is the distance from the center of the vibrating steel wheel or the driving vehicle body to the intersection point, and theta is the heading of the vibrating steel wheel.
Step 2.2, calculating a transverse error e according to the coordinates of the current position of the center of the vibrating steel wheel and the coordinates of a corresponding expected point of the center of the vibrating steel wheel on the track of the set straight linel;,el=(xd-x)sinθd+(y-yd)cosθdWherein (x, y) represents the actual distance position coordinate of the center of the vibration steel wheel of the vibratory roller, theta represents the actual course angle of the vibration steel wheel, and (x) represents the actual course angle of the vibration steel wheeld,yd) Representing the desired coordinate, theta, of the center of the wheel on the track of the straight line corresponding to the current coordinate of the center of the wheeldIndicating the desired heading angle of the vibrating steel wheel,indicating the corner error.
Step 2.3: according to the transverse error elAnd obtaining the course required by the road roller by the corresponding pre-aiming distance l at the corresponding speed, comparing the current course of the road roller with the course required by the road roller to obtain a course error eθ;eθ=θ-θdWhere θ represents the actual heading angle of the vibrating steel wheel, θdRepresenting the desired heading angle of the vibrating steel wheel.
Wherein k issDenotes the adjustment coefficient, eθIndicating a heading error, elRepresents lateral error, l represents pre-aiming distance, and elAnd correspond to each other.
Specifically, the step 3 includes:
step 3.1, a mathematical model of the steering system is constructed, a transfer function of the steering system is determined,
wherein the content of the first and second substances,is a proportional factor, omega, between the angle of rotation of the vehicle body and the output displacement of the oil cylinderhWhich is the natural frequency of the hydraulic power steering system,s is a laplace variable;sin order to obtain the damping coefficient of the system,Kqthe flow gain of the proportional speed control valve, I is the electromagnet input control current of the proportional speed control valve, CtpIs the total leakage coefficient, V, of an equivalent hydraulic oil cylindereIs the total volume of the equivalent hydraulic cylinder cavity, E is the volume elastic modulus of oil, ApIs the action area of an equivalent hydraulic oil cylinder;
3.3, controlling the adjustment of the body corner of the road roller by the steering system to achieve the expected body output corner;
and 3.4, adjusting the driving course and the position coordinates of the road roller by the vehicle body output corner passing through the whole motion model of the road roller.
Specifically, the control mode of the steering system in the step 3 comprises fuzzy PID control;
according to angular deviation in the fuzzy PID controlRate of change ofAnd the operation experience of the driver, and the adjustment quantity delta k of the comparative example adjustment parameter is establishedpIntegral adjustment parameter adjustment quantity delta kiAnd a differential tuning parameter adjustment Δ kdThe fuzzy control rule of (1).
Specifically, the running speed of the road roller is controlled by adopting a PID algorithm.
The invention also provides a control system for the movement of the road roller. The steering system is used for adjusting the steering direction of the vehicle body of the road roller;
the steering system includes:
the positioning assembly is arranged on the road roller main body and used for detecting the current position of the center of the vibrating steel wheel;
the orientation assembly is arranged on the road roller main body and used for detecting the current course of the road roller;
the angle encoder is arranged on the road roller main body and used for detecting the variable quantity of the angle of the road roller body in real time;
and the steering controller is electrically connected with the positioning assembly, the orientation assembly and the angle encoder and is used for receiving and processing electric signals sent by the positioning assembly, the orientation assembly and the angle encoder and adjusting the body rotation angle of the road roller.
Preferably, the controller includes a controller for controlling the angular deviationAnd angular deviationRate of change ofAs fuzzy input quantity to control PID adjustment quantity delta k of currentp、ΔkiAnd Δ kdA fuzzy PID controller as fuzzy output quantity.
Preferably, the controller includes a controller for controlling the angular deviationAnd angular deviationRate of change ofAs fuzzy input quantity to control PID adjustment quantity delta k of currentp、ΔkiAnd Δ kdA fuzzy PID controller as fuzzy output quantity.
Preferably. The control system also comprises a running control system for controlling the running direction and speed of the road roller;
the travel control system includes:
the navigator is arranged on the road roller main body and used for acquiring and outputting the real-time speed of the road roller main body and the deviation from the set speed;
and the running controller is electrically connected with the navigator and the road roller main body and is used for adjusting the running speed or/and the running direction of the road roller main body.
According to the scheme, compared with the prior art, the method for adjusting the motion path of the vibratory roller and the control system thereof provided by the invention have the advantages that the control on the vibration error is realized through the adjusting method provided by the invention, the control performance of the vibratory roller adopting the method is better under the condition of larger initial transverse error, and the control error has smaller overshoot and shorter corresponding time. The steering system formed by the steering controller, the orientation component, the positioning component and the angle encoder can quickly and accurately complete the adjustment of the direction of the vibratory roller in the rolling process.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the description of the embodiments or the prior art will be briefly described below, it is obvious that the drawings in the following description are only some embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to the drawings without creative efforts.
Fig. 1 is a schematic view of a vibratory roller for use in the present invention;
FIG. 2 is a schematic diagram of the relationship between the output displacement of the cylinder and the rotation angle of the vehicle body of a vibratory roller used in the present invention;
FIG. 3 is a diagram illustrating the shape of an input variable membership function according to an embodiment of the present invention;
FIG. 4 is a diagram of scaling parameters in an embodiment of the present inventionpA fuzzy control rule schematic diagram of the adjustment quantity;
FIG. 5 is a graph of integral adjustment parameters in an embodiment of the present inventioniA fuzzy control rule schematic diagram of the adjustment quantity;
FIG. 6 shows differential tuning parameters in an embodiment of the present inventiondA fuzzy control rule schematic diagram of the adjustment quantity;
fig. 7 is a first flowchart of a method for adjusting a movement path of a vibratory roller according to an embodiment of the present invention;
fig. 8 is a second flowchart of a method for adjusting a movement path of a vibratory roller according to an embodiment of the present invention;
fig. 9 is a third flowchart of a method for adjusting a movement path of a vibratory roller according to an embodiment of the present disclosure;
fig. 10 is a fourth flowchart of a method for adjusting a path of a vibratory roller according to an embodiment of the present disclosure;
fig. 11 is a flow chart diagram of a fifth method of adjusting a path of a vibratory roller according to an embodiment of the present disclosure;
fig. 12 is a block diagram of a drive control system for a control system of a vibratory roller according to an embodiment of the present invention;
fig. 13 is a structural frame diagram of a steering system for a control system of a vibratory roller;
in the figure: 1. a positioning assembly; 2. an orientation assembly; 3. an angle encoder; 4. a steering controller; 5. a position data acquisition instrument; 6. a running controller.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
Referring to fig. 1 to 13 together, a method for adjusting a movement path of a vibratory roller according to the present invention will now be described. The method for adjusting the motion path of the vibratory roller comprises the following steps:
s1, planning and tracking a straight line track;
specifically, the trajectory of the tracking straight line is defined by the coordinates (x) of the starting points,ys) And endpoint coordinate (x)e,ye) Determined, the expression is:
(ye-ys)x+(xs-xe)y+xeys-xsye=0
s2, determining the tracking error between the road roller and the track of the tracking straight line, and calculating the expected vehicle body corner variation according to the tracking error
The specific mathematical form of the tracking error is as follows:
wherein: (x, y) is the actual distance position coordinate of the center of the vibration steel wheel of the road roller; theta is the actual course angle of the vibrating steel wheel; (x)d,yd) The center expected coordinate of the vibrating steel wheel corresponding to the current coordinate of the center of the vibrating steel wheel on the tracking straight-line track is obtained; thetadIs the desired course angle of the vibrating steel wheel;indicating the corner error.
Wherein k issDenotes the adjustment coefficient, eθIndicating a heading error, elRepresents lateral error, l represents pre-aiming distance, and elOne-to-one correspondence is realized;
specifically, the S2 includes the following steps:
s2.1, constructing the integral motion model of the road roller
Wherein v is the speed of the vibrating steel wheel, omega is the course angular speed of the vibrating steel wheel,the vehicle body turning angle is shown, l is the distance between the center of the vibrating steel wheel and the driving vehicle body and the intersection point, and theta is the heading of the vibrating steel wheel.
Specifically, the S2.1 includes:
s2.1.1, constructing a vectorThe method is used for determining the position and the heading of the vibratory roller.
Wherein (x)1,y1) Coordinates representing the center of the vibrating steel wheel, (x)2,y2) Coordinates, theta, representing the center of the driven vehicle body1And theta2Respectively representing the course of the vibrating steel wheel and the course of the driving wheel;the corner between the center of the driving vehicle body and the center of the vibrating steel wheel is shown, and l represents the distance from the center of the vibrating steel wheel or the driving vehicle body to a hinge point.
In formula (1), the distance from the vibrating steel wheel to the hinge point is equal to the distance from the center of the driving vehicle body to the hinge point, and is denoted by l. Constructed vector qTAnd selecting the center of the vibrating steel wheel as a reference point. The position and the course of the center of the driving vehicle body can pass through the position and the course of the center of the vibrating steel wheel and combine the rotation angle between the twoThus obtaining the product.
S2.1.2, set perpendicular to v1And v2The velocity of the direction is zero, the formula is obtained
It should be noted that the roller is longitudinally symmetrical in structure, and the tyre and steel wheel are point-contact with the ground, and at the same time, the movement of the roller is simplified into planar movement and no lateral and longitudinal slippage exists. Thus, perpendicular v1And v2The velocity of the direction is zero.
S2.1.3, obtaining the overall motion model of the road roller by combining the formula (1) and the formula (2), and expressing the model in the form of formula (3).
S2.2, according to the current position of the center of the vibration steel wheelCalculating the transverse error e by the coordinates of the corresponding expected point of the center of the vibrating steel wheel on the track of the coordinate and the tracking straight linel;
el=(xd-x)sinθd+(y-yd)cosθdWherein (x, y) represents the actual distance position coordinate of the center of the vibration steel wheel of the vibratory roller, theta represents the actual course angle of the vibration steel wheel, and (x) represents the actual course angle of the vibration steel wheeld,yd) Representing the desired coordinate, theta, of the center of the wheel on the track of the straight line corresponding to the current coordinate of the center of the wheeldIndicating the desired heading angle of the vibrating steel wheel,the error in the rotation angle is represented by,
s2.3: according to the transverse error elAnd obtaining the course required by the road roller by the corresponding pre-aiming distance l at the corresponding speed, comparing the current course of the road roller with the course required by the road roller to obtain a course error eθ;
eθ=θ-θd,
Wherein theta represents the actual course angle of the vibrating steel wheel, and theta represents the actual course angle of the vibrating steel wheeldRepresenting the desired heading angle of the vibrating steel wheel.
Note that the adjustment coefficient k issSelecting according to Lyapunov stability discrimination method, and selecting proper regulating coefficient ksCan make course error eθTransverse error elAnd the corner error tends to zero.
It should be noted that the road roller pair is specified straightThe tracking error of the line is mainly determined by the course error eθTransverse error elAnd rotation angle errorAnd (4) determining. Course error e in actual linear trackingθAnd the error of the rotation angleAnd (3) obtaining a road roller overall model according to the formula (3) and linearizing the road roller overall model to obtain a linear tracking error linearized equation of state of the vibratory roller, wherein the linear tracking error linearized equation of state is as follows:
s3, calculating the expected vehicle body turning angle variationAnd the angle deviation of the real-time angle variation of the vehicle bodyAnd adjusting the rotation angle of the vehicle body of the road roller through a steering system.
Specifically, the S3 includes:
s3.1, constructing a mathematical model of the steering system and determining a transfer function of the steering system
Wherein the content of the first and second substances,is a proportional factor, omega, between the angle of rotation of the vehicle body and the output displacement of the oil cylinderhWhich is the natural frequency of the hydraulic power steering system,s is a laplace variable;sin order to obtain the damping coefficient of the system,Kqthe flow gain of the proportional speed control valve, I is the electromagnet input control current of the proportional speed control valve, CtpIs the total leakage coefficient, V, of an equivalent hydraulic oil cylindereIs the total volume of the equivalent hydraulic cylinder cavity, E is the volume elastic modulus of oil, ApIs the action area of an equivalent hydraulic oil cylinder;
specifically, the S3.1 includes:
s3.1.1, making simplifying assumptions about the steering system;
specifically, the following assumptions are made for the steering system to simplify the analysis:
(1) neglecting the influence of the starting process of the electromagnetic directional valve on the dynamic characteristics of the steering system.
(2) The viscosity, density and elastic modulus of the oil liquid are not changed along with the changes of pressure and temperature.
(3) Only the coupling effect of force is considered among the steering oil cylinders, and the acting force among the steering oil cylinders is regarded as interference force.
S3.1.2 derivation of proportional governor valve output flow qs
qs=KqI (4)
Wherein, KqThe flow gain of the proportional speed control valve is shown, and I is the control current input by the electromagnet of the proportional speed control valve.
It should be noted that, in this case, the proportional variable valve operates in a linear section.
S3.1.3, deducing the flow q flowing into the equivalent hydraulic oil cylinderB
Wherein p isBFor equivalent load pressure of hydraulic cylinder, CtpIs the total leakage coefficient, V, of an equivalent hydraulic oil cylindereIs the total volume of the equivalent hydraulic cylinder cavity, E is the volume elastic modulus of oil, ApThe effective area of the equivalent hydraulic oil cylinder is shown, and Y is the output displacement of the equivalent hydraulic oil cylinder.
It should be noted that the output displacement Y of the oil cylinder and the vehicle body cornerAre in a proportional relationship.
S3.1.4, deducing a torque balance equation of the steering hydraulic oil cylinder
Wherein, JtRepresenting the moment of inertia of the equivalent load;prepresents the viscous damping coefficient, T, of the equivalent hydraulic oil cylinderLRepresenting the steering resistance torque during steering; p is a radical ofB1Representing the acting force arm of the equivalent hydraulic oil cylinder; p is a radical ofB2Representing the output pressure of the equivalent hydraulic oil cylinder; and R represents the acting force arm of the equivalent hydraulic oil cylinder.
S3.1.5 deriving transfer function of steering system
Wherein the content of the first and second substances,is a proportional factor, omega, between the angle of rotation of the vehicle body and the output displacement of the oil cylinderhWhich is the natural frequency of the hydraulic power steering system,s is a laplace variable;sin order to obtain the damping coefficient of the system,Kqthe flow gain of the proportional speed control valve, I is the electromagnet input control current of the proportional speed control valve, CtpIs the total leakage coefficient, V, of an equivalent hydraulic oil cylindereIs the total volume of the equivalent hydraulic cylinder cavity, E is the volume elastic modulus of oil, ApIs the action area of an equivalent hydraulic oil cylinder;
the transfer function (7) is obtained by performing laplace transform on the (4) to (6) in parallel, and neglecting the viscous damping of the oil.
Specifically, the amount of change in the desired rotation angle is calculated based on the amount of change in the calculated desired rotation angleObtaining the angle deviation with the detected real-time angle variation of the vehicle body
S3.3, controlling the adjustment of the vehicle body corner of the vibratory roller by the steering system to achieve the expected vehicle body output corner;
specifically, the steering controller 4 obtains an angle deviation according to the calculated expected corner variation and the real-time angle variation detected by the angle encoder 3, adjusts the proportional speed regulating valve to input a control current, and outputs the control current to the steering oil cylinder through the hydraulic system of the road roller to realize the adjustment of the corner of the road roller body, thereby achieving the expected output of the vehicle body corner.
And S3.4, adjusting the driving course and the position coordinates of the vibratory roller by the vehicle body output corner through the integral motion model of the vibratory roller.
As a specific implementation manner of the embodiment of the present invention, please refer to fig. 3 to 11 together, the control manner of the steering system in step 3 includes fuzzy PID control;
according to angular deviation in the fuzzy PID controlRate of change ofAnd the operation experience of the driver, and the adjustment quantity delta k of the comparative example adjustment parameter is establishedpIntegral adjustment parameter adjustment quantity delta kiAnd differential regulationParameter adjustment Δ kdThe fuzzy control rule of (1).
As a specific implementation manner of the embodiment of the invention, the running speed of the vibratory roller is controlled by adopting a PID algorithm. By adopting the PID algorithm, the vibratory roller can overcome the influence of vibration and uneven road surface conditions, and the running speed of the vibratory roller can be effectively ensured to be stabilized at the set speed.
In the embodiment, a PID algorithm is adopted to control the running speed of the vibratory road roller, and the running speed of the vibratory road roller is acquired in real time through a speed sensor arranged on a vibratory steel wheel to realize speed closed-loop control. Three regulating parameters (proportional regulating parameter k) of speed PID controllerpIntegral adjustment parameter kiDifferential adjustment parameter kd) Determined by automatic driving experiments.
In the present embodiment, the parameter of the proportional adjustmentpTo 3, integral adjustment of the parametersiIs 0.5, a differential tuning parameter kdAnd 1, stabilizing the actual operation speed of the vibratory roller at a set speed.
Compared with the prior art, the method for adjusting the motion path of the vibratory roller provided by the invention realizes the control of the vibration error, the vibratory roller adopting the method has better control performance under the condition of larger initial transverse error, and the control error has smaller overshoot and shorter corresponding time.
The invention also provides a control system for the movement of the vibratory roller. Referring also to fig. 12 to 13, a control system for the movement of a vibratory roller comprises a steering system for adjusting the steering direction of the body of the vibratory roller; the steering system comprises a positioning component 1, a directional component 2, an angle encoder 3 and a steering controller 4, wherein the positioning component 1 is arranged on the main body of the vibratory roller and used for detecting the current position of the center of the vibratory steel wheel; the orientation assembly 2 is arranged on the main body of the vibratory roller and used for detecting the current course of the vibratory roller; the angle encoder 3 is arranged on the main body of the vibratory roller and is used for detecting the variable quantity of the body angle of the vibratory roller in real time; and the steering controller 4 is electrically connected with the positioning assembly 1, the orientation assembly 2 and the angle encoder 3 and is used for receiving and processing electric signals sent by the positioning assembly 1, the orientation assembly 2 and the angle encoder 3 and adjusting the body corner of the vibratory roller.
Calculating a transverse error e according to the current position coordinates of the center of the vibrating steel wheel detected by the positioning component 1 and the coordinates of a corresponding expected point of the center of the vibrating steel wheel on a set linear trackl(ii) a And calculating to obtain the required course of the road roller according to the transverse error and the corresponding pre-aiming distance at the corresponding speed. Comparing the current course of the road roller detected by the orientation component 2 with the course required by the road roller to obtain course deviation; and calculating an expected vehicle body corner variation according to the course deviation, obtaining an angle deviation by the steering controller 4 according to the calculated expected corner variation and the real-time angle variation detected by the angle encoder 3, adjusting the input control current of the proportional speed regulating valve, and outputting the control current to a steering oil cylinder through a hydraulic system of the road roller to realize the adjustment of the road roller vehicle body corner so as to achieve the expected output vehicle body corner.
Compared with the prior art, the control system for the movement of the vibratory roller can quickly and accurately complete the adjustment of the direction of the vibratory roller in the rolling process through the steering system consisting of the steering controller 4, the orientation component 2, the positioning component 1 and the angle encoder 3.
In the present embodiment, the steering controller 4 includes a steering angle deviationAnd angular deviationRate of change ofAs fuzzy input quantity to control PID adjustment quantity delta k of currentp、ΔkiAnd Δ kdA fuzzy PID controller as fuzzy output quantity. Course tracking fuzzy PID controller based on preview has better control effect, and the fuzzy PID controller controlsThe error has a shorter corresponding time.
Specifically, the amount of change in the body angle will be expectedAngle deviation from actual vehicle body corner variationAs fuzzy input quantity, PID regulating quantity delta k of proportional speed regulating valve control currentp、Δki、ΔkdAs a fuzzy output.
Defining angular deviationsHas a discourse field of [ -24 DEG, 24 DEG ]]Rate of change of angular deviationHas a discourse field of [ -9, 9 [)](°).s-1. The quantization levels of the two are-3, -2, -1, 0, 1, 2 and 3, the angle deviation is obtainedThe quantization factor of (a) is 0.125. Rate of change of angular deviationHas a quantization factor of 0.33.
PID adjustment quantity delta k of control currentpHas a discourse field of [ -0.3, 0.3],ΔkiHas a discourse field of [ -0.015, 0.015],ΔkdHas a discourse field of [ -0.3, 0.3]And the quantization factors of the three are all 1.
Fuzzy subsets of input-output variables are defined as negative large (NB), Negative Medium (NM), Negative Small (NS), Zero (ZO), Positive Small (PS), Positive Medium (PM), and positive large (PB).
Referring to fig. 12 and 13 together, the control system further includes a driving control system for controlling the driving direction and speed of the vibratory roller; the driving control system comprises a position data acquisition instrument 5 and a driving controller 6, wherein the position data acquisition instrument 5 is arranged on the vibratory roller main body and is used for acquiring and outputting the real-time speed of the vibratory roller main body and the deviation of the real-time speed and the set speed; and the driving controller 6 is electrically connected with the position data acquisition instrument 5 and the vibratory roller main body and is used for adjusting the driving speed or/and the driving direction of the vibratory roller main body. And the running controller 6 adjusts the current of coils at two ends of the control valve according to the deviation of the real-time speed and the set speed of the road roller fed back by the position data acquisition instrument 5 (such as a GPS data acquisition instrument and the like), so that the automatic running speed and direction of the vibratory road roller are controlled.
The embodiments are described in a progressive manner, each embodiment focuses on differences from other embodiments, and the same or similar parts among the embodiments are referred to each other.
The previous description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the present invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the generic principles defined herein may be applied to other embodiments without departing from the spirit or scope of the invention. Thus, the present invention is not intended to be limited to the embodiments shown herein but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.
Claims (8)
1. A method for adjusting the path of motion of a vibratory roller, comprising the steps of:
step 1, planning a track of a tracking straight line;
step 2, determining a tracking error between the vibratory roller and a track of a tracking straight line, and calculating an expected vehicle body corner variation according to the tracking error
Step 3, calculating the expected vehicle body corner variationAngular deviation from real-time angular variation of vehicle bodyAnd adjusting the rotation angle of the vehicle body of the vibratory roller through a steering system, and further adjusting the driving course and the position coordinate of the vibratory roller.
2. A method of adjusting the path of movement of a vibratory roller as claimed in claim 1, wherein step 2 comprises:
step 2.1, constructing an integral motion model of the vibratory roller:
wherein v is the speed of the vibrating steel wheel, omega is the course angular speed of the vibrating steel wheel,the vehicle body corner is represented, l represents the distance from the center of the vibration steel wheel or the driving vehicle body to the intersection point, and theta represents the course of the vibration steel wheel;
step 2.2, calculating a transverse error e according to the coordinates of the current position of the center of the vibrating steel wheel and the coordinates of a corresponding expected point of the center of the vibrating steel wheel on the track of the tracking straight linel,el=(xd-x)sinθd+(y-yd)cosθdWherein (x, y) represents the actual distance position coordinate of the center of the vibration steel wheel of the vibratory roller, theta represents the actual course angle of the vibration steel wheel, and (x) represents the actual course angle of the vibration steel wheeld,yd) Representing the desired coordinate, theta, of the center of the wheel on the track of the straight line corresponding to the current coordinate of the center of the wheeldIndicating the desired heading angle of the vibrating steel wheel,indicating a corner error;
step 2.3:according to the transverse error elAnd obtaining the course required by the vibratory roller according to the corresponding pre-aiming distance 1 at the corresponding speed, comparing the current course of the vibratory roller with the course required by the vibratory roller to obtain a course error eθ,
3. A method of adjusting the path of movement of a vibratory roller as claimed in claim 2, wherein step 3 comprises:
3.1, constructing a mathematical model of the steering system, and determining a transfer function of the steering system:
wherein the content of the first and second substances,is a proportional factor, omega, between the angle of rotation of the vehicle body and the output displacement of the oil cylinderhWhich is the natural frequency of the hydraulic power steering system,s is a laplace variable;sin order to obtain the damping coefficient of the system,Kqis the flow gain of the proportional speed control valve, I is the ratioControl current, C, input to electromagnet of speed regulating valvetpIs the total leakage coefficient, V, of an equivalent hydraulic oil cylindereIs the total volume of the equivalent hydraulic cylinder cavity, E is the volume elastic modulus of oil, ApIs the action area of an equivalent hydraulic oil cylinder;
step 3.2, calculating the angle deviation
3.3, controlling the adjustment of the vehicle body corner of the vibratory roller by the steering system to achieve the expected vehicle body output corner;
and 3.4, adjusting the driving course and the position coordinates of the vibratory roller by the vehicle body output corner passing through the integral motion model of the vibratory roller.
4. A method of conditioning the path of movement of a vibratory roller as claimed in any one of claims 1 to 3, wherein: the control mode of the steering system in the step 3 comprises fuzzy PID control;
according to angular deviation in the fuzzy PID controlRate of change ofAnd the operation experience of the driver, and the adjustment quantity delta k of the comparative example adjustment parameter is establishedpIntegral adjustment parameter adjustment quantity delta kiAnd a differential tuning parameter adjustment Δ kdThe fuzzy control rule of (1).
5. A method of adjusting the path of movement of a vibratory roller as claimed in claim 1, wherein: and the running speed of the vibratory roller is controlled by adopting a PID algorithm.
6. A control system for the movement of a vibratory roller, comprising: the steering system is used for adjusting the steering direction of the vehicle body of the vibratory roller;
the steering system includes:
the positioning assembly is arranged on the main body of the vibratory roller and used for detecting the current position of the center of the vibratory steel wheel;
the orientation assembly is arranged on the main body of the vibratory roller and used for detecting the current course of the vibratory roller;
the angle encoder is arranged on the main body of the vibratory roller and is used for detecting the variable quantity of the body angle of the vibratory roller in real time;
and the steering controller is electrically connected with the positioning assembly, the orientation assembly and the angle encoder and is used for receiving and processing electric signals sent by the positioning assembly, the orientation assembly and the angle encoder and adjusting the body corner of the vibratory roller.
8. A control system for a path of movement of a vibratory roller as claimed in claim 6, wherein: the control system also comprises a driving control system for controlling the driving direction and speed of the vibratory roller;
the travel control system includes:
the position data acquisition instrument is arranged on the vibratory roller main body and is used for acquiring and outputting the real-time speed of the vibratory roller main body and the deviation of the real-time speed and the set speed;
and the driving controller is electrically connected with the position data acquisition instrument and the vibratory roller main body and is used for adjusting the driving speed or/and the driving direction of the vibratory roller main body.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010768614.XA CN111857157A (en) | 2020-08-03 | 2020-08-03 | Method for adjusting motion path of vibratory roller and control system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010768614.XA CN111857157A (en) | 2020-08-03 | 2020-08-03 | Method for adjusting motion path of vibratory roller and control system |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111857157A true CN111857157A (en) | 2020-10-30 |
Family
ID=72954407
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010768614.XA Withdrawn CN111857157A (en) | 2020-08-03 | 2020-08-03 | Method for adjusting motion path of vibratory roller and control system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111857157A (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113050622A (en) * | 2021-02-01 | 2021-06-29 | 武汉光庭科技有限公司 | Method and system for controlling path tracking of unmanned road roller, server and medium |
CN113721454A (en) * | 2021-09-03 | 2021-11-30 | 吉林大学 | Articulated vehicle path tracking control method |
CN115328135A (en) * | 2022-08-16 | 2022-11-11 | 上海联适导航技术股份有限公司 | Scribing robot calibration and scribing method and device, electronic equipment and scribing robot |
-
2020
- 2020-08-03 CN CN202010768614.XA patent/CN111857157A/en not_active Withdrawn
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113050622A (en) * | 2021-02-01 | 2021-06-29 | 武汉光庭科技有限公司 | Method and system for controlling path tracking of unmanned road roller, server and medium |
CN113050622B (en) * | 2021-02-01 | 2022-10-18 | 武汉光庭科技有限公司 | Method and system for controlling path tracking of unmanned road roller, server and medium |
CN113721454A (en) * | 2021-09-03 | 2021-11-30 | 吉林大学 | Articulated vehicle path tracking control method |
CN115328135A (en) * | 2022-08-16 | 2022-11-11 | 上海联适导航技术股份有限公司 | Scribing robot calibration and scribing method and device, electronic equipment and scribing robot |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111857157A (en) | Method for adjusting motion path of vibratory roller and control system | |
US8175771B2 (en) | Control apparatus for electric power steering system | |
JP4957071B2 (en) | Control device for electric power steering device | |
EP3309044B1 (en) | Steering assist apparatus | |
US8660749B2 (en) | Motor vehicle steering system | |
CN112918550B (en) | Control method and control system for active steering system of unmanned automobile | |
CN108646756B (en) | Intelligent automobile transverse control method and system based on segmented affine fuzzy sliding mode | |
CN111625008A (en) | Method for adjusting motion path of vibratory roller and control system | |
CN111923908A (en) | Stability-fused intelligent automobile path tracking control method | |
US7546191B2 (en) | Handwheel damping control of active steering system | |
JPS6133746B2 (en) | ||
KR101241621B1 (en) | Lane keeping assist system considering driver's range of view and steering tendency by speed | |
JP5633118B2 (en) | Travel control device | |
JPS60229873A (en) | Method of controlling steering of rear wheel in four wheel steering vehicle | |
CN110989346B (en) | Intelligent control method integrating decision behaviors of driver | |
Yu et al. | A feedback-feedforward steering controller designed for vehicle lane keeping in hard-braking manoeuvres on split-μ roads | |
CN112965498A (en) | Intelligent sweeping machine running track tracking control method | |
JP2523125B2 (en) | Vehicle steering angle control device | |
JP3235384B2 (en) | Actual steering angle control device for vehicle | |
Cong et al. | Path Tracking Control Based on Adaptive Control Period | |
JP4300923B2 (en) | Vehicle steering control device | |
JP2946778B2 (en) | Travel control device for hydraulically driven vehicle | |
JP3216459B2 (en) | Actual steering angle control device for vehicle | |
JP2523118B2 (en) | Vehicle steering angle control device | |
Wu et al. | Numeric Approach on Optimal Control for the Path Following System in Autonomous Vehicle |
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 | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20201030 |
|
WW01 | Invention patent application withdrawn after publication |