CN108319136A - A kind of tether tension control method based on model prediction - Google Patents
A kind of tether tension control method based on model prediction Download PDFInfo
- Publication number
- CN108319136A CN108319136A CN201810047019.XA CN201810047019A CN108319136A CN 108319136 A CN108319136 A CN 108319136A CN 201810047019 A CN201810047019 A CN 201810047019A CN 108319136 A CN108319136 A CN 108319136A
- Authority
- CN
- China
- Prior art keywords
- tether
- tension
- model
- establishing
- order
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 239000010813 municipal solid waste Substances 0.000 claims abstract description 10
- 238000005259 measurement Methods 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 6
- 238000012546 transfer Methods 0.000 claims description 5
- 238000013016 damping Methods 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 3
- 238000013461 design Methods 0.000 abstract description 3
- 238000009415 formwork Methods 0.000 abstract 1
- 230000015572 biosynthetic process Effects 0.000 description 2
- 239000002699 waste material Substances 0.000 description 2
- 101000606504 Drosophila melanogaster Tyrosine-protein kinase-like otk Proteins 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Classifications
-
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
The present invention relates to a kind of, and the tether tension control method based on model prediction establishes assembly dynamics of orbits model first.Secondly, the unknown quality identifier of captured track rubbish is established using least square method of recursion.Then, it establishes based on the super relative motion state observer for turning round sliding formwork.Finally, design a model prediction tension controller.The present invention has the advantages that following:One, unknown mass parameter and unobservable quantity of state are considered, practicability is had more compared with existing controller;Two, using Model Predictive Control, this method can under the conditions of executing agency is controlled by tension stability in the ideal range.
Description
Technical Field
The invention belongs to the research of maneuvering orbital transfer of a tethered spacecraft, and relates to a tethered tension control method based on model prediction.
Background
The use of space tethered robots for orbital trash removal by towing has received attention for their high flexibility and safety.
Before removal is carried out, the space mobile platform releases the rope robot to approach and catch the rail rubbish. After the catching is finished, the space mobile platform and the target body are connected into a combination body with the rigidity and flexibility through a tether. In subsequent drag transfers, tether tension has a significant effect on the formation configuration of the combination. If the tension is unstable, such as large amplitude oscillation or even slack, the captured track trash and the tether can be entangled. This winding, in turn, exacerbates the instability in tether tension, pulling the two end spacecraft toward each other, resulting in a collision. Therefore, how to efficiently stabilize tether tension is critical to maintaining formation flight.
For this reason, scholars at home and abroad have proposed a number of strategies in terms of tether tension stabilization, such as: the swinging characteristic and the stability control of a space tether dragging system published in the journal of Beijing university of aerospace are combined with tether tension compound control by using a position-retaining and damping control to eliminate the swinging of a target body and keep the relative distance between satellites. In the publication "Twist application method of thermal stroke for training space deployment" of ASCE-journal of Aerospace Engineering, impedance control is used to stabilize the tether tension. However, none of their strategies takes into account the problem of actuator saturation. With existing tension control strategies, the reel used to unwind and unwind the tether is an effective and commonly used tension control actuator. In each control cycle, the reel should unwind and unwind the tether within a certain range. However, once such a tether take-up and pay-off constraint is added to existing tension controllers, the tether tension will be unstable to varying degrees.
Disclosure of Invention
Technical problem to be solved
In order to avoid the defects of the prior art, the invention provides a tether tension control method based on model prediction, which can stabilize tension in tether retraction constraint and release and does not influence the design of a platform track, so that the method has higher practicability.
Technical scheme
A tether tension control method based on model prediction is characterized by comprising the following steps:
step 1, establishing a dynamic model of an assembly orbit:
the platform mass center orbital plane internal transfer dynamic model:
wherein r is the distance between the platform centroid and the geocentric, α is the true peripherial angle of the platform centroid, mu is the gravity constant of the earth, and m is1the mass of the platform, F is the thrust of the platform along the local horizontal line, T is the tension of the tether, β is the inner angle of the orbital plane of the tether and is defined as the included angle between the orbital plane of the tether and the local horizontal line;
relative dynamics model of two-end spacecraft:
whereinD is the centroid distance of the spacecraft at both ends, m2Is the track trash quality;
step 2, establishing an unknown track garbage quality identifier:
let in the relative dynamics modelThe rope tension after being released is as follows:
where U (k) is the tension measurement, k is the iteration order,is an estimated value of the quality of the rail refuse,andrespectively, the in-plane angular velocity and the in-plane angle estimate from a state observer. And (3) establishing an iterative relationship among U (k), Y (k) and theta (k) by using a recursive least square method:
where k is the order of iteration and λ is a forgetting factor, usually taking a constant close to 1
Step 3, establishing a nonlinear full-dimensional state observer:
order toFor the true state of the relative kinetic model,in order to be an estimate of the state X,in order to estimate errors, a nonlinear full-dimensional state observer is established by utilizing an overtorque sliding mode:
wherein,
wherein δ is a1f+,γ=a2(f+)1/2,a1And a2Is a normal number around 1. f. of+Is a deviation of the modelThe supremum limit of (a) is,
step 4, establishing a nonlinear model predictive controller:
discretizing the relative dynamic model of the two-end spacecraft in the step 1 by using first-order difference
Where Δ τ is the sampling time and i is the sampling order;
establishing a tension model of a tether:
where EA is the tether stiffness coefficient,/0Is the length of the undeformed tether, ctIs the damping coefficient of the tether, and delta l (i) is the retraction length of the tether in the current control;
defining a desired tether tension command:
defining a performance indicator function:
wherein Q and R are weight coefficients,the tether take-up and pay-off rate, N is the predicted step number;
designing system constraints:
model predictive controller utilizing tether tension command TrefTension measurement value U (k), state estimation valueAnd a quality estimateAs input to the controller, an optimal tether take-up and pay-off rate is generated, which is integrated with the initial length l of the tether when the tether is undeformed0Adding to obtain the actual length of the undeformed rope to act on the system, and finishing the whole control process.
Advantageous effects
The invention provides a tether tension control method based on model prediction. Secondly, establishing an unknown quality identifier of the captured rail waste by using a recursive least square method. Then, a relative motion state observer based on the overtorque sliding mode is established. Finally, a model predictive tension controller is designed.
The invention has the following advantages: the method has the advantages that firstly, unknown quality parameters and unobservable state quantities are considered, and the method is more practical compared with the existing controller; and secondly, by adopting model predictive control, the method can stabilize the tension in an ideal range under the condition that an actuating mechanism is constrained.
Drawings
FIG. 1: model prediction tension controller structure diagram
Detailed Description
The invention will now be further described with reference to the following examples and drawings:
a spatial tether tension model prediction control method is characterized by comprising the following steps:
step 1, establishing a dynamic model of an assembly orbit:
A. platform mass center orbital plane internal transfer dynamic model
wherein r is the distance between the platform centroid and the geocentric, α is the true peripherial angle of the platform centroid, mu is the gravity constant of the earth, and m is1Is the platform mass, F is the thrust of the platform along the local horizontal line, T is the tether tensionand small, β is the inner angle of the tether orbital plane and is defined as the angle with the local horizontal line.
B. Relative dynamics model of two-end spacecraft
Wherein d is the centroid distance of the spacecraft at the two ends, m2Is the track trash quality.
Step 2, establishing an unknown track garbage quality identifier
Let in the relative dynamics modelCan release the tension of the tether to
Where U (k) is the tension measurement, k is the iteration order,is an estimated value of the quality of the rail refuse,andrespectively, the in-plane angular velocity and the in-plane angle estimate from a state observer. And (3) establishing an iterative relationship among U (k), Y (k) and theta (k) by using a recursive least square method:
where λ is a forgetting factor, and usually takes a constant close to 1.
Step 3, establishing a nonlinear full-dimensional state observer
Order toFor the true state of the relative kinetic model,in order to be an estimate of the state X,to estimate the error. The following state observer was built using the overtorque sliding mode.
Wherein,
wherein δ is a1f+,γ=a2(f+)1/2,a1And a2Is a normal number around 1. f. of+Is a deviation of the modelThe supremum limit of (a) is,
step 4, establishing a nonlinear model predictive controller
First, the B model in step 1 is discretized using a first order difference.
Where Δ τ is the sampling time and i is the sampling order.
Secondly, a tension model is established
Where EA is the tether stiffness coefficient,/0Is the length of the undeformed tether, ctIs the tether damping coefficient, and Δ l (i) is the tether take-up and pay-off length at this time of control. The desired tether tension command is defined as follows:
then, the performance indicator function is defined as follows:
wherein Q and R are weight coefficients,for tether take-up and pay-off rates, N is the predicted number of steps.
Finally, the design system constraints are as follows:
the control flow is shown in fig. 1.First, the position sensor measures the coordinates [ x, y ] of the rail refuse in the rail plane relative to the platform]TAnd the tension sensor measures the tension of the tether. Secondly, the state observer is based on the position coordinates andestimating speed information of off-track spamWhereinThe quality identifier estimates information according to the stateAnd identifying the estimated quality of the rail waste by using the tether tension measurement value. Then, the model predictive controller utilizes the tension instruction, the tension measured value, the state estimated value and the quality estimated value to generate the optimal tether retraction rate, and the rate is integrated with the initial length l of the undeformed tether0Adding to obtain the actual length of the undeformed rope to act on the system, and finishing the whole control process.
Claims (1)
1. A tether tension control method based on model prediction is characterized by comprising the following steps:
step 1, establishing a dynamic model of an assembly orbit:
the platform mass center orbital plane internal transfer dynamic model:
wherein r is the distance between the platform centroid and the geocentric, α is the true peripherial angle of the platform centroid, mu is the gravity constant of the earth, and m is1the mass of the platform, F is the thrust of the platform along the local horizontal line, T is the tension of the tether, β is the inner angle of the orbital plane of the tether and is defined as the included angle between the orbital plane of the tether and the local horizontal line;
relative dynamics model of two-end spacecraft:
wherein d is the centroid distance of the spacecraft at the two ends, m2Is the track trash quality;
step 2, establishing an unknown track garbage quality identifier:
let in the relative dynamics modelThe rope tension after being released is as follows:
where U (k) is the tension measurement, k is the iteration order,is an estimated value of the quality of the rail refuse,andrespectively, the in-plane angular velocity and the in-plane angle estimate from a state observer. And (3) establishing an iterative relationship among U (k), Y (k) and theta (k) by using a recursive least square method:
where k is the order of iteration and λ is a forgetting factor, usually taking a constant close to 1
Step 3, establishing a nonlinear full-dimensional state observer:
order toFor the true state of the relative kinetic model,in order to be an estimate of the state X,in order to estimate errors, a nonlinear full-dimensional state observer is established by utilizing an overtorque sliding mode:
wherein,
wherein δ is a1f+,γ=a2(f+)1/2,a1And a2Is a normal number around 1. f. of+Is a deviation of the modelThe supremum limit of (a) is,
step 4, establishing a nonlinear model predictive controller:
discretizing the relative dynamic model of the two-end spacecraft in the step 1 by using first-order difference
Where Δ τ is the sampling time and i is the sampling order;
establishing a tension model of a tether:
where EA is the tether stiffness coefficient,/0Is the length of the undeformed tether, ctIs the damping coefficient of the tether, and delta l (i) is the retraction length of the tether in the current control;
defining a desired tether tension command:
defining a performance indicator function:
wherein Q and R are weight coefficients,the tether take-up and pay-off rate, N is the predicted step number;
designing system constraints:
model predictive controller utilizing tether tension command TrefTension measurement value U (k), state estimation valueAnd a quality estimateAs an input to the controller, an optimal tether pay-off and take-up rate is generated, which is integrated with the initial undeformed tetherLength of rope l0Adding to obtain the actual length of the undeformed rope to act on the system, and finishing the whole control process.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810047019.XA CN108319136B (en) | 2018-01-18 | 2018-01-18 | Tether tension control method based on model prediction |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810047019.XA CN108319136B (en) | 2018-01-18 | 2018-01-18 | Tether tension control method based on model prediction |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108319136A true CN108319136A (en) | 2018-07-24 |
CN108319136B CN108319136B (en) | 2019-12-27 |
Family
ID=62894972
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810047019.XA Active CN108319136B (en) | 2018-01-18 | 2018-01-18 | Tether tension control method based on model prediction |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108319136B (en) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109189091A (en) * | 2018-07-25 | 2019-01-11 | 西北工业大学 | More spacecraft cooperative control methods based on Integral Sliding Mode and Model Predictive Control |
CN109613822A (en) * | 2018-11-27 | 2019-04-12 | 上海航天控制技术研究所 | Control method is unfolded in spatial tether system based on Nonlinear Model Predictive Control |
CN110007681A (en) * | 2018-11-28 | 2019-07-12 | 北京理工大学 | It is a kind of to realize that rope is formation spinning stability expansion optimization method using continuous propeller |
CN110174844A (en) * | 2019-07-03 | 2019-08-27 | 西北工业大学 | A kind of broad sense rank sliding mode predictive control method of remote control system |
CN112180944A (en) * | 2020-10-22 | 2021-01-05 | 南京航空航天大学 | Rope-tied wheel type mobile robot motion control system and method |
TWI826322B (en) * | 2023-05-18 | 2023-12-11 | 威綸科技股份有限公司 | Display apparatus having waterproof and dustproof structure |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4580747A (en) * | 1983-03-15 | 1986-04-08 | Jerome Pearson | Method and apparatus for orbital plane changing |
JPH0472000A (en) * | 1990-07-10 | 1992-03-06 | Takeshi Hatsuda | Geostationary optical fiber tether satellite system |
CN103955220A (en) * | 2014-04-30 | 2014-07-30 | 西北工业大学 | Coordination control method for tracking optimal track by space tied-rope robot |
CN104345738A (en) * | 2014-09-30 | 2015-02-11 | 中国运载火箭技术研究院 | Rope system releasing stable control method and electric force rope system off-tracking stable control method |
CN105700536A (en) * | 2016-01-21 | 2016-06-22 | 北京航空航天大学 | Active satellite attitude and tethered librational and vibrational combination control method based on tethered dragging system |
CN106774360A (en) * | 2016-11-24 | 2017-05-31 | 西北工业大学 | Using the target satellite attitude stabilization method of tether/connecting rod in a kind of towing change rail |
CN107065910A (en) * | 2017-04-24 | 2017-08-18 | 西北工业大学 | Space rope system capturing system keeps stage tether face inner face exterior angle stable control method |
CN107085374A (en) * | 2017-06-09 | 2017-08-22 | 北京航空航天大学 | It is the dragging targeted attitude stable control method of space towboat thrust regulation based on rope |
CN107194039A (en) * | 2017-04-26 | 2017-09-22 | 西北工业大学 | It is a kind of that control method is deployed based on the spatial flexible system for improving the pseudo- spectrometry of Gauss |
-
2018
- 2018-01-18 CN CN201810047019.XA patent/CN108319136B/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4580747A (en) * | 1983-03-15 | 1986-04-08 | Jerome Pearson | Method and apparatus for orbital plane changing |
JPH0472000A (en) * | 1990-07-10 | 1992-03-06 | Takeshi Hatsuda | Geostationary optical fiber tether satellite system |
CN103955220A (en) * | 2014-04-30 | 2014-07-30 | 西北工业大学 | Coordination control method for tracking optimal track by space tied-rope robot |
CN104345738A (en) * | 2014-09-30 | 2015-02-11 | 中国运载火箭技术研究院 | Rope system releasing stable control method and electric force rope system off-tracking stable control method |
CN105700536A (en) * | 2016-01-21 | 2016-06-22 | 北京航空航天大学 | Active satellite attitude and tethered librational and vibrational combination control method based on tethered dragging system |
CN106774360A (en) * | 2016-11-24 | 2017-05-31 | 西北工业大学 | Using the target satellite attitude stabilization method of tether/connecting rod in a kind of towing change rail |
CN107065910A (en) * | 2017-04-24 | 2017-08-18 | 西北工业大学 | Space rope system capturing system keeps stage tether face inner face exterior angle stable control method |
CN107194039A (en) * | 2017-04-26 | 2017-09-22 | 西北工业大学 | It is a kind of that control method is deployed based on the spatial flexible system for improving the pseudo- spectrometry of Gauss |
CN107085374A (en) * | 2017-06-09 | 2017-08-22 | 北京航空航天大学 | It is the dragging targeted attitude stable control method of space towboat thrust regulation based on rope |
Non-Patent Citations (2)
Title |
---|
ZHONGJIE MENG: "《Super-Twisting-Based Detumbling Control for Space Towing Removal Using 3-DOF Tether Link》", 《2017 12TH IEEE CONFERENCE ON INDUSTRIAL ELECTRONICS AND APPLICATIONS (ICIEA)》 * |
何勇: "《绳系卫星系绳参数的实时估计方法》", 《哈尔滨工业大学学报》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109189091A (en) * | 2018-07-25 | 2019-01-11 | 西北工业大学 | More spacecraft cooperative control methods based on Integral Sliding Mode and Model Predictive Control |
CN109189091B (en) * | 2018-07-25 | 2021-11-02 | 西北工业大学 | Multi-spacecraft cooperative control method based on integral sliding mode and model predictive control |
CN109613822A (en) * | 2018-11-27 | 2019-04-12 | 上海航天控制技术研究所 | Control method is unfolded in spatial tether system based on Nonlinear Model Predictive Control |
CN109613822B (en) * | 2018-11-27 | 2022-01-18 | 上海航天控制技术研究所 | Space tether system deployment control method based on nonlinear model predictive control |
CN110007681A (en) * | 2018-11-28 | 2019-07-12 | 北京理工大学 | It is a kind of to realize that rope is formation spinning stability expansion optimization method using continuous propeller |
CN110007681B (en) * | 2018-11-28 | 2020-06-26 | 北京理工大学 | Optimization method for realizing spin stability and unfolding of rope formation by using continuous propeller |
CN110174844A (en) * | 2019-07-03 | 2019-08-27 | 西北工业大学 | A kind of broad sense rank sliding mode predictive control method of remote control system |
CN112180944A (en) * | 2020-10-22 | 2021-01-05 | 南京航空航天大学 | Rope-tied wheel type mobile robot motion control system and method |
CN112180944B (en) * | 2020-10-22 | 2022-02-15 | 南京航空航天大学 | Rope-tied wheel type mobile robot motion control system and method |
TWI826322B (en) * | 2023-05-18 | 2023-12-11 | 威綸科技股份有限公司 | Display apparatus having waterproof and dustproof structure |
Also Published As
Publication number | Publication date |
---|---|
CN108319136B (en) | 2019-12-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108319136B (en) | Tether tension control method based on model prediction | |
Zhang et al. | Adaptive fuzzy tracking control of autonomous underwater vehicles with output constraints | |
CN109189085A (en) | Spacecraft networked system attitude control method based on event triggering | |
Masoud et al. | Sway reduction on container cranes using delayed feedback controller | |
Yu et al. | Nonlinear feedback control of a gantry crane | |
CN108508746B (en) | Self-adaptive control method of four-rotor unmanned aerial vehicle hanging transportation system | |
Emami et al. | Simultaneous trajectory tracking and aerial manipulation using a multi-stage model predictive control | |
Vázquez et al. | Control of a parametrically excited crane: A vector Lyapunov approach | |
CN106774360B (en) | It is a kind of to pull the target satellite attitude stabilization method for becoming in rail and utilizing tether and connecting rod | |
CN111008467A (en) | Online planning method for shimmy-damping track of unmanned aerial vehicle hanging flight transportation system | |
CN111880410A (en) | Four-rotor unmanned aerial vehicle fault-tolerant control method for motor faults | |
Su et al. | RISE based active vibration control for the flexible refueling hose | |
Meng et al. | Position control with zero residual vibration for two degrees-of-freedom flexible systems based on motion trajectory optimization | |
Zhang et al. | Manipulator-actuated adaptive integrated translational and rotational stabilization for spacecraft in proximity operations with control constraint | |
Su et al. | Neural-adaptive constrained flight control for air–ground recovery under terrain obstacles | |
Luan et al. | Double-mode robust model predictive control of ship dynamic positioning system based on event-triggered mechanism | |
CN107102549B (en) | Space tethered robot target approaching attitude and orbit stability control method under uncertain parameter condition | |
Miyazawa et al. | Longitudinal landing control law for an autonomous reentry vehicle | |
Wu et al. | Neuroadaptive output-feedback trajectory tracking control for a stratospheric airship with prescribed performance | |
Fang et al. | Advanced nonlinear control of an offshore boom crane | |
Ouyang et al. | An LMI‐based simple robust control for load sway rejection of rotary cranes with double‐pendulum effect | |
Haghparast et al. | A cubature Kalman filter for parameter identification and output-feedback attitude control of liquid-propellant satellites considering fuel sloshing effects | |
CN110908398A (en) | Self-adaptive control method for hanging air transportation system of energy coupling quad-rotor unmanned aerial vehicle | |
Vukosavljev et al. | Control of a gantry crane: a reach control approach | |
Mooij et al. | Nonlinear robust control and observation for aeroelastic launch vehicles with propellant slosh in a turbulent atmosphere |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |