A method for automatically correcting deviation of a tire crane trolley

By setting virtual tracks on tire crane trucks and using laser sensors to detect deviation data, combined with PID control technology, the automatic deviation correction of the truck is achieved, solving the problems of low efficiency and low accuracy of traditional manual deviation correction, and improving operation flexibility Sex and efficiency.

CN116692686BActive Publication Date: 2024-11-22RAINBOW CARGOTEC IND
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202310593869.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-05-24
Publication Date
2024-11-22
Estimated Expiration
2043-05-24

AI Technical Summary

Technical Problem

Traditional tire cranes rely on manual manual correction and cannot be accurately positioned, which poses human subjective risks and is inefficient.

Method used

The automatic deviation correction method is adopted, by setting up virtual tracks, detecting deviation data with laser sensors, establishing PID control formulas, and adjusting the deviation correction speed in real time to achieve automatic deviation correction of the cart.

Benefits of technology

It improves the flexible operation ability of large trucks in different container yards, reduces artificial errors, improves the response speed and accuracy of deviation correction, and reduces the complexity of equipment usage and operation difficulty.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN116692686B_ABST
    Figure CN116692686B_ABST
Patent Text Reader

Abstract

The present invention relates to the technical field of port container loading and unloading, and discloses a method for automatic deviation correction of a tire-type container gantry crane trolley. The method comprises the following steps: Step 1, setting an ideal virtual track on the normal walking track of the trolley; Step 2, establishing a calculation formula, and detecting the data difference of the actual deviation from the track through a sensor; Step 3, establishing a coordinate system diagram, and establishing a mapping relationship; Step 4, judging the operation trend of the trolley through the mapping relationship reaction, and correcting it. In order to realize the flexible operation of a tire-type container gantry crane in different container yards, the present invention invents a method for automatic deviation correction of a tire-type container gantry crane trolley. The present invention overcomes the defects of relying on human experience to judge, and uses PID control technology to realize the automatic deviation correction function of the trolley.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of port container loading and unloading, and in particular to an automatic deviation correction method for a tire crane trolley. Background Art

[0002] Rubber-tyred container gantry crane is an important lifting machinery in port engineering machinery. Traditional rubber-tyred crane trolley adopts manual deviation correction method, which has average actual effect, cannot accurately locate, and needs to rely on the driver's experience to predict, which has the risk of human subjective consciousness. Summary of the invention

[0003] In view of the deficiencies in the prior art, the present invention provides an automatic deviation correction method for a tire crane trolley.

[0004] To achieve the above object, the present invention provides the following technical solution: a method for automatically correcting the deviation of a tire crane trolley, comprising the following steps:

[0005] Step 1: Set an ideal virtual track on the normal walking track of the vehicle;

[0006] Step 2: Establish a calculation formula and detect the actual deviation from the track data difference through the sensor;

[0007] Step 3: Create a coordinate system diagram and establish a mapping relationship;

[0008] Step 4: Determine the running trend of the vehicle through the mapping relationship and make corrections

[0009] Preferably, the specific steps of step 1 are: setting an ideal virtual track on the normal walking track of the vehicle, the distance between this track and the reflective plate is determined by a laser sensor, and this virtual track defines a correction area, a deceleration area, and a stopping critical line.

[0010] Preferably, the specific steps of step 2 are: when the vehicle deviates from the ideal track line, the sensor detects the data difference of the actual deviation from the track, and calculates a process output value through a formula to superimpose the output value, and the calculation formula is: err = set value - process output value.

[0011] Preferably, the specific steps of step 3 are: establishing a coordinate system diagram:

[0012] err is the ordinate, k is the abscissa (the k value interval is set to [0.8, 1.0]), and err is the ordinate value interval setting [0, correction interval difference].

[0013] Preferably, a mapping relationship is established in step 3: the vehicle correction speed coefficient variable is x=1-[(ABS(err)-correction interval starting value) / correction distance interval difference*(jvmax-jvmin)], and the correction interval is defined as the difference between the correction starting distance and the correction stopping distance.

[0014] Preferably, the maximum value of the vehicle correction speed coefficient jvmax is a fixed value = 1.0; the minimum value of the vehicle correction speed coefficient jvmin is a variable, temporarily set at 0.8.

[0015] Preferably, x is accelerated or decelerated in linear proportion to the given speed of the frequency converter, and the relationship is Vref=x*Vref, and the value of x is in the interval [0.8-1]; Vref is the given speed of the trolley, and the direction of the trolley correction is determined by err: when err>0, the DS side decelerates, and err<0, the DOS side decelerates.

[0016] Preferably, in step 4, during the high-speed operation of the tire crane, a PID (proportional integral differential) calculation formula rule with the virtual center track is established through the reflection principle of the laser sensor, and the offset data is read in real time and fed back to the PLC. The PLC calibrates the relative position of the tire crane from time to time through the established calculation rules and offset requirements.

[0017] Preferably, the runway operation data is read in real time by a sensor, indicated by a reflector, and the feedback offset distance from the ranging laser sensor to the reflector is set to S1, S3, and the virtual track distance is set to S0.

[0018] Preferably, the offset data reading rules and correction direction are:

[0019] Smartrail exterior

[0020] Left line s3>s1>s0 or s1>s3>s0

[0021] Identify trends

[0022] If ABS(s3-s1)-ABS((s3-s1)old)>0, it tends to be vertical

[0023] if s3-s1>0, stay away from smartrail; Vref before = jvmin*Vref, Vref after = Vref

[0024] s3-s1<0 approaches smartrail; Vref before = Vref, Vref after = jvmin*Vrefif ABS(s3-s1)-ABS((s3-s1)old)<0 approaches horizontal

[0025] if s3-s1>0, stay away from smartrail; Vref before = x*Vref, Vref after = Vref

[0026] s3-s1<0 approaches smartrail; Vref before = Vref, Vref after = x*Vref

[0027] Right row s1>s3>s0 or s3>s1>s0

[0028] Identify trends

[0029] If ABS(s1-s3)-ABS((s1-s3)old)>0, it tends to be vertical

[0030] if s3-s1>0, move away from smartrail; Vref before = jvmin*Vref, Vref after = Vrefs3-s1<0, move towards smartrail; Vref before = Vref, Vref after = jvmin*Vref if ABS(s1-s3)-ABS((s1-s3)old)<0, move towards horizontal

[0031] if s3-s1>0, stay away from smartrail; Vref before = x*Vref, Vref after = Vref

[0032] s3-s1<0 approaches smartrail; Vref before = Vref, Vref after = x*Vref;

[0033] Inside Smartrail

[0034] Left line s0>s3>s1 or s0>s1>s3

[0035] Identify trends

[0036] If ABS(s3-s1)-ABS((s3-s1)old)>0, it tends to be vertical

[0037] if s1-s3>0, move away from smartrail; Vref before = Vref, Vref after = jvmin*Vrefs1-s3<0, move towards smartrail; Vref before = jvmin*Vref, Vref after = Vref if ABS(s3-s1)-ABS((s3-s1)old)<0, move towards horizontal

[0038] if s1-s3>0 approaches smartrail; Vref before = Vref, Vref after = x*Vref

[0039] s1-s3<0, far away from smartrail; Vref before = x*Vref, Vref after = Vref

[0040] Right s0>s1>s3 or s0>s3>s1

[0041] Identify trends

[0042] If ABS(s1-s3)-ABS((s1-s3)old)>0, it tends to be vertical

[0043] if s3-s1>0 approaching smartrail; Vref before = Vref, Vref after = jvmin*Vrefs3-s1<0 away from smartrail; Vref before = jvmin*Vref, Vref after = Vref if ABS(s1-s3)-ABS((s1-s3)old)<0 approaching horizontal

[0044] if s3-s1>0, approaching smartrail; Vref before = Vref, Vref after = x*Vrefs3-s1<0, moving away from smartrail; Vref before = x*Vref, Vref after = Vref.

[0045] Compared with the prior art, the present invention provides a method for automatically correcting the deviation of a tire crane trolley, which has the following beneficial effects:

[0046] 1. This tire-type crane trolley automatic deviation correction method is invented to realize the flexible operation of the tire-type container gantry crane in different container yards. It overcomes the judgment based on human experience and uses PID control technology to realize the automatic deviation correction function of the trolley.

[0047] 2. The automatic deviation correction method of the tire crane trolley is simple and reliable in design. The hardware of the present invention uses a laser sensor and the principle of light reflection to read the offset of two points during operation and feed it back to the PLC;

[0048] 3. The automatic deviation correction method of the tire crane trolley has reliable system control. The PID (proportional integral differential control) adopted by the present invention forms a control deviation according to the given value and the actual output value, and the deviation is linearly combined by proportion, integration and differentiation to form a control quantity to control the controlled object. From the perspective of time, the proportional action controls the current error of the system, the integral action controls the history of the system error, and the differential action reflects the changing trend of the system error. The combination of these three is a perfect combination of "past, present and future".

[0049] 4. The automatic deviation correction method of the tire crane trolley is characterized by that when the trolley deviates from the preset track, it senses the actual deviation direction and distance, and adjusts the given output of the trolley inverter in the shortest time to make the trolley return to the normal driving track. The difference between it and the manual deviation correction control is that the automatic deviation correction of the trolley has a fast response speed, no static error, and the trolley can quickly adjust to the normal track.

[0050] 5. The automatic deviation correction method of the tire crane trolley is based on the characteristics of the trolley running mechanism and speed of the tire container gantry crane. When the tire crane trolley is moving, it is different from the rail-type gantry crane. Due to the weight difference between the front and rear beams, the different linearity of the left and right legs of the trolley, and the combined influence of many adverse factors such as tire pressure, the walking speed of the two sides of the trolley will be different, and it will deviate as the trolley moves. This will cause the misalignment of the spreader and the container during the subsequent container placement; in traditional manual deviation correction, the driver determines whether the trolley is deviating by identifying the markings on the trolley runway; if the trolley is deviating, the trolley deviation correction button in the driver's cab is combined with the trolley handle to correct the position. In this way, the driver needs to manually adjust the slewing motor or even the trolley to complete normal work, which not only causes trouble to the driver, but also greatly reduces the use efficiency of the equipment and the work efficiency of the yard. BRIEF DESCRIPTION OF THE DRAWINGS

[0051] Figure 1 This is the overall design concept diagram of the present invention;

[0052] Figure 2 Establishing a coordinate system diagram for the present invention;

[0053] Figure 3 It is the right schematic diagram of the present invention. DETAILED DESCRIPTION

[0054] 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.

[0055] See also Figure 1-3 , a tire crane trolley automatic deviation correction method, comprising the following steps:

[0056] Step 1: Set an ideal virtual track on the normal walking track of the vehicle;

[0057] Step 2: Establish a calculation formula and detect the actual deviation from the track data difference through the sensor;

[0058] Step 3: Create a coordinate system diagram and establish a mapping relationship;

[0059] Step 4: Determine the running trend of the vehicle through the mapping relationship and make corrections

[0060] The specific steps of step 1 are: setting an ideal virtual track on the normal walking track of the vehicle, the distance between this track and the reflective plate is determined by a laser sensor, and this virtual track defines the correction area, the deceleration area, and the stop critical line.

[0061] The specific steps of step 2 are: when the vehicle deviates from the ideal track line, the sensor detects the data difference of the actual deviation from the track, and calculates a process output value through a formula to superimpose the output value. The calculation formula is: err = set value - process output value.

[0062] The specific steps of step 3 are: establishing a coordinate system diagram:

[0063] err is the ordinate, k is the abscissa (the k value interval is set to [0.8, 1.0]), and err is the ordinate value interval setting [0, correction interval difference].

[0064] In step 3, a mapping relationship is established: the vehicle correction speed coefficient variable is x=1-[(ABS(err)-correction interval starting value) / correction distance interval difference*(jvmax-jvmin)], and the correction interval is defined as the difference between the correction starting distance and the correction stopping distance.

[0065] The maximum value of the trolley correction speed coefficient jvmax is a fixed value = 1.0; the minimum value of the trolley correction speed coefficient jvmin is a variable, temporarily set at 0.8.

[0066] x is accelerated and decelerated in linear proportion to the given speed of the inverter, and the relationship is Vref=x*Vref, and the value of x is in the range of [0.8-1]; Vref is the given speed of the trolley, and the direction of the trolley correction is determined by err: when err>0, the DS side decelerates, and err<0, the DOS side decelerates.

[0067] In step 4, during the high-speed operation of the tire crane, the PID (proportional integral differential) calculation formula rule with the virtual center track is established through the reflection principle of the laser sensor, the offset data is read in real time, and the PLC is fed back to the PLC. The PLC calibrates the relative position of the tire crane from time to time according to the established calculation rules and offset requirements.

[0068] The sensor reads the runway operation data in real time, and the reflector is used for illustration. The feedback offset distance from the ranging laser sensor to the reflector is set to S1 and S3, and the virtual track distance is set to S0.

[0069] Offset data reading rules and correction direction:

[0070] Smartrail exterior

[0071] Left line s3>s1>s0 or s1>s3>s0

[0072] Identify trends

[0073] If ABS(s3-s1)-ABS((s3-s1)old)>0, it tends to be vertical

[0074] if s3-s1>0, stay away from smartrail; Vref before = jvmin*Vref, Vref after = Vref

[0075] s3-s1<0 approaches smartrail; Vref before = Vref, Vref after = jvmin*Vrefif ABS(s3-s1)-ABS((s3-s1)old)<0 approaches horizontal

[0076] if s3-s1>0, stay away from smartrail; Vref before = x*Vref, Vref after = Vref

[0077] s3-s1<0 approaches smartrail; Vref before = Vref, Vref after = x*Vref

[0078] Right row s1>s3>s0 or s3>s1>s0

[0079] Identify trends

[0080] If ABS(s1-s3)-ABS((s1-s3)old)>0, it tends to be vertical

[0081] if s3-s1>0, move away from smartrail; Vref before = jvmin*Vref, Vref after = Vrefs3-s1<0, move towards smartrail; Vref before = Vref, Vref after = jvmin*Vref if ABS(s1-s3)-ABS((s1-s3)old)<0, move towards horizontal

[0082] if s3-s1>0, stay away from smartrail; Vref before = x*Vref, Vref after = Vref

[0083] s3-s1<0 approaches smartrail; Vref before = Vref, Vref after = x*Vref;

[0084] Inside Smartrail

[0085] Left line s0>s3>s1 or s0>s1>s3

[0086] Identify trends

[0087] If ABS(s3-s1)-ABS((s3-s1)old)>0, it tends to be vertical

[0088] if s1-s3>0, move away from smartrail; Vref before = Vref, Vref after = jvmin*Vrefs1-s3<0, move towards smartrail; Vref before = jvmin*Vref, Vref after = Vref if ABS(s3-s1)-ABS((s3-s1)old)<0, move towards horizontal

[0089] if s1-s3>0 approaches smartrail; Vref before = Vref, Vref after = x*Vref

[0090] s1-s3<0, far away from smartrail; Vref before = x*Vref, Vref after = Vref

[0091] Right s0>s1>s3 or s0>s3>s1

[0092] Identify trends

[0093] If ABS(s1-s3)-ABS((s1-s3)old)>0, it tends to be vertical

[0094] if s3-s1>0 approaching smartrail; Vref before = Vref, Vref after = jvmin*Vrefs3-s1<0 away from smartrail; Vref before = jvmin*Vref, Vref after = Vref if ABS(s1-s3)-ABS((s1-s3)old)<0 approaching horizontal

[0095] if s3-s1>0 approaches smartrail; Vref before = Vref, Vref after = x*Vref

[0096] s3-s1<0, stay away from smartrail; Vref before = x*Vref, Vref after = Vref.

[0097] 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. A method for automatically correcting the deviation of a tire crane trolley, characterized in that: The following steps are involved: Step 1: Set an ideal virtual track on the normal walking track of the vehicle; Step 2: Establish a calculation formula to detect the actual deviation from the track data difference through the sensor; Step 3: Create a coordinate system diagram and establish a mapping relationship; Step 4: Determine the running trend of the vehicle through the mapping relationship and make corrections; The specific steps of step 3 are: establishing a coordinate system diagram: err is the ordinate, k is the abscissa, the k value interval is set to [0.8, 1.0], and err is the ordinate value interval set to [0, correction interval difference]; In step 3, a mapping relationship is established: the vehicle correction speed coefficient variable is x=1-[(ABS(err)-correction interval starting value) / correction distance interval difference × (jvmax-jvmin)], and the correction interval is defined as the difference between the correction starting distance and the correction stopping distance; x is linearly accelerated and decelerated in proportion to the given speed of the inverter, and the relationship is Vref=x×Vref, where the value of x is in the range of [0.8-1]; Vref is the given speed of the trolley, and the direction of the trolley correction is determined by err: when err>0, the DS side decelerates, and err<0, the DOS side decelerates; In step 4, during the high-speed operation of the tire crane, the PID (proportional integral differential) calculation formula rule with the virtual center track is established through the reflection principle of the laser sensor, the offset data is read in real time, and the PLC is fed back to the PLC. The PLC calibrates the relative position of the tire crane from time to time according to the established calculation rules and offset requirements; The sensor reads the runway operation data in real time, and uses the reflector to indicate, and sets the feedback offset distance from the ranging laser sensor to the reflector to S1 and S3, and the virtual track distance to S0; Offset data reading rules and correction direction: Smartrail exterior Left line s3>s1>s0 or s1>s3>s0 Identify trends if ABS(s3-s1)-ABS((s3-s1)old)>0, it tends to be vertical if s3-s1>0, stay away from smartrail; Vref before = jvmin×Vref, Vref after = Vref s3-s1<0 Approaching smartrail; Vref before = Vref, Vref after = jvmin×Vref if ABS(s3-s1)- ABS((s3-s1)old)<0, trending horizontally if s3-s1>0, stay away from smartrail; Vref before = x×Vref, Vref after = Vref s3-s1<0 Approaching smartrail; Vref before = Vref, Vref after = x×Vref Right row s1>s3>s0 or s3>s1>s0 Identify trends if ABS(s1-s3)-ABS((s1-s3)old)>0, it tends to be vertical if s3-s1>0, stay away from smartrail; Vref before = jvmin×Vref, Vref after = Vref s3-s1<0 Approaching smartrail; Vref before = Vref, Vref after = jvmin×Vref if ABS(s1-s3)-ABS((s1-s3)old)<0, then it moves horizontally if s3-s1>0, stay away from smartrail; Vref before = x × Vref, Vref after = Vref s3-s1<0 Approaching smartrail; Vref before = Vref, Vref after = x×Vref; Inside Smartrail Left line s0>s3>s1 or s0>s1>s3 Identify trends if ABS(s3-s1)-ABS((s3-s1)old)>0, it tends to be vertical if s1-s3>0, stay away from smartrail; Vref before = Vref, Vref after = jvmin×Vref s1-s3<0 Approaching smartrail; Vref before = jvmin×Vref, Vref after = Vref if ABS(s3-s1)- ABS((s3-s1)old)<0, trending horizontally if s1-s3>0 approaching smartrail; Vref before = Vref, Vref after = x×Vref s1-s3<0, far away from smartrail; Vref before = x × Vref, Vref after = Vref Right s0>s1>s3 or s0>s3>s1 Identify trends if ABS(s1-s3)-ABS((s1-s3)old)>0, it tends to be vertical if s3-s1>0 approaching smartrail; Vref before = Vref, Vref after = jvmin×Vref s3-s1<0, far away from smartrail; Vref before = jvmin×Vref, Vref after = Vref if ABS(s1-s3)-ABS((s1-s3)old)<0, trending horizontally if s3-s1>0 approaching smartrail; Vref before = Vref, Vref after = x × Vref s3-s1<0, stay away from smartrail; Vref before = x×Vref, Vref after = Vref.

2. The automatic deviation correction method for a tire crane trolley according to claim 1 is characterized in that: The specific steps of step 1 are: setting an ideal virtual track on the normal walking track of the vehicle, the distance between this track and the reflective plate is determined by a laser sensor, and this virtual track defines the correction area, the deceleration area, and the stop critical line.

3. The automatic deviation correction method for a tire crane trolley according to claim 1 is characterized in that: The specific steps of step 2 are: when the vehicle deviates from the ideal track line, the sensor detects the data difference of the actual deviation from the track, and calculates a process output value through a formula to superimpose the output value. The calculation formula is: err=set value-process output value.

4. The automatic deviation correction method for a tire crane trolley according to claim 1 is characterized in that: The maximum value of the trolley correction speed coefficient jvmax is a fixed value = 1.0; the minimum value of the trolley correction speed coefficient jvmin is a variable, temporarily set at 0.8.

Citation Information

Cited By

  • Large vehicle deviation rectification method based on double-layer self-adaptive unscented Kalman filtering

    CN122110179A

  • Big truck deviation rectification method based on double-layer adaptive unscented Kalman filter

    CN122110179B