CN104063537A - Multi-body dynamics parameter determination system based on distributive time trigger and method thereof - Google Patents

Multi-body dynamics parameter determination system based on distributive time trigger and method thereof Download PDF

Info

Publication number
CN104063537A
CN104063537A CN201410240779.4A CN201410240779A CN104063537A CN 104063537 A CN104063537 A CN 104063537A CN 201410240779 A CN201410240779 A CN 201410240779A CN 104063537 A CN104063537 A CN 104063537A
Authority
CN
China
Prior art keywords
dynamics
module
attitude
parameter
sensor
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
CN201410240779.4A
Other languages
Chinese (zh)
Other versions
CN104063537B (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.)
Beijing Institute of Control Engineering
Original Assignee
Beijing Institute of Control Engineering
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 Beijing Institute of Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN201410240779.4A priority Critical patent/CN104063537B/en
Publication of CN104063537A publication Critical patent/CN104063537A/en
Application granted granted Critical
Publication of CN104063537B publication Critical patent/CN104063537B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)

Abstract

The invention discloses a multi-body dynamics parameter determination system based on the distributive time trigger and a method thereof. The method comprises the following steps: firstly, a system architecture model based on a time-triggered data bus is established, wherein each aircraft system simulation node is connected onto the bus and comprises multiple simulation modules; secondly, a system dynamics parameter is subjected to calculation through the guiding of the dynamics simulation modules; thirdly, a single aircraft system inner closed-loop simulation process is implemented through a system inner data receiving and dispatching module; fourthly, data exchange is implemented through an outer receiving and dispatching module and other aircraft system simulation nodes; fifthly, the dynamic parameters in a next time is obtained through calculation via a differential equation or a linearization formula, and the synchronization of a distributed system multi-body dynamics parameter is achieved.

Description

Many-body dynamics parameter based on the distributed time triggers is determined system and method thereof
Technical field
The many-body dynamics parameter the present invention relates to based on the distributed time triggers is determined system and method thereof, belongs to spacecraft ground l-G simulation test field.
Background technology
According to the general plan of the manned astro-engineering, manned space station forms by assembling in-orbit to build, space station is emitted to respectively space by a plurality of independent tank sections, the final space station that forms of intersection by each other docking again, during also have part manned spaceship and cargo ship to dock and stop in space station.
In the l-G simulation test and testing authentication process of GNC (GNC is guidance navigation and control) subsystem, need to face the situation that a plurality of aircraft are worked in space simultaneously, therefore need to solve the technical matters of multi-aircraft associative simulation and checking.In the related work of manned space flight the second stage of the project, in order to complete the task of two aircraft intersection docking verification experimental verifications, when two aircraft carry out joint test, use an equipment as main control computer, this main control computer is responsible for calculating the dynamics of object machine and tracker simultaneously, and result of calculation is converted into excited data sends to platform sensor simulator and intersection docking sensor simulator.In second phase work, testing apparatus by tracker is served as main control computer, and the testing apparatus of object machine is as slave, the dynamics data calculating in target device is not introduced closed loop verification system, therefore whole process of the test is not real Combined Trials, but by tracker relevant device and the leading single cabin section verification experimental verification of system.
In the planning of space station Combined Trials, may have the task of 5 aircraft associative simulations (3 cabin section+cargo ship+manned spaceships) at the most, if re-use the second stage of main control computer pattern, can face 2 insurmountable problems:
A) computational resource is not enough: the kinetic parameter that single CPU cannot complete a plurality of aircraft within the emulation cycle calculates;
B) system-level tasks synchronization difficulty, is used traditional architectures cannot accomplish large system data high-speed synchronous and share.
Therefore need to design a kind of distributed Dynamic Co-Simulation pilot system, for many cabins, space station section Combined Trials, verify.
Summary of the invention
Technology of the present invention is dealt with problems and is: overcome the deficiencies in the prior art, the many-body dynamics parameter that proposition triggered based on the distributed time is determined system and method thereof, by the system architecture triggering based on the time, coordinate through linearizing system dynamics parameter determination method, the many-body dynamics that has solved large-scale distributed system distributes and calculates and parameter problem identificatioin; The combined calculation method of the many simulation nodes by distributed system, has improved system-level arithmetic capability, has solved the problem of single CPU computational resource deficiency; By the system level data function of exchange of time trigger data bus, solved system-level tasks synchronization problem.
Technical solution of the present invention is: the many-body dynamics parameter based on the distributed time triggers is determined system, comprise a plurality of aerocraft system simulation nodes and time-trigged system bus, a plurality of aerial vehicle simulation nodes interconnect by time-trigged system bus, and each aerial vehicle simulation node comprises aerocraft system control realistic model, internal system data transmit-receive module, dynamics simulation module, data preprocessing module, system external data transceiver module; Aerocraft system is controlled realistic model and is comprised that control bus in GNC controller, GNC system, topworks, topworks monitor module, GNC sensor, sensor excitation simulator;
Data preprocessing module comprises that by the dynamics simulation module original state of setting system operation initial time, system preliminary orbit position, system initial attitude deliver to dynamics simulation module;
The initial driving force mathematic(al) parameter of the system that dynamics simulation module is set according to data preprocessing module comprises that operation initial bat time, system preliminary orbit position, system initial attitude carry out track and attitude and calculate that the system operation time, system track position and the system attitude that obtain current bat deliver to respectively internal system data transmit-receive module and system external data transceiver module;
Internal system data transmit-receive module comprises that by the kinetic parameter of current shooting system system operation time, system track position and system attitude change into sensor measurement excited data and deliver to sensor excitation simulator according to sensor model; Sensor excitation simulator is measured excited data according to sensor GNC sensor is carried out to optical excitation or microwave excitation or these physical stimulus of thermal excitation, make GNC sensor form sensor measuring-signal, GNC sensor is delivered to GNC controller by the sensor measuring-signal of formation by control bus in GNC system;
GNC controller forms guidance control rate according to sensor measuring-signal, according to the instruction of guidance control rate formation control, steering order is delivered to topworks by control bus in GNC system, topworks changes the state of flywheel or engine jet pipe according to the steering order of receiving, steering order is delivered to topworks simultaneously and monitored module, topworks monitors the steering order that module monitors topworks sends here, the steering order of simultaneously topworks being sent here sends to internal system data transmit-receive module, internal system data transmit-receive module is converted into system control and system control moment by steering order according to the specified control parameter of topworks, system control and system control moment are sent to dynamics simulation module,
System external data transceiver module comprises that by the kinetic parameter of the current shooting system receiving from dynamics simulation module system operation time, system track position and system attitude send to other aerocraft system simulation node by time-trigged system bus, the kinetic parameter that simultaneity factor external data transceiver module receives the current shooting system of other aerocraft system simulation node comprises system operation time, system track position and system attitude, synchronous to realize in system the kinetic parameter between each aerocraft system simulation node.
Many-body dynamics parameter determination method based on distributed time triggering, it is characterized in that: the feature of having utilized distributed system, service time, trigger data bus was carried out time established data exchange in system, and finally reach that system-level kinetic parameter is determined and synchronous effect, the concrete steps of method are as follows:
(1) data preprocessing module comprises that by the dynamics simulation module original state of setting system operation initial time, system preliminary orbit position, system initial attitude deliver to dynamics simulation module;
(2) the initial driving force mathematic(al) parameter of the system that dynamics simulation module is set according to data preprocessing module comprises that operation initial bat time, system preliminary orbit position, system initial attitude carry out track and attitude and calculate that the system operation time, system track position and the system attitude that obtain current bat deliver to respectively internal system data transmit-receive module and system external data transceiver module;
(3) internal system data transmit-receive module comprises that by the kinetic parameter of current shooting system system operation time, system track position and system attitude change into sensor measurement excited data and deliver to sensor excitation simulator according to sensor model;
(4) sensor excitation simulator carries out optical excitation or microwave excitation or these physical stimulus of thermal excitation according to sensor measurement excited data to GNC sensor, make GNC sensor form sensor measuring-signal, GNC sensor is delivered to GNC controller by the sensor measuring-signal of formation by control bus in GNC system;
(5) GNC controller forms guidance control rate according to sensor measuring-signal, according to the instruction of guidance control rate formation control, steering order is delivered to topworks by control bus in GNC system;
(6) topworks changes the state of flywheel or engine jet pipe according to the steering order of receiving, steering order is delivered to topworks simultaneously and is monitored module;
(7) topworks monitors the steering order that module monitors topworks sends here, and the steering order of simultaneously topworks being sent here sends to internal system data transmit-receive module;
(8) internal system data transmit-receive module is converted into system control F by steering order according to the specified control parameter of topworks cwith system control moment T c, system control and system control moment are sent to dynamics simulation module;
(9) system external data transceiver module comprises that by the kinetic parameter of the current shooting system receiving from dynamics simulation module system operation time, system track position and system attitude send to time-trigged system bus, and extracts the system dynamic mathematic(al) parameter of other aerocraft system simulation node from time-trigged system bus;
(10) dynamics simulation module is according to the terrestrial gravitation F of the system operation time of current bat in step (2), system track position and the current bat of system Attitude Calculation g, terrestrial gravitation gradient moment T gwith unexpected perturbed force F wwith unexpected disturbance torque T w;
(11) dynamics simulation module is according to the system control F of current bat in step (8) cand the terrestrial gravitation F of current bat in step (10) gwith unexpected perturbed force F w, then according to the dynamics of orbits differential equation of classical Newton's law, calculate the second derivative of current bat dynamics of orbits parameter according to the second derivative of current bat dynamics of orbits parameter extrapolate the kinetic parameter r of the system of next bat, the dynamics of orbits differential equation of described classical Newton's law is:
r . . = F m = F g + F c + F w m - - - ( 1 )
In formula, represent acceleration under inertial system (ax, ay, az) ', (r represents the position (x, y, z) of aircraft under Earth central inertial system ', represent the speed (dx, dy, dz) of aircraft under Earth central inertial system '), F represents all external force (comprising inertial force) that aircraft is subject to, wherein F grepresent terrestrial gravitation, F crepresent actuating mechanism controls power, F wrepresent unexpected perturbed force, m represents this weight of aircraft;
(12) dynamics simulation module is according to the system control moment T in step (8) c, and the terrestrial gravitation gradient moment T in step (10) gwith unexpected disturbance torque T wobtain bonding force square projection T under body series that aircraft is received, then according to the attitude dynamics differential equation of classical Newton's law, calculate the second derivative of current bat attitude dynamics parameter and extrapolate the attitude dynamics parameter ω of next bat, the described attitude dynamics differential equation is:
I ω . + ω ~ * H = T = T C + T g + T w - - - ( 2 )
In formula, ω is the projection of angular velocity under body series under aircraft inertial system, be the skew matrix of ω, I is the projection under body series of system moment of inertia, and H is the projection under body series of aircraft moment of inertia, and T is bonding force square projection under body series that aircraft is received, T cactuating mechanism controls moment, T gterrestrial gravitation gradient moment, T wnon-expected interference moment;
(13), according to the attitude dynamics differential equation in other aerocraft system kinetic parameter in step (9), the dynamics of orbits differential equation in step 11 and step (12), the dynamics of orbits differential equation and the attitude dynamics differential equation are carried out to linearization and obtain formula (3):
X t 1 = e A t 1 + ∫ t 0 t 1 e A ( t 1 - τ ) B ( F w + F C ) dτ - - - ( 3 )
Wherein X represents dynamics of orbits parameter or attitude dynamics parameter, t 1represent the target simulator time (being generally a control cycle), A representative is through linearizing system state matrix, and B represents that control is to the Transfer Parameters of system state, F crepresent actuating mechanism controls power, F wrepresent unexpected perturbed force;
(14) according to the formula (3) in step (13), calculate other aerocraft system kinetic parameter, complete the determining of kinetic parameter of all aircraft nodes in this periodic system.
The present invention's advantage is compared with prior art:
(1) the invention solves the exchange of many-body dynamics parameter and the definite problem of parameter of distributed system, provided a kind of system scheme that triggers distributed computing technology based on the time;
(2) traditional dynamics calculation system architecture based on centralized all, all calculating all concentrates on a main control computer and completes, its advantage is to be very easy to realize, shortcoming is to solve day by day complicated large system high-precision environment dynamics calculation amount problem, and cannot utilize the calculating advantage of distributed system, therefore must find a technological approaches addressing this problem;
(3) core concept of the present invention is that single aircraft system node is responsible for the complete single vehicle dynamics of emulation, other dynamics adopts the formula of reduction through deriving to carry out recursion, and periodically carry out system-level parameters correction, guarantee that terminal does not produce cumulative errors to the recursive parameter of other aircraft;
(4) the present invention has utilized the feature of system-level Distributed Calculation, has improved system-level simulation calculation ability, has also guaranteed that the dynamics precision index of all terminals in system meets the demands.
Accompanying drawing explanation
Fig. 1 is the process flow diagram of system works method of the present invention;
Fig. 2 is system architecture schematic diagram of the present invention;
Fig. 3 is single aircraft system emulation node working timing figure of the present invention.
Embodiment
Basic ideas of the present invention are: model be take time trigger data bus as basic distributed systems architecture, each aerocraft system simulation node in system has been responsible for the closed-loop simulation process of this aircraft, simultaneously with other aerocraft system simulation node exchange kinetics parameter, by linearizing formula, carry out kinetic parameter reckoning again, the definite and synchronizing process of completion system kinetic parameter.
Below in conjunction with accompanying drawing, the present invention is described in detail, and distributed system forms as shown in Figure 2, and system is comprised of 5 aerocraft system simulation nodes, and each node represents an aerospacecraft system, possesses all features of single spacecraft; Each node can independent operating, under independent operating state, is equivalent to the closed-loop simulation process of single aircraft.Under single spacecraft state, system is mainly comprised of aerocraft system control realistic model, internal system data transmit-receive module, dynamics simulation module, data preprocessing module, system external data transceiver module.
In distributed system, all single aircraft system emulation nodes are all connected in a time trigger data bus, and the system external data transceiver module in single aerocraft system is controlled.Time-trigged system bus (Time Triggered Data Bus) is different from traditional as 1553B bus and CAN bus, in this bus, there is no clear and definite master slave relation, all node priorities are identical, and according to the flow process timesharing of appointing in advance, alternately send data in bus, the representative of this class data bus is FlexRay bus, TTP bus and TTEthernet bus.Service time, the advantage of trigger data bus was that the operation of system does not rely on any one independently node, and the reconfigurability of system is stronger, can articulate 2~10 system nodes that do not wait.
It is the GNC system model of spacecraft that aerocraft system is controlled realistic model, and this model can be GNC system actual product, can be also the simulator of simulation GNC systemic-function.This model is comprised of 5 submodules: in GNC controller, GNC system, control bus, topworks, topworks monitor module, GNC sensor, sensor excitation simulator.Wherein GNC controller is the nucleus module of this model, is responsible for gathering from GNC intra-system bus the metrical information of each sensor, and by the steering order of navigation, conductance calculating aircraft processed, then send to topworks by GNC intra-system bus, GNC sensor is responsible for the external information of GNC system and is measured, then metrical information is sent to GNC controller, sensor excitation simulator is on ground, to coordinate the uphole equipment of sensor module work, first simulator obtains kinetic parameter from dynamics simulation module, again parameter is converted into the required pumping signal of different sensors, such as first star sensor simulator receives the signal that dynamics is converted to sensor measurement data, again this signal is generated to the starry sky image that star sensor should collect under this state according to actual space constellation configuration, again this starry sky image is encouraged to star sensor, make the true outputting power of star sensor learn the measurement data signals after transforming, reach the effect of ground simulation simulation, topworks is the execution module of GNC system, and the steering order that reception GNC controller sends the action that is converted into topworks, as engine jet pipe start or flywheel acceleration rotation etc., the instruction that topworks's supervision module-specific is received in supervision topworks and current running status, then be converted to actual dynamics Controlling power F cwith control moment T cfeed back to dynamics, form system closed-loop simulation.
Dynamics simulation module be mainly responsible for to be calculated this aerocraft system kinetic parameter, and calculates other vehicle dynamics parameter, and kinetic parameter is determined and is divided into two main contents: dynamics of orbits parameter and attitude dynamics parameter.
(1) dynamics of orbits computing formula
The emulation of environmental dynamics can be divided into two major parts, the one, dynamics of orbits emulation, the 2nd, attitude dynamics emulation.The basis of dynamics of orbits is disome lemma law, has:
F=grad(U)
Wherein F is the gravitation that aircraft is subject to, and considers the perturbation that aircraft is subject to, and has
r . . = - Gm r 3 r + grad ( R )
Wherein R is perturbative force bit function, has
grad(R)=F ru r+F tu t+F nu n
In spacecraft orbit dynamics, terrestrial gravitation is maximal term, the control of aircraft is 3 rank a small amount of with respect to terrestrial gravitation, and perturbative force is 6 rank a small amount of with respect to terrestrial gravitation, therefore in traditional dynamics of orbits differential equation, at short notice, can be linear (time is short) permanent (external force impact is little) differential equation by equation simplification, so this differential equation should have general solution:
X t 1 = e A t 1 + ∫ t 0 t 1 e A ( t 1 - τ ) B ( F w + F C ) dτ
F wherein wand F cbe respectively perturbative force and control, terrestrial gravitation is relevant to aircraft ontological property, in matrix A, with constant, embodies.According to every 160ms, exchange a secondary data,
t 1-t 0=0.16
Use the deviation of this reduced equation and true environment dynamics calculation to come from F wand F cuncertainty, according to actual conditions, F cspan be (300N~+ 300N), F wspan be (5N~+ 5N), aircraft physical characteristics is cylindrical, quality is designated as 10 tons, the deviation uncertainty within 0.16 second time of general solution of differential equation is 7mm.Below 1cm, and there is not cumulative errors in the position uncertainty of the dynamics of orbits recursive algorithm in every 160ms under inertial system, meets the requirement of spacecraft ground l-G simulation test.
(2) attitude dynamics computing formula
Attitude dynamics take attitude quaternion as basic expression-form as:
q . = 1 2 Ω ( ω ) q
Expansion is:
q . = q . 1 q . 2 q . 3 q . 4 = 1 2 q 4 - q 3 q 2 q 1 q 3 q 4 - q 1 q 2 - q 2 q 1 q 4 q 3 - q 1 - q 2 - q 3 q 4 ω x ω y ω z 0
Because the angular velocity of spacecraft in actual moving process is very little, || ω || <0.005, therefore obtains once at each exchange cycle re-use this coordinate single order Long Gekutafa to calculate the attitude quaternion in lower each emulation cycle, have:
q i + 1 = q i + q . 0 &times; &Delta;t , i &Element; ( 0,1,2 . . . . 15 )
The uncertainty that single order Long Gekutafa after use is simplified carries out attitude dynamics calculating mainly comes from T w(perturbation moment) and T cthe uncertainty of (control moment), T cspan be (250Nm~+ 250Nm), T wspan be (3Nm~+ 3Nm), the aircraft principal axis of inertia is taken as 10 5kg.m.m, to calculate the uncertainty that hypercomplex number result is transformed into attitude angle under inertial system be (0.047 degree~+ 0.047 degree) to the attitude dynamics recursive algorithm in every 160ms.
Determined that thus system architecture, system information flows, single aircraft system emulation nodal function form and system dynamics parameter determination method, will describe the concrete implementation step of the many-body dynamics parameter determination method based on distributed time triggering as shown in Figure 1 below:
(1) data preprocessing module comprises that by the dynamics simulation module original state of setting system operation initial time, system preliminary orbit position, system initial attitude deliver to dynamics simulation module;
(2) the initial driving force mathematic(al) parameter of the system that dynamics simulation module is set according to data preprocessing module comprises that operation initial bat time, system preliminary orbit position, system initial attitude carry out track and attitude and calculate that the system operation time, system track position and the system attitude that obtain current bat deliver to respectively internal system data transmit-receive module and system external data transceiver module;
(3) internal system data transmit-receive module comprises that by the kinetic parameter of current shooting system system operation time, system track position and system attitude change into sensor measurement excited data and deliver to sensor excitation simulator according to sensor model;
(4) sensor excitation simulator carries out optical excitation or microwave excitation or these physical stimulus of thermal excitation according to sensor measurement excited data to GNC sensor, make GNC sensor form sensor measuring-signal, GNC sensor is delivered to GNC controller by the sensor measuring-signal of formation by control bus in GNC system;
(5) GNC controller forms guidance control rate according to sensor measuring-signal, according to the instruction of guidance control rate formation control, as in-orbit over the ground in three axle control situations, the measurement data that GNC controller obtains according to star sensor, be converted into the attitude information of current flight device, and calculate control rate according to PID controller, then according to engine jet pipe, steering order is delivered to topworks by control bus in GNC system the most at last;
(6) topworks changes the state of flywheel or engine jet pipe according to the steering order of receiving, steering order is delivered to topworks simultaneously and is monitored module;
(7) topworks monitors the steering order that module monitors topworks sends here, and the steering order of simultaneously topworks being sent here sends to internal system data transmit-receive module;
(8) internal system data transmit-receive module is converted into system control F by steering order according to the specified control parameter of topworks cwith system control moment T c, system control and system control moment are sent to dynamics simulation module;
(9) system external data transceiver module comprises that by the kinetic parameter of the current shooting system receiving from dynamics simulation module system operation time, system track position and system attitude send to time-trigged system bus, and extracts the system dynamic mathematic(al) parameter of other aerocraft system simulation node from time-trigged system bus; 3 the aerocraft system simulation nodes (A, B and C) of take are example, this aerocraft system kinetic parameter that node A learns emulation module by this node medium power sends in time-trigged system bus by system external data transceiver module, from time-trigged system bus, obtain the system dynamic mathematic(al) parameter of Node B and node C transmission simultaneously, like this with node A, just obtained the kinetic parameter of all nodes in the system that comprises A, B and C, in like manner Node B and node C also can acquisition system in the kinetic parameter of all nodes;
(10) dynamics simulation module is according to the terrestrial gravitation F of the system operation time of current bat in step (2), system track position and the current bat of system Attitude Calculation g, terrestrial gravitation gradient moment T gwith unexpected perturbed force F wwith unexpected disturbance torque T w;
(11) dynamics simulation module is according to the system control F of current bat in step (8) cand the terrestrial gravitation F of current bat in step (10) gwith unexpected perturbed force T g, then according to the dynamics of orbits differential equation of classical Newton's law, calculate the second derivative of current bat dynamics of orbits parameter according to the second derivative of current bat dynamics of orbits parameter extrapolate the kinetic parameter r of the system of next bat, the dynamics of orbits differential equation of described classical Newton's law is:
r . . = F m = F g + F c + F w m - - - ( 1 )
In formula, represent acceleration under inertial system (ax, ay, az) ', (r represents the position (x, y, z) of aircraft under Earth central inertial system ', represent the speed (dx, dy, dz) of aircraft under Earth central inertial system '), F represents all external force (comprising inertial force) that aircraft is subject to, wherein F grepresent terrestrial gravitation, F crepresent actuating mechanism controls power, F wrepresent unexpected perturbed force, m represents this weight of aircraft;
(12) dynamics simulation module is according to the system control moment T in step (8) c, and the terrestrial gravitation gradient moment T in step (10) gwith unexpected disturbance torque T wobtain bonding force square projection T under body series that aircraft is received, then according to the attitude dynamics differential equation of classical Newton's law, calculate the second derivative of current bat attitude dynamics parameter , and extrapolate the attitude dynamics parameter ω of next bat, the described attitude dynamics differential equation is:
I &omega; . + &omega; ~ * H = T = T C + T g + T w - - - ( 2 )
In formula, ω is the projection of angular velocity under body series under aircraft inertial system, be the skew matrix of ω, I is the projection under body series of system moment of inertia, and H is the projection under body series of aircraft moment of inertia, and T is bonding force square projection under body series that aircraft is received, T cactuating mechanism controls moment, T gterrestrial gravitation gradient moment, T wnon-expected interference moment;
(13), according to the attitude dynamics differential equation in other aerocraft system kinetic parameter in step (9), the dynamics of orbits differential equation in step 11 and step (12), the dynamics of orbits differential equation and the attitude dynamics differential equation are carried out to linearization and obtain formula (3):
X t 1 = e A t 1 + &Integral; t 0 t 1 e A ( t 1 - &tau; ) B ( F w + F C ) d&tau; - - - ( 3 )
Wherein X represents dynamics of orbits parameter or attitude dynamics parameter, t 1represent the target simulator time (being generally a control cycle), A representative is through linearizing system state matrix, and B represents that control is to the Transfer Parameters of system state, F crepresent actuating mechanism controls power, F wrepresent unexpected perturbed force;
(14) according to the formula (3) in step (13), calculate other aerocraft system kinetic parameter, complete the determining of kinetic parameter of all aircraft nodes in this periodic system;
(15) as shown in Figure 3, described under a kind of typical condition, the work schedule of the single aircraft system emulation node in system, the emulation cycle of system is 10ms, and the control cycle of system is 160ms, and time-trigged system bus data exchange cycle is 160ms; Wherein A1~A8 represents the work schedule of GNC controller, A1 represents GNC controller task time that control bus obtains GNC sensor data in GNC system, A2 represents GNC controller internal data comparison task time, the A3 representative navigation calculation task time, A4 represents the conductance calculation task time processed, A5 represents GNC controller internal data comparison task time, A6 represents that GNC controller is to the time of topworks's sending controling instruction task, A7 represents Telemetering Data Processing task time, and A8 represents the fault-tolerant decision task time.The exemplary operation sequential of D1~D10 representative dynamics simulation module in the cycle at 1 controller simulation, D1 representative and other vehicle dynamics parameter exchange process, D2 represents other vehicle dynamics parameter renewal process, in D3~D7 representative system, different single aircraft system emulation nodes are to the task time that sends this aerocraft system kinetic parameter in time-trigged system bus, D10 represents that dynamics simulation module receives the actuating mechanism controls instruction that topworks monitors that module sends, and adds the task time of system closed-loop simulation; Q1~Q5 represented within 1 emulation cycle, the work schedule of dynamics simulation module, Q1 represents steering order inquiry and upgrades task time, Q2 represents topworks's model emulation task time, Q3 representative system track and attitude dynamics model calculation task time, Q4 represents external tapping Data Update task time, and Q5 represents clock and data synchronous task time.Under this typical condition, system is moved according to work schedule as shown in Figure 3, can reach the system emulation of expection and control effect.
Environmental dynamics data filtering algorithm in the present invention is on the basis of primary track and attitude dynamics, by the analysis to spacecraft dynamics characteristic, nonlinear differential equation is reduced to permanent linear differential equation at short notice, when meeting simulation accuracy requirement, simplified calculating, and realized the method for distributed system dynamics simulation, for future many spacecrafts of large system associative simulation provide an effective technology to realize approach.
The content not being described in detail in instructions of the present invention belongs to those skilled in the art's known technology.

Claims (2)

1. the many-body dynamics parameter triggering based on the distributed time is determined system, it is characterized in that: comprise a plurality of aerocraft system simulation nodes and time-trigged system bus, a plurality of aerial vehicle simulation nodes interconnect by time-trigged system bus, and each aerial vehicle simulation node comprises aerocraft system control realistic model, internal system data transmit-receive module, dynamics simulation module, data preprocessing module, system external data transceiver module; Aerocraft system is controlled realistic model and is comprised that control bus in GNC controller, GNC system, topworks, topworks monitor module, GNC sensor, sensor excitation simulator;
Data preprocessing module comprises that by the dynamics simulation module original state of setting system operation initial time, system preliminary orbit position, system initial attitude deliver to dynamics simulation module;
The initial driving force mathematic(al) parameter of the system that dynamics simulation module is set according to data preprocessing module comprises that operation initial bat time, system preliminary orbit position, system initial attitude carry out track and attitude and calculate that the system operation time, system track position and the system attitude that obtain current bat deliver to respectively internal system data transmit-receive module and system external data transceiver module;
Internal system data transmit-receive module comprises that by the kinetic parameter of current shooting system system operation time, system track position and system attitude change into sensor measurement excited data and deliver to sensor excitation simulator according to sensor model; Sensor excitation simulator is measured excited data according to sensor GNC sensor is carried out to optical excitation or microwave excitation or these physical stimulus of thermal excitation, make GNC sensor form sensor measuring-signal, GNC sensor is delivered to GNC controller by the sensor measuring-signal of formation by control bus in GNC system;
GNC controller forms guidance control rate according to sensor measuring-signal, according to the instruction of guidance control rate formation control, steering order is delivered to topworks by control bus in GNC system, topworks changes the state of flywheel or engine jet pipe according to the steering order of receiving, steering order is delivered to topworks simultaneously and monitored module, topworks monitors the steering order that module monitors topworks sends here, the steering order of simultaneously topworks being sent here sends to internal system data transmit-receive module, internal system data transmit-receive module is converted into system control and system control moment by steering order according to the specified control parameter of topworks, system control and system control moment are sent to dynamics simulation module,
System external data transceiver module comprises that by the kinetic parameter of the current shooting system receiving from dynamics simulation module system operation time, system track position and system attitude send to other aerocraft system simulation node by time-trigged system bus, the kinetic parameter that simultaneity factor external data transceiver module receives the current shooting system of other aerocraft system simulation node comprises system operation time, system track position and system attitude, synchronous to realize in system the kinetic parameter between each aerocraft system simulation node.
2. the many-body dynamics parameter determination method triggering based on the distributed time, is characterized in that: concrete steps are as follows:
(1) data preprocessing module comprises that by the dynamics simulation module original state of setting system operation initial time, system preliminary orbit position, system initial attitude deliver to dynamics simulation module;
(2) the initial driving force mathematic(al) parameter of the system that dynamics simulation module is set according to data preprocessing module comprises that operation initial bat time, system preliminary orbit position, system initial attitude carry out track and attitude and calculate that the system operation time, system track position and the system attitude that obtain current bat deliver to respectively internal system data transmit-receive module and system external data transceiver module;
(3) internal system data transmit-receive module comprises that by the kinetic parameter of current shooting system system operation time, system track position and system attitude change into sensor measurement excited data and deliver to sensor excitation simulator according to sensor model;
(4) sensor excitation simulator carries out optical excitation or microwave excitation or these physical stimulus of thermal excitation according to sensor measurement excited data to GNC sensor, make GNC sensor form sensor measuring-signal, GNC sensor is delivered to GNC controller by the sensor measuring-signal of formation by control bus in GNC system;
(5) GNC controller forms guidance control rate according to sensor measuring-signal, according to the instruction of guidance control rate formation control, steering order is delivered to topworks by control bus in GNC system;
(6) topworks changes the state of flywheel or engine jet pipe according to the steering order of receiving, steering order is delivered to topworks simultaneously and is monitored module;
(7) topworks monitors the steering order that module monitors topworks sends here, and the steering order of simultaneously topworks being sent here sends to internal system data transmit-receive module;
(8) internal system data transmit-receive module is converted into system control F by steering order according to the specified control parameter of topworks cwith system control moment T c, system control and system control moment are sent to dynamics simulation module;
(9) system external data transceiver module comprises that by the kinetic parameter of the current shooting system receiving from dynamics simulation module system operation time, system track position and system attitude send to time-trigged system bus, and extracts the system dynamic mathematic(al) parameter of other aerocraft system simulation node from time-trigged system bus;
(10) dynamics simulation module is according to the terrestrial gravitation F of the system operation time of current bat in step (2), system track position and the current bat of system Attitude Calculation g, terrestrial gravitation gradient moment T gwith unexpected perturbed force F wwith unexpected disturbance torque T w;
(11) dynamics simulation module is according to the system control F of current bat in step (8) cand the terrestrial gravitation F of current bat in step (10) gwith unexpected perturbed force F w, then according to the dynamics of orbits differential equation of classical Newton's law, calculate the second derivative of current bat dynamics of orbits parameter according to the second derivative of current bat dynamics of orbits parameter extrapolate the kinetic parameter r of the system of next bat, the dynamics of orbits differential equation of described classical Newton's law is:
r . . = F m = F g + F c + F w m - - - ( 1 )
In formula represent acceleration under inertial system (ax, ay, az) ', F represents all external force that aircraft is subject to, wherein F grepresent terrestrial gravitation, F crepresent actuating mechanism controls power, F wrepresent unexpected perturbed force, m represents this weight of aircraft;
(12) dynamics simulation module is according to the system control moment T in step (8) c, and the terrestrial gravitation gradient moment T in step (10) gwith unexpected disturbance torque T wobtain bonding force square projection T under body series that aircraft is received, then according to the attitude dynamics differential equation of classical Newton's law, calculate the derivative of current bat attitude dynamics parameter and extrapolate the attitude dynamics parameter ω of next bat, the described attitude dynamics differential equation is:
I &omega; . + &omega; ~ * H = T = T C + T g + T w - - - ( 2 )
In formula, ω is the projection of angular velocity under body series under aircraft inertial system, be the skew matrix of ω, I is the projection under body series of system moment of inertia, and H is the projection under body series of aircraft moment of inertia, and T is bonding force square projection under body series that aircraft is received, T cactuating mechanism controls moment, T gterrestrial gravitation gradient moment, T wnon-expected interference moment;
(13), according to the attitude dynamics differential equation in other aerocraft system kinetic parameter in step (9), the dynamics of orbits differential equation in step (11) and step (12), the dynamics of orbits differential equation and the attitude dynamics differential equation are carried out to linearization and obtain formula (3):
X t 1 = e A t 1 + &Integral; t 0 t 1 e A ( t 1 - &tau; ) B ( F w + F C ) d&tau; - - - ( 3 )
Wherein X represents dynamics of orbits parameter or attitude dynamics parameter, t 1represent the target simulator time, A representative is through linearizing system state matrix, and B represents that control is to the Transfer Parameters of system state, F crepresent actuating mechanism controls power, F wrepresent unexpected perturbed force;
(14) according to the formula (3) in step (13), calculate other aerocraft system kinetic parameter, complete the determining of kinetic parameter of all aircraft nodes in this periodic system.
CN201410240779.4A 2014-05-30 2014-05-30 Multi-body dynamics parameter determination system based on distributive time trigger and method thereof Active CN104063537B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410240779.4A CN104063537B (en) 2014-05-30 2014-05-30 Multi-body dynamics parameter determination system based on distributive time trigger and method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410240779.4A CN104063537B (en) 2014-05-30 2014-05-30 Multi-body dynamics parameter determination system based on distributive time trigger and method thereof

Publications (2)

Publication Number Publication Date
CN104063537A true CN104063537A (en) 2014-09-24
CN104063537B CN104063537B (en) 2017-04-19

Family

ID=51551250

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410240779.4A Active CN104063537B (en) 2014-05-30 2014-05-30 Multi-body dynamics parameter determination system based on distributive time trigger and method thereof

Country Status (1)

Country Link
CN (1) CN104063537B (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107300861A (en) * 2017-06-21 2017-10-27 北京控制工程研究所 A kind of spacecraft dynamics distributed computing method
CN108037676A (en) * 2017-10-17 2018-05-15 哈尔滨工业大学 A kind of semi physical ground simulating device suitable for aircraft navigation Guidance and control
CN108111494A (en) * 2017-12-13 2018-06-01 天津津航计算技术研究所 A kind of protocol conversion apparatus of 1553B buses and FlexRay buses
CN109120330A (en) * 2018-08-07 2019-01-01 北京空间技术研制试验中心 Long-range joint-trial method between the system of the spacecraft of strange land distribution
CN110007617A (en) * 2019-03-29 2019-07-12 北京航空航天大学 A kind of uncertainty transmission analysis method of hardware-in-the-loop system
CN110803305A (en) * 2019-12-03 2020-02-18 上海航天控制技术研究所 Satellite attitude control thruster spray limiting method
CN115670445A (en) * 2022-11-09 2023-02-03 山东大学 Human body posture detection and recognition system and method

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070129922A1 (en) * 2005-12-01 2007-06-07 Electronics And Telecommunications Research Institute Satellite simulation system using component-based satellite modeling
CN101178312A (en) * 2007-12-12 2008-05-14 南京航空航天大学 Spacecraft shading device combined navigation methods based on multi-information amalgamation
CN103116280A (en) * 2013-01-16 2013-05-22 北京航空航天大学 Microminiature unmanned aerial vehicle longitudinal control method with random delay of distributed network
CN103218482A (en) * 2013-03-29 2013-07-24 南京航空航天大学 Estimation method for uncertain parameters in dynamic system

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070129922A1 (en) * 2005-12-01 2007-06-07 Electronics And Telecommunications Research Institute Satellite simulation system using component-based satellite modeling
CN101178312A (en) * 2007-12-12 2008-05-14 南京航空航天大学 Spacecraft shading device combined navigation methods based on multi-information amalgamation
CN103116280A (en) * 2013-01-16 2013-05-22 北京航空航天大学 Microminiature unmanned aerial vehicle longitudinal control method with random delay of distributed network
CN103218482A (en) * 2013-03-29 2013-07-24 南京航空航天大学 Estimation method for uncertain parameters in dynamic system

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107300861A (en) * 2017-06-21 2017-10-27 北京控制工程研究所 A kind of spacecraft dynamics distributed computing method
CN108037676A (en) * 2017-10-17 2018-05-15 哈尔滨工业大学 A kind of semi physical ground simulating device suitable for aircraft navigation Guidance and control
CN108111494A (en) * 2017-12-13 2018-06-01 天津津航计算技术研究所 A kind of protocol conversion apparatus of 1553B buses and FlexRay buses
CN109120330A (en) * 2018-08-07 2019-01-01 北京空间技术研制试验中心 Long-range joint-trial method between the system of the spacecraft of strange land distribution
CN110007617A (en) * 2019-03-29 2019-07-12 北京航空航天大学 A kind of uncertainty transmission analysis method of hardware-in-the-loop system
CN110803305A (en) * 2019-12-03 2020-02-18 上海航天控制技术研究所 Satellite attitude control thruster spray limiting method
CN110803305B (en) * 2019-12-03 2021-06-08 上海航天控制技术研究所 Satellite attitude control thruster spray limiting method
CN115670445A (en) * 2022-11-09 2023-02-03 山东大学 Human body posture detection and recognition system and method

Also Published As

Publication number Publication date
CN104063537B (en) 2017-04-19

Similar Documents

Publication Publication Date Title
CN104063537A (en) Multi-body dynamics parameter determination system based on distributive time trigger and method thereof
Sun et al. Adaptive backstepping control of spacecraft rendezvous and proximity operations with input saturation and full-state constraint
Broida et al. Spacecraft rendezvous guidance in cluttered environments via reinforcement learning
Gavilan et al. Chance-constrained model predictive control for spacecraft rendezvous with disturbance estimation
CN107544262B (en) Self-adaptive accurate recovery control method for carrier rocket
CN109358497B (en) B-spline function-based tracking method for satellite path planning and predictive control
Bodin et al. PRISMA: An in-orbit test bed for guidance, navigation, and control experiments
CN105353763A (en) Relative orbit attitude finite time control method for non-cooperative target spacecraft
Garcia et al. Nonlinear model predictive controller for navigation, guidance and control of a fixed-wing UAV
Lungu et al. Automatic landing system using neural networks and radio-technical subsystems
CN101650569A (en) Trailing formation control method of multiple movement bodies in three-dimensional space
Tavakoli et al. Predictive fault-tolerant control of an all-thruster satellite in 6-DOF motion via neural network model updating
CN104076818A (en) Space rendezvous system gain scheduling control method with linearization errors taken into consideration
Morgan et al. Decentralized model predictive control of swarms of spacecraft using sequential convex programming
Dong et al. A novel stable and safe model predictive control framework for autonomous rendezvous and docking with a tumbling target
Salazar et al. Alternative transfer to the Earth–Moon Lagrangian points L4 and L5 using lunar gravity assist
CN108303874A (en) It is a kind of for rope be the shimmy low thrust method for handover control of space Tugboat system
Yang et al. A station-keeping control method for GEO spacecraft based on autonomous control architecture
CN107300861B (en) Distributed computing method for spacecraft dynamics
CN111949040B (en) Satellite formation attitude cooperative tracking control method for efficiently utilizing space wireless resources
Dziuk et al. Fuzzy logic controlled UAV autopilot using C-Mean clustering
Holguin et al. Guidance and control for spacecraft autonomous rendezvous and proximity maneuvers using a geometric mechanics framework
Qi et al. Space robot active collision avoidance maneuver under thruster failure
Sun et al. Piecewise attitude tracking control of a gravity gradient microsatellite for coplanar orbital transfer
Jewison et al. Resource aggregated reconfigurable control and risk-allocative path planning for on-orbit servicing and assembly of satellites

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant