CN102914968A - Self-learning synchronous corrosion control system and method - Google Patents

Self-learning synchronous corrosion control system and method Download PDF

Info

Publication number
CN102914968A
CN102914968A CN2012103853577A CN201210385357A CN102914968A CN 102914968 A CN102914968 A CN 102914968A CN 2012103853577 A CN2012103853577 A CN 2012103853577A CN 201210385357 A CN201210385357 A CN 201210385357A CN 102914968 A CN102914968 A CN 102914968A
Authority
CN
China
Prior art keywords
driver element
driven
self study
synchronous
parameter
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.)
Granted
Application number
CN2012103853577A
Other languages
Chinese (zh)
Other versions
CN102914968B (en
Inventor
龚志明
周强
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Henan Weihua Heavy Machinery Co Ltd
Original Assignee
Henan Weihua Heavy Machinery Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Henan Weihua Heavy Machinery Co Ltd filed Critical Henan Weihua Heavy Machinery Co Ltd
Priority to CN201210385357.7A priority Critical patent/CN102914968B/en
Publication of CN102914968A publication Critical patent/CN102914968A/en
Application granted granted Critical
Publication of CN102914968B publication Critical patent/CN102914968B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Multiple Motors (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

The invention relates to a self-learning synchronous corrosion control system and a self-learning synchronous corrosion control method. The system comprises operating control equipment, wherein the operating control equipment is connected with at least two driving units through a synchronous correction controller; each driving unit is connected with corresponding driven equipment in a driving mode; a position detector is arranged on each driven equipment; and the signal output end of each position detector is connected with the synchronous corrosion controller. The system automatically learns the driving parameter of each driving unit on line and respectively adjusts the control parameter of each driven/driving unit continuously according to the operating distance and the real-time position obtained through on-line measurement of a range pole driving unit and each driven/driving unit, and adjusts the corrosion control quantity of each driven/driving unit according to the position deviation value of the range pole driving unit and each driven/driving unit, so that all the driven/driving units and the range pole driving unit operate synchronously, and the synchronous correction controller with the self-learning function can realize synchronous correction control more stably and precisely.

Description

The synchronous deviation correction control system of self study and method
Technical field
The invention belongs to the synchronous correction movement control technology field of a plurality of operation driver elements, relate to the synchronous deviation correction control system of self study and method.
Background technology
When two or more operation driver elements drove the mechanism of an association and load simultaneously, we needed this a plurality of driver elements to realize synchronous operations.For example, when the crane with a plurality of dollies and lifting mechanism lifted the load operation, hoisting of dolly need to be synchronized with the movement with level run.Have, large span overhead and gantry cranes is when two siding tracks move again, and the driver element of both sides need to keep high level of synchronization, and what crane wheel occurs to avoid crane two lateral movements that deviation is arranged gnaws the rail phenomenon.
In order to guarantee being synchronized with the movement of a plurality of driver elements, need to be according to the physical location feedback of its driver element, to the driver element control of rectifying a deviation synchronously.Synchronous correction control method commonly used only utilizes the deviation of position to carry out simple FEEDBACK CONTROL.And in the working control operational process, because of the different and variation of environmental factor, the actual driving parameter of each driver element always has difference and the variation of a small amount of the unknown.In the control method of rectifying a deviation synchronously, not intellectual and the time dependent characteristic of the actual driving of driver element parameter are taken into account, can realize that better synchronous correction is controlled.
Summary of the invention
The purpose of this invention is to provide the synchronous deviation correction control system of a kind of self study and method, to realize more stable, more accurate synchronous correction control.
For achieving the above object, the synchronous deviation correction control system of self study of the present invention comprises operational control unit, this operational control unit control linkage has synchronous deviation correcting device, this synchronous deviation correcting device control linkage has at least two driver elements, each driver element drives respectively and connects corresponding driven equipment, be respectively equipped with position detector on each driven equipment, the signal output part of position detector is connected with described synchronous deviation correcting device, and this synchronous deviation correcting device is for the synchronous operation command speed of sending according to operational control unit, the positional information of the driven equipment of position detector feedback is sent the synchronous operation speed command to each driver element.
Further, described driver element is a mark post driver element and m driven driver element, and wherein m 〉=1 is positive integer.
Rectify a deviation the synchronously step of control method of self study of the present invention is as follows:
(1) make up the synchronous deviation correction control system of self study, this system comprises a mark post driver element and m driven driver element, and wherein m 〉=1 is positive integer;
(2) set the self study cycle T, operational control unit sends the command speed V of synchronous operation c
(3) in a self study cycle T, the command speed V of the synchronously deviation correcting device synchronous operation of sending according to operational control unit cWith the positional information of each driven equipment of position detector feedback, determine the synchronous correction control Parameter H of each driven driver element via online self study i, 1≤i≤m;
(4) deviation correcting device sends action command speed to each driver element synchronously, and the action command speed that wherein sends to the mark post driver element is V Cb=V c, the action command speed that sends to each driven driver element is V Czi=H iV c, 1≤i≤m realizes driven driver element self study rectify a deviation synchronously control, wherein V bAnd V Zi, be respectively the travelling speed of mark post driver element and driven driver element, V CbAnd V Czi
Further, the self study cycle T is according to mark post drive unit drives parameter K in described step (2) and (3) bWith driven drive unit drives parameter K Zi(the speed degree of the variation of 1≤i≤m) and the accuracy requirement of synchronous correction control determined.
Further, synchronously correction control Parameter H in described step (3) and (4) i, 1≤i≤m is obtained by following self study loop iteration computing method
L i ( n ) = a i 1 L i ( n - 1 ) + a i 2 H i ( n - 1 ) D b ( n - 1 ) D zi ( n - 1 )
H i ( n ) = L i ( n ) + P b ( n ) - P zi ( n ) K zi max V c ( n ) T
A wherein I1, a I2Be weighting coefficient, subscript (n) n self study cycle of expression, subscript (n-1) n-1 self study cycle of expression, H I (n-1)The value that represents n-1 self study cycle synchronisation correction control parameter, H I (n)Initial value H I (0)Be 1, L I (n-1)Represent that n-1 self study cycle is to mark post drive unit drives parameter K bWith i driven drive unit drives parameter K ZiRatio
Figure BDA00002243172600023
The self study estimated value, L I (n)Initial value L I (0)Be 1, D B (n-1), D Zi (n-1)Be respectively the distance of driven equipment driven equipment actual motion within n-1 self study cycle that mark post driver element and i driven driver element drives, P B (n), P Zi (n)The driven equipment that drives for mark post driver element and i driven driver element n the zero hour in self study cycle driven equipment the position, V C (n)Be the command speed of n the synchronous operation that operational control unit the sends zero hour in self study cycle, K ZimaxBe i driven drive unit drives parameter K ZiThe maximum estimated value.
Further, when crane runway was arc-shaped rail, described driver element was that mark post driver element, driven driver element respectively are 1 along the level run driver element of arc-shaped rail operation, and two drived units rotate around track center of arc, and its angular velocity is respectively ω bAnd ω Z1, angular displacement δ bAnd δ Z1, and position, angle θ bAnd θ Z1, deviation correcting device is respectively ω to the angular velocity action command of mark post driver element and driven driver element synchronously CbAnd ω Cz1, and obtained by following loop iteration formula:
L 1 ( n ) = a 11 L 1 ( n - 1 ) + a 12 H 1 ( n - 1 ) δ b ( n - 1 ) δ z 1 ( n - 1 )
H 1 ( n ) = L 1 ( n ) + θ b ( n ) - θ z 1 ( n ) K z 1 max ω c ( n ) T
ω cb=ω c
ω cz1=H 1ω c
A wherein 11, a 12Be weighting coefficient, subscript (n) n self study cycle of expression, subscript (n-1) n-1 self study cycle of expression, H 1 (n-1)The value that represents n-1 self study cycle synchronisation correction control parameter, H 1 (n)Initial value H 1 (0)Be 1, L 1 (n-1)Represent that n-1 self study cycle drives parameter K to mark post driver element angular velocity bDrive parameter K with driven driver element angular velocity Z1Ratio
Figure BDA00002243172600033
The self study estimated value, L 1 (n)Initial value L 1 (0)Be 1, δ B (n-1), δ Z1 (n-1)Be respectively the driven equipment angular displacement that driven equipment reality is moved around the rotation of track center of arc within n-1 self study cycle that mark post driver element and driven driver element drive, θ B (n), θ Z1 (n)The driven equipment that drives for mark post driver element and driven driver element n the zero hour in self study cycle driven equipment the position, angle, ω C (n)Be the angular velocity command speed of n the synchronous operation that operational control unit the sends zero hour in self study cycle, K Z1maxFor driven driver element angular velocity drives parameter K Z1The maximum estimated value, ω cThe crane that sends for operational control unit rotates the order angular velocity that moves, H around the center of arc of arc-shaped rail 1Synchronous correction control parameter for driven driver element.
The synchronous deviation correction control system of self study of the present invention and method, make constantly each the driver element the unknown of on-line automatic study of synchronous deviation correcting device, time dependent driving mechanism parameter, and the driving mechanism parameter that institute's self study obtains is used for revising the control parameter of synchronous deviation correcting device.In the synchronous deviation correction control system of multi-drive, can select that wherein any one driver element is as the mark post driver element, remaining driver element is as driven driver element.Distance and the real time position of the operation that obtains according to mark post driver element and each driven driver element on-line measurement, the driving parameter of on-line automatic study driver element, constantly adjust respectively the control parameter of each driven driver element, while is according to the position deviation amount of mark post driver element and driven driver element, adjust the correction controlled quentity controlled variable of driven driver element, make all driven driver elements always with the synchronous operation of mark post driver element.Synchronous deviation correcting device with self-learning function can be realized more stable, more accurate synchronous correction control.
Description of drawings
Fig. 1 is the system architecture synoptic diagram of the embodiment of the invention;
Fig. 2 is the overhead and gantry cranes synchronous operation synoptic diagram of rectilinear orbit operation;
Fig. 3 is the overhead and gantry cranes synchronous operation synoptic diagram that moves on the arc orbit.
Embodiment
Take the synchronous deviation correction control system of crane as example illustrates the synchronous deviation correction control system of self study of the present invention.The synchronous deviation correction control system of self study comprises operational control unit, this operational control unit control linkage has synchronous deviation correcting device, this synchronous deviation correcting device control linkage has at least two driver elements, each driver element drives respectively and connects corresponding driven equipment, be respectively equipped with position detector on each driven equipment, the signal output part of position detector is connected with described synchronous deviation correcting device, and this synchronous deviation correcting device is for the synchronous operation command speed of sending according to operational control unit, the positional information of the driven equipment of position detector feedback is sent the synchronous operation speed command to each driver element.Driver element is a mark post driver element and m driven driver element, and wherein m 〉=1 is positive integer.Driver element can be for the operation driver element that hoists of the dolly level run driver element of the operation driver element that hoists of the level run driver element of many each dollies of small car hoist, many each dollies of small car hoist, each crane of a lot of heavy-duty machine system, each crane of a lot of heavy-duty machine system, each crane level run driver element of a lot of heavy-duty machine system, crane both ends horizontal operation driver element or along the level run driver element of parallel orbit operation.
Rectify a deviation the synchronously step of control method of self study is as follows:
(1) make up the synchronous deviation correction control system of self study, this system comprises a mark post driver element and m driven driver element, and wherein m 〉=1 is positive integer; Driver element satisfies drive characteristic
V b=K bV cb
V zi=K ziV czi,1≤i≤m
V wherein bAnd V Zi, 1≤i≤m is respectively the travelling speed of mark post driver element and driven driver element, V CbAnd V Czi, 1≤i≤m is respectively the action command speed that synchronous deviation correcting device sends to mark post driver element and driven driver element, K bAnd K Zi, 1≤i≤m is respectively the actual driving parameter of mark post driver element and driven driver element.Do not lose its generality, suppose that here the design and operation speed of each driver element equals its command speed, namely the design driven parameter of each driver element is 1.Its actual driving parameter K bAnd K Zi, 1≤i≤m, value be unknown number close to design load 1, and temporal evolution.
(2) set the self study cycle T, operational control unit sends the command speed V of synchronous operation c
(3) in a self study cycle T, the command speed V of the synchronously deviation correcting device synchronous operation of sending according to operational control unit cWith the positional information of each driven equipment of position detector feedback, determine the synchronous correction control Parameter H of each driven driver element via online self study i, 1≤i≤m;
(4) deviation correcting device sends action command speed to each driver element synchronously, and the action command speed that wherein sends to the mark post driver element is V Cb=V c, the action command speed that sends to each driven driver element is V Czi=H iV c, 1≤i≤m realizes that the self study of driven driver element is rectified a deviation synchronously.
In above-mentioned steps was described, we had used subscript c to represent speed command, and subscript b represents the mark post driver element, and subscript z represents driven driver element, and numeric suffix i represents i driven driver element.
We during with double trolley crane lifting load horizontal synchronization operate to example this self study control method of rectifying a deviation synchronously be described.We have two dollies and two driver elements in this example, and one of them is the mark post driver element, another driven driver element, i.e. m=1.
As shown in Figure 1, when crane lifted operation, the dolly driver element 7 of establishing dolly 1 was the mark post driver element, and the dolly driver element 8 of dolly 2 is (first) driven driver element, and dolly 1 and dolly 2 are the unit of drive and independent operating.The position detection device 3 and the 4(that are installed in respectively on the dolly can be comprised of scrambler) detect the position P of dolly 1 bPosition P with dolly 2 Z1Allow each dolly at separately initial initial point, suppose dolly when initial initial point, two little truck positions are synchronous, and namely alternate position spike is zero.The position P of dolly 1 bPosition P with dolly 2 Z1Be transferred to synchronous deviation correcting device 5.Synchronously deviation correcting device 5 can be by Programmable Logic Controller (PLC), or other equipment with computing function form.Operational control unit 6 sends the command speed V of two dolly synchronous operations for synchronous deviation correcting device 5 c Deviation correcting device 5 is with the position P of dolly 1 synchronously bPosition P with dolly 2 Z1And V cAs input, utilize control method of the present invention, calculate the action command speed V of dolly 1 and dolly 2 CbAnd V Cz1, and with action command speed V CbAnd V Cz1, be transferred to respectively the driver element 7 and 8 of dolly 1 and dolly 2.The driver element of dolly can be formed with mechanical part by frequency converter and motor etc. are electric.Two dollies are moved by drive unit drives respectively.Load 10 is lifted on two dollies by hoist cable 11 among Fig. 1, and two dollies run on the trolley track 9 according to control command.
In the working control operational process, because of the different of the difference of each trolley driving mechanism and environmental factor with change, two identical dolly order travelling speed also may cause the actual motion speed of dolly that deviation is arranged, and cause the deviation of two little truck positions.For realizing the synchronous correction control to dolly, controller sends synchronous operation command speed V to mark post driver element dolly 1 c, and give 2 one in driven driver element dolly proportional, but be different from synchronous operation command speed V cCommand speed, that is:
V cb=V c (1)
V cz1=H 1V c (2)
Formula V CbBe the action command speed of controller to mark post driver element 7 and dolly 1, V Cz1Be the action command speed that controller 5 sends for (first) driven driver element 8 and dolly 2, V cBe the command speed of dolly synchronous operation, H 1Be the synchronous correction control parameter of controller 5 for (first) driven driver element dolly 2.Below describe synchronously correction control Parameter H in detail 1Computing method.
Allow K bBe the actual motion speed of dolly 1 and the ratio of synchronously correction control to the order travelling speed of mark post driver element 7, K Z1Be the actual motion speed of dolly 2 and the ratio of synchronously correction control to the order travelling speed of mark post driver element 7, namely
V b=K bV cb=K bV c (3)
V z1=K z1V cz1=K z1H 1V c (4)
Do not lose its ubiquity, we suppose that driver element 7 and 8 is designed to identical system when actual Driving Scheme, and allow the design and operation speed of dolly 1 and dolly 2 equal the command speed of each driver element, that is, and and K bAnd K Z1Design load be 1.Therefore, the driving parameter K of driver element bAnd K Z1Be two close to 1 coefficient.Because of in real system, parameter K bAnd K Z1Be unknown, also change, so we need controller 5 ceaselessly to learn online the parameters of driver element, and and then to the drived unit control of rectifying a deviation synchronously.
Allow the driving parameter K of driver element bAnd K Z1Ratio be R 1, namely
R 1 = K b K z 1 - - - ( 5 )
Deviation correcting device is to R synchronously 1Carry out periodic online self study and estimation.We use L 1Represent that synchronous deviation correcting device is to R 1Carry out the estimated value that self study obtains.The cycle T of self study can be according to the driving parameter K of driver element bAnd K Z1The speed degree that changes and the accuracy requirement of synchronous correction control determined.Allow L 1Initial value L 1 (0), i.e. R 1Initial best estimate is R 1Design load.Because of K bAnd K Z1Design load be 1, according to formula (5) L 1Initial value L 1 (0)Elect 1 as.
The synchronous deviation correcting device of self study has two control targets:
(1) self study synchro control: in each self study cycle, according to the distance of two dollies actual motion in the self study cycle in the past, upgrade calculating parameter R 1Best estimate L 1
(2) correction control: in each self study cycle, if the location, position of two dollies is poor, within a self study cycle, eliminate most possibly known dolly alternate position spike.
The self study synchro control:
The principle of for convenience of description self study synchro control, we do not consider first correction control, and hypothesis is in original state two dollies location deviation not.If D bAnd D Z1Be respectively the distance of dolly 1 and dolly 2 actual motion in the cycle T of a self study.Obviously, D bAnd D Z1Can be easily from dolly position P bAnd P Z1Variation in calculate.Suppose the driving parameter K of two driver elements bAnd K Z1Variation in a very short self study cycle T can be ignored, to the actual motion speed V of two dollies in formula (3) and (4) bAnd V Z1Carry out carrying out two formulas behind the integration again and be divided by, we have
D b D z 1 = K b K z 1 H 1 = R 1 H 1 - - - ( 6 a )
R 1 = H 1 D b D z 1 - - - ( 6 b )
We represent the current self study cycle with subscript (n), subscript (n-1) the previous self study cycle of expression.Be L 1 (n)Represent that the current self study cycle is to R 1Estimated value, L 1 (n-1)Represent that the previous self study cycle is to R 1Estimated value.If only consider dolly 1 and dolly 2 range ability D in the previous self study cycle B (n-1)And D Z1 (n-1), so in the current self study cycle, to R 1Estimated value be
L 1 ( n ) * = H 1 ( n - 1 ) D b ( n - 1 ) D z 1 ( n - 1 ) - - - ( 7 )
H in the following formula 1 (n-1)Be previous self study cycle synchronisation correction control Parameter H 1Value.According to stochastic variable Kalman Kalman filtering loop iteration optimum estimate principle, we utilize R 1The estimated value L in previous self study cycle 1 (n-1)And following formula (7) provides
Figure BDA00002243172600082
To R 1Carry out optimum estimate.Allow weighting coefficient a 11And a 12, 0<a 11<1,0<a 12<1, satisfy
a 11+a 12=1 (8)
We get the current self study cycle to R 1Best estimate be
L 1 ( n ) = a 11 L 1 ( n - 1 ) + a 12 L 1 ( n ) * - - - ( 9 )
Weighting coefficient a 11And a 12Can determine according to following formula.
a 11 = σ 1 * σ 1 + σ 1 * - - - ( 10 a )
a 12 = σ 1 σ 1 + σ 1 * - - - ( 10 b )
Constant in the following formula
Figure BDA00002243172600086
Right
Figure BDA00002243172600087
The maximum error estimated value, constant σ 1To L 1 (n-1)The maximum error estimated value.
Suppose R 1Self study estimated value L 1 (n)There is not error with actual value, i.e. L 1 (n)=R 1, so, if allow synchronous correction control Parameter H 1=L 1 (n)From formula (3), (4) and (5) can get V Z1=V bThis formula shows that two dollies have reached the Complete Synchronization operation.In the Complete Synchronization operational process, two dollies do not produce alternate position spike.
Correction control:
Owing to affected by environment and measuring error etc., two dollies can not move by absolute Complete Synchronization, thereby always might produce certain alternate position spike.We carry out positional deviation correction with the mode of FEEDBACK CONTROL on the basis of self study synchro control.
Allow P B (n), P Z1 (n), and V C (n)Be illustrated respectively in current zero hour in self study cycle of dolly 1 position, the position of dolly 2, and the command speed of dolly synchronous operation.Allow E (n)The alternate position spike that represents two dollies, that is,
E (n)=P b(n)-P z1(n) (11)
We allow synchronous correction control parameter
H 1(n)=L 1(n)+K e(n)E (n) (12)
In the following formula and K E (n)Be the correction feedback control parameters.Allow
K e ( n ) = 1 K z 1 max V c ( n ) T - - - ( 13 )
K in the following formula ZlmaxBe the maximum estimated value of parameter K z1, T is the self study cycle.Formula (7)-(13) have provided following synchronous correction control Parameter H 1Complete self study loop iteration computing method
L 1 ( n ) = a 11 L 1 ( n - 1 ) + a 12 H 1 ( n - 1 ) D b ( n - 1 ) D z 1 ( n - 1 ) - - - ( 14 a )
H 1 ( n ) = L 1 ( n ) + P b ( n ) - P z 1 ( n ) K z 1 max V c ( n ) T - - - ( 14 b )
Because adopt the loop iteration algorithm, the above control method of rectifying a deviation does not synchronously need store historical data.It only uses moving of car measurement data and the control parameter in previous and current self study cycle.It is constantly to parameters R 1Carry out online self study and obtain estimated value L 1 (n), and through type (1) and formula (2) adjust the action command speed to dolly, eliminates the alternate position spike of dolly, makes two dollies keep synchronous operation.
Correction control principle for the control method of rectifying a deviation synchronously shown in the formula (14) is analyzed as follows:
Suppose when the current self study cycle begins the poor E in two dolly locations (n)=P B (n)-P Z1 (n)We can reasonably suppose the command speed V of dolly synchronous operation cVariation in a very short self study cycle T is very little, and since the synchronously online self study of deviation correcting device, R 1Estimated value L 1 (n)With actual value R 1Error is very little, namely
V c≈V c(n) (15a)
L 1(n)≈R 1 (15b)
Utilize formula (3), (4), (5), (14) and (15), the alternate position spike of two dollies was when we can obtain current self study end cycle
E ( n + 1 ) = ( P b ( n ) + ∫ t n t n + T K b V c dt ) - ( P z 1 ( n ) + ∫ t n t n + T K z 1 ( L 1 ( n ) + P b ( n ) - P z 1 ( n ) K z 1 max V c ( n ) T ) V c dt )
= E ( n ) ( 1 - 1 K z 1 max V c ( n ) T ∫ t n t n + T K z 1 V c dt ) + ∫ t n t n + T ( K b - K z 1 L 1 ( n ) ) V c dt - - - ( 16 )
≈ E ( n ) ( K z 1 max - K ~ z 1 ( n ) K z 1 max )
T in the following formula nBe the zero hour in current self study cycle, K ZlmaxBe parameter K Z1The maximum estimated value, Be K Z1Mean value within the current self study cycle.Following formula shows that within each self study cycle, the alternate position spike of two dollies is reduced to original Doubly.Because, as previously mentioned, the driving parameter K of driver element Z1Design load is 1.For most Practical Project system, the actual value of this parameter is a very little number with the difference of design load, therefore
Figure BDA00002243172600106
It is the number much smaller than 1.Thus explanation, control method of the present invention has realized the target that self study is rectified a deviation synchronously and controlled.
When there being a plurality of dollies to carry out level when lifting load, we have a mark post driver element and a plurality of driven driver element, i.e. m〉1, above computing method are applicable equally.
The above self study control method of rectifying a deviation synchronously can be applicable in the synchronous correction control control of the operation that hoists when crane has a plurality of dollies to lift load equally.
The above self study control method of rectifying a deviation synchronously can be applicable to the synchronous correction control of many cranes (cart) when lifting load equally.Many cranes (cart) are when lifting load, need to carry out the same self study control of rectifying a deviation synchronously to the cart of many cranes and dolly.
The above self study control method of rectifying a deviation synchronously is applicable to the synchronous correction motion control of large span overhead and gantry cranes two side drives too.For the overhead and gantry cranes of walking at common rectilinear orbit, as shown in Figure 2,21 expression dollies, 22 expression crane rectilinear orbits, its control target is the travelling speed V that makes crane both sides driver element bAnd V Z1, and the position P of both sides driver element bAnd P Z1, keep synchronously, crane is kept along the smooth linear running of track, do not produce the generation of gnawing the rail phenomenon.
When crane runway is arc-shaped rail, driver element is the level run driver element along the arc-shaped rail operation, overhead and gantry cranes for turning operation on arc-shaped rail, as shown in Figure 3, need crane to keep centering on the center rotating of track circular arc when operation, 31 represent dollies among the figure, 32 expression loading bridges, arc orbit in 33 expressions, 34 expression external arc tracks, the center of arc of 35 expression tracks.The driver element of crane both sides is independently controlled orbital motion.Utilize the above self study control method of rectifying a deviation synchronously, similarly can control the both sides driver element, make the angular velocity omega that rotates two driver elements around track center of arc bAnd ω Z1, angular displacement δ bAnd δ Z1, and position, angle θ bAnd θ Z1, keep synchronously, make crane keep rotating smoothly around the center of arc of track.Rectify a deviation the synchronously computing formula of control method of its self study is similar with the linear running crane, and difference only is to replace space rate with angular velocity, and straight-line displacement is replaced in angular displacement, and linear position is replaced in the position, angle.The self study of the crane that moves at the arc-shaped rail control computing method of rectifying a deviation synchronously are shown below:
L 1 ( n ) = a 11 L 1 ( n - 1 ) + a 12 H 1 ( n - 1 ) δ b ( n - 1 ) δ z 1 ( n - 1 ) - - - ( 17 a )
H 1 ( n ) = L 1 ( n ) + θ b ( n ) - θ z 1 ( n ) K z 1 max ω c ( n ) T - - - ( 17 b )
ω cbc (17c)
ω cz1=H 1ω c (17d)
In following formula, we have utilized same identifier convention, and the implication of each identifier is repeated no more.

Claims (6)

1. synchronous deviation correction control system of self study, it is characterized in that, this system comprises operational control unit, this operational control unit control linkage has synchronous deviation correcting device, this synchronous deviation correcting device control linkage has at least two driver elements, each driver element drives respectively and connects corresponding driven equipment, be respectively equipped with position detector on each driven equipment, the signal output part of position detector is connected with described synchronous deviation correcting device, and this synchronous deviation correcting device is for the synchronous operation command speed of sending according to operational control unit, the positional information of the driven equipment of position detector feedback is sent the synchronous operation speed command to each driver element.
2. system according to claim 1 is characterized in that: described driver element is a mark post driver element and m driven driver element, and wherein m 〉=1 is positive integer.
3. self study control method of rectifying a deviation synchronously is characterized in that the step of the method is as follows:
(1) make up the synchronous deviation correction control system of self study, this system comprises a mark post driver element and m driven driver element, and wherein m 〉=1 is positive integer;
(2) set the self study cycle T, operational control unit sends the command speed V of synchronous operation c
(3) in a self study cycle T, the command speed V of the synchronously deviation correcting device synchronous operation of sending according to operational control unit cWith the positional information of each driven equipment of position detector feedback, determine the synchronous correction control Parameter H of each driven driver element via online self study i, 1≤i≤m;
(4) deviation correcting device sends action command speed to each driver element synchronously, and the action command speed that wherein sends to the mark post driver element is V Cb=V c, the action command speed that sends to each driven driver element is V Czi=H iV c, 1≤i≤m realizes driven driver element self study rectify a deviation synchronously control, wherein V bAnd V Zi, be respectively the travelling speed of mark post driver element and driven driver element, V CbAnd V Czi
4. method according to claim 3 is characterized in that: the self study cycle T is according to mark post drive unit drives parameter K in described step (2) and (3) bWith driven drive unit drives parameter K Zi(the speed degree of the variation of 1≤i≤m) and the accuracy requirement of synchronous correction control determined.
5. it is characterized in that according to claim 3 or 4 described methods: synchronously correction control Parameter H in described step (3) and (4) i, 1≤i≤m is obtained by following self study loop iteration computing method
L i ( n ) = a i 1 L i ( n - 1 ) + a i 2 H i ( n - 1 ) D b ( n - 1 ) D zi ( n - 1 )
H i ( n ) = L i ( n ) + P b ( n ) - P zi ( n ) K zi max V c ( n ) T
A wherein I1, a I2Be weighting coefficient, subscript (n) n self study cycle of expression, subscript (n-1) n-1 self study cycle of expression, H I (n-1)The value that represents n-1 self study cycle synchronisation correction control parameter, H I (n)Initial value H I (0)Be 1, L I (n-1)Represent that n-1 self study cycle is to mark post drive unit drives parameter K bWith i driven drive unit drives parameter K ZiRatio The self study estimated value, L I (n)Initial value L I (0)Be 1, D B (n-1), D Zi (n-1)Be respectively the distance of driven equipment driven equipment actual motion within n-1 self study cycle that mark post driver element and i driven driver element drives, P B (n), P Zi (n)The driven equipment that drives for mark post driver element and i driven driver element n the zero hour in self study cycle driven equipment the position, V C (n)Be the command speed of n the synchronous operation that operational control unit the sends zero hour in self study cycle, K ZimaxBe i driven drive unit drives parameter K ZiThe maximum estimated value.
6. method according to claim 5, it is characterized in that: when crane runway is arc-shaped rail, described driver element is the level run driver element along the arc-shaped rail operation, mark post driver element, driven driver element respectively are 1, and two drived units rotate around track center of arc, and its angular velocity is respectively ω bAnd ω Z1, angular displacement δ bAnd δ Z1, and position, angle θ bAnd θ Z1, deviation correcting device is respectively ω to the angular velocity action command of mark post driver element and driven driver element synchronously CbAnd ω Cz1, and obtained by following loop iteration formula:
L 1 ( n ) = a 11 L 1 ( n - 1 ) + a 12 H 1 ( n - 1 ) δ b ( n - 1 ) δ z 1 ( n - 1 )
H 1 ( n ) = L 1 ( n ) + θ b ( n ) - θ z 1 ( n ) K z 1 max ω c ( n ) T
ω cb=ω c
ω cz1=H 1ω c
A wherein 11, a 12Be weighting coefficient, subscript (n) n self study cycle of expression, subscript (n-1) n-1 self study cycle of expression, H 1 (n-1)The value that represents n-1 self study cycle synchronisation correction control parameter, H 1 (n)Initial value H 1 (0)Be 1, L 1 (n-1)Represent that n-1 self study cycle drives parameter K to mark post driver element angular velocity bDrive parameter K with driven driver element angular velocity Z1Ratio
Figure FDA00002243172500031
The self study estimated value, L 1 (n)Initial value L 1 (0)Be 1, δ B (n-1), δ Z1 (n-1)Be respectively the driven equipment angular displacement that driven equipment reality is moved around the rotation of track center of arc within n-1 self study cycle that mark post driver element and driven driver element drive, θ B (n), θ Z1 (n)The driven equipment that drives for mark post driver element and driven driver element n the zero hour in self study cycle driven equipment the position, angle, ω C (n)Be the angular velocity command speed of n the synchronous operation that operational control unit the sends zero hour in self study cycle, K Z1maxFor driven driver element angular velocity drives parameter K Z1The maximum estimated value, ω cThe crane that sends for operational control unit rotates the order angular velocity that moves, H around the center of arc of arc-shaped rail 1Synchronous correction control parameter for driven driver element.
CN201210385357.7A 2012-10-11 2012-10-11 Self-learning synchronous corrosion control system and method Active CN102914968B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210385357.7A CN102914968B (en) 2012-10-11 2012-10-11 Self-learning synchronous corrosion control system and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210385357.7A CN102914968B (en) 2012-10-11 2012-10-11 Self-learning synchronous corrosion control system and method

Publications (2)

Publication Number Publication Date
CN102914968A true CN102914968A (en) 2013-02-06
CN102914968B CN102914968B (en) 2015-01-07

Family

ID=47613381

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210385357.7A Active CN102914968B (en) 2012-10-11 2012-10-11 Self-learning synchronous corrosion control system and method

Country Status (1)

Country Link
CN (1) CN102914968B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105776027A (en) * 2016-05-12 2016-07-20 中南大学 Deviation rectification control method and system for car of bridge crane in walking process

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1439440A2 (en) * 2003-01-20 2004-07-21 Fanuc Ltd Servo motor drive control device
JP2007042068A (en) * 2005-07-08 2007-02-15 Fanuc Ltd Servo controller
CN101261509A (en) * 2007-03-08 2008-09-10 发那科株式会社 Servo controller
CN101349910A (en) * 2008-08-29 2009-01-21 华中科技大学 Numerical control machine tool double-shaft synchronization controller
CN102701080A (en) * 2012-05-07 2012-10-03 河南省矿山起重机有限公司 Automatic correction device for crane

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1439440A2 (en) * 2003-01-20 2004-07-21 Fanuc Ltd Servo motor drive control device
JP2007042068A (en) * 2005-07-08 2007-02-15 Fanuc Ltd Servo controller
CN101261509A (en) * 2007-03-08 2008-09-10 发那科株式会社 Servo controller
CN101349910A (en) * 2008-08-29 2009-01-21 华中科技大学 Numerical control machine tool double-shaft synchronization controller
CN102701080A (en) * 2012-05-07 2012-10-03 河南省矿山起重机有限公司 Automatic correction device for crane

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
孙宜标 等: ""龙门加工中心的模糊自学习交叉耦合补偿控制"", 《沈阳工业大学学报》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105776027A (en) * 2016-05-12 2016-07-20 中南大学 Deviation rectification control method and system for car of bridge crane in walking process

Also Published As

Publication number Publication date
CN102914968B (en) 2015-01-07

Similar Documents

Publication Publication Date Title
CN102145808B (en) Industrial laser guidance AGV double-closed-loop control system and control method thereof
CN110989526A (en) double-AGV cooperative carrying control system and method
CN201993646U (en) Double closed loop control system of industrial laser guidance AGV (Automatic Guided Vehicle)
CN106708061B (en) A kind of collaboration of greenhouse movable job platform follows operation air navigation aid and device
CN103048996A (en) Automatic guided vehicle based on laser scanning distance meter, and system and navigation method of automatic guided vehicle
CN106708027A (en) On-line graphical real-time navigation and control system of unmanned navigation intelligent electric flat vehicle
CN103760908A (en) Inspecting device closed loop tracking control method
CN105479460A (en) Non-time reference differential drive robot path tracking control method
CN103235594B (en) Computing method of traction position correction of traction control system
CN107065562A (en) A kind of anti-interference synchronization sliding-mode control of series parallel type automobile electrophoretic coating conveyor structure
CN105892459A (en) Non-time-based differential drive robot set-point tracking control method
CN110103998A (en) Asymmetric four steering wheels AGV is turned to and the control method of translational motion
CN105068543A (en) Piggyback-type AGV two wheel synchronization method based on PID control
CN115525051A (en) Shuttle vehicle walking positioning control method based on encoder self-correction
CN103046468B (en) Control circuit, detection device and control method for steel box girder detection car orbital transfer operation
CN203164695U (en) Control circuit and detection device for steel box beam inspection vehicle track change running
CN102914968B (en) Self-learning synchronous corrosion control system and method
CN102234076B (en) Electrical control device for crawler-type counter weight trolley and control method thereof
CN201258021Y (en) Electron differential speed system of straddle carrier
CN106143263A (en) Driving control system and container and/or vehicle inspection carry car
CN101976083A (en) Multi-motor positioning cooperation control system of four-axis driving electric trolley
CN102079481A (en) Dual-hoisting dual-hanger yard crane control system as well as control method thereof
CN104932553A (en) Position control system based on steel wire rope driving
CN208488672U (en) Traveling control system and carrying closed-loop control system
RU2605233C1 (en) Method for automated control of asynchronous electric drive of movement with correction of transverse displacement

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant