[go: up one dir, main page]

CN105301959A - A Control Method for Space Robots Independent of Model Parameters - Google Patents

A Control Method for Space Robots Independent of Model Parameters Download PDF

Info

Publication number
CN105301959A
CN105301959A CN201510335294.8A CN201510335294A CN105301959A CN 105301959 A CN105301959 A CN 105301959A CN 201510335294 A CN201510335294 A CN 201510335294A CN 105301959 A CN105301959 A CN 105301959A
Authority
CN
China
Prior art keywords
angular velocity
arm
platform
robot
space robot
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201510335294.8A
Other languages
Chinese (zh)
Other versions
CN105301959B (en
Inventor
汤亮
何英姿
胡权
王大轶
张海博
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Control Engineering
Original Assignee
Beijing Institute of Control Engineering
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN201510335294.8A priority Critical patent/CN105301959B/en
Publication of CN105301959A publication Critical patent/CN105301959A/en
Application granted granted Critical
Publication of CN105301959B publication Critical patent/CN105301959B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Manipulator (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种不依赖模型参数的空间机器人控制方法,包含以下步骤:根据空间机器人的自由度数,确定控制通道个数,控制通道个数与自由度数相同;根据空间机器人的平台姿态角和角速度以及机械臂各臂杆的关节角和关节角速度,确定每个控制通道的自适应滑模控制器;根据空间机器人的高阶状态观测器,得到平台角速度以及机械臂各臂杆角速度的估计量以及空间机器人的内外扰动的估计量;利用平台角速度以及机械臂各臂杆角速度的估计量替换平台角速度以及机械臂各臂杆角速度的测量量,并更新自适应滑模控制器。本发明能够不依赖系统参数,提高空间机器人的精确控制。

The invention discloses a space robot control method independent of model parameters, comprising the following steps: determining the number of control channels according to the number of degrees of freedom of the space robot, and the number of control channels is the same as the number of degrees of freedom; according to the platform attitude angle and the number of degrees of freedom of the space robot Angular velocity and the joint angle and joint angular velocity of each arm of the manipulator to determine the adaptive sliding mode controller for each control channel; according to the high-order state observer of the space robot, the angular velocity of the platform and the angular velocity of each arm of the manipulator are estimated And the estimated quantity of internal and external disturbance of the space robot; the angular velocity of the platform and the angular velocity of each arm of the manipulator are used to replace the measured quantities of the angular velocity of the platform and the angular velocity of each arm of the manipulator, and the adaptive sliding mode controller is updated. The invention can improve the precise control of the space robot without depending on the system parameters.

Description

A kind of robot for space control method of independent of model parameter
Technical field
The present invention relates to a kind of robot for space control method, particularly a kind of independent of model parameter, the strong robustness Adaptive variable control with high state observer designs, belong to robot for space field.
Background technology
Space Robot System is typical strong nonlinearity, a strongly coupled system, and there is the problems such as Parameter uncertainties, outer interference and Unmarried pregnancy in application, and thus its control problem is comparatively complicated.At present, a lot of control method is applied to robotics system, such as Adaptive PID Control (KucTY, HanWG.AnAdaptivePIDLearningControlofRobotManipulators.Au tomatica, 2000, 36 (5): 717-725.), Sliding mode variable structure control (ManZH, PalaniswamiM.RobustTrackingControlforRigidRoboticManipul ators.IEEETransactionsonAutomaticControl, 1994, 39 (1): 154-159.), adaptive control (XuY, ShumH-Y, LeeJ-J, KanadeT.AdaptiveControlofSpaceRobotSystemWithanAttitudeC ontrolledBase.Proceedingsofthe1992IEEEInternationalConfe renceonRoboticsandAutomation, Nice, France, 1992.), Robust Adaptive Control (SpongMW.OntheRobustControlofRobotManipulators.IEEETransa ctionsonAutomaticControl, 1992, 37 (11): 1782 – 1786.) etc.But the current existing control law information needing systematic parameter more or less, the quality, inertia, installation parameter etc. in such as joint.Therefore result in for different Space Robot Systems, need for each system specialized designs controller to realize task object.This considerably increases the workload of system, and make the controller partial dependency systematic parameter of design.Therefore, desired design does not rely on the controller of robot for space parameter completely, makes single controller be applicable to all Space Robot Systems.Thus simplify the work of control design case.
From control program, the control system of robot for space can be divided into centerized fusion and distributing to control two classes.From reducing the dependence of Controller gain variations for model, Controller gain variations dirigibility and range of application, obvious distributing control program is more suitable for the controller designing complete individual system parameters; That is the design of controller is independently carried out in each joint of mechanical arm, and like this, designed controller can not rely on system dynamics model completely, and control method can be applicable in the mechanical arm system of all kinds of different configuration.
But distributing control program also has the technical difficulty in its design.First, because each joint is independently designed, the impact of other joints and Platform movement is outer disturbance to controller; Further, due to joint angle acceleration, even angular velocity is difficult to measure, and these disturbances can not be surveyed, and be also difficult to estimate the upper limit, this proposes very high requirement to the robustness of controller.Secondly, in distributing control program, the mass property parameter (inertia) in each joint be on a large scale time become, this proposes challenge to the Parameter uncertainties adaptability of controller; Again, because engineering upper joint angular velocity is difficult to Measurement accuracy, thus need to design the controller only needing to measure joint angle.
Summary of the invention
Technology of the present invention is dealt with problems and is: overcome the deficiencies in the prior art, provide a kind of robot for space control method of independent of model parameter, the present invention is combined by high state observer and adaptive sliding-mode observer, the internal and external interference of effective bucking-out system, under the prerequisite of only measurement mechanical shoulder joint angle position information, realize mechanical arm high precision and control.
Technical solution of the present invention is:
A robot for space control method for independent of model parameter, comprises following steps:
(1) according to the number of degrees of freedom, of robot for space, determine control channel number, control channel number is identical with number of degrees of freedom;
(2) according to the platform stance angle of robot for space and the joint angle of angular velocity and each armed lever of mechanical arm and joint angle speed, the adaptive sliding mode controller of each control channel in determining step (1);
(3) according to the high state observer of robot for space, the estimator of the estimator of mesa corners speed and mechanical arm each armed lever angular velocity and the inside and outside disturbance of robot for space is obtained;
(4) utilize the estimator of the mesa corners speed in (3) and mechanical arm each armed lever angular velocity to replace the measuring amount of mesa corners speed in (2) and each armed lever angular velocity of mechanical arm, and repeat step (2) more row adaptive sliding mode controller.
In step (2), the performing step of adaptive sliding mode controller is as follows:
(2.1) adaptive sliding mode controller of each control channel is determined:
Wherein, u represents the controlled quentity controlled variable that adaptive sliding mode controller exports; x represents the joint angle of robot platform attitude angle or each armed lever of mechanical arm, represent the angular velocity of platform or the angular velocity of each armed lever of mechanical arm; λ > 0; represent self-adaptation handoff gain; K d, λ and ε 0be constant, wherein K d> 0; κ > 0, κ represents the adaptive gain sensitive coefficient of handoff gain; Sat () is saturation function, definition r is boundary layer thickness;
(2.2) motion of robot for space platform stance, each armed lever of mechanical arm are rotated and be considered as each degree of freedom independently one dimension second-order system, this one dimension second order model is:
Wherein, x represents the joint angle of robot platform attitude angle or each armed lever of mechanical arm; represent the angular velocity of platform or the angular velocity of each armed lever of mechanical arm; represent the angular acceleration of platform or the angular acceleration of each armed lever of mechanical arm; m 0the generalized mass of each freedom of motion of representation space robot; The indeterminate of each freedom of motion generalized mass of Δ m representation space robot; f c=um 0; f dexpression system unknown disturbances power;
(2.3) by each degree of freedom independently one dimension second order model in step (2.2), carry out arrangement and obtain as drag:
Wherein, the inside and outside disturbance of Δ u representation space robot;
(2.4) obtain in determining step (2.3) whether meet the desired the angular acceleration of platform or the angular acceleration of each armed lever of mechanical arm, if meet, in description of step (2.1), adaptive sliding mode controller meets the demands, if do not meet, adjustment parameter re-starts the design of step (2.1), until meet the demands;
(2.5) according to the controlled quentity controlled variable that adaptive sliding mode controller exports, the true control f of robot for space is determined c1:
f c1=K dynamicsu(5)
Wherein, K dynamicsrepresent (m 0+ Δ m) estimated value.
In step (3), high state Design of Observer step is:
(3.1) will be organized into following form:
Wherein x 1=x,
(3.2) High-Order Sliding Mode observer is designed:
Wherein, x 1the measuring amount of the joint angle of the platform stance angle of representation space robot or each armed lever of mechanical arm is known quantity; represent the estimator of the joint angle of platform stance angle or each armed lever of mechanical arm, represent derivative; represent the estimator of the joint angle speed of mesa corners speed or each armed lever of mechanical arm, represent derivative; represent observer intermediate variable, represent derivative; χ 1represent intermediate variable; represent the estimated value to disturbance inside and outside robot for space; γ 1> 0, γ 2> 0 and γ 3> 0 represents observer parameter;
(3.3) by selecting suitable parameter γ 1, γ 2, γ 3, can estimated value be made and disturbance estimated value at Finite-time convergence to its actual value.
The present invention's beneficial effect is compared with prior art:
(1) adaptive sliding mode controller is combined with High-Order Sliding Mode observer by the present invention, not only without the need to the upper bound of known polymerization disturbance, and can compensate polymerization disturbance, further raising control accuracy, simultaneously without the need to the speed amount of measuring system, solve the problem of joint angle speed not easily Measurement accuracy, versatility strengthens greatly, and is easy to realize.
(2) the present invention is applicable to have uncertain, the outer interference of structural parameters and nonlinear system, and without the need to the upper bound of known polymerization disturbance, the present invention can ensure systems compliant bounded stability, steady state controling precision can be regulated by the parameter adjusting adaptive sliding mode controller, flexibly controlled, simultaneously wherein add High-Order Sliding Mode observer in control, with control inputs and system displacement for input, accurately can estimate system speed amount and polymerization disturbance.
(3) the present invention can to the identical controller of each channels designs structure of multivariant Space Robot System, when controlled device changes, only need for the number of degrees of freedom, of controlled device, increase or reduce the port number of controller, namely can realize control objectives, therefore practicality of the present invention and versatility are all very strong.
(4) application extension space of the present invention is larger, different controlled devices can be applied to, the robot for space of such as different configuration, the field such as industrial robot or even automobile, without the need to configuration speed sensor in the system that the present invention uses, only need measuring system displacement, simplify Control system architecture, reduce cost.Due to the highly versatile of the method, structure is simple, compared to other self-adaptation control method, has the very large market competitiveness.
(5) of the present invention have universality, can promote, and namely the method is not only applicable to this kind of multiple degrees of freedom second order nonlinear time-varying systems of robot, and is applicable to the control of general linear multi degrees of freedom kinematic system.
Accompanying drawing explanation
Fig. 1 is the inventive method process flow diagram;
Fig. 2 is autonomous configuration robot arm schematic diagram in the present embodiment;
Fig. 3 is mechanical arm distortion schematic diagram in the present embodiment.
Embodiment
Below in conjunction with accompanying drawing, the course of work of the present invention and principle of work are further explained.
As shown in Figure 1, the robot for space control method of a kind of independent of model parameter of the present invention comprises following steps:
(1) according to the number of degrees of freedom, of robot for space, determine control channel number, control channel number is identical with number of degrees of freedom;
(2) according to the platform stance angle of robot for space and the joint angle of angular velocity and each armed lever of mechanical arm and joint angle speed, the adaptive sliding mode controller of each control channel in determining step (1);
(3) according to the high state observer of robot for space, the estimator of the estimator of mesa corners speed and mechanical arm each armed lever angular velocity and the inside and outside disturbance of robot for space is obtained;
Joint angle and the angular velocity of the platform stance angle in step 2 and angular velocity and each armed lever of mechanical arm are obtained by angular velocity sensor, because sensor exists certain error, so add the estimation that high state observer carries out angular velocity and interference in step (3), improve control accuracy
(4) utilize the measuring amount of mesa corners speed in the estimator replacement step (2) of the mesa corners speed in step (3) and mechanical arm each armed lever angular velocity and each armed lever angular velocity of mechanical arm, and repeat step (2) and upgrade adaptive sliding mode controller.
The performing step of adaptive sliding mode controller is as follows:
The effect of adaptive sliding mode controller obtains control moment according to system motion state with to the estimation of disturbance, that system motion arrives sliding-mode surface and is tending towards zero point, this controller can regulate auto-adaptive parameter size according to the degree of system state departure sliding-mode surface, improves controller's effect.
The performing step of adaptive sliding mode controller is as follows:
(2.1) adaptive sliding mode controller of each control channel is determined:
Wherein, u represents the controlled quentity controlled variable that adaptive sliding mode controller exports; x represents the joint angle of robot platform attitude angle or each armed lever of mechanical arm, represent the angular velocity of platform or the angular velocity of each armed lever of mechanical arm; λ > 0; represent self-adaptation handoff gain; K d, λ and ε 0be constant, wherein K d> 0; κ > 0, κ represents the adaptive gain sensitive coefficient of handoff gain; Its value is less, and adaptive gain change is faster; Sat () is saturation function, definition r is boundary layer thickness; R value is less, and the characteristic of saturation function is more close to sign function, and corresponding departure is also less, but produce flutter may be larger.Its value is larger, flutter may be less, but departure can increase.Therefore boundary layer thickness needs compromise to choose.
The adaptive law principle of formula 1 and 2 can underdraw into: using the size of S as the pace of change foundation of self-adaptation handoff gain, as long as S ≠ 0, handoff gain just continues to increase; System motion track departs from sliding-mode surface larger (| S| is larger), and self-adaptation handoff gain increases faster, and to strengthen the interference rejection capability of system, flog system state motion is to sliding-mode surface S=0.ε 0> 0 is the constant value part in handoff gain, in order to strengthen the robustness of system to interference further.
(2.2) motion of robot for space platform stance, each armed lever of mechanical arm are rotated and be considered as each degree of freedom independently one dimension second-order system, be considered as outer interference by the coupling terms between each degree of freedom, this one dimension second order model is:
Wherein, x represents the joint angle of robot platform attitude angle or each armed lever of mechanical arm; represent the angular velocity of platform or the angular velocity of each armed lever of mechanical arm; represent the angular acceleration of platform or the angular acceleration of each armed lever of mechanical arm; m 0the generalized mass of each freedom of motion of representation space robot; The indeterminate of each freedom of motion generalized mass of Δ m representation space robot; f c=um 0; f dexpression system unknown disturbances power (friction of such as joint and damping and environmental interference factor etc.); the non-linear partial of expression system; Formula (1) has taken into full account the Parameter uncertainties of system, non-linear and outer interference, is one and has extensive representational Kind of Nonlinear Dynamical System model.Different systems functional form is different, obtains according to concrete system.
(2.3) by each degree of freedom independently one dimension second order model in step (2.2), carry out arrangement and obtain as drag:
Wherein, (interior disturbance comprises the uncertainty of mass inertia installation site and the friction in joint and damping, outer disturbance and comprises unknown environmental interference power in the inside and outside disturbance of Δ u representation space robot, suppose that internal and external interference is bounded, when specifically solving, Δ u can replace with enough large constant, and the scope of constant is different according to the configuration difference of robot for space);
(2.4) obtain in determining step (2.3) whether meet the desired the angular acceleration of platform or the angular acceleration of each armed lever of mechanical arm, if meet, in description of step (2.1), adaptive sliding mode controller meets the demands, if do not meet, adjustment parameter re-starts the design of step (2.1), until meet the demands;
(2.5) according to the controlled quentity controlled variable that adaptive sliding mode controller exports, the true control f of robot for space is determined c1:
f c1=K dynamicsu(5)
Wherein, K dynamicsrepresent (m 0+ Δ m) estimated value.
High state observer
High state observer can be estimated system disturbance, and is compensated in the controller; It also can the speed (platform stance angular velocity, joint of mechanical arm angular velocity) of estimating system, and for controlling feedback, this makes only to need in the control program of system to measure displacement (platform stance angle, joint of mechanical arm angle), and without the need to measuring speed amount, enormously simplify system configuration.
High state Design of Observer step is:
(3.1) will be organized into following form:
Wherein x 1=x,
(3.2) High-Order Sliding Mode observer is designed:
Wherein, x 1the measuring amount of the joint angle of the platform stance angle of representation space robot or each armed lever of mechanical arm is known quantity; represent the estimator of the joint angle of platform stance angle or each armed lever of mechanical arm, represent derivative; represent the estimator of the joint angle speed of mesa corners speed or each armed lever of mechanical arm, represent derivative; represent observer intermediate variable, represent derivative; χ 1represent intermediate variable; represent the estimated value to disturbance inside and outside robot for space; γ 1> 0, γ 2> 0 and γ 3> 0 represents observer parameter (setting according to system);
(3.3) by selecting suitable parameter γ 1, γ 2, γ 3, can estimated value be made and disturbance estimated value at Finite-time convergence to its actual value.
To change the stage for the armed lever length of space allosteric type robot, the course of work of the present invention and principle of work are further explained below:
The present invention can be applied to the robot of multiple not same-action, different configuration.Change the stage for the armed lever length of space allosteric type robot below, the concrete steps that the method that the present invention carries controls for closed loop configuration robot for space are described.
As shown in Figure 2, closed loop configuration robot for space comprise armed lever 1, armed lever 3, armed lever 4, armed lever 7, armed lever 8, armed lever 9, armed lever 10, armed lever 11, armed lever 12, each armed lever cut with scissors by passive cylinder or post hinge be connected.
As shown in Figure 3, the control object of this exemplifying embodiment changes the relative translational movement displacement between armed lever 3 and armed lever 4, be connected by passive cylinder hinge 5 between armed lever 3 with armed lever 4 that (passive cylinder cuts with scissors 5 inside does not have active actuator, need to apply control moment at all the other hinge places, control the relative motion of armed lever 3 and armed lever 4).First mechanical arm 14 (armed lever 3, armed lever 4, passive cylinder hinge 5 and armed lever 16 constitute the first mechanical arm 14) and the first mechanical arm 15 (being made up of armed lever 17 and other armed levers) are caught mutually and are formed closed loop configuration, unlock passive cylinder hinge 5, control moment is applied at all the other joints, relative position between armed lever 3 and armed lever 4 is increased, realizes changing armed lever length.Need in control procedure to maintain the stable of robot platform attitude, amount to be designed is the control moment in gesture stability moment and each joint.
Step one: according to robot for space number of degrees of freedom (comprising 3 degree of freedom of robot platform attitude, and manipulator motion degree of freedom, 12), determine that control channel number is 15.
Step 2: to each passage, designs following adaptive sliding mode controller,
Wherein, 3 channel parameters of gesture stability are identical, are K d=0.1, λ=0.5, ε 0=0.05, κ=0.02, τ=0.01, r=0.001; 12 channel parameters that mechanical arm controls are identical, are K d=1, λ=10, ε 0=0.1, κ=0.001, τ=0.01, r=0.001.
Step 4: introduce High-Order Sliding Mode observer and system disturbance is estimated, and compensated in the controller.High-order Observer Structure is provided by following formula, and the observer parameter of all 15 passages is identical,
Wherein γ 1=2.1, γ 2=4.2 and γ 3=8.4.
Scope is not only confined to the present embodiment, the present embodiment for explaining the present invention, all changes with the present invention under same principle and design condition or revise all within protection domain disclosed by the invention.

Claims (3)

1.一种不依赖模型参数的空间机器人控制方法,其特征在于包含以下步骤:1. A space robot control method independent of model parameters, characterized in that it comprises the following steps: (1)根据空间机器人的自由度数,确定控制通道个数,控制通道个数与自由度数相同;(1) Determine the number of control channels according to the number of degrees of freedom of the space robot, and the number of control channels is the same as the number of degrees of freedom; (2)根据空间机器人的平台姿态角和角速度以及机械臂各臂杆的关节角和关节角速度,确定步骤(1)中每个控制通道的自适应滑模控制器;(2) According to the platform attitude angle and angular velocity of the space robot and the joint angle and joint angular velocity of each arm bar of the mechanical arm, determine the adaptive sliding mode controller of each control channel in step (1); (3)根据空间机器人的高阶状态观测器,得到平台角速度以及机械臂各臂杆角速度的估计量以及空间机器人的内外扰动的估计量;(3) According to the high-order state observer of the space robot, the angular velocity of the platform, the angular velocity of each arm of the manipulator, and the estimated quantity of the internal and external disturbance of the space robot are obtained; (4)利用步骤(3)中的平台角速度以及机械臂各臂杆角速度的估计量替换步骤(2)中的平台角速度以及机械臂各臂杆角速度的测量量,并重复步骤(2)更新自适应滑模控制器。(4) Use the estimated angular velocity of the platform and the angular velocity of each arm of the manipulator in step (3) to replace the angular velocity of the platform and the measured values of the angular velocity of each arm of the manipulator in step (2), and repeat step (2) to update from Adapted to a sliding mode controller. 2.根据权利要求1所述的一种不依赖模型参数的空间机器人控制方法,其特征在于:所述步骤(2)中自适应滑模控制器的实现步骤如下:2. a kind of space robot control method that does not depend on model parameter according to claim 1, it is characterized in that: the realization step of self-adaptive sliding mode controller in described step (2) is as follows: (2.1)确定每个控制通道的自适应滑模控制器:(2.1) Determine the adaptive sliding mode controller for each control channel: uu == -- KK DD. SS -- λλ xx ·&Center Dot; -- (( ϵϵ 00 ++ ϵϵ ^^ )) satsat (( SS )) -- -- -- (( 11 )) ϵϵ ^^ ·&Center Dot; == 11 κκ (( -- ττ ϵϵ ^^ ++ || SS || )) -- -- -- (( 22 )) 其中,u表示自适应滑模控制器输出的控制量;x表示机器人平台姿态角或机械臂各臂杆的关节角,表示平台的角速度或机械臂各臂杆的角速度;λ>0;表示自适应切换增益;KD、λ和ε0均为常数,其中KD>0;κ>0,κ表示切换增益的自适应增益变化敏感系数;sat(·)为饱和函数,定义 sat ( S ) = ( ϵ 0 + ϵ ^ ) S r , ( ϵ 0 + ϵ ^ ) | S | ≤ r sign ( S ) , ( ϵ 0 + ϵ ^ ) | S | > r , r为边界层厚度;Among them, u represents the control quantity output by the adaptive sliding mode controller; x represents the attitude angle of the robot platform or the joint angle of each arm of the manipulator, Indicates the angular velocity of the platform or the angular velocity of each arm of the robotic arm; λ>0; Indicates the adaptive switching gain; K D , λ and ε 0 are all constants, where K D >0;κ>0, κ represents the adaptive gain change sensitivity coefficient of the switching gain; sat( ) is a saturation function, defined sat ( S ) = ( ϵ 0 + ϵ ^ ) S r , ( ϵ 0 + ϵ ^ ) | S | ≤ r sign ( S ) , ( ϵ 0 + ϵ ^ ) | S | > r , r is the thickness of the boundary layer; (2.2)将空间机器人平台姿态运动、机械臂各个臂杆转动视为各个自由度独立的一维二阶系统,该一维二阶系统模型为:(2.2) The attitude motion of the space robot platform and the rotation of each arm of the manipulator are regarded as a one-dimensional second-order system with independent degrees of freedom. The one-dimensional second-order system model is: (( mm 00 ++ ΔmΔm )) xx ·&Center Dot; ·&Center Dot; == ff cc ++ ff dd ++ ff nonnon (( xx ,, xx ·· )) -- -- -- (( 33 )) 其中,x表示机器人平台姿态角或机械臂各臂杆的关节角;表示平台的角速度或机械臂各臂杆的角速度;表示平台的角加速度或机械臂各臂杆的角加速度;m0表示空间机器人各运动自由度的广义质量;Δm表示空间机器人各运动自由度广义质量的不确定项;fc=um0;fd表示系统未知干扰力;Among them, x represents the attitude angle of the robot platform or the joint angle of each arm of the mechanical arm; Indicates the angular velocity of the platform or the angular velocity of each arm of the robotic arm; Represents the angular acceleration of the platform or the angular acceleration of each arm of the mechanical arm; m 0 represents the generalized quality of each degree of freedom of motion of the space robot; Δm represents the uncertainty item of the generalized quality of each degree of freedom of motion of the space robot; f c =um 0 ; d represents the unknown disturbance force of the system; (2.3)将步骤(2.2)中各自由度独立的一维二阶系统模型,进行整理得到如下模型:(2.3) Arranging the one-dimensional second-order system model with independent degrees of freedom in step (2.2) to obtain the following model: xx ·· ·· == uu ++ ΔuΔu -- -- -- (( 44 )) 其中,Δu表示空间机器人的内外扰动;Among them, Δu represents the internal and external disturbance of the space robot; (2.4)判断步骤(2.3)中求出的是否满足期望的平台的角加速度或机械臂各臂杆的角加速度,若满足,说明步骤(2.1)中自适应滑模控制器满足要求,若不满足,调整参数重新进行步骤(2.1)的设计,直至满足要求;(2.4) Calculated in the judgment step (2.3) Whether it meets the expected angular acceleration of the platform or the angular acceleration of each arm of the manipulator. If it is satisfied, it means that the adaptive sliding mode controller in step (2.1) meets the requirements. If not, adjust the parameters and redesign the step (2.1) , until the requirements are met; (2.5)根据自适应滑模控制器输出的控制量,确定空间机器人真实控制力fc1(2.5) According to the control quantity output by the adaptive sliding mode controller, determine the real control force f c1 of the space robot: fc1=Kdynamicsu(5)f c1 =K dynamics u(5) 其中,Kdynamics表示(m0+Δm)的估计值。Wherein, K dynamics represents an estimated value of (m 0 +Δm). 3.根据权利要求1所述的一种不依赖模型参数的空间机器人控制方法,其特征在于:所述步骤(3)中高阶状态观测器设计步骤为:3. a kind of space robot control method that does not depend on model parameter according to claim 1, it is characterized in that: the high-order state observer design step in the described step (3) is: (3.1)将整理成如下形式:(3.1) will Organized into the following form: xx ·&Center Dot; 11 == xx 22 xx ·&Center Dot; 22 == uu ++ ΔuΔu -- -- -- (( 66 )) 其中x1=x, where x 1 =x, (3.2)设计高阶滑模观测器:(3.2) Design a high-order sliding mode observer: xx ^^ ·· 11 == χχ 11 χχ 11 == xx ^^ 22 -- γγ 33 || xx ^^ 11 -- xx 11 || 22 // 33 signsign (( xx ^^ 11 -- xx 11 )) xx ^^ ·· 22 == uu ++ ΔΔ uu ^^ ΔΔ uu ^^ == -- γγ 22 || xx ^^ 22 -- χχ 11 || 11 // 22 signsign (( xx ^^ 22 -- χχ 11 )) ++ xx ^^ 33 xx ^^ ·· 33 == -- γγ 33 signsign (( xx ^^ 33 -- ΔΔ uu ^^ )) -- -- -- (( 77 )) 其中,x1表示空间机器人的平台姿态角或机械臂各臂杆的关节角的测量量,为已知量;表示平台姿态角或机械臂各臂杆的关节角的估计量,表示的导数;表示平台角速度或机械臂各臂杆的关节角速度的估计量,表示的导数;表示观测器中间变量,表示的导数;χ1表示中间变量;表示对空间机器人内外扰动的估计值;γ1>0、γ2>0和γ3>0表示观测器参数;Wherein, x 1 represents the measured quantity of the platform attitude angle of the space robot or the joint angle of each arm of the mechanical arm, which is a known quantity; represents the estimation of the attitude angle of the platform or the joint angle of each arm of the manipulator, express derivative of represents an estimate of the angular velocity of the platform or the joint angular velocity of each arm of the robotic arm, express derivative of represents an observer intermediate variable, express The derivative of ; χ 1 represents the intermediate variable; Indicates the estimated value of the internal and external disturbance of the space robot; γ 1 >0, γ 2 >0 and γ 3 >0 represent the observer parameters; (3.3)通过选择合适的参数γ123,可以使得估计值以及扰动估计值在有限时间内收敛到其真实值。(3.3) By choosing appropriate parameters γ 1 , γ 2 , γ 3 , the estimated value and the disturbance estimate converges to its true value in finite time.
CN201510335294.8A 2015-06-17 2015-06-17 A kind of robot for space control method of independent of model parameter Active CN105301959B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510335294.8A CN105301959B (en) 2015-06-17 2015-06-17 A kind of robot for space control method of independent of model parameter

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510335294.8A CN105301959B (en) 2015-06-17 2015-06-17 A kind of robot for space control method of independent of model parameter

Publications (2)

Publication Number Publication Date
CN105301959A true CN105301959A (en) 2016-02-03
CN105301959B CN105301959B (en) 2018-07-24

Family

ID=55199357

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510335294.8A Active CN105301959B (en) 2015-06-17 2015-06-17 A kind of robot for space control method of independent of model parameter

Country Status (1)

Country Link
CN (1) CN105301959B (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107505841A (en) * 2017-08-31 2017-12-22 电子科技大学 A kind of mechanical arm attitude robust control method based on interference estimator
CN109917655A (en) * 2019-03-27 2019-06-21 中国科学院光电技术研究所 A Control Method to Improve Disturbance Rejection Capability of Equivalent Sliding Mode Control
CN111772794A (en) * 2020-06-29 2020-10-16 郑州大学 Master and slave robot control method and device for minimally invasive surgery
CN112198795A (en) * 2020-10-14 2021-01-08 中国科学院长春光学精密机械与物理研究所 Electromechanical servo control method, electromechanical servo control system, terminal equipment and storage medium

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002318602A (en) * 2001-02-19 2002-10-31 Komatsu Ltd Device and method for controlling discrete time sliding mode for process system having dead time
CN102591207A (en) * 2012-03-01 2012-07-18 北京航空航天大学 Sliding form control method of flexible joint mechanical arm based on disturbance observer
CN103406909A (en) * 2013-07-24 2013-11-27 黑龙江科技大学 Tracking control device and method of mechanical arm system
CN203909498U (en) * 2014-03-26 2014-10-29 许一男 Adaptive robust fault-tolerant control architecture model with dynamic fault reconstruction mechanism

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002318602A (en) * 2001-02-19 2002-10-31 Komatsu Ltd Device and method for controlling discrete time sliding mode for process system having dead time
CN102591207A (en) * 2012-03-01 2012-07-18 北京航空航天大学 Sliding form control method of flexible joint mechanical arm based on disturbance observer
CN103406909A (en) * 2013-07-24 2013-11-27 黑龙江科技大学 Tracking control device and method of mechanical arm system
CN203909498U (en) * 2014-03-26 2014-10-29 许一男 Adaptive robust fault-tolerant control architecture model with dynamic fault reconstruction mechanism

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
张文辉等: "基于滑模变结构的空间机器人神经网络跟踪控制", 《控制理论与应用》 *
薛力军等: "空间机器人分布式滑模变结构控制方法", 《控制工程》 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107505841A (en) * 2017-08-31 2017-12-22 电子科技大学 A kind of mechanical arm attitude robust control method based on interference estimator
CN107505841B (en) * 2017-08-31 2021-02-05 电子科技大学 Mechanical arm posture robust control method based on interference estimator
CN109917655A (en) * 2019-03-27 2019-06-21 中国科学院光电技术研究所 A Control Method to Improve Disturbance Rejection Capability of Equivalent Sliding Mode Control
CN111772794A (en) * 2020-06-29 2020-10-16 郑州大学 Master and slave robot control method and device for minimally invasive surgery
CN112198795A (en) * 2020-10-14 2021-01-08 中国科学院长春光学精密机械与物理研究所 Electromechanical servo control method, electromechanical servo control system, terminal equipment and storage medium
CN112198795B (en) * 2020-10-14 2022-02-22 中国科学院长春光学精密机械与物理研究所 Electromechanical servo control method, electromechanical servo control system, terminal equipment and storage medium

Also Published As

Publication number Publication date
CN105301959B (en) 2018-07-24

Similar Documents

Publication Publication Date Title
Liu et al. Neural-network-based sliding-mode control of an uncertain robot using dynamic model approximated switching gain
Liu et al. Formation control of multiple mobile robots incorporating an extended state observer and distributed model predictive approach
Duan et al. Adaptive variable impedance control for dynamic contact force tracking in uncertain environment
Chen et al. Adaptive neural output feedback control of uncertain nonlinear systems with unknown hysteresis using disturbance observer
Chung et al. Motion control
Rahmani et al. Adaptive neural network output feedback control for flexible multi-link robotic manipulators
Yildiz et al. Sliding-mode neuro-controller for uncertain systems
CN106393116B (en) Mechanical arm fractional order iterative learning control method with Initial state learning and system
Fei et al. Adaptive control of MEMS gyroscope using global fast terminal sliding mode control and fuzzy-neural-network
CN104950678B (en) A kind of Neural Network Inversion control method of flexible mechanical arm system
CN104111607A (en) Motor position servo system control method taking input time lag into consideration
CN105301959A (en) A Control Method for Space Robots Independent of Model Parameters
Yang et al. Finite-time synchronization control for bilateral teleoperation under communication delays
Feliu-Talegon et al. Control of very lightweight 2-DOF single-link flexible robots robust to strain gauge sensor disturbances: A fractional-order approach
CN104614984A (en) High-precision control method of motor position servo system
CN108363293A (en) A kind of cross coupling control algorithm and system based on PID control
Zhou et al. Trajectory tracking control for electro-optical tracking system using ESO based fractional-order sliding mode control
Yang et al. Multi‐manipulators coordination for bilateral teleoperation system using fixed‐time control approach
Yang et al. Observer-based adaptive fuzzy event-triggered control for mechatronic systems with inaccurate signal transmission and motion constraints
Hu et al. Impedance with Finite‐Time Control Scheme for Robot‐Environment Interaction
Ma et al. Nonlinear filters-based adaptive fuzzy control of strict-feedback nonlinear systems with unknown asymmetric dead-zone output
Yan et al. Time-varying disturbance-observer-based tracking control of uncertain flexible-joint manipulator
CN110829933A (en) Neural network output feedback self-adaptive robust control method based on transmitting platform
Wang et al. Data-driven adaptive control for uncertain nonlinear systems
Tran et al. Finite-time output control for uncertain robotic manipulators with time-varying output constraints

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