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 PDF

Info

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
Application number
CN201810047019.XA
Other languages
Chinese (zh)
Other versions
CN108319136B (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.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
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 Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201810047019.XA priority Critical patent/CN108319136B/en
Publication of CN108319136A publication Critical patent/CN108319136A/en
Application granted granted Critical
Publication of CN108319136B publication Critical patent/CN108319136B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/042Adaptive 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

Tether tension control method based on model prediction
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.
CN201810047019.XA 2018-01-18 2018-01-18 Tether tension control method based on model prediction Active CN108319136B (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (9)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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