CN103496449B - A kind of aircraft side walls parts assembling posture adjustment method for planning track - Google Patents

A kind of aircraft side walls parts assembling posture adjustment method for planning track Download PDF

Info

Publication number
CN103496449B
CN103496449B CN201310384485.4A CN201310384485A CN103496449B CN 103496449 B CN103496449 B CN 103496449B CN 201310384485 A CN201310384485 A CN 201310384485A CN 103496449 B CN103496449 B CN 103496449B
Authority
CN
China
Prior art keywords
coordinate system
centerdot
side walls
pose
alpha
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.)
Expired - Fee Related
Application number
CN201310384485.4A
Other languages
Chinese (zh)
Other versions
CN103496449A (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.)
Chengdu Aircraft Industrial Group Co Ltd
Beihang University
Original Assignee
Chengdu Aircraft Industrial Group Co Ltd
Beihang University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Chengdu Aircraft Industrial Group Co Ltd, Beihang University filed Critical Chengdu Aircraft Industrial Group Co Ltd
Priority to CN201310384485.4A priority Critical patent/CN103496449B/en
Publication of CN103496449A publication Critical patent/CN103496449A/en
Application granted granted Critical
Publication of CN103496449B publication Critical patent/CN103496449B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

A kind of aircraft side walls parts assembling posture adjustment method for planning track, step is: one, on tooling base, install fixed target mirror, utilizes laser tracker to measure target mirror coordinate, sets up fixed coordinate system { A}; Two, on aircraft side walls parts, target mirror is installed, aircraft side walls parts is set up with moving coordinate system { B}; Three, target mirror is installed on every platform steady arm and sets up and drive system of axes { M i; Four, calculate that { { pose in A}, is the initial pose of aircraft side walls parts to B} at fixed coordinate system with moving coordinate system; Five, four nip points, target mirror is installed, utilizes laser tracker to measure target mirror coordinate, obtain bite in the fixed coordinate system { initial coordinate in A}; The anti-drive solution moving coordinate system { position vector under M}; Six, rotary motion trajectory planning; Seven, motion of translation trajectory planning.The present invention effectively reduces the control difficulty that pose_adjuster multiaxis is coordinated to drive, and solves the known and motion path of aircraft side walls parts pose at the whole story in fitting process uncertain pose adjustment trajectory planning problem.

Description

A kind of aircraft side walls parts assembling posture adjustment method for planning track
(1) technical field
The invention provides a kind of aircraft side walls parts assembling posture adjustment method for planning track, it is based on six-degree-of-freedom parallel connection mechanism aircraft side walls parts assembling posture adjustment method for planning track, belongs to aircraft components assembly technique field.
(2) technical background
Over nearly ten or twenty year, greatly develop numeric terminal technology with the Aviation Manufacturing Enterprises that Boeing and Air Passenger company are representative, generally adopt Digital-flexible Assembly Tool.The digital tool of highly versatiles a large amount of like this can repeated usage, not only can shorten the production cycle, improve fitting process, greatly improve assembly quality and work efficiency thereof, and go for the assembling of concentrated different aircraft product or parts due to its commonality and alerting ability, decrease frock quantity significantly.At present, the transporation by plane technology of China is compared with developed countries also very backward.Each main engine plants still follow to come based on the transporation by plane technology of handicraft workshop pattern in the past few decades substantially, adopt a large amount of standard frocks and special assembly tooling.
Aircraft components mostly adopts multiple steady arm to support in posture adjustment fitting process, by Automated condtrol, realizes pose posture adjustment and the docking of parts.Flexible assembly fixture based on multi-point support has the advantages such as stiffness/weight ratio is large, load-carrying capacity strong, fast response time as a kind of typical apply of parallel institution, but based on the posture adjustment assembly system of steady arm, generally all need multiaxis redundant drive, control method is had higher requirement.
Trajectory planning is the key issue must considered in many Design of Motion Control System processes, and whether the whether reasonable mechanism that will be directly connected to of its planning can finish the work task on request.Good trajectory planning even some performance figure of Neng Shi mechanism are optimized, such as time, energy ezpenditure, propulsive effort (moment) etc., and these are all the common trajectory planning targets of parallel institution.Rational trajectory planning is carried out to multi-shaft motion control system, reduces control difficulty necessary.
(3) summary of the invention
1, object:
The object of the invention is to propose a kind of aircraft side walls parts assembling posture adjustment method for planning track, it is the Aircraft-Oriented side member flexible assembly pose_adjuster in conjunction with autonomous Design, propose a kind of based on side member pose at the whole story the known and complete uncertain pose adjustment method for planning track of motion path, to reduce the control difficulty that pose_adjuster multiaxis is coordinated to drive.
2, technical scheme:
(1) first introducing flexible assembly pose_adjuster: as shown in Figure 1, this six-degree-of-freedom parallel connection mechanism aircraft side walls parts flexible assembly pose_adjuster, is the accurate three-coordinate positioner composition of front two rows, high level matches with low level layout primarily of four.See Fig. 2, aircraft side walls parts are considered as moving platform, jointly form 4-PPPS parallel institution with four steady arms, can realize adjusting aircraft side walls space of components 6DOF pose.Annexation between them is: each PPPS branch terminals and aircraft side walls parts connect to form typed ball bearing pair by ball pivot, is then connected with silent flatform by three mutually orthogonal moving sets successively.Front-seat two steady arms are for supporting aircraft side walls feature bottom position; Rear row two steady arms are used for supporting side walls component top position.Every platform three-coordinate positioner comprises 4 parts: x is to moving assembly, y to moving assembly, z to moving assembly and process connection.Aircraft side walls parts are connected by process connection with between steady arm, and this process connection can be considered ball and socket.Steady arm x, y, z to movement carry out precision actuation by servomotor.
Described PPPS side chain is fast by ball pivot, hold-down arm, cross holder, column, guide rail, base form.Hold-down arm end is connected with aircraft side walls parts by ball pivot, and hold-down arm and cross holder are fast, cross holder is fast and column, column and base are connected to form moving sets by guide rail slide block successively.
Described silent flatform refer to the adjustment level of fixing with ground assembly jig base,
Moving sets in the present invention adopts ball-screw and nut structure to realize single degree of freedom transmission campaign, nut and being fixed by driven unit, and each moving assembly all moves along rolling linear guide.
In the present invention, unidirectional guide rail is parallel to each other, and the guide rail of different directions is mutually orthogonal.
(2) a kind of aircraft side walls parts assembling of the present invention posture adjustment method for planning track, the method step is as follows:
Step one: install fixed target mirror on the tooling base of aircraft components erecting yard, utilizes laser tracker to measure target mirror coordinate, tooling base is set up a fixed coordinate system o-xyz, is designated as { A};
Step 2: install target mirror on aircraft side walls parts, { in A}, coordinate, aircraft side walls parts is set up one with moving coordinate system o '-x ' y ' z ', is designated as { B} at fixed coordinate system to utilize laser tracker to measure target mirror; Its origin of coordinates is at { the position vector p in A} a=(p xp yp z) t, at { the attitude matrix R in A} aB;
Step 3: install target mirror on every platform steady arm, utilizes laser tracker to measure target mirror at fixed coordinate system { coordinate o in A} i, every platform steady arm is set up one and drives system of axes o i-x iy iz i, be designated as { M i(i=1,2,3,4), the origin of coordinates is { position vector in A} is m i a;
Step 4: calculate with moving coordinate system that { { pose in A} is the initial pose of aircraft side walls parts, is designated as U B} at fixed coordinate system 0;
Step 5: install target mirror four nip points, utilize laser tracker to measure target mirror coordinate, { initial coordinate in A}, is designated as q at fixed coordinate system to obtain bite i a, (i=1,2,3,4); Anti-drive solution moving coordinate system { the position vector q under M} i m;
Step 6: rotary motion trajectory planning; First set the boundary condition of this trajectory planning, namely set posture adjustment time T, given aircraft side walls parts object pose U tand posture adjustment course motion boundary condition, be designated as:
1) pose boundary condition: U (0)=U 0, U (T)=U t;
2) velocity boundary conditions: v (0)=v 0, v (T)=v t;
3) acceleartion boundary condition: a (0)=a 0, a (T)=a t;
Calculate each steady arm drive volume;
Step 7: motion of translation trajectory planning; First set the boundary condition of this trajectory planning, namely set posture adjustment time T, given aircraft side walls parts object pose U tand posture adjustment course motion boundary condition, be designated as:
1) pose boundary condition: U (0)=U 0, U (T)=U t;
2) velocity boundary conditions: v (0)=v 0, v (T)=v t;
3) acceleartion boundary condition: a (0)=a 0, a (T)=a t.
Calculate each steady arm drive volume.
Wherein, described in step one " on tooling base, set up a fixed coordinate system o-xyz, be designated as A} ", its method for building up is:
Base is first installed a target mirror f 0, its position in the middle part of base, as fixed coordinate system { the initial point o of A}; O point vertical direction and with guide's x parallel direction on a target mirror f is installed respectively z, f x.With vector as x-axis, with vector direction as z-axis direction, according to right-hand rule determination y-axis direction, as shown in Figure 1.
Wherein, " set up on aircraft side walls parts with moving coordinate system { B} " described in step 2, its method for building up is;
In aircraft side walls parts approximate center, one target mirror f is installed o 'as moving coordinate system the initial point o ' of B}, and on aircraft side walls parts roughly with target mirror f o 'vertically and in horizontal direction target mirror f is installed z ', f x '.With vector as x ' axle, with vector y ' direction of principal axis, as z ' direction of principal axis, is determined according to right-hand rule in direction.
Wherein, " setting up and driving system of axes o on every platform steady arm described in step 3 i-x iy iz i, be designated as { M i", its method set up is;
In column bottom, one target mirror f is installed o ias driving system of axes { M iinitial point o i, x i, y i, z iall { the x, y, z direction of principal axis of A} is corresponding consistent with fixed coordinate system for direction of principal axis.
Wherein, " calculating with moving coordinate system that { { pose in A} is the initial pose of aircraft side walls parts, is designated as U B} at fixed coordinate system described in step 4 0", its method calculated is:
Utilize target mirror f in laser tracker instrumentation airplane side member o 'at fixed coordinate system, { position in A}, as aircraft side walls parts at fixed coordinate system { the initial position vector p in A} a=(p xp yp z) t.If under initial condition, with moving coordinate system, { relative to fixed coordinate system, { Eulerian angles of A}z, x, z rotation order are α (0), β (0), γ (0) to B}.Then with moving coordinate system B} relative to fixed coordinate system the pose transformation matrix of A} is:
R AB = cos α cos γ - sin α cos β sin γ - cos α sin γ - sin α cos β cos γ sin α sin β sin α cos γ + cos α cos β sin γ - sin α sin γ + cos α cos β cos γ - cos α sin β sin β sin γ sin β cos γ cos β
Then can obtain initial pose U 0=[p x(0) p y(0) p z(0) α (0) β (0) γ (0)] t.
Wherein, " the anti-drive solution moving coordinate system { M described in step 5 iunder position vector q i m", its method of instead separating is:
To steady arm i (i=1 ~ 4), its bite is in { the position vector in A} { in B}, position vector is q i b, then have:
q i A = R AB q i B + p A - - - ( 1 )
{ M iand A} coordinate axle is parallel to each other, and in whole side member posture adjustment process, { M iand { A} geo-stationary, so R a mibe 3 × 3 identity matrixs.Bite is at { M iin position vector be q i mithen have
q i A = R A M i q i M i + m i A - - - ( 2 )
Simultaneous formula (1) and formula (2) can obtain
q i M i = R AB q i B + p A - m i A - - - ( 3 )
By q i mito driving system of axes { M ithree main shaft coordinate projections can obtain each joint variable of steady arm i.To (3) formula differentiate, the joint velocity vector of steady arm i and the relation between acceleration and side member pose can be drawn.
q · i M i q · · i M i = R · AB p · A R · · AB p · · A q i B 1 - - - ( 4 )
Wherein, " rotary motion trajectory planning " described in step 6, the method for its trajectory planning is:
Adopt quintic algebra curve to carry out matching to rotary motion track, for Eulerian angles α, side member can be expressed as from initial pose to the rotary motion equation of locus of object pose process:
α ( t ) α · ( t ) α · · ( t ) = 1 t t 2 t 3 t 4 t 5 0 1 2 t 3 t 2 4 t 3 5 t 4 0 0 2 6 t 12 t 2 20 t 3 a 0 a 1 a 2 a 3 a 4 a 5 - - - ( 5 )
Kinematic boundary condition is substituted into (6) formula can solve:
α ( t ) = 6 Δα T R 5 t 5 - 15 Δα T R 4 t 4 + 10 Δα T R 3 t 3 + α 0 - - - ( 6 )
T in formula rfor the rotary motion time, α 0for initial attitude Eulerian angles, α 0=α (0), Δ α=α (T r)-α (0).
Utilize the method for planning track that α (t) is similar, the track can trying to achieve β and γ is:
β ( t ) γ ( t ) 6 Δβ T R 5 - 15 Δβ T R 4 20 Δβ T R 3 β 0 6 Δγ T R 5 - 15 Δγ T R 4 20 Δγ T R 3 γ 0 t 5 t 4 t 3 1 - - - ( 7 )
Side member rotary motion track U can be obtained by formula (6), (7) r(t) be:
U R(t)=[p x(0) p y(0) p z(0) α(t) β(t) γ(t)] T(8)
[p in formula x(0) p y(0) p z(0)] t=p a(0), for side member is at the position vector at initial pose place.Formula (8) is substituted into formula (3), path of motion that (4) can try to achieve each joint of steady arm in side member rotary movement is:
q i M i ( t ) = R AB ( t ) q i B + p A ( 0 ) - m i A q · i M i ( t ) = R · AB ( t ) q i B q · · i M i ( t ) = R · · AB ( t ) q i B - - - ( 9 )
Wherein, " calculating each steady arm drive volume " described in step 6, its method of calculating is:
By what try to achieve in formula (9) respectively to { M ichange in coordinate axis direction projection can obtain the corresponding drive volume driven.
Wherein, " motion of translation trajectory planning " described in step 7, the method for its trajectory planning is:
After side member completes pose adjustment, targeted attitude [α (T will be in r) β (T r) γ (T r)] t, only need to carry out motion of translation respectively along x, y, z three directions and can complete pose adjustment.Motion of translation for side member adopts " accelerate-at the uniform velocity-slow down " velocity mode, carry out trajectory planning with segmental cubic polynomials.In motion of translation trajectory planning, make accelerator and moderating process symmetry.The track U of motion of translation p(t) be:
U P(t)=[p x(t) p y(t) p z(t) α(T R) β(T R) γ(T R)] T(10)
T in formula pfor the side member motion of translation time.Formula (10) is substituted into formula (3), (4) can try to achieve the path of motion in each joint of steady arm in side member motion of translation process.
q i M i ( t ) = R AB ( T R ) q i B + p A ( t ) - m i A q · i M i ( t ) = p · A ( t ) q · · i M i ( t ) = p · · A ( t ) - - - ( 11 )
Wherein, " calculating each steady arm drive volume " described in step 7, its method of calculating is:
By what try to achieve in formula (11) respectively to { M ichange in coordinate axis direction projection can obtain the corresponding drive volume driven.
3, advantage and effect
The adjustment of aircraft side walls part pose, in conjunction with the Aircraft-Oriented side member flexible assembly pose_adjuster of autonomous Design, is decomposed into pose adjustment peace transposition whole two stages by the present invention.Take time as variable, carry out the adjustment of six spatial coordinates variable successively, effectively reduce the control difficulty that pose_adjuster multiaxis is coordinated to drive.Solve the complete uncertain pose adjustment trajectory planning problem of the known and motion path of aircraft side walls parts pose at the whole story in fitting process.
(4) accompanying drawing explanation
Fig. 1 is that aircraft side walls subassembler involved in the present invention fills schematic diagram.
Fig. 2 is aircraft side walls subassembler mounting mechanism kinematic sketch involved in the present invention.
Fig. 3 is operational flowchart of the present invention.
In figure, nomenclature is as follows:
1 process connection, 2 line slideways, 3 hold-down arms, 4 cross trays, 5 columns, 6 slide blocks, 7 line slideways, 8 tooling bases, 9 aircraft side walls parts, 10z to moving sets, 11y to moving sets, 12 typed ball bearing pair, 13x to moving sets, 14 tooling bases.
(5) detailed description of the invention
See Fig. 1 to Fig. 3, a kind of aircraft side walls parts assembling of the present invention posture adjustment method for planning track, its concrete implementation step is as follows:
Step one: install fixed target mirror on the tooling base of aircraft components erecting yard, utilizes laser tracker to measure target mirror coordinate, tooling base is set up a fixed coordinate system o-xyz, is designated as { A};
Step 2: install target mirror on aircraft side walls parts, { in A}, coordinate, aircraft side walls parts is set up one with moving coordinate system o '-x ' y ' z ', is designated as { B} at fixed coordinate system to utilize laser tracker to measure target mirror.Its origin of coordinates is at { the position vector p in A} a=(p xp yp z) t, at { the attitude matrix R in A} aB;
Step 3: install target mirror on every platform steady arm, utilizes laser tracker to measure target mirror at fixed coordinate system { coordinate o in A} i, every platform steady arm is set up one and drives system of axes o i-x iy iz i, be designated as { M i(i=1,2,3,4), the origin of coordinates is { position vector in A} is m i a;
Step 4: calculate with moving coordinate system that { { pose in A} is the initial pose of aircraft side walls parts, is designated as U B} at fixed coordinate system 0;
Step 5: install target mirror four nip points, utilize laser tracker to measure target mirror coordinate, { initial coordinate in A}, is designated as q at fixed coordinate system to obtain bite i a, (i=1,2,3,4).Anti-drive solution moving coordinate system { the position vector q under M} i m;
Step 6: rotary motion trajectory planning.Setting posture adjustment time T, given aircraft side walls parts object pose U tand posture adjustment course motion boundary condition.Be designated as:
1) pose boundary condition: U (0)=U 0, U (T)=U t;
2) velocity boundary conditions: v (0)=v 0, v (T)=v t;
3) acceleartion boundary condition: a (0)=a 0, a (T)=a t.
Calculate each steady arm drive volume;
Step 7: motion of translation trajectory planning.Setting posture adjustment time T, given aircraft side walls parts object pose U tand posture adjustment course motion boundary condition.Be designated as:
1) pose boundary condition: U (0)=U 0, U (T)=U t;
2) velocity boundary conditions: v (0)=v 0, v (T)=v t;
3) acceleartion boundary condition: a (0)=a 0, a (T)=a t.
Calculate each steady arm drive volume.
Wherein, described in step one tooling base set up fixed coordinate system the method for A} is:
Base is first installed a target mirror f 0, its position in the middle part of base, as fixed coordinate system { the initial point o of A}; O point vertical direction and with guide's x parallel direction on a target mirror f is installed respectively z, f x.With vector as x-axis, with vector direction as z-axis direction, according to right-hand rule determination y-axis direction, as shown in Figure 1.
Wherein, { method of B} is setting up on aircraft side walls parts described in step 2 with moving coordinate system;
In aircraft side walls parts approximate center, one target mirror f is installed o 'as moving coordinate system the initial point o ' of B}, and on aircraft side walls parts roughly with target mirror f o 'vertically and in horizontal direction target mirror f is installed z ', f x '.With vector as x ' axle, with vector y ' direction of principal axis, as z ' direction of principal axis, is determined according to right-hand rule, as shown in Figure 1 in direction.
Wherein, on steady arm, driving system of axes { M is being set up described in step 3 imethod be;
In column bottom, one target mirror f is installed o ias driving system of axes { M iinitial point o i, x i, y i, z iall { the x, y, z direction of principal axis of A} is corresponding consistent with fixed coordinate system for direction of principal axis.
Wherein, { B} is at fixed coordinate system { the initial pose U in A} calculating described in step 4 with moving coordinate system 0method be:
Utilize target mirror f in laser tracker instrumentation airplane side member o 'at fixed coordinate system, { position in A}, as aircraft side walls parts at fixed coordinate system { the initial position vector p in A} a=(p xp yp z) t.If under initial condition, with moving coordinate system, { relative to fixed coordinate system, { Eulerian angles of A}z, x, z rotation order are α (0), β (0), γ (0) to B}.Then with moving coordinate system B} relative to fixed coordinate system the pose transformation matrix of A} is:
R AB = cos α cos γ - sin α cos β sin γ - cos α sin γ - sin α cos β cos γ sin α sin β sin α cos γ + cos α cos β sin γ - sin α sin γ + cos α cos β cos γ - cos α sin β sin β sin γ sin β cos γ cos β
Then can obtain initial pose U 0=[p x(0) p y(0) p z(0) α (0) β (0) γ (0)] t
Wherein, anti-drive solution moving coordinate system { M described in step 5 iunder position vector q i mmethod be:
To steady arm i (i=1 ~ 4), its bite is at { the position vector q in A} i a=(q ix aq iy aq iz a) t, { in B}, position vector is q i b, then have:
q i A = R AB q i B + p A - - - ( 1 )
{ M iand A} coordinate axle is parallel to each other, and in whole side member posture adjustment process, { M iand { A} geo-stationary, so R a mibe 3 × 3 identity matrixs.Bite is at { M iin position vector be q i mi, then have
q i A = R A M i q i M i + m i A - - - ( 2 )
Simultaneous formula (1) and formula (2) can obtain
q i M i = R AB q i B + p A - m i A - - - ( 3 )
By q i mito driving system of axes { M ithree main shaft coordinate projections can obtain each joint variable of steady arm i.To (3) formula differentiate, the joint velocity vector of steady arm i and the relation between acceleration and side member pose can be drawn.
q · i M i q · · i M i = R · AB p · A R · · AB p · · A q i B 1 - - - ( 4 )
Wherein, described in step 6, the method for rotary motion trajectory planning is:
Kinematic boundary condition is set as follows in test:
1) pose boundary condition: U 0(0,0,0,0,0,0) t, U t=(0,0,0,0.015 ,-0.02,0.03) t
2) velocity boundary conditions: v (0)=0, v (T)=0;
3) acceleartion boundary condition: α (0)=0, α (T)=0.
Adopt quintic algebra curve to carry out matching to rotary motion track, for Eulerian angles α, side member can be expressed as from initial pose to the rotary motion equation of locus of object pose process:
α ( t ) α · ( t ) α · · ( t ) = 1 t t 2 t 3 t 4 t 5 0 1 2 t 3 t 2 4 t 3 5 t 4 0 0 2 6 t 12 t 2 20 t 3 a 0 a 1 a 2 a 3 a 4 a 5 - - - ( 5 )
Kinematic boundary condition is substituted into (6) formula can solve:
α ( t ) = 6 Δα T R 5 t 5 - 15 Δα T R 4 t 4 + 10 Δα T R 3 t 3 + α 0 - - - ( 6 )
The adjustment of Eulerian angles α, β, γ is carried out successively, regulation time sequence T in test r=(18,25,30), initial attitude Eulerian angles α 0=(0,0,0), targeted attitude Eulerian angles α (T r)=(0.015 ,-0.02,0.03), Δ α=α (T r)-α (0)=(0.015 ,-0.02,0.03).
Utilize the method for planning track that α (t) is similar, the track can trying to achieve β and γ is:
β ( t ) γ ( t ) = 6 Δβ T R 5 - 15 Δβ T R 4 20 Δβ T R 3 β 0 6 Δγ T R 5 - 15 Δγ T R 4 20 Δγ T R 3 γ 0 t 5 t 4 t 3 1 - - - ( 7 )
Side member rotary motion track U can be obtained by formula (6), (7) r(t) be:
U R(t)=[p x(0) p y(0) p z(0) α(t) β(t) γ(t)] T(8)
[p in formula x(0) p y(0) p z(0)] t=P a(0), for side member is at the position vector at initial pose place.Formula (8) is substituted into formula (3), path of motion that (4) can try to achieve each joint of steady arm in side member rotary movement is:
q i M i ( t ) = R AB ( t ) q i B + p A ( 0 ) - m i A q · i M i ( t ) = R · AB ( t ) q i B q · · i M i ( t ) = R · · AB ( t ) q i B - - - ( 9 )
Wherein, " calculating each steady arm drive volume " described in step 6, its method of calculating is:
By what try to achieve in formula (9) respectively to { M ichange in coordinate axis direction projection can obtain the corresponding drive volume driven.
Wherein, described in step 7, the method for motion of translation trajectory planning is:
After side member completes pose adjustment, targeted attitude [α (T will be in r) β (T r) γ (T r)] t, only need to carry out motion of translation respectively along x, y, z three directions and can complete pose adjustment, the track U of motion of translation p(t) be:
U p(t)=[p x(t) p y(t) p z(t) α(T R) β(T R) γ(T R))] T(10)
Kinematic boundary condition is set as follows in test:
1) pose boundary condition: U 0=(0,0,0,0,0,0) t, U t=(30 ,-45,25,0,0,0) t
2) velocity boundary conditions: v (0)=0, v (T)=0;
3) acceleartion boundary condition: α (0)=0, α (T)=0.
The adjustment of x, y, x is carried out successively, regulation time sequence T in test p=(24,35,22)
In aircraft side walls parts motion of translation process, the path of motion of steady arm is identical with the path of motion of aircraft side walls parts.Adopt " accelerating an at the uniform velocity deceleration " velocity mode, carry out trajectory planning with segmental cubic polynomials.In motion of translation trajectory planning, make accelerator and moderating process symmetry.For motion of translation (y to z to identical) in the x-direction, the acceleration/accel of side member, speed, location track are respectively shown in formula (11), (12), (13).
p · · x ( t ) = b 0 t + b 1 t ∈ [ 0 , T P 6 ] - b 0 t + b 2 t ∈ [ T P 6 , T P 3 ] 0 t ∈ [ T P 3 , 2 T P 3 ] - b 0 t + b 3 t ∈ [ 2 T P 3 , 5 T P 6 ] b 0 t + b 4 t ∈ [ 5 T P 6 , T P ] - - - ( 11 )
p · x ( t ) = 1 2 b 0 t 2 + b 1 t + b 5 t ∈ [ 0 , T p 6 ] - 1 2 b 0 t 2 + b 2 t + b 6 t ∈ [ T p 6 , T p 3 ] b 7 t ∈ [ T p 3 , 2 T p 3 ] - 1 2 b 0 t 2 + b 3 t + b 8 t ∈ [ 2 T p 3 , 5 T p 6 ] 1 2 b 0 t 2 + b 4 t + b 9 t ∈ [ 5 T p 6 , T p ] - - - ( 12 )
p x ( t ) = 1 6 b 0 t 3 + 1 2 b 1 t 2 + b 5 t + b 10 t ∈ [ 0 , T P 6 ] - 1 6 b 0 t 3 + 1 2 b 2 t 2 + b 6 t + b 11 t ∈ [ T P 6 , T P 3 ] b 7 t + b 12 t ∈ [ T P 3 , 2 T P 3 ] - 1 6 b 0 t 3 + 1 2 b 3 t 2 + b 8 t + b 13 t ∈ [ 2 T P 3 , 5 T P 6 ] 1 6 b 0 t 3 + 1 2 b 4 t 2 + b 9 t + b 14 t ∈ [ 5 T P 6 , T P ] - - - ( 13 )
Respectively 6 kinematic boundary conditions are substituted into formula (11), (12), (13), be combined in the continuity of side member displacement in motion of translation process, speed and acceleration trajectory simultaneously, can solve that to obtain motion of translation equation of locus as follows:
p · · x ( t ) = 54 Δ p x T P 3 t - 54 Δ p x T P 3 t + 18 Δ p x T P 2 0 - 54 Δ p x T P 3 t + 36 Δ p x T P 2 54 Δ p x T P 3 t - 54 Δ p x T P 2 - - - ( 14 )
p · x ( t ) = 27 Δ p x T P 3 t 2 - 27 Δ p x T P 3 t 2 + 18 Δ p x T P 2 t - 3 Δ p x 2 T P 3 Δ p x 2 T P - 27 Δ p x T P 3 t 2 + 36 Δ p x T P 2 t - 21 Δ p x 2 T P 27 Δ p x T P 3 t 2 - 54 Δ p x T P 2 t + 27 Δ p x T P - - - ( 15 )
p x ( t ) = 9 Δ p x T P 3 t 3 + p x 0 - 9 Δ p x T P 3 t 3 + 9 Δ p x T P 2 t 2 - 3 Δ p x 2 T P t + Δ p x 12 + p x 0 3 Δ p x 2 T P t - Δ p x 4 + p x 0 - 9 Δ p x T P 3 t 3 + 18 Δ p x T P 2 t 2 - 21 Δ p x 2 T P t + 29 Δ p x 12 + p x 0 9 Δ p x T P 3 t 3 - 27 Δ p x T P 2 t 2 + 27 Δ p x T P t - 8 Δ p x + p x 0 - - - ( 16 )
T in formula pfor the side member motion of translation time, p x0for the position coordinate at initial pose place, p x0=p x(0), Δ p x=p x(T p)-p x(0).P y(t) and p zthe same p of trajectory planning of (t) xt (), by p x(t), p y(t), p zt () substitutes into the track that formula (10) can obtain side member motion of translation.
Wherein, " calculating each steady arm drive volume " described in step 7, its method of calculating is:
By what try to achieve in formula (11) respectively to { M ichange in coordinate axis direction projection can obtain the corresponding drive volume driven.

Claims (10)

1. an aircraft side walls parts assembling posture adjustment method for planning track, is characterized in that: the method step is as follows:
Step one: install fixed target mirror on the tooling base of aircraft components erecting yard, utilizes laser tracker to measure target mirror coordinate, tooling base is set up a fixed coordinate system o-xyz, is designated as { A};
Step 2: install target mirror on aircraft side walls parts, { in A}, coordinate, aircraft side walls parts is set up one with moving coordinate system o '-x ' y ' z ', is designated as { B} at fixed coordinate system to utilize laser tracker to measure target mirror; Its origin of coordinates is at { the position vector p in A} a=(p xp yp z) t, at { the attitude matrix R in A} aB;
Step 3: install target mirror on every platform steady arm, utilizes laser tracker to measure target mirror at fixed coordinate system { coordinate o in A} i, every platform steady arm is set up one and drives system of axes o i-x iy iz i, be designated as { M i, i=1,2,3, position vector in 4, origin of coordinates ﹛ A ﹜ is m i a;
Step 4: calculate with moving coordinate system that { { pose in A} is the initial pose of aircraft side walls parts, is designated as U B} at fixed coordinate system 0;
Step 5: install target mirror four nip points, utilize laser tracker to measure target mirror coordinate, { initial coordinate in A}, is designated as q at fixed coordinate system to obtain bite i a, i=1,2,3,4; Anti-drive solution moving coordinate system { the position vector q under M} i m;
Step 6: rotary motion trajectory planning; First set the boundary condition of this trajectory planning, namely set posture adjustment time T, given aircraft side walls parts object pose U tand posture adjustment course motion boundary condition, be designated as:
1) pose boundary condition: U (0)=U 0, U (T)=U t;
2) velocity boundary conditions: v (0)=v 0, v (T)=v t;
3) acceleartion boundary condition: a (0)=a 0, a (T)=a t;
Calculate each steady arm drive volume;
Step 7: motion of translation trajectory planning; First set the boundary condition of this trajectory planning, namely set posture adjustment time T, given aircraft side walls parts object pose U tand posture adjustment course motion boundary condition, be designated as:
1) pose boundary condition: U (0)=U 0, U (T)=U t;
2) velocity boundary conditions: v (0)=v 0, v (T)=v t;
3) acceleartion boundary condition: a (0)=a 0, a (T)=a t;
Calculate each steady arm drive volume.
2. a kind of aircraft side walls parts assembling posture adjustment method for planning track according to claim 1, is characterized in that:
Described in step one " on tooling base, set up a fixed coordinate system o-xyz, be designated as A} ", its method for building up is: on tooling base, first install a target mirror f 0, its position in the middle part of tooling base, as fixed coordinate system { the initial point o of A}; O point vertical direction and with guide's x parallel direction on a target mirror f is installed respectively z, f x, with vector as x-axis, with vector direction as z-axis direction, according to right-hand rule determination y-axis direction.
3. a kind of aircraft side walls parts assembling posture adjustment method for planning track according to claim 1, is characterized in that:
" set up on aircraft side walls parts with moving coordinate system { B} " described in step 2, its method for building up is: install a target mirror f at aircraft side walls part centre place o 'as moving coordinate system, { the initial point o ' of B}, with target mirror f on aircraft side walls parts o 'vertically and in horizontal direction target mirror f is installed z ', f x ', with vector as x ' axle, with vector y ' direction of principal axis, as z ' direction of principal axis, is determined according to right-hand rule in direction.
4. a kind of aircraft side walls parts assembling posture adjustment method for planning track according to claim 1, is characterized in that:
" setting up and driving system of axes o on every platform steady arm described in step 3 i-x iy iz i, be designated as { M i", its method set up is: install a target mirror f in column bottom o ias driving system of axes { M iinitial point o i, x i, y i, z iall { the x, y, z direction of principal axis of A} is corresponding consistent with fixed coordinate system for direction of principal axis.
5. a kind of aircraft side walls parts assembling posture adjustment method for planning track according to claim 1, is characterized in that:
" calculating with moving coordinate system that { { pose in A} is the initial pose of aircraft side walls parts, is designated as U B} at fixed coordinate system described in step 4 0", its method calculated is:
Utilize target mirror f in laser tracker instrumentation airplane side member o 'at fixed coordinate system, { position in A}, as aircraft side walls parts at fixed coordinate system { the initial position vector p in A} a=(p xp yp z) t; If under initial condition, with moving coordinate system B} relative to fixed coordinate system A}z, x, z rotation order Eulerian angles be α (0), β (0), γ (0), then with moving coordinate system B} relative to fixed coordinate system the pose transformation matrix of A} is:
R AB = cos α cos γ - sin α cos β sin γ - cos α sin γ - sin α cos β cos γ sin α sin β sin α cos γ + cos α cos β sin γ - sin α sin γ + cos α cos β cos γ - cos α sin β sin β sin γ sin β cos γ cos β
Then obtain initial pose U0=[p x(0) p y(0) p z(0) α (0) β (0) γ (0)] t.
6. a kind of aircraft side walls parts assembling posture adjustment method for planning track according to claim 1, is characterized in that:
" anti-drive solution moving coordinate system { M described in step 5 iunder position vector q i m", its method of instead separating is:
To steady arm I (i=1 ~ 4), its bite is at { the position vector q in A} i a=(q ix aq iy aq iz a) t, { in B}, position vector is q i b, then have:
q i A = R AB q i B + p A - - - ( 1 )
{ M iand A} coordinate axle is parallel to each other, and in whole side member posture adjustment process, { M iand { A} geo-stationary, so R a mibe 3 × 3 identity matrixs, bite is at { M iin position vector be q i mi, then have
q i A = R A M i q i M i + m i A - - - ( 2 )
Simultaneous formula (1) and formula (2) obtain
q i M i = R AB q i B + p A - m i A - - - ( 3 )
By q i mito driving moving coordinate system ﹛ M inamely three main shaft coordinate projections of ﹜ obtain each joint variable of steady arm i; To (3) formula differentiate, namely draw the joint velocity vector of steady arm i and the relation between acceleration and side member pose:
q · i M i q · · i M i = R · AB p · A R · · AB p · · A q i B 1 - - - ( 4 ) .
7. a kind of aircraft side walls parts assembling posture adjustment method for planning track according to claim 1, is characterized in that:
" rotary motion trajectory planning " described in step 6, the method for this trajectory planning is:
Adopt quintic algebra curve to carry out matching to rotary motion track, Eulerian angles are α, and side member is expressed as from initial pose to the rotary motion equation of locus of object pose process:
α ( t ) α · ( t ) α · · ( t ) = 1 t t 2 t 3 t 4 t 5 0 1 2 t 3 t 2 4 t 3 5 t 4 0 0 2 6 t 12 t 2 20 t 3 a 0 a 1 a 2 a 3 a 4 a 5 - - - ( 5 )
Kinematic boundary condition is substituted into (6) formula solve:
α ( t ) = 6 Δα T R 5 t 5 - 15 Δα T R 4 t 4 + 10 Δα T R 3 t 3 + α 0 - - - ( 6 )
T in formula rfor the rotary motion time, α 0for initial attitude Eulerian angles, α 0=α (0), Δ α=α (T r)-α (0);
Utilize the method for planning track that α (t) is similar, the track of trying to achieve β and γ is:
β ( t ) γ ( t ) = 6 Δβ T R 5 - 15 Δβ T R 4 20 Δβ T R 3 β 0 6 Δγ T R 5 - 15 Δγ T R 4 20 Δγ T R 3 γ 0 t 5 t 4 t 3 1 - - - ( 7 )
Side member rotary motion track U is obtained by formula (6), (7) r(t) be:
U R(t)=[p x(0) p y(0) p z(0) α(t) β(t) γ(t)] T(8)
[p in formula x(0) p y(0) p z(0)] t=p a(0), for side member is at the position vector at initial pose place; Formula (8) is substituted into formula (3), path of motion that (4) namely try to achieve each joint of steady arm in side member rotary movement is:
q i M i ( t ) = R AB ( t ) q i B + P A ( 0 ) - m i A q · i M i ( t ) = R · AB ( t ) q i B q · · i M i ( t ) = R · · AB ( t ) q i B - - - ( 9 ) .
8. a kind of aircraft side walls parts assembling posture adjustment method for planning track according to claim 7, is characterized in that:
" calculating each steady arm drive volume " described in step 6, its method of calculating is: by what try to achieve in formula (9) respectively to { M inamely change in coordinate axis direction projection obtain the corresponding drive volume driven.
9. a kind of aircraft side walls parts assembling posture adjustment method for planning track according to claim 1, is characterized in that:
" motion of translation trajectory planning " described in step 7, the method for this trajectory planning is:
After side member completes pose adjustment, targeted attitude [α (T will be in r) β (T r) γ (T r)] t, only need to carry out motion of translation respectively along x, y, z three directions and namely complete pose adjustment; Motion of translation for side member adopts " accelerate-at the uniform velocity-slow down " velocity mode, carry out trajectory planning with segmental cubic polynomials; In motion of translation trajectory planning, make accelerator and moderating process symmetry, the track U of motion of translation p(t) be:
U P(t)=[p x(t) p y(t) p z(t) α(T R) β(T R) γ(T R)] T(10)
T in formula pfor the side member motion of translation time; Formula (10) is substituted into formula (3), (4) namely try to achieve the path of motion in each joint of steady arm in side member motion of translation process;
q i M i ( t ) = R AB ( T R ) q i B + p A ( t ) - m i A q · i M i ( t ) = p · A ( t ) q · · i M i ( t ) = p · · A ( t ) - - - ( 11 ) .
10. a kind of aircraft side walls parts assembling posture adjustment method for planning track according to claim 9, is characterized in that:
" calculating each steady arm drive volume " described in step 7, its method of calculating is:
By what try to achieve in formula (11) respectively to { M inamely change in coordinate axis direction projection obtain the corresponding drive volume driven.
CN201310384485.4A 2013-08-29 2013-08-29 A kind of aircraft side walls parts assembling posture adjustment method for planning track Expired - Fee Related CN103496449B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310384485.4A CN103496449B (en) 2013-08-29 2013-08-29 A kind of aircraft side walls parts assembling posture adjustment method for planning track

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310384485.4A CN103496449B (en) 2013-08-29 2013-08-29 A kind of aircraft side walls parts assembling posture adjustment method for planning track

Publications (2)

Publication Number Publication Date
CN103496449A CN103496449A (en) 2014-01-08
CN103496449B true CN103496449B (en) 2015-09-30

Family

ID=49861746

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310384485.4A Expired - Fee Related CN103496449B (en) 2013-08-29 2013-08-29 A kind of aircraft side walls parts assembling posture adjustment method for planning track

Country Status (1)

Country Link
CN (1) CN103496449B (en)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105015800B (en) * 2015-05-19 2017-07-07 北京星航机电装备有限公司 Spacecraft bay section automatic assembly system on the ground
CN105081719A (en) * 2015-07-31 2015-11-25 北京星航机电装备有限公司 Spacecraft cabin automatic assembly system based on visual measurement and assembly method thereof
CN105651166B (en) * 2015-12-30 2018-04-24 哈尔滨工业大学 Spacecraft product final assemble accuracy measurement method based on workpiece coordinate system
CN107102645B (en) * 2016-02-22 2023-07-21 成都飞机工业(集团)有限责任公司 Aircraft attitude adjusting device
CN109911241B (en) * 2019-03-20 2022-06-14 成都飞机工业(集团)有限责任公司 Seven-degree polynomial-based multi-section automatic posture adjusting method
CN111351480B (en) * 2020-03-17 2021-10-15 北京航空航天大学 Aircraft attitude adjusting path optimization method based on rotation
CN111422374B (en) * 2020-04-01 2022-04-29 中国航空制造技术研究院 Coordination and compensation method suitable for welded part and machine body structure
WO2022198588A1 (en) * 2021-03-25 2022-09-29 苏州迈澜医疗科技有限公司 Six-degree-of-freedom movement mechanism
CN113084228B (en) * 2021-03-30 2022-07-26 杭州艾美依航空制造装备有限公司 Positioning tool for automatic drilling and riveting of aircraft panel
CN114104323B (en) * 2021-11-12 2023-06-23 中航西安飞机工业集团股份有限公司 Large-angle rotation flexible attitude adjustment device and attitude adjustment method for aircraft wall plate
CN115071997B (en) * 2022-06-20 2024-06-11 成都飞机工业(集团)有限责任公司 Aircraft wing assembly device and assembly method
CN115446612A (en) * 2022-09-22 2022-12-09 山东大学 Six-degree-of-freedom precision positioning platform driven by stick-slip

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2226168C1 (en) * 2002-09-09 2004-03-27 ГОУ "Иркутский государственный технический университет" Method of placing article in preset spatial position and device for realization of this method
CN101362515A (en) * 2008-09-19 2009-02-11 浙江大学 Path planning method of aircraft pose alignment
CN101362514A (en) * 2008-09-19 2009-02-11 浙江大学 Pose alignment system and method of aircraft part based on three locater
CN101362511A (en) * 2008-09-19 2009-02-11 浙江大学 Synergetic control method of aircraft part pose alignment based on four locater
CN101456452A (en) * 2008-12-25 2009-06-17 浙江大学 Aircraft fuselage flexible and automatic attitude-adjusting method
CN102001451A (en) * 2010-11-12 2011-04-06 浙江大学 Airplane component attitude adjusting and butting system based on four numeric control positioners, attitude adjusting platform and mobile bracket and corresponding method

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2226168C1 (en) * 2002-09-09 2004-03-27 ГОУ "Иркутский государственный технический университет" Method of placing article in preset spatial position and device for realization of this method
CN101362515A (en) * 2008-09-19 2009-02-11 浙江大学 Path planning method of aircraft pose alignment
CN101362514A (en) * 2008-09-19 2009-02-11 浙江大学 Pose alignment system and method of aircraft part based on three locater
CN101362511A (en) * 2008-09-19 2009-02-11 浙江大学 Synergetic control method of aircraft part pose alignment based on four locater
CN101456452A (en) * 2008-12-25 2009-06-17 浙江大学 Aircraft fuselage flexible and automatic attitude-adjusting method
CN102001451A (en) * 2010-11-12 2011-04-06 浙江大学 Airplane component attitude adjusting and butting system based on four numeric control positioners, attitude adjusting platform and mobile bracket and corresponding method

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
大型飞机部件数字化对接装配技术研究;邹冀华等;《计算机集成制造系统》;20070731;第13卷(第7期);1367-1373 *
飞机柔性装配制孔设备的工件坐标系建立方法;王丽秀;《机械设计与制造》;20120430(第4期);229-231 *

Also Published As

Publication number Publication date
CN103496449A (en) 2014-01-08

Similar Documents

Publication Publication Date Title
CN103496449B (en) A kind of aircraft side walls parts assembling posture adjustment method for planning track
CN108161896B (en) 6-PSS parallel mechanism
CN109605371B (en) Mobile hybrid robot processing integrated system
US8005563B2 (en) System for assembling aircraft
CN105974822B (en) A kind of spacecraft, which is independently diversion, intersects the verification method of control system ground validation device
CN111665784B (en) Siemens subsystem-based spatial positioning error compensation method
CN108204879B (en) A kind of measuring method and system of rotary inertia
CN101850850A (en) Layout method of central airframe digital assembly of big plane
CN101907893A (en) Aircraft component attitude adjusting assembly system based on parallel mechanism with six degrees of freedom and debugging method
CN106885676A (en) The non-decoupling mechanism in six degree of freedom end position and attitude error penalty method that aerodynamic loading is produced
CN105015800A (en) Automatic assembly system of spacecraft cabin on ground
CN102941545A (en) Flexible tool for assembling row-line chuck type wall board
CN109911241A (en) A kind of attitude-adjusting method of the multi-section automatic attitude-adjusting based on seven order polynomials
CN103862458A (en) Six-degree-of-freedom parallel platform for airborne servo system
CN109141802A (en) Analogy method for the store Combinations control law in captive trajectory testing
Peng et al. Development of an integrated laser sensors based measurement system for large-scale components automated assembly application
Shao et al. Driving force analysis for the secondary adjustable system in FAST
CN102331784B (en) Online adjusting system and method for attitude aligning and positioning before assembly of nose gear of airplane
CN106840587B (en) Six degree of freedom wind tunnel test end position and attitude error penalty method based on six-dimensional force measurement
CN111504582A (en) Novel flexible cable rigidity measuring method and system
CN107665616A (en) A kind of nine-degree of freedom motion simulator relative motion equivalent method and system
CN106768789A (en) The decoupling six-freedom mechanism store Combinations position and attitude error penalty method that aerodynamic loading causes
CN112462753A (en) Kinematic modeling method of vehicle-snake combined variable structure mobile robot
CN207141431U (en) Nine-degree of freedom sport simulated system
CN111243374A (en) Six-degree-of-freedom motion simulator with large translation stroke and high response speed

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20150930

Termination date: 20180829

CF01 Termination of patent right due to non-payment of annual fee