CN107263466A - Pedestal unperturbed control method of the robot for space based on quadratic programming problem - Google Patents
Pedestal unperturbed control method of the robot for space based on quadratic programming problem Download PDFInfo
- Publication number
- CN107263466A CN107263466A CN201710330726.5A CN201710330726A CN107263466A CN 107263466 A CN107263466 A CN 107263466A CN 201710330726 A CN201710330726 A CN 201710330726A CN 107263466 A CN107263466 A CN 107263466A
- Authority
- CN
- China
- Prior art keywords
- msub
- mover
- mrow
- mtd
- mtr
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1612—Programme controls characterised by the hand, wrist, grip control
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
The invention discloses a kind of pedestal unperturbed control method of robot for space based on quadratic programming problem, including the kinetic model under robot for space operating space is derived;Establish the governing equation of pedestal unperturbed task and end effector tracing task;By solving quadratic programming problem, the joint moment of pedestal, end effector mission requirements and Filters with Magnitude Constraints is met;The validity of method proposed by the present invention finally by case verification.The present invention is by deriving the kinetic model under robot for space operating space, it is not necessary to solve Inverse Kinematics Problem, directly obtains and meets mission requirements and can be applied directly to the joint moment of system.
Description
Technical field
The present invention relates to a kind of robot for space pedestal unperturbed control method, more particularly to robot for space is based on secondary rule
The pedestal unperturbed control method for the problem of drawing.
Background technology
Robot for space possesses the ability for performing the fine space tasks such as in-orbit spacecraft maintenance, space junk cleaning, because
And begun one's study from 1990s mid-term, each spacefaring nation and the concern of researcher are constantly caused so far.With ground machine
Tool arm is different, because Dynamics Coupling is acted on, space manipulator meeting in motion process
Reaction force and torque are produced to the pedestal spacecraft freely floated, and cause the change of pedestal pose.Reduce this
Plant the pedestal spacecraft of microgravity environment and holding disturbance of the manipulator motion to pedestal keeps to(for) Space Robot System
Communicate over the ground significant.Part work trial pedestal control system, such as propeller and counteraction flyback, to mend
The disturbance that manipulator motion is produced to pedestal is repaid, however, propeller fuel is a kind of precious for system performs orbit maneuver
Expensive resource, the torque that counteraction flyback is produced is limited, it is necessary to limits mechanical arm and is moved with the speed of very little.Another part works
The motion using mechanical arm is then attempted, including the pose of pedestal is adjusted by the motion of mechanical arm or is expected that by constructing redundancy
Mechanical arm makes not producing the disturbance to pedestal during mechanical arm execution task.
Include disturbance figure/enhancing disturbance figure (Disturbance map/ using the typical method of manipulator motion
Enhanced disturbance map, DM/EDM) method and reaction kernel (Reaction null space, RNS) side
Method.Wherein, disturbance figure/enhancing disturbance drawing method shows manipulator motion to pedestal disturbance minimum and maximum under joint space
Direction, so that the motion of mechanical arm is instructed, the property of the reaction Zero Space Method and Its utilization space robot system conservation of angular momentum,
Pedestal speed is solution conservation of angular momentum equation under conditions of zero, so as to find the joint motions speed for being zero to pedestal disturbance.
Solution to redundant mechanical arm track is described as optimization problem by other methods, including solution local optimum problem obtains machinery
The pedestal unperturbed track of arm, wherein, the track in each joint is by the technologies such as Rayleigh-Ritz and polynomial function by parameter
Change;Or require pedestal unperturbed etc. to be included in object function by Lagrange multiplier, so that by solving nonlinear equation
Obtain mechanical arm pedestal unperturbed track;And the minimum variance problem containing linear equality constraints is solved, so as to obtain simultaneously full
The manipulator motion track of sufficient pedestal unperturbed and end effector tracer request.However, above-mentioned all methods can be attributed to greatly
Redundancy decomposition strategy of the robot for space based on inverse kinematics, obtained result is the angular speed or angular acceleration in joint, is
Result is applied to Space Robot System, in addition it is also necessary to which extra kinematics control method calculates moment method.The present invention
Propose a kind of pedestal unperturbed control method of robot for space based on quadratic programming problem, it is not necessary to inverse kinematics, obtain
Result be to meet pedestal unperturbed, end effector tracking desired trajectory etc. mission requirements and the phase in joint can be applied directly to
Hope joint moment.
The content of the invention
Manipulator motion may cause the problem of pedestal spacecraft pose is disturbed during for robot for space execution task,
The present invention proposes a kind of pedestal unperturbed control method of the robot for space based on quadratic programming problem, is different from conventional method needs
The solution for solving Inverse Kinematics Problem and obtaining is can not act directly on joint angular speed, the angular acceleration of system, the present invention
By deriving the kinetic model under robot for space operating space, it is not necessary to solve Inverse Kinematics Problem, satisfaction is directly obtained
Mission requirements and the joint moment that system can be applied directly to.
The technical proposal of the invention is realized in this way:
The present invention proposes a kind of control method of robot for space pedestal unperturbed, including has derived robot for space operation
Kinetic model under space;Establish the governing equation of pedestal unperturbed task and end effector tracing task;By solving
Quadratic programming problem, is met the joint moment of pedestal, end effector mission requirements and Filters with Magnitude Constraints;Finally by
The case verification validity of method proposed by the present invention.The implementation of the invention mainly includes three below step:
Step 1: setting up robot for space operating space kinetic model.
Space Robot System is made up of the mechanical arm of pedestal spacecraft and the n frees degree, be typically chosen the line of pedestal/
The rotary speed in angular speed and joint is as generalized variable, based on lagrange equation of the second kind, the dynamics of robot for space
Model can be expressed as follows:
Wherein,For line/angular speed of pedestal,It is the vector of each joint rotating speed composition, Hb,HmFor pedestal and
Mechanical arm inertia matrix, HbmFor the coupling torque matrix c between end effector and mechanical armb,cmTo be non-with velocity correlation
Linear term, fb,feThe external force and moment of face being subject to for pedestal and end effector, τ are the opplied moment at joint of mechanical arm.
In the present invention, it is considered to the pedestal that the Space Robot System freely floated is not fixed, from the point of view of modeling,
The end effector of mechanical arm can also be considered as " pedestal " of system, and pedestal spacecraft can then be considered as " end " of system,
Modeled so as to carry out system from end effector to pedestal.Because in existing modeling method, representing end effector
Body coordinate system is built upon greatly the end of last connecting rod, and the present invention is moved the body coordinate system of pedestal by its barycenter
To pedestal one end so that Space Robot System turns into a symmetrical system, so as to be modeled down from end effector to pedestal
Obtained kinetic model will have identical structure with the kinetic model obtained under the modeling of pedestal end-effector.So
And, generalized variable in kinetic model is by the line/angular speed for being changed into end effector and the rotary speed in each joint:
Wherein,For line/angular speed of end effector, symbol '~' represent equation from end effector to
Pedestal modeling is obtained.Because the motion state variable of end effector is occurred directly in kinetics equation (2), thus, for
The control task of end effector, designing corresponding control law using equation (2) will be more simpler than using equation (1).
It is pointed out that because kinetics equation is obtained by the kinetic energy of system is substituted into Lagrange's equation, and this hair
It is bright that the establishment of coordinate system of pedestal is needed to use into pedestal barycenter at one end of pedestal, the kinetic energy for calculating pedestal in step one
Linear velocity:
v′b=vb+ωb×a0 (15)
Rather than directly use vb, a0It is position vector of the base body coordinate origin to pedestal barycenter, symbol ' × ' table
Show multiplication cross computing.Meanwhile, with the nonlinear terms c of velocity correlation in kinetics equationbPass through Recursive Newton-Euler method numerical computations
Obtain, wherein including the inertia force for calculating pedestal.At this time, it may be necessary to use the linear acceleration of pedestal barycenter:
Rather than directly use ab.When modeled from end effector to pedestal, above-mentioned change is equally applicable to pair
The calculating of end effector kinetic energy and inertia force.
Pedestal is considered in the present invention not by controling power/torque, while end effector is not in contact with outside, so that dynamic
F in mechanical equation (1) and (2)b,fe=0.Equation (1) can be reduced to:
Eliminate joint velocity from above-mentioned equation, equation can be reduced to only with pedestal variableIt is relevant,
Wherein,
Similarly, by causing f in equation (2)b,fe=0 and joint velocity is eliminated, robot for space is in operation
The kinetics equation in space can be expressed as:
Wherein,
Step 2: setting up the governing equation of pedestal and end effector task.
The desired trajectory of given pedestalIt is readily obtained by equation (6), on pedestal desired trajectoryClosed with its correspondence
Section input τ governing equation meets following relation:
In order to ensure that the motion of mechanical arm is not disturbed to pedestal, the desired track of pedestal isAbove-mentioned controlling party
Journey can be further simplified as:
Similarly, task is expected on end effectorJoint input corresponding with itsGoverning equation be:
In addition, in being modeled by pedestal end-effector, joint JiConnect connecting rod Bi-1And Bi.If joint JiLocate motor
To connecting rod BiThe torque of effect is τi, it is clear that equally can be to connecting rod Bi-1Opplied moment-τi.Because from end effector to base
During seat modeling, joint Ji, connecting rod BiAnd Bi-1It is changed into joint J respectivelyn-i+1, connecting rod Bn-iAnd Bn-i+1, while created symbolRepresent each
The torque in joint,Represent joint Jn-i+1To connecting rod Bn-i+1The torque of application, thus, there is following relation:
Meanwhile, joint variable θi,WithAlso there is the relation that above formula is represented.
Thus, governing equation (10) can be expressed as the equation on τ:
As long as so that matrixI-th row turn into matrix(n-i+1) row.
Step 3: being described as the optimal input that quadratic programming problem solves joint.
To be met the joint input of pedestal unperturbed and end effector tracking desired trajectory mission requirements, step 2 point
Equation (9) and the governing equation shown in (12) have not been obtained.Below, under quadratic programming problem framework, obtained governing equation
It is described as linear equality constraints, and further considers the amplitude range τ of joint momentmin≤τ≤τmax, describe it as linear
Inequality constraints.For the object function in quadratic programming problem, consume to save system capacity and obtain smooth joint
Track, uses following object function:
F (τ)=λττTIτ (25)
Wherein, λτFor adjustment factor, I ∈ Rn×nFor unit matrix.
Thus, meeting the expectation joint moment of pedestal unperturbed, end effector tracing task and Filters with Magnitude Constraints can lead to
Cross and solve following quadratic programming problem and obtain:
The beneficial effects of the invention are as follows:Propose a kind of pedestal unperturbed control of robot for space based on quadratic programming problem
Method.Wherein, by deriving and setting up kinetic model of the robot for space under task space, it is not necessary to solve inverse kinematics
Problem, the Linear Control equation on joint moment can be described as by realizing the tracing task of end effector.By further
It is described as quadratic programming problem, by governing equation, joint moment Filters with Magnitude Constraints and system capacity consumption and generation can be saved
The mission requirements of smooth articular track is respectively depicted as linear equality constraints, linear inequality constraint and the target of planning problem
Function.By solving obtained quadratic programming problem, pedestal unperturbed, end effector tracing task and width can be met
It is worth the expectation joint moment of constraint.
Brief description of the drawings
Fig. 1 Space Robot System schematic diagrames
Fig. 2 end effectors position desired trajectory and actual path
Fig. 3 end effector position tracking errors
Pedestal attitude error caused by Fig. 4 manipulator motions
Each joint moment tracks of Fig. 5
Embodiment
The implementation of the invention mainly includes three below step:
Step 1: setting up robot for space operating space kinetic model.
Space Robot System is made up of the mechanical arm of pedestal spacecraft and the n frees degree, be typically chosen the line of pedestal/
The rotary speed in angular speed and joint is as generalized variable, based on lagrange equation of the second kind, the dynamics of robot for space
Model can be expressed as follows:
Wherein,For line/angular speed of pedestal,It is the vector of each joint rotating speed composition, Hb,HmFor pedestal and
Mechanical arm inertia matrix, HbmFor the coupling torque matrix c between end effector and mechanical armb,cmTo be non-with velocity correlation
Linear term, fb,feThe external force and moment of face being subject to for pedestal and end effector, τ are the opplied moment at joint of mechanical arm.
In the present invention, it is considered to the pedestal that the Space Robot System freely floated is not fixed, from the point of view of modeling,
The end effector of mechanical arm can also be considered as " pedestal " of system, and pedestal spacecraft can then be considered as " end " of system,
Modeled so as to carry out system from end effector to pedestal.Because in existing modeling method, representing end effector
Body coordinate system is built upon greatly the end of last connecting rod, and the present invention is moved the body coordinate system of pedestal by its barycenter
To pedestal one end so that Space Robot System turns into a symmetrical system, so as to be modeled down from end effector to pedestal
Obtained kinetic model will have identical structure with the kinetic model obtained under the modeling of pedestal end-effector.So
And, generalized variable in kinetic model is by the line/angular speed for being changed into end effector and the rotary speed in each joint:
Wherein,For line/angular speed of end effector, symbol '~' represent equation from end effector to
Pedestal modeling is obtained.Because the motion state variable of end effector is occurred directly in kinetics equation (2), thus, for
The control task of end effector, designing corresponding control law using equation (2) will be more simpler than using equation (1).
It is pointed out that because kinetics equation is obtained by the kinetic energy of system is substituted into Lagrange's equation, and this hair
It is bright that the establishment of coordinate system of pedestal is needed to use into pedestal barycenter at one end of pedestal, the kinetic energy for calculating pedestal in step one
Linear velocity:
v′b=vb+ωb×a0 (29)
Rather than directly use vb, a0It is position vector of the base body coordinate origin to pedestal barycenter, symbol ' × ' table
Show multiplication cross computing.Meanwhile, with the nonlinear terms c of velocity correlation in kinetics equationbPass through Recursive Newton-Euler method numerical computations
Obtain, wherein including the inertia force for calculating pedestal.At this time, it may be necessary to use the linear acceleration of pedestal barycenter:
Rather than directly use ab.When modeled from end effector to pedestal, above-mentioned change is equally applicable to pair
The calculating of end effector kinetic energy and inertia force.
Pedestal is considered in the present invention not by controling power/torque, while end effector is not in contact with outside, so that dynamic
F in mechanical equation (1) and (2)b,fe=0.Equation (1) can be reduced to:
Eliminate joint velocity from above-mentioned equation, equation can be reduced to only with pedestal variableIt is relevant,
Wherein,
Similarly, by causing f in equation (2)b,fe=0 and joint velocity is eliminated, robot for space is in operation
The kinetics equation in space can be expressed as:
Wherein,
Step 2: setting up the governing equation of pedestal and end effector task.
The desired trajectory of given pedestalIt is readily obtained by equation (6), on pedestal desired trajectoryClosed with its correspondence
Section input τ governing equation meets following relation:
In order to ensure that the motion of mechanical arm is not disturbed to pedestal, the desired track of pedestal isAbove-mentioned controlling party
Journey can be further simplified as:
Similarly, task is expected on end effectorJoint input corresponding with itsGoverning equation be:
In addition, in being modeled by pedestal end-effector, joint JiConnect connecting rod Bi-1And Bi.If joint JiLocate motor
To connecting rod BiThe torque of effect is τi, it is clear that equally can be to connecting rod Bi-1Opplied moment-τi.Because from end effector to base
During seat modeling, joint Ji, connecting rod BiAnd Bi-1It is changed into joint J respectivelyn-i+1, connecting rod Bn-iAnd Bn-i+1, while created symbolRepresent each
The torque in joint,Represent joint Jn-i+1To connecting rod Bn-i+1The torque of application, thus, there is following relation:
Meanwhile, joint variable θi,WithAlso there is the relation that above formula is represented.
Thus, governing equation (10) can be expressed as the equation on τ:
As long as so that matrixI-th row turn into matrix(n-i+1) row.
Step 3: being described as the optimal input that quadratic programming problem solves joint.
To be met the joint input of pedestal unperturbed and end effector tracking desired trajectory mission requirements, step 2 point
Equation (9) and the governing equation shown in (12) have not been obtained.Below, under quadratic programming problem framework, obtained governing equation
It is described as linear equality constraints, and further considers the amplitude range τ of joint momentmin≤τ≤τmax, describe it as linear
Inequality constraints.For the object function in quadratic programming problem, consume to save system capacity and obtain smooth joint
Track, uses following object function:
F (τ)=λττTIτ (39)
Wherein, λτFor adjustment factor, I ∈ Rn×nFor unit matrix.
Thus, meeting the expectation joint moment of pedestal unperturbed, end effector tracing task and Filters with Magnitude Constraints can lead to
Cross and solve following quadratic programming problem and obtain:
Kinematics/kinetic parameter of the degree-of-freedom manipulator robot for space of 1 band of table 7
Table 1 is the kinematics of Space Robot System and kinetic parameter used in example, and Fig. 1 is robot for space system
System schematic diagram, Fig. 2 is the desired trajectory and actual path of end effector position, and Fig. 3, Fig. 4 are respectively the position of end effector
Put the pedestal attitude disturbance of tracking error and pedestal spacecraft, Fig. 5 joint moments that each joint applies during being task.
The present invention verifies the robot for space pedestal unperturbed proposed by taking the robot for space of the degree-of-freedom manipulator of band 7 as an example
Control method, kinematics/kinetic parameter of system is as shown in table 1.
End effector is set to track the location track of following " lemniscate " shape,
And require manipulator motion to pedestal posture unperturbed, i.e. pedestal Attitude Tracking reference locus
Mechanical arm initial configuration is] control r ad device parameters be set to λτ=10-3, τmax=0.2N
m,τmin=-0.2Nm.
Fig. 2 is the desired trajectory and actual path that robot arm end effector is moved, and can be intuitive to see, end is performed
Device can track desired trajectory well;Fig. 3 furthermore present the position tracking error of end effector, and tracking accuracy reaches
10-4;Fig. 4 illustrates interference of the manipulator motion to pedestal posture in the form of Eulerian angles (" 3-2-1 " order), can see
Go out, the angle maximum of pedestal attitude misalignment is no more than 0.1 °, it is believed that realize manipulator motion and pedestal posture is not produced
Interference;Fig. 5 gives the variation track of each joint moment, and each joint moment is all not above the amplitude range set.By this
Example illustrates robot for space control method proposed by the present invention to realize by the motion of mechanical arm and completes end well
Actuator tracing task is held, each joint moment meets the amplitude requirement proposed, and does not produce disturbance to pedestal.
Claims (1)
1. pedestal unperturbed control method of the robot for space based on quadratic programming problem, including derived robot for space operation sky
Between under kinetic model;Establish the governing equation of pedestal unperturbed task and end effector tracing task;By solving two
Secondary planning problem, is met the joint moment of pedestal, end effector mission requirements and Filters with Magnitude Constraints;Its feature exists
In, including three below step:
Step 1: setting up robot for space operating space kinetic model
Space Robot System is made up of the mechanical arm of pedestal spacecraft and the n frees degree, is typically chosen line/angle speed of pedestal
The rotary speed in degree and joint is as generalized variable, based on lagrange equation of the second kind, the kinetic model of robot for space
It can be expressed as follows:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>H</mi>
<mi>b</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>H</mi>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>H</mi>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
<mi>T</mi>
</msubsup>
</mtd>
<mtd>
<msub>
<mi>H</mi>
<mi>m</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>b</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>c</mi>
<mi>b</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>c</mi>
<mi>m</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mi>b</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>&tau;</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>J</mi>
<mi>b</mi>
<mi>T</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>J</mi>
<mi>m</mi>
<mi>T</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<msub>
<mi>f</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
Wherein,For line/angular speed of pedestal,It is the vector of each joint rotating speed composition, Hb,HmFor pedestal and machinery
Arm inertia matrix, HbmFor the coupling torque matrix c between end effector and mechanical armb,cmTo be non-linear with velocity correlation
, fb,feThe external force and moment of face being subject to for pedestal and end effector, τ are the opplied moment at joint of mechanical arm, it is considered to from
The pedestal do not fixed by the Space Robot System floated, the end effector of mechanical arm can also be considered as " the base of system
Seat ", and pedestal spacecraft can then be considered as " end " of system, so that the system of progress is modeled from end effector to pedestal, obtain
The kinetic model arrived will have identical structure with equation (1), however, the generalized variable in kinetic model will be changed into end
Line/angular speed of actuator and the rotary speed in each joint:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mi>e</mi>
</msub>
</mtd>
<mtd>
<msub>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>e</mi>
<mi>m</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>e</mi>
<mi>m</mi>
</mrow>
<mi>T</mi>
</msubsup>
</mtd>
<mtd>
<msub>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mi>m</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>e</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mover>
<mi>&theta;</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>c</mi>
<mo>~</mo>
</mover>
<mi>e</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>c</mi>
<mo>~</mo>
</mover>
<mi>m</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mi>e</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&tau;</mi>
<mo>~</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>J</mi>
<mo>~</mo>
</mover>
<mi>e</mi>
<mi>T</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mover>
<mi>J</mi>
<mo>~</mo>
</mover>
<mi>m</mi>
<mi>T</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<msub>
<mi>f</mi>
<mi>b</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
Wherein,For line/angular speed of end effector, symbol '~' represents equation from end effector to pedestal
Modeling is obtained, because the motion state variable of end effector is occurred directly in kinetics equation (2), thus, for end
The control task of actuator, designing corresponding control law using equation (2) will be more simpler than using equation (1);
Pedestal is considered not by controling power/torque, while end effector is not in contact with outside, so that kinetics equation (1)
(2) f inb,fe=0, equation (1) is reduced to:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>H</mi>
<mi>b</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>H</mi>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>H</mi>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
<mi>T</mi>
</msubsup>
</mtd>
<mtd>
<msub>
<mi>H</mi>
<mi>m</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>b</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>c</mi>
<mi>b</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>c</mi>
<mi>m</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>&tau;</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
Eliminate joint velocity from above-mentioned equation, equation simplification for only with pedestal variableIt is relevant,
<mrow>
<msub>
<mover>
<mi>H</mi>
<mo>^</mo>
</mover>
<mi>b</mi>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>b</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>c</mi>
<mo>^</mo>
</mover>
<mi>b</mi>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>H</mi>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
<msup>
<msub>
<mi>H</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mi>&tau;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
Wherein,
Similarly, by causing f in equation (2)b,fe=0 and joint velocity is eliminated, robot for space is in operating space
Kinetics equation can be expressed as:
<mrow>
<msub>
<mover>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mo>^</mo>
</mover>
<mi>e</mi>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>e</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mover>
<mi>c</mi>
<mo>~</mo>
</mover>
<mo>^</mo>
</mover>
<mi>e</mi>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>e</mi>
<mi>m</mi>
</mrow>
</msub>
<msup>
<msub>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mi>m</mi>
</msub>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mi>&tau;</mi>
<mo>~</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
Wherein,
Step 2: setting up the governing equation of pedestal and end effector task
The desired trajectory of given pedestalIt is readily obtained by equation (4), on pedestal desired trajectoryIt is defeated with its corresponding joint
The governing equation for entering τ meets following relation:
<mrow>
<mo>-</mo>
<msub>
<mi>H</mi>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
<msup>
<msub>
<mi>H</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mi>&tau;</mi>
<mo>=</mo>
<msub>
<mover>
<mi>H</mi>
<mo>^</mo>
</mover>
<mi>b</mi>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mi>b</mi>
<mi>d</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>c</mi>
<mo>^</mo>
</mover>
<mi>b</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
1
In order to ensure that the motion of mechanical arm is not disturbed to pedestal, the desired track of pedestal isAbove-mentioned governing equation can
To be further simplified as:
<mrow>
<mo>-</mo>
<msub>
<mi>H</mi>
<mrow>
<mi>b</mi>
<mi>m</mi>
</mrow>
</msub>
<msup>
<msub>
<mi>H</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mi>&tau;</mi>
<mo>=</mo>
<msub>
<mover>
<mi>c</mi>
<mo>^</mo>
</mover>
<mi>b</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
Similarly, task is expected on end effectorCorresponding with its joint input τ governing equation is:
<mrow>
<mo>-</mo>
<msub>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>e</mi>
<mi>m</mi>
</mrow>
</msub>
<msup>
<msub>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mi>m</mi>
</msub>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mi>&tau;</mi>
<mo>~</mo>
</mover>
<mo>=</mo>
<msub>
<mover>
<mover>
<mi>H</mi>
<mo>~</mo>
</mover>
<mo>^</mo>
</mover>
<mi>e</mi>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mi>e</mi>
<mi>d</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mover>
<mi>c</mi>
<mo>~</mo>
</mover>
<mo>^</mo>
</mover>
<mi>e</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
In addition, in being modeled by pedestal end-effector, joint JiConnect connecting rod Bi-1And BiIf, joint JiLocate motor to even
Bar BiThe torque of effect is τi, it is clear that equally can be to connecting rod Bi-1Opplied moment-τi, because being built from end effector to pedestal
During mould, joint Ji, connecting rod BiAnd Bi-1It is changed into joint J respectivelyn-i+1, connecting rod Bn-iAnd Bn-i+1, while created symbolRepresent each joint
Torque,Represent joint Jn-i+1To connecting rod Bn-i+1The torque of application, thus, there is following relation:
<mrow>
<mo>-</mo>
<msub>
<mi>&tau;</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>&tau;</mi>
<mo>~</mo>
</mover>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mi>i</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
Meanwhile, joint variable θi,WithAlso there is the relation that above formula is represented;
Thus, governing equation (8) can be expressed as the equation on τ:
As long as so that matrixI-th row turn into matrix(n-i+1) row;
Step 3: being described as the optimal input that quadratic programming problem solves joint
To be met the joint input of pedestal unperturbed and end effector tracking desired trajectory mission requirements, step 2 is obtained respectively
Equation (7) and the governing equation shown in (10) have been arrived, below, under quadratic programming problem framework, obtained governing equation is retouched
State as linear equality constraints, and further consider the amplitude range τ of joint momentmin≤τ≤τmax, describe it as linear
Formula is constrained, for the object function in quadratic programming problem, is consumed to save system capacity and is obtained smooth joint trajectories,
Use following object function:
F (τ)=λττTIτ (11)
Wherein, λτFor adjustment factor, I ∈ Rn×nFor unit matrix;
Thus, the expectation joint moment for meeting pedestal unperturbed, end effector tracing task and Filters with Magnitude Constraints can be by asking
Following quadratic programming problem is solved to obtain:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710330726.5A CN107263466B (en) | 2017-05-11 | 2017-05-11 | Base undisturbed control method of space robot based on quadratic programming problem |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710330726.5A CN107263466B (en) | 2017-05-11 | 2017-05-11 | Base undisturbed control method of space robot based on quadratic programming problem |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107263466A true CN107263466A (en) | 2017-10-20 |
CN107263466B CN107263466B (en) | 2020-07-17 |
Family
ID=60073934
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710330726.5A Active CN107263466B (en) | 2017-05-11 | 2017-05-11 | Base undisturbed control method of space robot based on quadratic programming problem |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107263466B (en) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107967241A (en) * | 2017-11-21 | 2018-04-27 | 中国运载火箭技术研究院 | A kind of space freely floats the pedestal disturbance computational methods of robot |
CN108132601A (en) * | 2017-12-06 | 2018-06-08 | 西北工业大学 | A kind of method for inhibiting spacecraft pedestal attitude disturbance using mechanical arm |
CN108445778A (en) * | 2018-02-06 | 2018-08-24 | 南京航空航天大学 | A kind of dynamic modeling method non-fully constraining assembly for space non-cooperative target |
CN109394231A (en) * | 2018-12-10 | 2019-03-01 | 刘坤 | One kind stand moving equilibrium monitoring with dynamic analysis system |
CN109571484A (en) * | 2019-01-10 | 2019-04-05 | 北京邮电大学 | A kind of submissive assembly control method of space manipulator for self assembly task |
CN109591015A (en) * | 2018-12-29 | 2019-04-09 | 西北工业大学 | It is a kind of assess multi-arm robot for space dynamics can operational readiness method |
CN109794939A (en) * | 2019-02-19 | 2019-05-24 | 宁波凯德科技服务有限公司 | A kind of parallel Shu Fangfa of welding robot motion planning |
CN110716557A (en) * | 2019-11-18 | 2020-01-21 | 河北工业大学 | Machine parameter identification and contact force monitoring method based on priori dynamics knowledge |
CN111558941A (en) * | 2020-07-14 | 2020-08-21 | 深圳市优必选科技股份有限公司 | Floating base dynamics feedforward control method and device and multi-legged robot |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030220714A1 (en) * | 2002-02-12 | 2003-11-27 | The University Of Tokyo | Method for generating a motion of a human type link system |
CN102990661A (en) * | 2012-12-27 | 2013-03-27 | 广西大学 | Large-workspace controllable stack device |
CN106502101A (en) * | 2016-12-23 | 2017-03-15 | 西北工业大学 | The quick racemization stable control method of assembly model-free after spacecraft capture target |
CN106625671A (en) * | 2016-12-27 | 2017-05-10 | 西北工业大学 | Optimal track planning method for space robot for capturing rolling target |
-
2017
- 2017-05-11 CN CN201710330726.5A patent/CN107263466B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030220714A1 (en) * | 2002-02-12 | 2003-11-27 | The University Of Tokyo | Method for generating a motion of a human type link system |
CN102990661A (en) * | 2012-12-27 | 2013-03-27 | 广西大学 | Large-workspace controllable stack device |
CN106502101A (en) * | 2016-12-23 | 2017-03-15 | 西北工业大学 | The quick racemization stable control method of assembly model-free after spacecraft capture target |
CN106625671A (en) * | 2016-12-27 | 2017-05-10 | 西北工业大学 | Optimal track planning method for space robot for capturing rolling target |
Non-Patent Citations (1)
Title |
---|
朱建军等: "空间机器人姿态稳定方法研究", 《计算机仿真》 * |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107967241B (en) * | 2017-11-21 | 2021-04-13 | 中国运载火箭技术研究院 | Base disturbance calculation method of space free floating robot |
CN107967241A (en) * | 2017-11-21 | 2018-04-27 | 中国运载火箭技术研究院 | A kind of space freely floats the pedestal disturbance computational methods of robot |
CN108132601A (en) * | 2017-12-06 | 2018-06-08 | 西北工业大学 | A kind of method for inhibiting spacecraft pedestal attitude disturbance using mechanical arm |
CN108132601B (en) * | 2017-12-06 | 2020-04-28 | 西北工业大学 | Method for suppressing spacecraft base attitude interference by using mechanical arm |
CN108445778A (en) * | 2018-02-06 | 2018-08-24 | 南京航空航天大学 | A kind of dynamic modeling method non-fully constraining assembly for space non-cooperative target |
CN109394231A (en) * | 2018-12-10 | 2019-03-01 | 刘坤 | One kind stand moving equilibrium monitoring with dynamic analysis system |
CN109394231B (en) * | 2018-12-10 | 2021-06-11 | 吉林大学 | Standing motion balance monitoring and dynamics analysis system |
CN109591015A (en) * | 2018-12-29 | 2019-04-09 | 西北工业大学 | It is a kind of assess multi-arm robot for space dynamics can operational readiness method |
CN109571484A (en) * | 2019-01-10 | 2019-04-05 | 北京邮电大学 | A kind of submissive assembly control method of space manipulator for self assembly task |
CN109794939A (en) * | 2019-02-19 | 2019-05-24 | 宁波凯德科技服务有限公司 | A kind of parallel Shu Fangfa of welding robot motion planning |
CN109794939B (en) * | 2019-02-19 | 2022-02-08 | 宁波凯德科技服务有限公司 | Parallel beam planning method for welding robot motion |
CN110716557A (en) * | 2019-11-18 | 2020-01-21 | 河北工业大学 | Machine parameter identification and contact force monitoring method based on priori dynamics knowledge |
CN111558941B (en) * | 2020-07-14 | 2020-09-29 | 深圳市优必选科技股份有限公司 | Floating base dynamics feedforward control method and device and multi-legged robot |
CN111558941A (en) * | 2020-07-14 | 2020-08-21 | 深圳市优必选科技股份有限公司 | Floating base dynamics feedforward control method and device and multi-legged robot |
Also Published As
Publication number | Publication date |
---|---|
CN107263466B (en) | 2020-07-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107263466A (en) | Pedestal unperturbed control method of the robot for space based on quadratic programming problem | |
CN107490965B (en) | Multi-constraint trajectory planning method for space free floating mechanical arm | |
Xu et al. | Dynamics modeling and analysis of a flexible-base space robot for capturing large flexible spacecraft | |
Xu et al. | Singularity-free trajectory planning of free-floating multiarm space robots for keeping the base inertially stabilized | |
Nakamura et al. | Nonholonomic path planning of space robots | |
Liu et al. | Cooperation control of multiple manipulators with passive joints | |
CN104460679B (en) | A kind of Spacecraft underactuated control system and its attitude control method based on method for handover control | |
CN106625671A (en) | Optimal track planning method for space robot for capturing rolling target | |
CN106695797A (en) | Compliance control method and system based on collaborative operation of double-arm robot | |
CN108241339A (en) | The movement solution of apery mechanical arm and configuration control method | |
CN106985139A (en) | Robot for space active disturbance rejection control method for coordinating with compensating is observed based on extended mode | |
CN106094528A (en) | A kind of spatial flexible robot arm vibration suppression algorithm | |
Meng et al. | Vibration suppression control of free-floating space robots with flexible appendages for autonomous target capturing | |
CN102795544A (en) | Online trajectory planning based efficient bridge crane swing elimination control method | |
CN107169196A (en) | Dynamic modeling method of the robot for space from end effector to pedestal | |
CN106864776A (en) | A kind of method and system of the capture target satellite based on butt joint ring | |
Kayastha et al. | Nonlinear model predictive control of a planar three-link space manipulator | |
Jin et al. | Finite-time model predictive tracking control of position and orientation for redundant manipulators | |
Xu et al. | Non-holonomic path planning of a free-floating space robotic system using genetic algorithms | |
Xu et al. | Target berthing and base reorientation of free-floating space robotic system after capturing | |
CN106547989A (en) | Position inner ring impedance control algorithm with flexibility of joint/armed lever flexible mechanical arm | |
You et al. | Semi-autonomous bilateral teleoperation of hexapod robot based on haptic force feedback | |
McCourt et al. | Autonomous robotic capture of a satellite using constrained predictive control | |
Jun-Pei et al. | Neural network control of space manipulator based on dynamic model and disturbance observer | |
Santhakumar et al. | Robust adaptive tracking control of autonomous underwater vehicle-manipulator systems |
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 |