CN105974797B - Consider the wire saws parallel robot motion control method of elasticity effect and compensation - Google Patents
Consider the wire saws parallel robot motion control method of elasticity effect and compensation Download PDFInfo
- Publication number
- CN105974797B CN105974797B CN201610512458.4A CN201610512458A CN105974797B CN 105974797 B CN105974797 B CN 105974797B CN 201610512458 A CN201610512458 A CN 201610512458A CN 105974797 B CN105974797 B CN 105974797B
- Authority
- CN
- China
- Prior art keywords
- rope
- moving platform
- matrix
- controller
- rope tension
- 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
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/041—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a variable is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Software Systems (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Health & Medical Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
- Feedback Control In General (AREA)
Abstract
The wire saws parallel robot motion control method for considering elasticity effect and compensation, is related to robot.System dynamics equation is built, for rope tension optimization and controller design;According to desired moving platform movement locus, it is based on system dynamics equation and constraints, the rope tension dynamic optimization model for being up to object function with rigidity weighting, optimization rope tension distribution is used to calculate deflection;Moving platform position and attitude error caused by traction rope flexible deformation is analyzed by forward kinematics solution according to practical rope length and deflection;Using the actual motion state of vision measurement moving platform, and using its deviation between desired motion state as controlled quentity controlled variable;Design controller;According to the controller of design, the instruction of driving force square is calculated, it is final to control moving platform movement locus and rope tension, meet duty requirements.
Description
Technical field
The present invention relates to robots, are transported more particularly, to the wire saws parallel robot of a kind of consideration elasticity effect and compensation
Flowing control method.
Background technology
Wire-driven parallel support system (Cable-Driven Parallel Supporting System, also referred to as Suo Binglian
Support system) it is a kind of novel mechanism based on robot technology, compared with traditional rigid connection parallel institution, the former is maximum
The advantages of be with scalability, by transmission mechanism adjust rope length be easily achieved larger working space, simultaneously
Have the characteristics that simple in structure, at low cost, inertia is small, movement is flexible, is highly suitable for mechanical processing, robot crane, aviation
The fields such as space flight, it has also become the hot spot of Recent study.
The substantially complicated close coupling of wire-driven parallel support system, multiple-input and multiple-output, nonlinear and time-varying system,
Dynamic analysis is the key that realize the mechanism kinematic with control.Further, since rope can only tension cannot be pressurized, it is desirable that system
Rope should be in tensioning state always when dynamic change, this feature is also determined must consider rope simultaneously when designing controller
Tension and motion pose, i.e. power/position mixing control.The application that some are required with moving platform high-precision motion, such as wire saws height
Fast video camera, wind tunnel test wire-driven parallel support system etc. also need the shadow for further considering rope elasticity to moving platform pose
It rings, and control compensation.
Compared with developing more mature rigid parallel robot control technology, the control of rope traction and parallel-connection mechanism at present is ground
Study carefully relatively fewer.In place of the control method of the two has similar use for reference, but also have any different.Especially with respect to power/position mixing control
Strategy, the former typically refers to end effector and contacts the power generated with external environment, may influence the TRAJECTORY CONTROL of pure position
Mode, therefore force detection sensor is introduced, it goes to correct desired location track using the power error of feedback, to reach control mesh
's;And the latter is primarily to ensure that drag rope is in tensioning state always in moving platform dynamic test, and meet certain
Rigidity requirement, while to model Pose Control, continuous real-time optimal control is carried out to rope tension.In addition, wire saws
The elasticity effect restricted in parallel robot is also to have to consider.
Currently, for the high-precision control problem of wire saws parallel robot, though there is document to carry out control emulation and tested
Card, such as:Foreign countries, Lamaury etc. are directed to ReelAx8 rope principle of parallel model machines, are based on driving spatial design PID controller, with
Motor corner is that feedback quantity controls rope lengths, adjustment moving platform pose (Lamaury J, Gouttefarde M, Michelin
M,et al.Design and control strategies of a redundant suspended cable-driven
parallel robot.In:Lenarcic J,Husty M(eds)Advances in robot
kinematics.Springer,Berlin,2012:237–244);Bayani etc. is directed to plane wire saws parallel robot, adopts
With monocular vision measure and adaptive sliding-mode observer, but only kinematics control (Bayani H, Masouleh M T, Kalhor
A.An experimental study on the vision-based control and identification of
planar cable-driven parallel robots.Robotics and Autonomous Systems,2016,75:
187-202).The country, the half-closed loop control that enemy original hawk etc. to rope traction and parallel-connection mechanism based on rigidity enhance emulate (Liu
It is glad, Chou Yuanying, the rigidity enhancing and motion control of Sheng English wind tunnel test wire saws redundant parallel robots, aviation journal,
2009,30(6):1156-1164);And it is directed to high speed wire saws cameras people, it is based on terminal position space, before devising PD
Feedback controller and interference observer are to realize stability contorting (Wei Huiling, Chou Yuanying, the Sheng English high speed wire saws video cameras of movement
Motion stabilization control [J] the Xian Electronics Science and Technology University journal of device people, 2016,05:70-77).But due to wire saws parallel machine
The application background of structure is different, and the critical issue that of interest and needs solve also is not quite similar, and the studies above is without reference to rope bullet
The influence of property, control accuracy can't fully meet requirement.
For wire saws parallel robot in high-precision applications such as wind tunnel test support system, mobile camera trailer systems
In the case of, it not only needs to consider the impact analysis of system stiffness and rope deformation to moving platform pose, design is also needed to mend
The force-location mix control method of corresponding error is repaid, it is therefore proposed that a kind of wire saws parallel machine considering rope elasticity effect and compensation
Device people's motion control method, is of great significance to its engineer application.
Invention content
The purpose of the invention is to overcome deficiencies of the prior art, one kind is provided and is mainly used to solve to restrict to lead
The problems such as drawing the existing control method of parallel robot existing kinematic accuracy be not high during the motion, system stiffness is relatively low
Consider the wire saws parallel robot motion control method of elasticity effect and compensation.
The present invention includes the following steps:
1) system dynamics equation is built, for rope tension optimization and controller design;
2) according to desired moving platform movement locus, it is based on system dynamics equation and constraints, uses and is added with rigidity
Power is up to the rope tension dynamic optimization model of object function, optimization rope tension distribution, and then calculates deflection;
3) moving platform caused by traction rope flexible deformation is analyzed by forward kinematics solution according to practical rope length and deflection
Position and attitude error;
4) the actual motion state of vision measurement moving platform is used, and will be between actual motion state and desired motion state
Deviation as controlled quentity controlled variable;
5) controller is designed, is specifically included:The proportion differential feedback controller based on position and attitude error is established, to meet movement
Required precision;Using rope tension dynamic optimization as feedforward controller, to ensure system stiffness, while rope being avoided to relax;Rope is added
Long variation correction term, error caused by compensation is elastic enhance the robustness of system, ensure that moving platform is moved along desired trajectory;
6) according to the controller of design, the instruction of driving force square is calculated, final moving platform movement locus and the rope of controlling is drawn
Power meets duty requirements.
In step 1), the system dynamics equation uses following expression:
System dynamics adoption status equation representation, x in formula1、x2、x3、x4Indicate state vector, wherein x1=X,x3=θ,X indicates that the pose vector of moving platform, θ are the corner vector of machine shaft.M0Motor is arrived to be equivalent
Moment of inertia matrix on axis;C0For equivalent viscous friction coefficient matrix;M (X) is the inertial matrix of moving platform;For
Non-linear Ge Shi centrifugal force matrix,For speed term;wgFor the gravity vector of moving platform;weFor external load suffered by moving platform, such as
Aerodynamic load;J is the Jacobian matrix of system;KsFor the extensional rigidity matrix of rope;L1、L2Correspond respectively to practical rope
Long and theoretical rope length;τ is motor driving force moment vector;R is the gearing factor of ball-screw, related with helical pitch;Indicate single order
Derivative;()-1Representing matrix it is inverse;()TThe transposition of representing matrix.
In step 2), the rope tension dynamic optimization model uses following expression:
To improve system principal direction rigidity as object function, optimization rope tension is distributed model;F () is optimization aim letter in formula
Number, T are that rope is pulling force vector, and λ is Lagrange multiplier;Kj,jFor j-th of diagonal entry of stiffness matrix, wjIt is weighted for j-th
Coefficient, j=1...6;tiThe pulling force restricted for i-th, i=1...8;tmin、tmaxFor rope tension lower limiting value and upper limit value;J be
The Jacobian matrix of system;M (X) is the inertial matrix of moving platform;For non-linear Ge Shi centrifugal force matrix;X is moving platform
Pose vector;For speed term;For acceleration item;wgFor the gravity vector of moving platform;weIt is carried to be external suffered by moving platform
Lotus;()TThe transposition of representing matrix;Min expressions are minimized;∑ indicates summation algorithm;| | expression takes absolute value;()2Expression takes
Square.
In step 5), the controller uses following expression:
In formula, τ torques in order to control;R is the gearing factor of ball-screw;(JT)+Indicate the puppet after Jacobian matrix transposition
It is inverse;KpIt is the ratio control gain of system;KdIt is the differential control gain of system;TdIt is the rope tension obtained by Inverse Dynamics
Feedforward term;K' is elastic compensating item proportional gain;XdIt is the desired trajectory of moving platform;X is the actual motion track of moving platform;L1、
L2Correspond respectively to practical rope length and theoretical rope length;Indicate first derivative.Designed controller includes three, wherein first
Item is moving platform Pose Control feedback term, and Section 2 is that rope tension controls feedforward term, and Section 3 is elastic compensating item of restricting.
The present invention is directed to the motion control of wire saws parallel robot moving platform, proposes to consider rope elasticity effect and compensation
High-accuracy control method has the following advantages:Based on stiffness optimization criterion, quantitative analysis rope flexible deformation is to moving platform pose
It influences, not only contributes to improve system stiffness, more moving platform high-precision motion control provides support;The design of controller was both wrapped
The PD feedback terms based on pose are included, and include rope tension feedforward term, and rope elastic compensating item, may finally realize wire saws simultaneously
Join the high-precision control of robot moving platform;The analysis can be widely applied to the movement of wire saws parallel robot with control method
In control.
Description of the drawings
Fig. 1 is a kind of wire saws parallel robot motion control method principle frame of compensation rope elasticity effect of the present invention
Figure.
Fig. 2 is that a kind of consideration rope elasticity effect of the present invention and the wire saws parallel robot motion control method of compensation are set
Count flow chart.
Fig. 3 is a kind of typical eight wire saws six degree of freedom redundant constaint parallel robot.
Fig. 4 represents the rope tension optimum results based on rigidity in the case where having method.
Fig. 5 is to restrict caused by flexible deformation along X-axis, Y-axis, the site error of Z axis in the case where having method.
Fig. 6 is the attitude errors such as roll angle, pitch angle and yaw angle caused by rope flexible deformation in the case where having method.
Fig. 7 is the tracking error of the pitch angle under control system of the present invention.
Specific implementation mode
Below in conjunction with drawings and the specific embodiments, invention is further described in detail
Fig. 1 show the wire saws parallel robot motion control side of a kind of the consideration rope elasticity effect and compensation of the present invention
Method functional block diagram, Fig. 2 show the wire saws parallel robot movement control of a kind of the consideration rope elasticity effect and compensation of the present invention
Method design flow diagram processed.System dynamics equation is built first, is optimized for rope tension;According to desired motion track, it is based on
System dynamics equation and rope tension constraints are up to object function with rigidity weighting, establish rope tension dynamic optimization mould
Type;Moving platform position and attitude error caused by traction rope flexible deformation is analyzed by forward kinematics solution according to practical rope length;By regarding
Feel the pose for measuring moving platform, it would be desirable to which the error between movement locus and actual motion track is as regulation and control amount;Design is based on
The PD feedback controllers of position and attitude error, to meet kinematic accuracy requirement;Using rope tension dynamic optimization as feedforward controller, to protect
System stiffness is demonstrate,proved, while rope being avoided to relax;Long change of rope correction term is added, error caused by compensation is elastic enhances the Shandong of system
Stick ensures that moving platform is moved along desired trajectory.It is as follows:
1) system dynamics equation is built, is optimized for rope tension.For the system dynamics of wire saws parallel robot
Equation is represented by:
System dynamics adoption status equation representation, x in formula1、x2、x3、x4Indicate state vector, wherein x1=X,x3=θ,X indicates that the pose vector of moving platform, θ are the corner vector of machine shaft.M0Motor is arrived to be equivalent
Moment of inertia matrix on axis;C0For equivalent viscous friction coefficient matrix;M (X) is the inertial matrix of moving platform;For
Non-linear Ge Shi centrifugal force matrix,For speed term;wgFor the gravity vector of moving platform;weFor external load suffered by moving platform, such as
Aerodynamic load;J is the Jacobian matrix of system;KsFor the extensional rigidity matrix of rope;L1、L2Correspond respectively to practical rope
Long and theoretical rope length;τ is motor driving force moment vector;R is the gearing factor of ball-screw, related with helical pitch;Indicate single order
Derivative;()-1Representing matrix it is inverse;()TThe transposition of representing matrix.
2) according to desired moving platform motion state, it is based on system dynamics equation and rope tension constraints, with rigidity
Weighting is up to target, the distribution of dynamic optimization rope tension.Wherein Optimized model is represented by:
To improve system stiffness as object function, optimization rope tension is distributed model;F () is optimization object function in formula, and T is
Rope system pulling force vector, λ are Lagrange multiplier;Kj,jFor j-th of diagonal entry of stiffness matrix, wjFor j-th of weighting coefficient, j
=1...6;tiThe pulling force restricted for i-th, i=1...8;tmin、tmaxFor rope tension lower limiting value and upper limit value;J is the refined of system
Gram compare matrix;M (X) is the inertial matrix of moving platform;For non-linear Ge Shi centrifugal force matrix;X is the pose of moving platform
Vector;For speed term;For acceleration item;wgFor the gravity vector of moving platform;weFor external load suffered by moving platform;()TTable
Show the transposition of matrix;Min expressions are minimized;∑ indicates summation algorithm;| | expression takes absolute value;()2Expression is squared.
3) according to rope tension optimum results, rope deflection is calculated:
In formula, Δ LiFor i-th long change of rope amount;tiFor rope tension real-time optimization value;t0For initial pretightening force;S is rope
Cross-sectional area;Y is rope elasticity modulus;LiFor i-th rope length theoretical value.
Further the attained pose of moving platform is obtained, is done with expected pose using Numerical Iteration Method according to practical rope length
Difference, you can obtain moving platform position and attitude error caused by rope length deformation.
4) use vision measurement moving platform actual motion state, and using its deviation between desired motion state as
Motion control amount;
δ=Xd-X (4)
In formula, δ is error;XdFor expected pose;X is the attained pose of vision measurement.
5) according to system dynamics equation, a kind of wire saws parallel robot motion control of compensation rope flexible deformation is designed
Device.Specifically it is expressed as follows:
(a) the PD control device fed back based on moving platform pose is designed, to meet kinematic accuracy requirement:
In formula, τ1For first item control moment;R is the gearing factor of ball-screw;(JT)+Indicate Jacobian matrix transposition
Pseudoinverse afterwards;KpIt is the ratio control gain of system;KdIt is the differential control gain of system;XdIt is the desired trajectory of moving platform;X
It is the actual motion track of moving platform;Indicate first derivative.
(b) rope tension feedforward controller is designed, to meet fortune rigidity requirement:
τ2=rTd (6)
In formula, τ2For Section 2 control moment;R is the gearing factor of ball-screw;TdIt is the rope obtained by Inverse Dynamics
Pulling force feedforward term;(JT)+Indicate the pseudoinverse after Jacobian matrix transposition;M (X) is the inertial matrix of moving platform;It is non-
Linear Ge Shi centrifugal force matrixes;X is the pose vector of moving platform;For speed term;For acceleration item;wgFor the weight of moving platform
Force vector;weFor external load suffered by moving platform.
(c) long change of rope correction term is designed, error caused by flexible deformation is compensated:
τ3=K'(L1-L2) (8)
In formula, τ3For Section 3 control moment;K' is elastic compensating item proportional gain;L1、L2Correspond respectively to practical rope length
With theoretical rope length.
Then total control moment is represented by:
τ=τ1+τ2+τ3 (9)
In formula, τ is total control moment.
6) according to the controller of design, the instruction of driving force square is calculated, final moving platform movement locus and the rope of controlling is drawn
Power meets duty requirements.
Embodiment
By the wire saws parallel robot motion control method application of a kind of the consideration rope elasticity effect and compensation that are proposed
With the six-degree-of-freedom parallel robot of eight wire saws, the parallel robot as shown in figure 3, moving platform 1 by taking dummy vehicle as an example,
It is drawn by eight traction ropes 2;Pulley 3 is fixed in rack 4;Traction rope 2 adjusts length by motor by pulley 3, to change
The position of dummy vehicle 1 and posture;The pose of dummy vehicle 1 can be obtained by the measurement of monocular vision 5, be mounted on and be fixed on
On the holder 6 of rack 7.The present embodiment control method is implemented as follows:
1) 1 error analysis of moving platform caused by 2 flexible deformation of traction rope
It is defined according to coordinate system, quiet coordinate origin is located at the center of 4 bottom surface of rack, and three reference axis are orthogonal, and meets
The right-hand rule;Moving coordinate system is located on the barycenter of moving platform 1, and wherein X-axis is before moving platform axis direction, and Y-axis is along spanwise
Outside being directed toward, under Z axis is directed toward, and meet the right-hand rule with X-axis, Y-axis.When moving platform 1 is in zero-bit appearance, quiet coordinate system is sat with dynamic
Mark system is parallel.1 barycenter of moving platform at this time, that is, it is that (0,0, -582) mm is expressed as in quiet coordinate system to refer to point coordinates;Traction rope 2
With the tie point B of rack 4iIt indicates, i=1 ... 8, wherein in quiet coordinate system:B1(472,814.5, -1285)T, B2
(514.5, -772, -1286)T, B3(- 472, -814.5, -1286)T, B4(- 472, -814.5, -1286)T, B5(- 472,
814.5, -90)T, B6(514.5,772, -91)T, B7(472, -814.5, -91)T, B8(- 514.5, -772, -90)T, unit is
Mm, ()TIndicate transposition;The tie point P of traction rope 2 and moving platform 1iIt indicates, i=1 ... 8, wherein in moving coordinate system:P1
(30,19.1, -19.1)T, P2(30, -19.1, -19.1)T, P3(- 165, -26,0)T, P4(- 165,26,0)T, P5(- 165,26,
0)T, P6(30,19.1,19.1)T, P7(30, -19.1,19.1)T, P8(- 165, -26,0)T, unit mm, ()TIndicate transposition;
1 mass of moving platform is 1.06kg;In original state, according to standing balance, setting 2 initial pretightening force minimum value of traction rope is 10N,
And it is selected as Kevlar rope, elasticity modulus 43.9GPa.According to rope material property and moving platform quality, rope tension bound point is taken
It Wei not 35N and 300N.
By taking pitching angle theta sinusoidal motion as an example, i.e. θ=π/6*sin (t), simulation time t is set as moving platform desired trajectory
10s.Rope tension optimization is carried out first, and rigidity weighting coefficient is selected as (0.2,0.1,0.3,0.2,0.1,0.1) successively.According to rope
Pulling force result and deflection carry out Kinematic Problem solution using practical rope length, obtain the attained pose of moving platform 1;Into
And subtract each other with desired trajectory, moving platform position and attitude error caused by rope length deformation can be obtained.
2) control method of compensation rope flexible deformation
The rated output torque τ of driving motorr=0.64Nm, the equivalent rotary inertia to motor side of drive system are m0
=7.76 × 10-5kg·m2, the equivalent viscous damping coefficient to motor side is c0=2 × 10-3N·m·s;Transmission ball wire
The gearing factor of thick stick is r=a/2 π, and ball-screw screw pitch is a=0.005m.
Likewise, it would be desirable to which track is by taking moving platform pitch angle sinusoidal motion as an example.It is as follows to design controller:
Wherein, τ is total control moment;R is the gearing factor of ball-screw;(JT)+After indicating Jacobian matrix transposition
Pseudoinverse;It is adapted in PD feedback control items, proportional gain factor Kp=diag (0,0,0,0,3.5,0), differential gain COEFFICIENT Kd
=diag (0,0,0,0,450,0);K'=50 × diag (1,1,1,1,1,1) in rope elastic compensating item;Diag () indicate with to
The diagonal matrix of element composition in amount;TdIt is the rope tension feedforward term obtained by Inverse Dynamics;The desired trajectory X of moving platformd
=[0,0,0,0, π/6*sin (t), 0]T, []TIndicate transposition;X is the actual motion track for the moving platform that vision measurement obtains;Indicate first derivative;L1、L2Correspond respectively to practical rope length and theoretical rope length.
3) it needs to carry out control compensation known to error result Fig. 5-Fig. 6, to improve kinematic accuracy.It is controlled aforementioned
Torque substitutes into system dynamics equation (1), may finally realize the high-precision motion of wire saws parallel robot moving platform 1.
Result by the control method of this embodiment is as shown in Figure 4 to 7.
Fig. 4 represents the rope tension optimum results based on rigidity in the case where having method;Fig. 5 represents elasticity of restricting in the case where having method
Three shaft position errors caused by deformation;Fig. 6 represents three attitude errors caused by rope flexible deformation in the case where having method;Fig. 7
Represent the tracking error of the pitch angle under control system of the present invention.Abscissa indicates run duration in all figures.Become by elasticity
Error result caused by shape needs to carry out control compensation it is found that improve moving platform kinematic accuracy.A kind of benefit proposed by the present invention
Tracking error can be effectively reduced by repaying the wire saws parallel robot motion control method of rope flexible deformation, improve wire saws simultaneously
Join the movenent performance of robot.
The present invention initially sets up the system dynamics equation comprising driving motor and moving platform, and wherein rope tension is expressed as becoming
The linear function of shape amount;It is instructed for given moving platform motion state, the rope tension dynamic optimization model weighted using rigidity,
Calculate rope length deflection;Kinematic Problem is further solved, using numerical method, analyzes and is moved caused by traction rope flexible deformation
Platform's position and pose error;Controller is designed according to system dynamics equation, using the pose of vision measurement moving platform, as directly anti-
Feedback;Design proportion Derivative Feedback and rope tension feedforward controller, while long change of rope correction term is added, it compensates caused by elasticity accidentally
Difference enhances the robustness of system, ensures that moving platform is moved along desired trajectory;According to designed controller, control driving is calculated
Torque command, final realize control the high precision position and posture of moving platform with rope tension.
Claims (2)
1. considering the wire saws parallel robot motion control method of elasticity effect and compensation, it is characterised in that including walking as follows
Suddenly:
1) system dynamics equation is built, for rope tension optimization and controller design;
The system dynamics equation uses following expression:
System dynamics adoption status equation representation, x in formula1、x2、x3、x4Indicate state vector, wherein x1=X,
x3=θ,X indicates that the pose vector of moving platform, θ are the corner vector of machine shaft;M0To be equivalent on motor shaft
Moment of inertia matrix;C0For equivalent viscous friction coefficient matrix;M (X) is the inertial matrix of moving platform;For non-linear brother
Family name's centrifugal force matrix,For speed term;wgFor the gravity vector of moving platform;weFor external load suffered by moving platform, such as air force
Load;J is the Jacobian matrix of system;KsFor the extensional rigidity matrix of rope;L1、L2Correspond respectively to practical rope length and theory
Rope length;τ is motor driving force moment vector;R is the gearing factor of ball-screw, related with helical pitch;()·Indicate first derivative;
()-1Representing matrix it is inverse;()TThe transposition of representing matrix;
2) according to desired moving platform movement locus, it is based on system dynamics equation and constraints, is used with rigidity weighting most
The greatly rope tension dynamic optimization model of object function, optimization rope tension distribution, and then calculate deflection;
The rope tension dynamic optimization model uses following expression:
To improve system principal direction rigidity as object function, optimization rope tension is distributed model;F () is optimization object function, T in formula
It is pulling force vector for rope, λ is Lagrange multiplier;Kj,jFor j-th of diagonal entry of stiffness matrix, wjFor j-th of weighting system
Number, j=1...6;tiThe pulling force restricted for i-th, i=1...8;tmin、tmaxFor rope tension lower limiting value and upper limit value;J is system
Jacobian matrix;M (X) is the inertial matrix of moving platform;For non-linear Ge Shi centrifugal force matrix;X is moving platform
Pose vector;For speed term;For acceleration item;wgFor the gravity vector of moving platform;weFor external load suffered by moving platform;
()TThe transposition of representing matrix;Min expressions are minimized;∑ indicates summation algorithm;| | expression takes absolute value;()2Expression is made even
Side;
3) moving platform pose caused by traction rope flexible deformation is analyzed by forward kinematics solution according to practical rope length and deflection
Error;
4) the actual motion state of vision measurement moving platform is used, and will be inclined between actual motion state and desired motion state
Difference is used as controlled quentity controlled variable;
5) controller is designed, is specifically included:Establish the proportion differential feedback controller based on position and attitude error;Rope tension dynamic is excellent
It is turned to feedforward controller;Long change of rope correction term is added, error caused by compensation is elastic enhances the robustness of system, ensures
Moving platform is moved along desired trajectory;
6) according to the controller of design, the instruction of driving force square is calculated, it is final to control moving platform movement locus and rope tension, completely
Sufficient duty requirements.
2. considering the wire saws parallel robot motion control method of elasticity effect and compensation, feature as described in claim 1
It is in step 5), the controller uses following expression:
In formula, τ is motor driving force moment vector;R is the gearing factor of ball-screw;(JT)+After indicating Jacobian matrix transposition
Pseudoinverse;KpIt is the ratio control gain of system;KdIt is the differential control gain of system;TdIt is to be drawn by the rope that Inverse Dynamics obtain
Power feedforward term;K' is elastic compensating item proportional gain;XdIt is the desired trajectory of moving platform;X indicates the pose vector of moving platform;L1、
L2Correspond respectively to practical rope length and theoretical rope length;()·Indicate first derivative;Designed controller includes three, wherein the
One is moving platform Pose Control feedback term, and Section 2 is that rope tension controls feedforward term, and Section 3 is rope elastic compensating item.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610512458.4A CN105974797B (en) | 2016-07-01 | 2016-07-01 | Consider the wire saws parallel robot motion control method of elasticity effect and compensation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610512458.4A CN105974797B (en) | 2016-07-01 | 2016-07-01 | Consider the wire saws parallel robot motion control method of elasticity effect and compensation |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105974797A CN105974797A (en) | 2016-09-28 |
CN105974797B true CN105974797B (en) | 2018-07-17 |
Family
ID=56953537
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610512458.4A Expired - Fee Related CN105974797B (en) | 2016-07-01 | 2016-07-01 | Consider the wire saws parallel robot motion control method of elasticity effect and compensation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105974797B (en) |
Families Citing this family (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106426174B (en) * | 2016-11-05 | 2019-01-11 | 上海大学 | A kind of robotic contact power detection method based on torque observation and Friction identification |
CN106774362B (en) * | 2016-11-25 | 2020-02-14 | 集美大学 | Flexible six-degree-of-freedom rope-traction ship model pool test control method and system |
CN106768789B (en) * | 2016-12-31 | 2019-03-05 | 重庆大学 | Decoupling six-freedom mechanism store Combinations position and attitude error penalty method caused by aerodynamic loading |
CN109986543A (en) * | 2017-12-29 | 2019-07-09 | 深圳光启超材料技术有限公司 | Apply location regulation method and device, robot in robot |
CN108247636B (en) * | 2018-01-24 | 2020-01-24 | 北京机械设备研究所 | Parallel robot closed-loop feedback control method, system and storage medium |
CN108344553B (en) * | 2018-02-06 | 2020-04-17 | 厦门大学 | Wind tunnel test model parallel mechanism supporting device for aircraft formation flight |
CN109141917B (en) * | 2018-08-14 | 2020-10-27 | 合肥工业大学 | Dynamic balance tensioning method and tightening device for vehicle on drum test bed in silencing room |
CN110948485B (en) * | 2019-11-21 | 2022-11-08 | 佛山科学技术学院 | Calculation method for accurate numerical solution of rope traction parallel robot flexible cable catenary model |
CN111307396B (en) * | 2019-11-29 | 2021-03-05 | 厦门大学 | Model supporting structure, device and system for wind tunnel virtual flight test |
CN111400917B (en) * | 2020-03-18 | 2022-09-30 | 中国科学技术大学 | Kinematics optimization solving method of rope traction parallel robot with variable structure |
CN112230681B (en) * | 2020-09-28 | 2021-09-07 | 西安交通大学 | Multi-motor disc suspension control system and method |
CN114386208B (en) * | 2020-10-16 | 2024-06-25 | 北京航空航天大学 | Over-constrained kinematic support reliability analysis method based on parallel mechanism model |
CN112180944B (en) * | 2020-10-22 | 2022-02-15 | 南京航空航天大学 | Rope-tied wheel type mobile robot motion control system and method |
CN112632768B (en) * | 2020-12-21 | 2022-05-03 | 厦门大学 | Stability analysis method for under-constrained rope traction parallel mechanism |
CN112859895B (en) * | 2021-01-12 | 2022-06-10 | 南开大学 | Load redistribution method for double-unmanned-aerial-vehicle hoisting system for tension optimization and dynamic process design |
CN112975912A (en) * | 2021-03-09 | 2021-06-18 | 西安工业大学 | Flight type rope traction parallel robot complete rigidity model and rigidity characteristic analysis method |
CN113305809B (en) * | 2021-05-27 | 2022-04-05 | 哈尔滨工业大学 | Force sense simulation control method of fully-constrained space rope driving parallel mechanism |
CN113607378B (en) * | 2021-08-02 | 2022-04-08 | 厦门大学 | Rope system supporting aircraft model forced free angle motion simulation and suppression method |
CN113624399B (en) * | 2021-08-20 | 2022-03-25 | 哈尔滨工业大学 | Object rotational inertia measuring method applied to large-space rope driving system |
CN113520802B (en) * | 2021-08-24 | 2024-03-12 | 上海卓道医疗科技有限公司 | Limb rehabilitation training device and control method |
CN114029787B (en) * | 2021-11-08 | 2022-11-25 | 陕西科控技术产业研究院有限公司 | Elastic deformation compensation method for numerical control machine tool feeding system in semi-closed loop control mode |
CN114460899B (en) * | 2022-01-27 | 2024-05-03 | 北京北特圣迪科技发展有限公司 | Four-flexible-cable traction parallel actuator motion attitude control method based on predicted rope length |
CN114838905B (en) * | 2022-03-23 | 2023-05-12 | 厦门大学 | Novel dynamic aerodynamic force measurement method for model of tethered parallel support aircraft |
CN114831847B (en) * | 2022-03-29 | 2023-06-09 | 中国农业大学 | Four-branched-chain parallel mechanism neck rehabilitation training robot and force control method thereof |
CN114643584B (en) * | 2022-05-17 | 2022-09-30 | 中国科学技术大学 | Rapid terminal sliding mode synchronous control method for rope traction parallel robot |
CN114706312B (en) * | 2022-06-06 | 2022-09-30 | 中国科学技术大学 | High-precision self-adaptive cooperative control method for rope traction parallel robot |
CN115070771B (en) * | 2022-07-19 | 2022-12-30 | 中国科学技术大学 | Elastic double-ring synchronous control method for rope traction parallel robot |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102495550A (en) * | 2011-11-21 | 2012-06-13 | 湖南湖大艾盛汽车技术开发有限公司 | Forward dynamic and inverse dynamic response analysis and control method of parallel robot |
CN103009391A (en) * | 2012-12-14 | 2013-04-03 | 厦门大学 | Variable-structure rope-traction parallel robot for wind tunnel test |
CN103034123A (en) * | 2012-12-11 | 2013-04-10 | 中国科学技术大学 | Dynamic model parameter identification based parallel robot control method |
CN105137764A (en) * | 2015-10-15 | 2015-12-09 | 清华大学 | Parallel robot motion control method with fast response and robust performance |
-
2016
- 2016-07-01 CN CN201610512458.4A patent/CN105974797B/en not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102495550A (en) * | 2011-11-21 | 2012-06-13 | 湖南湖大艾盛汽车技术开发有限公司 | Forward dynamic and inverse dynamic response analysis and control method of parallel robot |
CN103034123A (en) * | 2012-12-11 | 2013-04-10 | 中国科学技术大学 | Dynamic model parameter identification based parallel robot control method |
CN103009391A (en) * | 2012-12-14 | 2013-04-03 | 厦门大学 | Variable-structure rope-traction parallel robot for wind tunnel test |
CN105137764A (en) * | 2015-10-15 | 2015-12-09 | 清华大学 | Parallel robot motion control method with fast response and robust performance |
Non-Patent Citations (6)
Title |
---|
Design and control of a redundant suspended cable-driven parallel robots;J Lamaury 等;《Advances in robot kinematics》;20121231;全文 * |
低速风洞绳牵引并联机器人支撑系统的模型姿态控制研究;梁斌 等;《中国航空学会2007年学术年会》;20071231;全文 * |
绳牵引并联机器人弹性变形对动平台位姿精度的影响;王晓光 等;《计算力学学报》;20160630;第33卷(第3期);全文 * |
风洞试验绳牵引冗余并联机器人的刚度增强与运动控制;刘欣 等;《航空学报》;20090630;第30卷(第6期);全文 * |
风洞试验绳牵引并联机器人高精度控制仿真;王晓光 等;《动力学与控制学报》;20161031;第14卷(第5期);全文 * |
高速绳牵引摄像机器人的运动稳定控制;韦慧玲 等;《西安电子科技大学学报(自然科学版)》;20161031;第43卷(第5期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN105974797A (en) | 2016-09-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105974797B (en) | Consider the wire saws parallel robot motion control method of elasticity effect and compensation | |
Kondak et al. | Aerial manipulation robot composed of an autonomous helicopter and a 7 degrees of freedom industrial manipulator | |
Kim et al. | Vision-guided aerial manipulation using a multirotor with a robotic arm | |
Yeo et al. | Design and analysis of cable-driven manipulators with variable stiffness | |
JP3473834B2 (en) | Robot control device | |
Saab et al. | Design and integration of a novel spatial articulated robotic tail | |
Zhong et al. | A practical visual servo control for aerial manipulation using a spherical projection model | |
CN111216129B (en) | Active-passive combined series-parallel force feedback equipment gravity compensation method | |
US8428780B2 (en) | External force target generating device of legged mobile robot | |
US9555548B2 (en) | Robot control device for controlling robot moved according to applied force | |
Ji et al. | Adaptive synchronization control of cable-driven parallel robots with uncertain kinematics and dynamics | |
CN111923047A (en) | Attitude control method for rotor unmanned aerial vehicle with arm aiming at mass center offset and base floating | |
CN109648564B (en) | Control method of multi-degree-of-freedom flexible joint mechanical arm system based on hierarchical MPC (Multi-degree-of-freedom) | |
CN108453740A (en) | A kind of industrial robot collaborative interactive method and system | |
Shang et al. | Dual-space adaptive synchronization control of redundantly-actuated cable-driven parallel robots | |
CN111007877A (en) | Global robust self-adaptive trajectory tracking control method of four-rotor aircraft | |
CN111045440A (en) | Hypersonic aircraft nose-down section rapid rolling control method | |
Wimböck et al. | Experimental study on dynamic reactionless motions with DLR's humanoid robot Justin | |
Wang et al. | Hybrid pose/tension control based on stiffness optimization of cable-driven parallel mechanism in wind tunnel test | |
Sarkisov et al. | Hierarchical whole-body control of the cable-suspended aerial manipulator endowed with winch-based actuation | |
CN116301009B (en) | Anti-interference safety control method for variable-configuration unmanned aerial vehicle | |
CN111687835B (en) | System and method for controlling reverse priority impedance of redundant mechanical arm of underwater mechanical arm | |
Saab et al. | Design and analysis of a discrete modular serpentine robotic tail for improved performance of mobile robots | |
CN115712309B (en) | Control method and device for active variable-structure annular four-rotor unmanned aerial vehicle | |
Clark et al. | On a balanced delta robot for precise aerial manipulation: Implementation, testing, and lessons for future designs |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180717 Termination date: 20190701 |
|
CF01 | Termination of patent right due to non-payment of annual fee |