CN107121256B - A kind of six degree of freedom captive trajectory testing method of continuous in-orbit movement - Google Patents
A kind of six degree of freedom captive trajectory testing method of continuous in-orbit movement Download PDFInfo
- Publication number
- CN107121256B CN107121256B CN201710298838.7A CN201710298838A CN107121256B CN 107121256 B CN107121256 B CN 107121256B CN 201710298838 A CN201710298838 A CN 201710298838A CN 107121256 B CN107121256 B CN 107121256B
- Authority
- CN
- China
- Prior art keywords
- speed
- motor
- degree
- track
- freedom
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01M—TESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
- G01M9/00—Aerodynamic testing; Arrangements in or on wind tunnels
- G01M9/02—Wind tunnels
Landscapes
- Physics & Mathematics (AREA)
- Fluid Mechanics (AREA)
- General Physics & Mathematics (AREA)
- Aerodynamic Tests, Hydrodynamic Tests, Wind Tunnels, And Water Tanks (AREA)
Abstract
The invention discloses a kind of six degree of freedom captive trajectory testing methods of continuous in-orbit movement, the separation body Model aerodynamic force that the test method is measured using force balance, solve full-scale chorista kinetics equation group, obtain the flight path of full-scale chorista, it is converted again by the world, speed contracting ratio, obtain detaching the movement locus of body Model under wind tunnel axis system, finally utilize mechanism in six degree of freedom that the track of separation body Model on demand is driven to move, during chorista model sport, balance data are measured in advance, solve full-scale chorista kinetics equation group, and plan next section of movement locus.The test method carries out signal measurement without pause motion and data calculate, so that the movement locus Non-intermittent of entire separation body Model, and it can ensure that separation body Model remains in real trace, improve test accuracy, increase test data amount, the captive trajectory testing time is shortened, experimentation cost is reduced.
Description
Technical field
The invention belongs to hypersonic wind tunnel experiment technical fields, and in particular to a kind of six degree of freedom of continuous in-orbit movement
Captive trajectory testing method.
Background technology
Wind-tunnel captive trajectory testing technology(Abbreviation CTS)It is a kind of electromechanical integrated device being used in wind tunnel test,
It is suitable layout of the chorista on its host and dispensing parameter for simulating the movement locus after chorista is detached from host
Control provides reliable basis.It is cooperated using computer, six degree of freedom device and wind-tunnel, and body Model is detached by measurement
Aerodynamic loading solve chorista model space six degrees of freedom equation of motion group come obtain separation body Model movement position or speed,
And then realize dropping trajectory simulation.
Currently, the control mode of CTS is mainly based upon the position control mode of closed loop, separation body Model is in constant speed interval
Formula motor pattern is primarily present following deficiency:
1)Separation body Model suspends after moving to target location, carries out signal measurement and data calculate, then carry out again
The movement of next step, and need to correct position repeatedly, therefore the time for obtaining a chorista track is longer, experiment effect
Rate is low, high energy consumption;
2)Chorista model sport is noncontinuity, and the subsequent point position of tracing point is that prediction generates, might not with point
Isolated model six-degree-of-freedom dynamics equation specified position overlaps always, and model center of gravity can not be continuously held in real motion rail
On mark.
In addition to this, there is the method for control speed of CTS both at home and abroad, solve the kinematics six degree of freedom side of chorista flight
Journey calculates given time step-lengthThe centroid velocity of chorista afterwardsWith the angular speed of rotation around center of mass, reuse
Interpolation method obtains continuous speedWith angular speed, then control mechanism in six degree of freedom and drive chorista mould
Type according toMovement locus withAthletic posture moves, and iterative method completes the measurement of a separated track, but solves
The polynomial method of quadratic interpolation is used between speed out, the position of movement may be with the six-freedom motion differential equation
Calculated position difference is larger.
Since the track of CTS system mechanism in six degree of freedom movement cannot determine before the test, so traditional industry six is freely
The ripe control strategy of degree manipulator is difficult in the control for directly applying to CTS experiments.
Invention content
Technical problem to be solved by the invention is to provide a kind of six degree of freedom captive trajectory testings of continuous in-orbit movement
Method.
The six degree of freedom captive trajectory testing method of the continuous in-orbit movement of the present invention, its main feature is that:The experiment side
The testing equipment that method uses includes host computer, next bit computer, motor driver, motor, mechanism in six degree of freedom, position biography
Sensor, velocity sensor and force balance;The motor driver includes X1 spindle motors driver, X2 spindle motors driver, Y
Spindle motor driver, Z1 spindle motors driver, Z2 spindle motors driver, α spindle motors driver, β spindle motors driver and γ axis
Motor driver;The motor includes X1 spindle motors corresponding with motor driver, X2 spindle motors, y-axis motor, Z1 axis electricity
Machine, Z2 spindle motors, α spindle motors, β spindle motors and γ spindle motors;Absolute type encoder, absolute type are installed on the motor shaft
The data of acquisition are processed into position and speed information by encoder, and absolute type encoder has position sensor and velocity sensor
Dual function;
Its connection relation is that the host computer, next bit computer and motor driver are connected by cable, motor
Driver is connected by signal wire with power line with motor, and position sensor, velocity sensor and next bit computer pass through signal
Line connection, force balance are connected with next bit computer by signal wire;Force balance, dynamometry day are installed inside separation body Model
Flat strut is fixedly connected with mechanism in six degree of freedom;The motor driver driving motor control mechanism in six degree of freedom passes through survey
The strut of power balance drives chorista model sport;
The host computer is equipped with human-computer interaction program, and human-computer interaction program is for reading test parameters and preservation
Data, triggering experiment, display present speed and position, display balance signal;
The next bit computer is equipped with PLC softwares, is used for real-time control motor movement, and write in PLC softwares
The program of captive trajectory testing;
The running position signal of the position sensor detection separation body Model, and it is sent to next bit computer;
The running speed signal of the velocity sensor detection separation body Model, and it is sent to next bit computer;
The force balance measures the aerodynamic force of separation body Model, and is sent to next bit computer;
The six degree of freedom captive trajectory testing method of the continuous in-orbit movement includes the following steps:
1a. is inputted by host computer human-computer interaction interface and is tested relevant force balance coefficient, pneumatically resolves and join
Count n for track in number, track operation hop count m, every section of track, model geometric shrinkage scale, velocity transformation scale, single hop
Track moves the deadline, resolving time in advance, balance delay time, read balance data time;Input six
Degree of freedom kinematics of mechanism is against dematrix R1, the speed in input mechanism in six degree of freedom space is mapped to the Jacobi square of joint space
Battle array R2;
1b. controls motor movement by slave computer computer PLC softwares, by chorista model sport to initial pose(), and track hop count i=0 of resolving is set;
1c. judges whether the track hop count i currently resolved is 0, if i=0, slave computer computer acquisition force balance is surveyed
The power and torque that the chorista model of amount is received;If i ≠ 0, i-th section of track of slave computer computer acquisition exists(t1-t2-t3)Extremely
(t1-t2)The power and torque that balance measurement chorista model is received in time range, and calculate the average value of power and torque;
1d. slave computer computers calculate power and torque suffered by full-scale chorista;
1e. resolves full-scale chorista kinetics equation group by differential equation group numerical algorithm, obtains the(i+1)Section rail
The pose and speed of n tracing point on mark;
1f. by world conversion method, obtain under wind tunnel axis system the pose of the separation corresponding n tracing point of body Model and
Speed;
1g. obtains separation body Model and corresponds to this n tracing point pose and speed by speed contracting ratio and Inverse Kinematics Solution method
Each motor corner and rotating speed of degree;
1h. utilizes each motor corner and rotating speed, by motor movement curve planing method, plans that the movement of each motor is bent
Line;
Track hop count i=i+1 that 1i. has been resolved;
1j. judges whether i is 1 at this time, if i=1, by the movement of i-th section of track, if i ≠ 1, waits for the(i-1)
After the completion of the movement of section track, then by i-th section of track movement;
1k. is when i-th section of track run duration, meetWhen, judge whether i is less than track and runs
Hop count m returns to step 1c if i≤m, and output trajectory after the completion of i-th section of track movement is waited for if i > m, terminates examination
It tests.
The differential equation group numerical algorithm includes one kind in single order or second order differential equations numerical algorithm.
The world conversion method is as follows:
The center of mass motion of full-scale chorista by n tracing point of full-scale chorista pose()
With speed()It is described;
Model geometric scaling factor is, start the initial pose for testing time-division isolated model(),
Under wind tunnel axis system detach body Model correspond to tracing point pose () and speed
(), specific formula for calculation is as follows:
The speed contracting ratio includes the following steps with Inverse Kinematics Solution method:
4a. increases speed the chorista model sport time change of scaleTimes, separation body Model is respectively same by degree speed
When reduce velocity transformation scaleTimes, then detach speed when body Model actual motion()
For
4b. is according to the pose for detaching some tracing point of body Model()It is transported with mechanism in six degree of freedom
It is dynamic to learn inverse dematrix R1, calculate the corresponding corner of each motor(), specific formula for calculation is as follows:
Speed when actual motion()It is mapped with the speed in mechanism in six degree of freedom space
To the Jacobian matrix R of joint space2, rotating speed(), specific formula for calculation is as follows:
The motor movement curve planing method is as follows:
The corresponding angle of motor of two neighboring tracing point in known single hop track,And angular speed,(), the two neighboring tracing point run duration in single hop trackAfterwards, use is more three times
Item formula interpolation, the equation for obtaining curve movement are as follows:
Wherein:
。
World conversion method involved in the six degree of freedom captive trajectory testing method of the continuous in-orbit movement of the present invention
Principle is:The center of mass motion of full-scale chorista is actual track in the sky, when being converted to the situation in wind-tunnel, chorista mould
The barycenter displacement of type is reduced by geometry scaling factor, similarly, detaches the linear velocity of body Model by the linear speed of full-scale chorista barycenter
Geometry scaling factor is spent to reduce.Because the relative attitude of the separation body Model in full-scale chorista and wind-tunnel in the sky is constant, institute
It does not press geometry scaling factor with chorista model attitude angle to reduce, detaches the angular speed of the angular speed and full-scale chorista of body Model
It is identical.
User is man-machine by host computer in the six degree of freedom captive trajectory testing method of the continuous in-orbit movement of the present invention
Interactive interface input experiment and Parameters in Mathematical Model, next bit computer solve full-scale chorista flight six-freedom motion side
Journey calculates the pose and speed of full-scale chorista after given time step-length;According to solve come data, carry out the world turn
It changes, the tracing point for detaching body Model under wind tunnel axis system is obtained, by speed contracting than obtaining each electricity against solution with mechanism in six degree of freedom
The corresponding corner of machine and rotating speed cook up the full curve of a motor movement using the corner and rotating speed of each motor.It has planned
Cheng Hou, notice next bit computer control motor make CTS mechanism in six degree of freedom drive chorista model sport, it have been moved in track
Before, consider balance signal delay and chorista flight six-degree-of-freedom dynamics equation solution time, resolves and plan down in advance
One track ensures that separation body Model is transitioned into next track from a smooth trajectory.
The six degree of freedom captive trajectory testing method of the continuous in-orbit movement of the present invention is a kind of raising separation body Model fortune
The CTS test methods of dynamic path accuracy, the test method propose continuous in-orbit control mode, ensure that separation body Model according to
The track that chorista flight six-degree-of-freedom dynamics equation solver comes out is moved.The test method can be controlled and be counted simultaneously
The pose and speed for calculating tracing point, measure balance data in advance during model sport, solve full-scale chorista six
The degree of freedom equation of motion, and plan next section of movement locus, it carries out signal measurement without pause motion and data calculates so that is whole
A chorista model sport track Non-intermittent, it is ensured that separation body Model is maintained in real trace, improves test accuracy, is increased
Test data amount, shortens CTS test periods, reduces experimentation cost.
Description of the drawings
Fig. 1 is the separation body Model mechanism in six degree of freedom control system schematic diagram in the present invention;
Fig. 2 is the captive trajectory testing flow chart in the present invention.
Specific implementation mode
The present invention will be described in detail with reference to the accompanying drawings and examples.
As shown in Figure 1, the experiment that the six degree of freedom captive trajectory testing method of the continuous in-orbit movement of the present invention uses is set
Standby includes host computer, next bit computer, motor driver, motor, mechanism in six degree of freedom, position sensor, velocity pick-up
Device and force balance;The motor driver include X1 spindle motors driver, X2 spindle motors driver, y-axis motor driver,
Z1 spindle motors driver, Z2 spindle motors driver, α spindle motors driver, β spindle motors driver and γ spindle motor drivers;Institute
The motor stated includes X1 spindle motors corresponding with motor driver, X2 spindle motors, y-axis motor, Z1 spindle motors, Z2 spindle motors, α axis
Motor, β spindle motors and γ spindle motors;Absolute type encoder is installed, absolute type encoder is by acquisition on the motor shaft
Data are processed into position and speed information, and absolute type encoder has the dual function of position sensor and velocity sensor;
Its connection relation is that the host computer, next bit computer and motor driver are connected by cable, motor
Driver is connected by signal wire with power line with motor, and position sensor, velocity sensor and next bit computer pass through signal
Line connection, force balance are connected with next bit computer by signal wire;Force balance, dynamometry day are installed inside separation body Model
Flat strut is fixedly connected with mechanism in six degree of freedom;The motor driver driving motor control mechanism in six degree of freedom passes through survey
The strut of power balance drives chorista model sport;
The host computer is equipped with human-computer interaction program, and human-computer interaction program is for reading test parameters and preservation
Data, triggering experiment, display present speed and position, display balance signal;
The next bit computer is equipped with PLC softwares, is used for real-time control motor movement, and write in PLC softwares
The program of captive trajectory testing;
The running position signal of the position sensor detection separation body Model, and it is sent to next bit computer;
The running speed signal of the velocity sensor detection separation body Model, and it is sent to next bit computer;
The force balance measures the aerodynamic force of separation body Model, and is sent to next bit computer;
As shown in Fig. 2, the six degree of freedom captive trajectory testing method of the continuous in-orbit movement includes the following steps:
1a. is inputted by host computer human-computer interaction interface and is tested relevant force balance coefficient, pneumatically resolves and join
Count n for track in number, track operation hop count m, every section of track, model geometric shrinkage scale, velocity transformation scale, single hop
Track moves the deadline, resolving time in advance, balance delay time, read balance data time;Input six
Degree of freedom kinematics of mechanism is against dematrix R1, the speed in input mechanism in six degree of freedom space is mapped to the Jacobi square of joint space
Battle array R2;
1b. controls motor movement by slave computer computer PLC softwares, by chorista model sport to initial pose(), and track hop count i=0 of resolving is set;
1c. judges whether the track hop count i currently resolved is 0, if i=0, slave computer computer acquisition force balance is surveyed
The power and torque that the chorista model of amount is received;If i ≠ 0, i-th section of track of slave computer computer acquisition exists(t1-t2-t3)Extremely
(t1-t2)The power and torque that balance measurement chorista model is received in time range, and calculate the average value of power and torque;
1d. slave computer computers calculate power and torque suffered by full-scale chorista;
1e. resolves full-scale chorista kinetics equation group by differential equation group numerical algorithm, obtains the(i+1)Section rail
The pose and speed of n tracing point on mark;
1f. by world conversion method, obtain under wind tunnel axis system the pose of the separation corresponding n tracing point of body Model and
Speed;
1g. obtains separation body Model and corresponds to this n tracing point pose and speed by speed contracting ratio and Inverse Kinematics Solution method
Each motor corner and rotating speed of degree;
1h. utilizes each motor corner and rotating speed, by motor movement curve planing method, plans that the movement of each motor is bent
Line;
Track hop count i=i+1 that 1i. has been resolved;
1j. judges whether i is 1 at this time, if i=1, by the movement of i-th section of track, if i ≠ 1, waits for the(i-1)
After the completion of the movement of section track, then by i-th section of track movement;
1k. is when i-th section of track run duration, meetWhen, judge whether i is less than track and runs
Hop count m returns to step 1c if i≤m, and output trajectory after the completion of i-th section of track movement is waited for if i > m, terminates examination
It tests.
The differential equation group numerical algorithm includes one kind in single order or second order differential equations numerical algorithm.
The world conversion method is as follows:
The center of mass motion of full-scale chorista by n tracing point of full-scale chorista pose()
With speed()It is described;
Model geometric scaling factor is, start the initial pose for testing time-division isolated model(),
Under wind tunnel axis system detach body Model correspond to tracing point pose () and speed
(), specific formula for calculation is as follows:
。
The speed contracting ratio includes the following steps with Inverse Kinematics Solution method:
4a. increases speed the chorista model sport time change of scaleTimes, separation body Model is respectively same by degree speed
When reduce velocity transformation scaleTimes, then detach speed when body Model actual motion()
For
;
4b. is according to the pose for detaching some tracing point of body Model()It is transported with mechanism in six degree of freedom
It is dynamic to learn inverse dematrix R1, calculate the corresponding corner of each motor(), specific formula for calculation is as follows:
Speed when actual motion()It is mapped with the speed in mechanism in six degree of freedom space
To the Jacobian matrix R of joint space2, rotating speed(), specific formula for calculation is as follows:
。
The motor movement curve planing method is as follows:
The corresponding angle of motor of two neighboring tracing point in known single hop track,And angular speed,(), the two neighboring tracing point run duration in single hop trackAfterwards, it is inserted using cubic polynomial
Value, the equation for obtaining curve movement are as follows:
Wherein:
。
Embodiment 1
The present embodiment is implemented according to the above embodiment, it should be noted that differential equation group numerical algorithm is micro- using single order
Divide equation group numerical algorithm.Differential equation group formula is as follows:
Wherein,Be followed successively by that full-scale chorista is subject to along X to Y-direction and Z-direction
Resultant force;
Be followed successively by that full-scale chorista is subject to around X-axis, the resultant force of Y-axis and Z axis
Square;
To be followed successively by speed of the full-scale chorista with respect to main body along its body axis x to, Y-direction and Z-direction
Component, unit;
To be followed successively by speed of the full-scale chorista with respect to main body along its body axis x to, Y-direction and Z
To component change rate, unit;
To be followed successively by the angular speed of the opposite body rotation of full-scale separation along its body axis X-axis, Y-axis and Z
The projection of axis, unit;
To be followed successively by the angular acceleration of the opposite body rotation of full-scale separation along its body axis X-axis, Y-axis
It hangs down with Z the projection of axis, unit;
To be followed successively by the moment of inertia that full-scale chorista is rotated around its body axis X-axis, Y-axis and Z axis, unit;
It is that full-scale chorista is accumulated about the rotator inertia in its longitudinally asymmetric face, unit
For the quality of full-scale chorista, unit。
Above equation group is full-scale chorista kinetics equation group, and it is classical using quadravalence to solve above equation group
RungeKutta methods, the resultant force that the full-scale chorista speed and angular speed of last moment and full-scale chorista are subject to and
Resultant moment substitutes into quadravalence classics RungeKutta formula, solves the chorista speed of subsequent time()
And angular speed()Change rate.Increment after change rate is integrated brings the speed of last moment into and angular speed can
The speed and angular speed at current time are obtained, then integrates and can obtain position()And angle(),
Obtain the pose of each tracing point on every section of track()And speed().
Embodiment 2
The present embodiment and the embodiment of embodiment 1 are essentially identical, and the main distinction is:Differential equation group numerical algorithm is adopted
With second order differential equations numerical algorithm.Differential equation group formula is as follows:
Wherein,For the quality of full-scale chorista;
It is vectorial in fixed coordinate system bottom offset for full-scale chorista,,
For its second dervative vector;
Roll angle,Yaw angleFor pitch angle,For
Corresponding attitude angle first derivative vector,For corresponding attitude angle second dervative vector;
The direction cosine matrix of coordinate system is relatively fixed for separation body Model;Its calculation formula is as follows:
For body shafting angular speed,For body shafting angle
Percentage speed variation;
ForWithTransformed matrix, formula is:
For the resultant force vector suffered by full-scale chorista;
For resultant moment suffered by full-scale chorista to
Amount;
Moment of inertia matrix for chorista about chorista body shafting;
For body shafting angular speed coordinate square formation, wherein square formation expression way is as follows:
After obtaining the above second order differential equations formula, with numerical solutions such as Newmark β-methods, calculate、 And one
Order derivative.
The present invention is not limited to above-mentioned specific implementation mode, person of ordinary skill in the field from above-mentioned design,
Without performing creative labour, made various transformation are within the scope of the present invention.
Claims (5)
1. a kind of six degree of freedom captive trajectory testing method of continuous in-orbit movement, it is characterised in that:The test method makes
Testing equipment includes host computer, next bit computer, motor driver, motor, mechanism in six degree of freedom, position sensing
Device, velocity sensor and force balance;The motor driver includes X1 spindle motors driver, X2 spindle motors driver, Y-axis
Motor driver, Z1 spindle motors driver, Z2 spindle motors driver, α spindle motors driver, β spindle motors driver and γ axis electricity
Machine driver;The motor include X1 spindle motors corresponding with motor driver, X2 spindle motors, y-axis motor, Z1 spindle motors,
Z2 spindle motors, α spindle motors, β spindle motors and γ spindle motors;Absolute type encoder is installed, absolute type is compiled on the motor shaft
The data of acquisition are processed into position and speed information by code device, and absolute type encoder has position sensor and velocity sensor
Dual function;
Its connection relation is that the host computer, next bit computer and motor driver are connected by cable, motor driving
Device is connected by signal wire with power line with motor, and position sensor, velocity sensor and next bit computer are connected by signal wire
It connects, force balance is connected with next bit computer by signal wire;Force balance is installed inside separation body Model, force balance
Strut is fixedly connected with mechanism in six degree of freedom;The motor driver driving motor control mechanism in six degree of freedom passes through dynamometry day
Flat strut drives chorista model sport;
The host computer is equipped with human-computer interaction program, and human-computer interaction program is for reading test parameters and preserving number
According to, triggering experiment, display present speed and position, display balance signal;
The next bit computer is equipped with PLC softwares, is used for real-time control motor movement, and capture is write in PLC softwares
The program of trajectory tests;
The running position signal of the position sensor detection separation body Model, and it is sent to next bit computer;
The running speed signal of the velocity sensor detection separation body Model, and it is sent to next bit computer;
The force balance measures the aerodynamic force of separation body Model, and is sent to next bit computer;
The six degree of freedom captive trajectory testing method of the continuous in-orbit movement includes the following steps:
1a. is inputted by host computer human-computer interaction interface and is tested relevant force balance coefficient, pneumatically resolves parameter, rail
Mark runs the track points n in hop count m, every section of track, model geometric shrinkage scale, velocity transformation scale, single hop track
Move the deadline, resolving time in advance, balance delay time, read balance data time;Input six is freely
Kinematics of mechanism is spent against dematrix R1, the speed in input mechanism in six degree of freedom space is mapped to the Jacobian matrix R of joint space2;
1b. controls motor movement by slave computer computer PLC softwares, by chorista model sport to initial pose(), and track hop count i=0 of resolving is set;
1c. judges whether the track hop count i currently resolved is 0, if i=0, what slave computer computer acquisition force balance measured
The power and torque that chorista model is received;If i ≠ 0, i-th section of track of slave computer computer acquisition exists(t1-t2-t3)Extremely(t1-
t2)The power and torque that balance measurement chorista model is received in time range, and calculate the average value of power and torque;
1d. slave computer computers calculate power and torque suffered by full-scale chorista;
1e. resolves full-scale chorista kinetics equation group by differential equation group numerical algorithm, obtains the(i+1)On section track
The pose and speed of n tracing point;
1f. obtains the pose of the separation corresponding n tracing point of body Model and speed under wind tunnel axis system by world conversion method
Degree;
1g. by speed contract than and Inverse Kinematics Solution method, obtain separation body Model and correspond to this n tracing point pose and speed
Each motor corner and rotating speed;
1h. plans the curve movement of each motor using each motor corner and rotating speed by motor movement curve planing method;
Track hop count i=i+1 that 1i. has been resolved;
1j. judges whether i is 1 at this time, if i=1, by the movement of i-th section of track, if i ≠ 1, waits for the(i-1)Section rail
After the completion of mark movement, then by i-th section of track movement;
1k. is when i-th section of track run duration, meetWhen, judge whether i is less than track and runs hop count
M returns to step 1c if i≤m, and output trajectory after the completion of i-th section of track movement is waited for if i > m, terminates experiment.
2. the six degree of freedom captive trajectory testing method of continuous in-orbit movement according to claim 1, it is characterised in that:Institute
The differential equation group numerical algorithm stated includes one kind in single order or second order differential equations numerical algorithm.
3. the six degree of freedom captive trajectory testing method of continuous in-orbit movement according to claim 1, it is characterised in that:Institute
The world conversion method stated is as follows:
The center of mass motion of full-scale chorista by n tracing point of full-scale chorista pose()
With speed()It is described;
Model geometric scaling factor is, start the initial pose for testing time-division isolated model(),
Under wind tunnel axis system detach body Model correspond to tracing point pose () and speed
(), specific formula for calculation is as follows:
。
4. the six degree of freedom captive trajectory testing method of continuous in-orbit movement according to claim 1, it is characterised in that:Institute
The speed contracting ratio stated includes the following steps with Inverse Kinematics Solution method:
4a. increases speed the chorista model sport time change of scaleTimes, separation body Model is respectively subtracted by degree speed simultaneously
Few velocity transformation scaleTimes, then detach speed when body Model actual motion()For
;
4b. is according to the pose for detaching some tracing point of body Model()With mechanism in six degree of freedom kinematics
Inverse dematrix R1, calculate the corresponding corner of each motor(), specific formula for calculation is as follows:
Speed when actual motion()It is mapped to pass with the speed in mechanism in six degree of freedom space
Save the Jacobian matrix R in space2, rotating speed(), specific formula for calculation is as follows:
。
5. the six degree of freedom captive trajectory testing method of continuous in-orbit movement according to claim 1, it is characterised in that:Institute
The motor movement curve planing method stated is as follows:
The corresponding angle of motor of two neighboring tracing point in known single hop track,And angular speed,(), the two neighboring tracing point run duration in single hop trackAfterwards, it is inserted using cubic polynomial
Value, the equation for obtaining curve movement are as follows:
Wherein:
。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710298838.7A CN107121256B (en) | 2017-05-02 | 2017-05-02 | A kind of six degree of freedom captive trajectory testing method of continuous in-orbit movement |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710298838.7A CN107121256B (en) | 2017-05-02 | 2017-05-02 | A kind of six degree of freedom captive trajectory testing method of continuous in-orbit movement |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107121256A CN107121256A (en) | 2017-09-01 |
CN107121256B true CN107121256B (en) | 2018-10-09 |
Family
ID=59725059
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710298838.7A Active CN107121256B (en) | 2017-05-02 | 2017-05-02 | A kind of six degree of freedom captive trajectory testing method of continuous in-orbit movement |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107121256B (en) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107480402B (en) * | 2017-08-31 | 2019-07-16 | 北京理工大学 | A kind of plane pneumatically captures SOT state of termination coverage and determines method |
CN107991054B (en) * | 2017-11-08 | 2019-10-18 | 江西洪都航空工业集团有限责任公司 | A kind of captive trajectory experimental method |
CN107860545B (en) * | 2017-12-04 | 2024-04-12 | 中国航空工业集团公司沈阳空气动力研究所 | Six-degree-of-freedom system for large transonic wind tunnel large load model capture track test |
CN108414188A (en) * | 2018-03-22 | 2018-08-17 | 中国航空工业集团公司沈阳空气动力研究所 | It is a kind of to be used for and hang together the six component strain balance of double struts for playing CTS experiments |
CN108318217A (en) * | 2018-03-22 | 2018-07-24 | 中国航空工业集团公司沈阳空气动力研究所 | A kind of six component multi-disc beam balances for hanger CTS experiments in parallel |
CN110470449A (en) * | 2019-08-23 | 2019-11-19 | 中国航空工业集团公司沈阳空气动力研究所 | A kind of the captive trajectory testing method and test measuring and controlling equipment of continuous control mode |
CN110928239B (en) * | 2019-12-12 | 2020-11-13 | 山东大学 | Control method and system for feeding system of numerical control machine tool with time delay |
CN111693245B (en) * | 2020-06-23 | 2021-04-27 | 中国空气动力研究与发展中心超高速空气动力研究所 | Non-decoupling motion allocation method for continuous on-orbit linkage track capture experiment |
CN111693246B (en) * | 2020-06-23 | 2021-04-06 | 中国空气动力研究与发展中心超高速空气动力研究所 | Method for distributing motion of main body and separating body track capture experiment of continuous on-orbit motion |
CN112067248B (en) * | 2020-07-27 | 2022-09-23 | 中国航天空气动力技术研究院 | Nine-degree-of-freedom capture track test device and method for two-stage motion |
CN112964450B (en) * | 2021-02-07 | 2022-05-10 | 中国空气动力研究与发展中心超高速空气动力研究所 | Method for predicting trajectory of wind tunnel multi-body separation test model |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201653679U (en) * | 2010-04-29 | 2010-11-24 | 中国空气动力研究与发展中心高速空气动力研究所 | Real-time control device for capturing continuous motion of external store model in track wind tunnel test |
CN101907893A (en) * | 2010-07-02 | 2010-12-08 | 北京航空航天大学 | Aircraft component attitude adjusting assembly system based on parallel mechanism with six degrees of freedom and debugging method |
WO2010150506A1 (en) * | 2009-06-22 | 2010-12-29 | 川崎重工業株式会社 | Wind tunnel balance calibrator |
CN104964807A (en) * | 2015-04-22 | 2015-10-07 | 中国航天空气动力技术研究院 | Model pose continuous change collision detection method used for wind tunnel test |
CN105469406A (en) * | 2015-11-30 | 2016-04-06 | 东北大学 | Bounding box and space partitioning-based virtual object collision detection method |
CN106289708A (en) * | 2016-07-26 | 2017-01-04 | 中国航天空气动力技术研究院 | Pose scaling method for the motion of captive trajectory wind tunnel test |
CN106584464A (en) * | 2016-12-31 | 2017-04-26 | 重庆大学 | Method for compensating transmission chain errors of aircraft model of decoupling mechanism in captive trajectory tests |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102004030659B8 (en) * | 2004-06-24 | 2007-01-18 | Ruprecht Altenburger | mover |
-
2017
- 2017-05-02 CN CN201710298838.7A patent/CN107121256B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010150506A1 (en) * | 2009-06-22 | 2010-12-29 | 川崎重工業株式会社 | Wind tunnel balance calibrator |
CN201653679U (en) * | 2010-04-29 | 2010-11-24 | 中国空气动力研究与发展中心高速空气动力研究所 | Real-time control device for capturing continuous motion of external store model in track wind tunnel test |
CN101907893A (en) * | 2010-07-02 | 2010-12-08 | 北京航空航天大学 | Aircraft component attitude adjusting assembly system based on parallel mechanism with six degrees of freedom and debugging method |
CN104964807A (en) * | 2015-04-22 | 2015-10-07 | 中国航天空气动力技术研究院 | Model pose continuous change collision detection method used for wind tunnel test |
CN105469406A (en) * | 2015-11-30 | 2016-04-06 | 东北大学 | Bounding box and space partitioning-based virtual object collision detection method |
CN106289708A (en) * | 2016-07-26 | 2017-01-04 | 中国航天空气动力技术研究院 | Pose scaling method for the motion of captive trajectory wind tunnel test |
CN106584464A (en) * | 2016-12-31 | 2017-04-26 | 重庆大学 | Method for compensating transmission chain errors of aircraft model of decoupling mechanism in captive trajectory tests |
Non-Patent Citations (2)
Title |
---|
基于双闭环速度控制的捕获轨迹***;周润 等;《航空学报》;20131112;第1522页-1529页 * |
风洞CTS试验并联装置的速度控制方法;周润 等;《兵工自动化》;20170415;第63-68页 * |
Also Published As
Publication number | Publication date |
---|---|
CN107121256A (en) | 2017-09-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107121256B (en) | A kind of six degree of freedom captive trajectory testing method of continuous in-orbit movement | |
CN104133479B (en) | A kind of employing single-axle air bearing table simulates the method for testing of flexible satellite three-axis attitude coupled motions | |
CN102538598B (en) | A kind of motion simulation analogue system of infrared target | |
CN106885566B (en) | Wearable motion sensor and magnetic field interference resisting method thereof | |
CN105739537B (en) | A kind of small feature loss surface attachment movement Active Control Method | |
CN109916431A (en) | A kind of wheel encoder calibration algorithm for four wheel mobile robots | |
CN103869834B (en) | Three-axis air-bearing table barycenter intelligent adjusting method based on empirical modal method | |
CN105539890A (en) | Device and method for simulating space mechanical arm to capture ground three-dimensional space microgravity of target satellite | |
CN106607926A (en) | Driving mechanism, robot apparatus measurement method, robot apparatus control method and component manufacturing method | |
CN106200614B (en) | A kind of spacecraft attitude control test macro and method using the true torque of control-moment gyro | |
CN107457762A (en) | Robot arm control device, robot arm system including the same, and robot arm control method | |
CN107037739B (en) | Carrier rocket semi-physical simulation test inertial unit simulation method | |
TWI448969B (en) | Three - axis dynamic simulation platform system and its control method | |
CN103940442A (en) | Location method and device adopting accelerating convergence algorithm | |
CN107457783A (en) | Sixdegree-of-freedom simulation self-adapting intelligent detection method based on PD control device | |
CN103487011B (en) | A kind of attitude angle detection method of data glove | |
CN103868648A (en) | Barycenter measuring method for three-axis air floatation simulation experiment platform | |
CN104182614A (en) | System and method for monitoring attitude of mechanical arm with six degrees of freedom | |
CN111638654A (en) | Fault-adaptive intelligent control semi-physical simulation method for carrier rocket | |
CN107414827A (en) | Sixdegree-of-freedom simulation self-adapting detecting method based on linear feedback controller | |
CN202452892U (en) | Motion analogue simulation system for infrared target | |
CN110682290B (en) | Closed-loop mechanical arm system collision detection method based on momentum observer | |
CN104651909B (en) | Synchronous coordinated control method of series-parallel automobile electrophoretic painting conveying mechanism | |
CN103862458A (en) | Six-degree-of-freedom parallel platform for airborne servo system | |
CN105459116A (en) | Robot remote operation device and method based on magnetometer |
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 |