CN110116409B - Four-channel teleoperation bilateral control method based on disturbance observer - Google Patents
Four-channel teleoperation bilateral control method based on disturbance observer Download PDFInfo
- Publication number
- CN110116409B CN110116409B CN201910437931.0A CN201910437931A CN110116409B CN 110116409 B CN110116409 B CN 110116409B CN 201910437931 A CN201910437931 A CN 201910437931A CN 110116409 B CN110116409 B CN 110116409B
- Authority
- CN
- China
- Prior art keywords
- representing
- disturbance observer
- robot
- teleoperation
- slave
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
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/1679—Programme controls characterised by the tasks executed
- B25J9/1689—Teleoperation
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
Abstract
The invention discloses a four-channel teleoperation bilateral control method based on a disturbance observer. A globally stable disturbance observer-based nonlinear sliding mode controller design method is provided by establishing a nonlinear system dynamic model of a bilateral teleoperation system, so that the main problems of nonlinearity, uncertainty, external interference and the like of the teleoperation system are solved. Aiming at the problem of nonlinearity of a bilateral teleoperation system, the invention designs a four-channel structure suitable for the nonlinear bilateral teleoperation system, and better system transparency is obtained through transmission of master end positions, operation torque of an operator, slave end positions and environment operation torque signals among communication channels. Aiming at the problems of uncertainty and external interference of a bilateral teleoperation system, the invention designs ideal track generators and a nonlinear sliding mode controller based on a disturbance observer at a master end and a slave end respectively, and guarantees the global stability of the system based on the Lyapunov theory.
Description
Technical Field
The invention belongs to the field of teleoperation control, in particular to a four-channel teleoperation bilateral control method based on a disturbance observer, and aims to improve the transparency of a nonlinear teleoperation system.
Background
With the development of automation and robot technology, a remote operation technology of human-computer interaction is adopted, namely, an operator operates a master robot to realize motion control of a slave robot, so that remote operation is realized. In view of the characteristics of high telepresence and near real-time synchronous operation of the teleoperation technology, the teleoperation technology has wide application prospects in the fields of space exploration, underwater operation, nuclear environment monitoring, teleoperation and the like.
Transparency is widely studied as an important index of teleoperation systems. The four-channel structure is an effective method for improving the transparency of the teleoperation system, and ideal transparency conditions are obtained by matching impedance coefficients of a master end and a slave end. However, the existing four-channel structure is mostly used for the linear teleoperation system, and with the complication and refinement of the operation task, the linear teleoperation system based on the four-channel structure cannot well perform the operation task. Therefore, in order to deal with complex and fine operation tasks, the invention provides a four-channel teleoperation bilateral control method based on a disturbance observer, which considers the problems of nonlinearity, uncertainty, external interference and the like of a multi-degree-of-freedom master-slave robot, overcomes the influence of nonlinearity, uncertainty and external interference of the master-slave robot on the performance of a teleoperation system, and improves the transparency of the teleoperation system.
Disclosure of Invention
The invention aims to provide a four-channel teleoperation bilateral control method based on a disturbance observer, and aims to solve the technical problems of transparency, nonlinearity, uncertainty and the like of a traditional teleoperation system.
In order to achieve the purpose, the technical scheme of the invention comprises the following specific contents:
a four-channel teleoperation bilateral control method based on a disturbance observer comprises the following steps:
1) establishing a nonlinear system dynamics model of a bilateral teleoperation system, which comprises the following specific steps:
1-1) establishing a dynamic model of a master-slave robot
Wherein, thetam,And thetas,Indicating position, velocity and acceleration signals of the master and slave robots, Mm0And Ms0Representing the known mass inertia matrix, Cm0And Cs0Representing a known Coriolis force/centripetal force matrix, Gm0And Gs0Representing a known gravity matrix, dmAnd dsRepresenting external interference and model error, umAnd usRepresenting a control input, τhAnd τeIndicating the operator's operating torque or the ambient work torque.
The dynamic model of the master-slave robot has the following characteristics:
1-2) establishing a mass-spring-damping environmental dynamics model
Wherein M ise,Ce,GeRepresenting an environmental parameter.
2) A sliding mode controller of a main robot is designed based on a disturbance observer, and the method specifically comprises the following steps:
2-1) designing a main-end ideal track generator as follows:
wherein avrg {. represents an average value of {. cndot. } -,kfmDenotes the scale parameter, Mdm,Cdm,GdmRepresenting the planning parameters.
By mixing thetasBy inputting equation (4), the reference trajectory θ can be obtainedmr,Then selecting proper Mdm,Cdm,GdmEquations (5) and (6) can obtain the ideal trajectory θmd,
2-2) defining the sliding surface s of the master robot controllermThe following were used:
wherein e ism=θm-θmd,λm=diag{λm1,...,λmi,..., λ mw1,2, w denotes the number of degrees of freedom of the master robot.
2-3) calculating smThe first derivation of (A) is as follows:
2-4) designing a main controller according to the step (8) to ensure the progressive stability of the main robot, and designing a controller umComprises the following steps:
νmi0>0。
in the controller (9), sat(s)m) Representing a saturation function to avoid chattering in a sliding mode controller, can be defined as:
wherein β represents a boundary layer;
wherein the content of the first and second substances,Hmthe reversible matrix is expressed and can be obtained by calculating a linear matrix inequality.
3) The sliding mode controller of the slave robot is designed based on a disturbance observer, and specifically comprises the following steps:
3-1) design the slave-end ideal trajectory generator as follows:
wherein avrg {. denotes the average value of, kfsDenotes the scale parameter, Mds,Cds,GdsRepresenting the planning parameters.
By mixing thetamInputting equation (12), a reference trajectory theta can be obtainedsr,Then selecting proper Mds,Cds,GdsEquations (13) and (14) can obtain the ideal trajectory θsd,
3-2) defining a slip form surface s from the robot controllersThe following were used:
wherein e iss=θs-θsd,λs=diag{λs1,...,λsi,..., λ sw1,2, w denotes the number of degrees of freedom from the robot.
3-3) calculating ssThe first derivation of (A) is as follows:
3-4) designing a slave controller according to the step (16), ensuring the progressive stability of the slave robot, and designing a controller usComprises the following steps:
in the controller (17), sat(s)s) Representing a saturation function to avoid chattering in a sliding mode controller, can be defined as:
wherein β represents a boundary layer;
wherein the content of the first and second substances,Hsthe reversible matrix is expressed and can be obtained by calculating a linear matrix inequality.
4) A master-slave robot-based sliding mode controller designs a Lyapunov function to ensure the global stability of a teleoperation system, and specifically comprises the following steps:
4-1) designing a global Lyapunov function V as follows:
V=Vm+Vs+Vm0+Vs0(20)
4-2) when | | | sm||,||ssWhen | | ≦ β, the global lyapunov function V will converge to:
wherein the content of the first and second substances, andrepresenting the observed error values of the master and slave observer.
Compared with the prior art, the invention has the following beneficial effects:
1. a disturbance observer is designed, and the anti-interference performance of the nonlinear bilateral teleoperation system is improved by observing and compensating model errors and external interference of the teleoperation system;
2. a saturation function is designed, so that the buffeting problem existing in the traditional sliding mode controller is solved;
2. the nonlinear sliding mode control method based on the disturbance observer can enable the slave robot to track the position signal of the master robot in real time, overcomes the influence of nonlinearity, uncertainty and external interference on the performance of the bilateral teleoperation system, and improves the transparency of the system;
4. and the Lyapunov function is utilized to ensure the boundedness of all signals, so that the stability and the convergence of the nonlinear bilateral teleoperation system are ensured.
Drawings
FIG. 1 is a block diagram of four-channel teleoperation bilateral control based on a disturbance observer according to the present invention;
fig. 2 is a graph of position tracking and force feedback for the master and slave robots according to the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention. In addition, the technical features involved in the embodiments of the present invention described below may be combined with each other as long as they do not conflict with each other.
The invention will now be further described with reference to the following examples and drawings:
the implementation technical scheme of the invention is as follows:
establishing a nonlinear system dynamics model of a bilateral teleoperation system
The dynamic model of the master-slave robot is as follows:
wherein, thetam,And thetas,Indicating position, velocity and acceleration signals of the master and slave robots, Mm0And Ms0Representing the known mass inertia matrix, Cm0And Cs0Representing a known Coriolis force/centripetal force matrix, Gm0And Gs0Representing a known gravity matrix, dmAnd dsRepresenting external interference and model error, umAnd usRepresenting a control input, τhAnd τeIndicating the operator's operating torque or the ambient work torque.
The dynamic model of the master-slave robot has the following characteristics:
the environmental dynamics model based on mass-spring-damping is as follows:
wherein M ise,Ce,GeRepresenting an environmental parameter.
(II) designing sliding mode controller for designing main robot based on disturbance observer
The master-end ideal trajectory generator is designed as follows:
wherein avrg {. denotes the average value of, kfmDenotes the scale parameter, Mdm,Cdm,GdmRepresenting the planning parameters.
By mixing thetasBy inputting equation (4), the reference trajectory θ can be obtainedmr,Then selecting the combinationSuitably Mdm,Cdm,GdmEquations (5) and (6) can obtain the ideal trajectory θmd,
Defining a slip form surface s for a master robotic controllermThe following were used:
wherein e ism=θm-θmd,λm=diag{λm1,...,λmi,..., λ mw1,2, w denotes the number of degrees of freedom of the master robot.
Then, s is calculatedmThe first derivation of (A) is as follows:
designing a main controller according to the step (8) to ensure the progressive stability of the main robot, and designing a controller umComprises the following steps:
νmi0>0。
in the controller (9), sat(s)m) Representing a saturation function to avoid chattering in a sliding mode controller, can be defined as:
wherein β represents a boundary layer;
wherein the content of the first and second substances,Hmthe reversible matrix is expressed and can be obtained by calculating a linear matrix inequality.
(III) designing a sliding mode controller of a slave robot based on a disturbance observer
The slave-end ideal trajectory generator is designed as follows:
wherein avrg {. denotes the average value of, kfsDenotes the scale parameter, Mds,Cds,GdsRepresenting the planning parameters.
By mixing thetamInputting equation (12), a reference trajectory theta can be obtainedsr,Then selecting proper Mds,Cds,GdsEquations (13) and (14) can obtain the ideal trajectory θsd,
Defining a slip form surface s from a robot controllersThe following were used:
wherein e iss=θs-θsd,λs=diag{λs1,...,λsi,..., λ sw1,2, w denotes the number of degrees of freedom from the robot.
Then, s is calculatedsThe first derivation of (A) is as follows:
according to (16), a slave controller is designed, the progressive stability of the slave robot is ensured, and the designed controller usComprises the following steps:
in the controller (17), sat(s)s) Representing a saturation function to avoid chattering in a sliding mode controller, can be defined as:
wherein β represents a boundary layer;
wherein the content of the first and second substances,Hsthe reversible matrix is expressed and can be obtained by calculating a linear matrix inequality.
(IV) designing Lyapunov function of sliding mode controller based on master-slave robot
The global lyapunov function V is designed as follows:
V=Vm+Vs+Vm0+Vs0 (20)
when | | | sm||,||ssWhen | | ≦ β, the global lyapunov function V will converge to:
wherein the content of the first and second substances, andrepresenting the observed error values of the master and slave observer.
Based on (21), sm,ss,Is bounded, such that em,es,And um,usIs bounded. Therefore, all signals in the non-linear teleoperation system are bounded and the system is globally stable.
(V) carrying out simulation experiment verification
In order to verify the feasibility of the theory, a simulation experiment is carried out under MATLAB, and the simulation experiment verifies the effect of the four-channel teleoperation bilateral control method based on the disturbance observer.
The simulation parameters are selected as follows:
taking a main controller (9) and a disturbance observer (11), wherein lambdam=diag{10,10},νm=diag{0.2,0.2},β=0.05,Mdm=diag{4.0,4.0},Cdm=diag{0,0},Gdm=diag{4.9,4.9}*θmd,τfm=0.025,Hm=diag{0.28,0.38}。
Taking a slave controller (17) and a disturbance observer (19), whereins=diag{10,10},νs=diag{0.2,0.2},β=0.05,Mds=diag{4.0,4.0},Cds=diag{0,0},Gds=diag{5.8,5.8}*θsd,τfs=0.025,Hs=diag{0.28,0.38}。
Taking the environmental parameter as Me=diag{-2.0,-2.0},Ce=diag{0,0},Ge=diag{-0.9,-0.9}*θs。
Taking the operating moment of an operator as tauh=[-2 sin t 4 sin t]T。
Defining a master-slave robot as a mechanical arm with 2 degrees of freedom, and parameters are as follows:
where j is m, s represents the master robot and the slave robot, respectively, and g is 9.8m/s2。
Fig. 2 is a graph showing position tracking and force feedback of the master robot and the slave robot, and it can be seen from the graph that the slave robot can better track the position signal of the master robot, the operator can feel the force feedback signal, and an ideal tracking track is provided for the master robot through formula (6). Thus, the non-linear teleoperation system is transparent.
Claims (7)
1. The four-channel teleoperation bilateral control method based on the disturbance observer is characterized by comprising the following steps of:
1) establishing a nonlinear system dynamics model of a bilateral teleoperation system, which comprises the following specific steps:
1-1) establishing a dynamic model of a master-slave robot
Wherein, thetam,Respectively representing position, velocity and acceleration signals, theta, of the main robots,Respectively representing position, velocity and acceleration signals from the robot, Mm0And Ms0Representing the known mass inertia matrix, Cm0And Cs0Representing a known Coriolis force/centripetal force matrix, Gm0And Gs0Representing a known gravity matrix, dmAnd dsRepresenting external interference and model error, umAnd usRepresenting a control input, τhAnd τeRepresenting an operator's operating torque or an environmental work torque;
1-2) establishing a mass-spring-damping environmental dynamics model
Wherein M ise,Ce,GeRepresenting an environmental parameter;
2) a sliding mode controller of a main robot is designed based on a disturbance observer, and the method specifically comprises the following steps:
2-1) designing a main-end ideal track generator as follows:
wherein avrg {. denotes the average value of, kfmDenotes the scale parameter, Mdm,Cdm,GdmRepresenting a planning parameter;
by mixing thetasBy inputting equation (4), the reference trajectory θ can be obtainedmr,Then selecting proper Mdm,Cdm,GdmEquations (5) and (6) can obtain the ideal trajectory θmd,
2-2) defining the sliding surface s of the master robot controllermThe following were used:
wherein e ism=θm-θmd,λm=diag{λm1,...,λmi,...,λmw1,2, w denotes the number of degrees of freedom of the master robot;
2-3) calculating smThe first derivation of (A) is as follows:
2-4) designing a controller according to the step (8) to ensure the progressive stability of the main robot, and designing a controller umComprises the following steps:
3) the sliding mode controller of the slave robot is designed based on a disturbance observer, and specifically comprises the following steps:
3-1) design the slave-end ideal trajectory generator as follows:
wherein avrg {. denotes the average value of, kfsDenotes the scale parameter, Mds,Cds,GdsRepresenting a planning parameter;
by mixing thetamInputting equation (12), a reference trajectory theta can be obtainedsr,Then selecting proper Mds,Cds,GdsEquations (13) and (14) can obtain the ideal trajectory θsd,
3-2) defining a slip form surface s from the robot controllersThe following were used:
wherein e iss=θs-θsd,λs=diag{λs1,...,λsi,...,λsw1,2, w denotes the number of degrees of freedom from the robot;
3-3) calculating ssThe first derivation of (A) is as follows:
3-4) designing a controller according to (16) to ensure the gradual stability of the slave robot, and designing a controller usComprises the following steps:
wherein the content of the first and second substances,νs=diag{νs1,...,νsi,...,νsw}, representing a non-linear disturbance observer;
4) designing a Lyapunov function of a sliding mode controller based on a master robot and a slave robot, which specifically comprises the following steps:
4-1) designing a global Lyapunov function V to ensure the global stability of the nonlinear teleoperation system;
4-2) when | | | sm||≤β,||ssWhen | is less than or equal to β, V will converge to:
4. The four-channel teleoperation bilateral control method based on the disturbance observer according to claim 1, wherein in the step 2-4),represents a non-linear disturbance observer defined as:
6. The four-channel teleoperation bilateral control method based on the disturbance observer according to claim 1, wherein in the step 3-4),represents a non-linear disturbance observer defined as:
7. The four-channel teleoperation bilateral control method based on the disturbance observer according to claim 1, wherein in the step 4-1), the designed global lyapunov function V is as follows:
V=Vm+Vs+Vm0+Vs0 (20)
Hmrepresenting the primary invertible matrix, HsRepresenting a slave-reversible matrix.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910437931.0A CN110116409B (en) | 2019-05-24 | 2019-05-24 | Four-channel teleoperation bilateral control method based on disturbance observer |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910437931.0A CN110116409B (en) | 2019-05-24 | 2019-05-24 | Four-channel teleoperation bilateral control method based on disturbance observer |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110116409A CN110116409A (en) | 2019-08-13 |
CN110116409B true CN110116409B (en) | 2021-02-26 |
Family
ID=67523166
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910437931.0A Active CN110116409B (en) | 2019-05-24 | 2019-05-24 | Four-channel teleoperation bilateral control method based on disturbance observer |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110116409B (en) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111427264B (en) * | 2020-03-15 | 2021-12-14 | 中国地质大学(武汉) | Neural self-adaptive fixed time control method of complex teleoperation technology |
CN111745643A (en) * | 2020-05-28 | 2020-10-09 | 西华大学 | Position control method for main robot and slave robot teleoperation system |
CN113485120B (en) * | 2021-08-01 | 2022-07-05 | 西北工业大学 | Robot teleoperation trajectory planning method based on control behavior detection |
CN114488791B (en) * | 2021-12-15 | 2023-07-21 | 西北工业大学 | Teleoperation event triggering fixed time control method based on intention understanding of operator |
CN114102636B (en) * | 2021-12-31 | 2024-03-19 | 华中科技大学 | Welding seam polishing control system of teleoperation robot and design method and application thereof |
CN114800487B (en) * | 2022-03-14 | 2024-02-02 | 中国科学院自动化研究所 | Underwater robot operation control method based on disturbance observation technology |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102848391A (en) * | 2012-09-20 | 2013-01-02 | 北京邮电大学 | Four-channel bilateral teleoperation control system based on actual force feedback |
CN105138754A (en) * | 2015-05-13 | 2015-12-09 | 西北工业大学 | Design method of variable-structure controller for double teleoperation with feature of time-varying delay |
CN108500983B (en) * | 2018-06-26 | 2023-06-16 | 西华大学 | Nonlinear teleoperation bilateral control system |
CN108646569B (en) * | 2018-07-09 | 2020-05-12 | 燕山大学 | Control method of teleoperation system in discrete time state |
CN109085749B (en) * | 2018-08-07 | 2020-02-28 | 浙江大学 | Nonlinear teleoperation bilateral control method based on self-adaptive fuzzy inversion |
CN109240086B (en) * | 2018-10-16 | 2020-02-28 | 浙江大学 | Self-adaptive robust control method of nonlinear bilateral teleoperation system |
-
2019
- 2019-05-24 CN CN201910437931.0A patent/CN110116409B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN110116409A (en) | 2019-08-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110116409B (en) | Four-channel teleoperation bilateral control method based on disturbance observer | |
CN109240086B (en) | Self-adaptive robust control method of nonlinear bilateral teleoperation system | |
Chen et al. | RBFNN-based adaptive sliding mode control design for delayed nonlinear multilateral telerobotic system with cooperative manipulation | |
Chen et al. | An improved wave-variable based four-channel control design in bilateral teleoperation system for time-delay compensation | |
CN109085749B (en) | Nonlinear teleoperation bilateral control method based on self-adaptive fuzzy inversion | |
CN108303885B (en) | Self-adaptive control method of motor position servo system based on disturbance observer | |
CN110262256B (en) | Multilateral self-adaptive sliding mode control method of nonlinear teleoperation system | |
CN108445748B (en) | Adaptive spacecraft attitude tracking control method based on event trigger mechanism | |
CN107121932B (en) | Motor servo system error symbol integral robust self-adaptive control method | |
CN105772917B (en) | A kind of three joint spot welding robot's Trajectory Tracking Control methods | |
CN108241292B (en) | Underwater robot sliding mode control method based on extended state observer | |
CN108508749A (en) | A kind of anti-interference iterative learning control method of Space Manipulator System for arresting noncooperative target | |
CN110340894B (en) | Teleoperation system self-adaptive multilateral control method based on fuzzy logic | |
CN110543184B (en) | Fixed time neural network control method for rigid aircraft | |
CN112223275B (en) | Cooperative robot control method based on finite time tracking control | |
CN108155833B (en) | Motor servo system asymptotic stable control method considering electrical characteristics | |
CN108170151B (en) | Self-adaptive motion control device and method for underwater robot | |
Chen et al. | Driver-behavior-based adaptive steering robust nonlinear control of unmanned driving robotic vehicle with modeling uncertainties and disturbance observer | |
CN107621783A (en) | Flat pad adaptive robust control method based on friciton compensation | |
Dehghan et al. | Observer-based adaptive force–position control for nonlinear bilateral teleoperation with time delay | |
Tang et al. | Disturbance-observer-based sliding mode control design for nonlinear bilateral teleoperation system with four-channel architecture | |
CN110488854B (en) | Rigid aircraft fixed time attitude tracking control method based on neural network estimation | |
CN114114928A (en) | Fixed time self-adaptive event trigger control method for piezoelectric micro-positioning platform | |
Yang et al. | Fixed-time composite neural learning control of flexible telerobotic systems | |
CN111427264B (en) | Neural self-adaptive fixed time control method of complex teleoperation technology |
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 |