[go: up one dir, main page]

CN116184825A - A Trajectory Tracking Control Method Based on Fuzzy Adaptive Sliding Mode for Delta Parallel Robot - Google Patents

A Trajectory Tracking Control Method Based on Fuzzy Adaptive Sliding Mode for Delta Parallel Robot Download PDF

Info

Publication number
CN116184825A
CN116184825A CN202211729052.3A CN202211729052A CN116184825A CN 116184825 A CN116184825 A CN 116184825A CN 202211729052 A CN202211729052 A CN 202211729052A CN 116184825 A CN116184825 A CN 116184825A
Authority
CN
China
Prior art keywords
fuzzy
sliding mode
robot
adaptive
control
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
CN202211729052.3A
Other languages
Chinese (zh)
Other versions
CN116184825B (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.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
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 South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN202211729052.3A priority Critical patent/CN116184825B/en
Publication of CN116184825A publication Critical patent/CN116184825A/en
Application granted granted Critical
Publication of CN116184825B publication Critical patent/CN116184825B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/042Adaptive 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
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

The invention discloses a track tracking control method of a Delta parallel robot based on a fuzzy self-adaptive sliding mode, which comprises the following steps: s1, acquiring a dynamic model and a reference motion trail; s2, mapping is established, and a joint rotation angle is obtained; s3, acquiring a tracking error of the joint angle, designing a sliding mode, and selecting an approach rate to enable the angle tracking error to reach the sliding mode; according to the robot model and a control target of track tracking, designing a control law of a robot track tracking controller, and determining control parameters; s4, introducing a fuzzy self-adaptive control system; s5, analyzing stability and convergence of the fuzzy self-adaptive control system, adjusting control parameters of the controller, and outputting a track tracking result. According to the invention, fuzzy self-adaptive control is introduced on the basis of the sliding mode controller, and discontinuous switching functions in the sliding mode control law are replaced by the output of the fuzzy system, so that smooth output of the robot control moment is realized, and the robustness of the robot system in track tracking is maintained.

Description

Track tracking control method of Delta parallel robot based on fuzzy self-adaptive sliding mode
Technical Field
The invention relates to the technical field of robot system track tracking, in particular to a track tracking control method of a Delta parallel robot based on a fuzzy self-adaptive sliding mode.
Background
With the progress of technology and the development of the age, the industrial automation degree of a country is also advanced. The robot is a comprehensive system capable of realizing autonomous movement oriented to the target and completing corresponding tasks under the action of a controller according to the state and sensing information of the robot. Motion control is the most fundamental problem in robot autonomy research, as any task that a robot is to autonomously accomplish is motion-based. Because of uncertainty in the working environment of the robot, the robot is often required to track a planned feasible track. Such problems are called trajectory tracking problems, and are hot spot problems in the field of robot motion control research.
For the research of the robot track tracking technology, the more common method is to adopt linear feedback control or nonlinear feedback control, and the main defects are that the method cannot be applied to the motion planning problem in a complex environment, and the robustness of the system and the realization of the control effect are not ideal. With the development of robot technology, the moving and static requirements on the rapidity, the accuracy, the anti-interference capability and the like of the motion trail tracking of a robot system are higher and higher. In reality, the system is likely to be interfered by external environment in the running process, and the sliding mode control has the characteristic of insensitivity to the uncertainty factor of the system and the external disturbance, namely, good robustness can be maintained for the linear system and the nonlinear system. The sliding mode control method can obtain satisfactory dynamic quality through design of a design sliding mode, meanwhile, the control algorithm is simple, the Delta parallel robot is easy to realize track tracking control, the system is influenced by external disturbance, and the sliding mode control strategy is a good choice. However, the discontinuous switching function contained in the approach rate of the slip-mode controller may cause rapid switching of the brake responsible for driving, causing buffeting. In robotic systems, the control input to the system is torque, and severe buffeting can increase the energy loss of the system and affect the accuracy and stability of system trajectory tracking.
Disclosure of Invention
In order to solve the technical problems in the prior art, the invention provides the track tracking control method of the Delta parallel robot based on the fuzzy self-adaptive sliding mode, fuzzy self-adaptive control is introduced on the basis of a sliding mode controller, discontinuous switching functions in a sliding mode control law are replaced by the output of a fuzzy system, smooth output of robot control moment is realized, and robustness of robot system track tracking is maintained.
The invention is realized by adopting the following technical scheme: a track tracking control method of a Delta parallel robot based on a fuzzy self-adaptive sliding mode comprises the following steps:
s1, giving a dynamic model and a reference motion trail Xr of the robot according to the structure of the Delta parallel robot;
s2, establishing a mapping between a robot reference motion track Xr and a driving joint angle according to inverse kinematics solution of the Delta parallel robot, and obtaining a robot expected joint rotation angle qd corresponding to the reference motion track;
s3, measuring the actual rotation angle of a driving joint of the robot, feeding back to the controller, and obtaining a tracking error of the joint angle by making a difference with the expected joint angle in the step S2; according to the angle tracking error information, designing a sliding mode, and selecting an approach rate to enable the angle tracking error to reach the sliding mode; according to the robot model and a control target of track tracking, designing a control law of a robot track tracking controller, and determining control parameters;
s4, introducing a fuzzy self-adaptive control system, and replacing discontinuous switching functions in the synovial membrane control rate by smooth output of the fuzzy self-adaptive control system;
s5, analyzing stability and convergence of the fuzzy self-adaptive control system, adjusting control parameters of the controller, and outputting a track tracking result.
Compared with the prior art, the invention has the following advantages and beneficial effects:
1. according to the invention, fuzzy self-adaptive control is introduced on the basis of the sliding mode controller, and discontinuous switching functions in the sliding mode control law are replaced by the output of the fuzzy system, so that smooth output of the robot control moment is realized, and the robustness of the robot system in track tracking is maintained.
2. The output of the fuzzy function comprises information of system modeling errors and disturbance errors, and the fuzzy function can be estimated on line, so that the self-adaptive capacity of the system is enhanced.
Drawings
FIG. 1 is a flow chart of the method of the present invention;
FIG. 2 is a three-dimensional perspective view of a reference trajectory in an embodiment of the invention;
FIG. 3 is a schematic view of a desired joint rotation angle in an embodiment of the present invention;
FIG. 4 is a schematic diagram of torque output under the action of a simple sliding mode controller in step S53 according to an embodiment of the present invention;
FIG. 5 is a schematic diagram of torque output under the action of the fuzzy adaptive slip-form controller in step S53 according to an embodiment of the present invention;
FIG. 6 is a schematic diagram of tracking errors of the joint trajectories under the influence of a fuzzy adaptive slip-mode controller in accordance with an embodiment of the present invention.
Detailed Description
The present invention will be described in further detail with reference to examples and drawings, but embodiments of the present invention are not limited thereto.
Examples
As shown in fig. 1, the track tracking control method of the Delta parallel robot based on the fuzzy self-adaptive sliding mode of the embodiment comprises the following steps:
s1, giving a dynamic model and a reference motion trail Xr of the robot according to the structure of the Delta parallel robot;
s2, establishing a mapping between a robot reference motion track Xr and a driving joint angle according to inverse kinematics solution of the Delta parallel robot to obtain a robot expected joint rotation angle qd corresponding to the reference motion track, as shown in FIG. 3;
s3, measuring the actual rotation angle of a driving joint of the robot, feeding back to the controller, and obtaining a tracking error of the joint angle by making a difference with the expected joint angle in the step S2; according to the angle tracking error information, designing a sliding mode, and selecting an approach rate to enable the angle tracking error to reach the sliding mode; according to the robot model and a control target of track tracking, designing a control law of a robot track tracking controller, and determining control parameters;
s4, introducing a fuzzy self-adaptive control system, and replacing discontinuous switching functions in the synovial membrane control rate by smooth output of the fuzzy self-adaptive control system;
s5, analyzing stability and convergence of the fuzzy self-adaptive control system, adjusting control parameters of the controller, and outputting a track tracking result.
Specifically, in this embodiment, the dynamics model of the robot in step S1 is as follows:
Figure BDA0004030904610000031
where τ is the joint drive torque, τ d Is an external disturbance, q,
Figure BDA0004030904610000032
Represents the driving joint angle, angular velocity and angular acceleration, respectively, M (q) is the mass matrix,/->
Figure BDA0004030904610000033
Is the Kevlar force and centrifugal force matrix, G (q) is the gravity vector;
given reference motion trajectory X r =[x y z] T m; wherein x is an x-axis value, and x=0.3sin5t; y is the y-axis number, and y=0.3 cos5t; z is a z-axis number, and z= -0.5;
as shown in fig. 2, the Delta parallel robot has three moving branched chains, each of which is driven by a motor and can translate in a three-dimensional space; given a reference motion trajectory X r =[0.3sin5t 0.3cos5t -0.5] T
Specifically, in this embodiment, the specific procedure of step S3 is as follows:
s31, measuring the rotation angle q= [ q ] of each joint of the Delta parallel robot through a sensor installed in a driving motor 1 q 2 q 3 ] T And joint rotation angular velocity
Figure BDA0004030904610000034
The parameters of the robot dynamics model are unknown, and external disturbance tau acts on the system d Unknown; estimating the unknown items, taking a control law as u, and obtaining the following control system:
Figure BDA0004030904610000035
wherein ,
Figure BDA0004030904610000036
m (q), respectively>
Figure BDA0004030904610000037
G(q) and τd To obtain the estimated value of (2):
Figure BDA0004030904610000038
wherein ,
Figure BDA0004030904610000039
the product of the estimated value of the mass matrix and the joint rotation angular acceleration;
Figure BDA00040309046100000310
Is that
Figure BDA0004030904610000041
The linear regression form of (2) comprises modeling errors and disturbance estimation errors of a system;
Figure BDA0004030904610000042
Respectively represent M (q), respectively>
Figure BDA0004030904610000043
G(q) and τd Is determined by the estimation error of (a); the relationship between the angular velocity of the drive joint and the control law u is thus obtained:
Figure BDA0004030904610000044
wherein ,
Figure BDA0004030904610000045
for angular acceleration +.>
Figure BDA0004030904610000046
All disturbance information received by the system is provided;
s32, setting the expected joint rotation angle as q d The actual joint rotation angle of the Delta parallel robot is q, and the tracking error is defined as e=q d -q; the slide surface is then designed:
Figure BDA0004030904610000047
wherein e is tracking error;
Figure BDA0004030904610000048
is the derivative of the tracking error; lambda is an adjustable parameter;
when s=0, the tracking error of the system enters the sliding mode, at this time
Figure BDA0004030904610000049
Solving that the tracking error of the system is an exponential function, and gradually converging to 0 along with the time change;
s33, in order to enable the tracking error e of the system to finally converge to 0, the tracking error e is required to move on a sliding mode, namely t & gtto & gtinfinity, and s=0; to meet this condition, it is necessary to design the approach rate
Figure BDA00040309046100000410
First derivative is calculated on the sliding mode surface:
Figure BDA00040309046100000411
wherein ,
Figure BDA00040309046100000412
is the derivative of the slip form surface;
Figure BDA00040309046100000413
Is the second derivative of the error;
Figure BDA00040309046100000414
Is the desired angular acceleration;
Figure BDA00040309046100000415
Is the actual angular acceleration;
the approach rate comprises the control law of the sliding mode controller, and the design problem of the approach rate is related to the control law of the controller at the moment; the approach rate meeting the control requirement is designed, the essence becomes to design a control law u, the track tracking error can be gradually converged, and finally the sliding mode is realized;
s34, in order to finally converge the tracking error e of the system to 0, a control law is designed as follows:
Figure BDA00040309046100000416
wherein ,
Figure BDA00040309046100000417
is->
Figure BDA00040309046100000418
An upper boundary of the norm; λ and η are adjustable parameters and always satisfy λ > 0, η > 0; sgn(s) is the symbol operation result of taking s; substitution of the control law into the first derivative of the slip plane gives +.>
Figure BDA00040309046100000419
When s is greater than 0, the method comprises the steps of,
Figure BDA00040309046100000420
when s < 0, < ->
Figure BDA00040309046100000421
This ensures that the tracking error of the system always tends towards the sliding mode.
Specifically, in this embodiment, the specific procedure of step S4 is as follows:
s41, replacing discontinuous items contained in the control law u obtained in the step S3 by smooth output of the fuzzy self-adaptive system
Figure BDA00040309046100000422
The following blurring function is defined:
K=Θ T ψ(s) (21)
wherein k= [ K ] 1 ,k 2 ,k 3 ] T Representing the output of the fuzzy adaptive system; Θ= [ θ ] 12 ,…,θ N ] T Free parameters representing the fuzzy adaptive system, which are automatically updated by designing an adaptive law; ψ(s) = [ ψ ] 1 (s),ψ 2 (s),…,ψ N (s)]Is a fuzzy base function, N represents the number of fuzzy logic rules, s is a sliding mode surface, and T is a matrix transposed symbol; the fuzzy basis function is expressed as:
Figure BDA0004030904610000051
wherein ,
Figure BDA0004030904610000052
is a membership function; l is the number of elements of s; n is any integer from 1 to N; i is any integer from 1 to l;
s42, defining a fuzzy logic rule; specifically, the definition of the fuzzy logic rules is shown in table 1; wherein, the IF column lists all cases, and the THEN column lists rules of corresponding cases; NB represents a large negative number; NS represents a small negative number; ZO represents 0; PB represents a large positive number; PS represents a small positive number.
TABLE 1
Figure BDA0004030904610000053
S43, adopting a Gaussian membership function, a fuzzy logic rule, a product inference engine and a central average solution moduleThe pasting device obtains a smooth fuzzy function output K; specifically, the membership function is
Figure BDA0004030904610000054
i=1, 2,3; m=n=1, 2,3,4,5, each of the fuzzy function outputs is: />
Figure BDA0004030904610000055
wherein ,θM The free parameter of the Mth fuzzy system; m is the number of free parameters; j is any integer from 1 to M; a, a i Is the ith adjustable parameter, and a i ∈(0,1];s i Is the ith sliding die surface;
substituting K into equation (7) and replacing the discontinuous term thereof
Figure BDA0004030904610000056
Obtaining a control law of the fuzzy self-adaptive sliding mode controller:
Figure BDA0004030904610000057
specifically, in this embodiment, the specific procedure of step S5 is as follows:
s51, selecting a Lyapunov function as follows:
Figure BDA0004030904610000058
wherein V is a Lyapunov function;
Figure BDA0004030904610000061
is the estimated deviation value, and +.>
Figure BDA0004030904610000062
θ ki Representing the free parameters; θ kid Is theta ki The adaptive law is selected as:
Figure BDA0004030904610000063
wherein ,
Figure BDA0004030904610000064
is an adaptive law; psi phi type ki (s i ) Is a fuzzy basis function;
s52, obtaining a first derivative of the Lyapunov function, and obtaining:
Figure BDA0004030904610000065
wherein ,
Figure BDA0004030904610000066
a first derivative of the Lyapunov function; s is(s) i Is a sliding die surface;
Figure BDA0004030904610000067
Is disturbance information received by the system; psi phi type ki (s i ) Is a fuzzy basis function; η is an adjustable parameter;
under the action of the control law, the system is stable, the track tracking error of the system is convergent, the convergence speed of the track tracking error of the system is related to the parameter eta, and the larger the eta, the faster the convergence speed of the track tracking error of the system.
S53, in combination with the control law and the analysis of steps S51 and S52, selecting an adjustable parameter as λ=diag (10,10,10),
Figure BDA0004030904610000068
η=60, and an output torque of the Delta parallel robot under the action of the sliding mode controller is obtained, as shown in fig. 4. As can be seen from fig. 5, under the condition that a fuzzy adaptive system is not introduced, the output torque of the robot system generates buffeting, and the severe buffeting can increase the energy loss of the system and affect the accuracy and stability of the track tracking of the system.
After the fuzzy self-adaptive control system is introduced, and the step control law and the analysis of the steps S51 and S52 are combined, the adjustable parameter is selected to be lambda=diag (10,10,10), eta=100, and the output moment of the Delta parallel robot under the action of the fuzzy self-adaptive sliding mode controller is obtained, as shown in fig. 5. As can be seen from fig. 5, after the fuzzy adaptive control system is introduced, the output torque of the robot system is smooth, and the upper bounds of the modeling error and external disturbance of the system are estimated on line through the fuzzy system, so that the difficulty of parameter adjustment is reduced, and the adaptive capacity of the system is enhanced.
S54, the Delta parallel robot outputs smooth moment under the action of the fuzzy sliding mode controller, the joints of the robot are driven to move, the actual rotation angles of the joints of the Delta parallel robot are obtained through measurement of the sensors, and the tracking errors of the angles of the joints are calculated, as shown in FIG. 6.
The above examples are preferred embodiments of the present invention, but the embodiments of the present invention are not limited to the above examples, and any other changes, modifications, substitutions, combinations, and simplifications that do not depart from the spirit and principle of the present invention should be made in the equivalent manner, and the embodiments are included in the protection scope of the present invention.

Claims (5)

1. A track tracking control method of a Delta parallel robot based on a fuzzy self-adaptive sliding mode is characterized by comprising the following steps:
s1, providing a dynamic model and a reference motion trail X of the robot according to the structure of the Delta parallel robot r
S2, establishing a robot reference motion track X according to inverse kinematics solution of the Delta parallel robot r And driving the mapping between joint angles to obtain a desired joint rotation angle q of the robot corresponding to the reference motion trail d
S3, measuring the actual rotation angle of a driving joint of the robot, feeding back to the controller, and obtaining a tracking error of the joint angle by making a difference with the expected joint angle in the step S2; according to the angle tracking error information, designing a sliding mode, and selecting an approach rate to enable the angle tracking error to reach the sliding mode; according to the robot model and a control target of track tracking, designing a control law of a robot track tracking controller, and determining control parameters;
s4, introducing a fuzzy self-adaptive control system, and replacing discontinuous switching functions in the synovial membrane control rate by smooth output of the fuzzy self-adaptive control system;
s5, analyzing stability and convergence of the fuzzy self-adaptive control system, adjusting control parameters of the controller, and outputting a track tracking result.
2. The track tracking control method of a Delta parallel robot based on a fuzzy self-adaptive sliding mode as set forth in claim 1, wherein the dynamics model of the robot in step S1 is as follows:
Figure FDA0004030904600000011
where τ is the joint drive torque, τ d Is an external disturbance, q,
Figure FDA0004030904600000012
Represents the driving joint angle, angular velocity and angular acceleration, respectively, M (q) is the mass matrix,/->
Figure FDA0004030904600000013
Is the Kevlar force and centrifugal force matrix, G (q) is the gravity vector;
given reference motion trajectory X r =[x y z] T m; wherein x is an x-axis value, and x=0.3sin5t; y is the y-axis number, and y=0.3 cos5t; z is a z-axis number, and z= -0.5.
3. The track tracking control method of the Delta parallel robot based on the fuzzy self-adaptive sliding mode according to claim 1, wherein the specific process of the step S3 is as follows:
s31, measuring the rotation angle q= [ q ] of each joint of the Delta parallel robot through a sensor installed in a driving motor 1 q 2 q 3 ] T And joint rotation angular velocity
Figure FDA0004030904600000014
The parameters of the robot dynamics model are unknown, and external disturbance tau acts on the system d Unknown; estimating the unknown items, taking a control law as u, and obtaining the following control system:
Figure FDA0004030904600000015
wherein ,
Figure FDA0004030904600000016
m (q), respectively>
Figure FDA0004030904600000017
G(q) and τd To obtain the estimated value of (2):
Figure FDA0004030904600000018
wherein ,
Figure FDA0004030904600000021
the product of the estimated value of the mass matrix and the joint rotation angular acceleration;
Figure FDA0004030904600000022
Is that
Figure FDA0004030904600000023
The linear regression form of (2) comprises modeling errors and disturbance estimation errors of a system;
Figure FDA0004030904600000024
Respectively represent M (q), respectively>
Figure FDA0004030904600000025
G(q) and τd Is determined by the estimation error of (a); the relationship between the angular velocity of the drive joint and the control law u is thus obtained:
Figure FDA0004030904600000026
wherein ,
Figure FDA0004030904600000027
for angular acceleration +.>
Figure FDA0004030904600000028
All disturbance information received by the system is provided;
s32, setting the expected joint rotation angle as q d The actual joint rotation angle of the Delta parallel robot is q, and the tracking error is defined as e=q d -q; the slide surface is then designed:
Figure FDA0004030904600000029
wherein e is tracking error;
Figure FDA00040309046000000210
is the derivative of the tracking error; lambda is an adjustable parameter;
when s=0, the tracking error of the system enters the sliding mode, at this time
Figure FDA00040309046000000211
Solving that the tracking error of the system is an exponential function, and gradually converging to 0 along with the time change;
s33, in order to enable the tracking error e of the system to finally converge to 0, the tracking error e is required to move on a sliding mode, namely t & gtto & gtinfinity, and s=0; to meet this condition, it is necessary to design the approach rate
Figure FDA00040309046000000212
First derivative is calculated on the sliding mode surface:
Figure FDA00040309046000000213
wherein ,
Figure FDA00040309046000000214
is the derivative of the slip form surface;
Figure FDA00040309046000000215
Is the second derivative of the error;
Figure FDA00040309046000000216
Is the desired angular acceleration;
Figure FDA00040309046000000217
Is the actual angular acceleration;
s34, in order to finally converge the tracking error e of the system to 0, a control law is designed as follows:
Figure FDA00040309046000000218
wherein ,
Figure FDA00040309046000000219
is->
Figure FDA00040309046000000220
An upper boundary of the norm; λ and η are adjustable parameters and always satisfy λ > 0, η > 0; sgn(s) is the symbol operation result of taking s; substitution of the control law into the first derivative of the slip plane gives +.>
Figure FDA00040309046000000221
When s > 0, < > and->
Figure FDA00040309046000000222
When s < 0, < ->
Figure FDA00040309046000000224
This ensures that the tracking error of the system always tends to slip modes.
4. The track tracking control method of the Delta parallel robot based on the fuzzy self-adaptive sliding mode according to claim 1, wherein the specific process of the step S4 is as follows:
s41, replacing discontinuous items contained in the control law u obtained in the step S3 by smooth output of the fuzzy self-adaptive system
Figure FDA00040309046000000223
The following blurring function is defined:
K=Θ T Ψ(s) (8)
wherein k= [ K ] 1 ,k 2 ,k 3 ] T Representing the output of the fuzzy adaptive system; Θ= [ θ ] 12 ,…,θ N ] T Free parameters representing the fuzzy adaptive system, which are automatically updated by designing an adaptive law; ψ(s) = [ ψ ] 1 (s),ψ 2 (s),…,ψ N (s)]Is a fuzzy base function, N represents the number of fuzzy logic rules, s is a sliding mode surface, and T is a matrix transposed symbol; the fuzzy basis function is expressed as:
Figure FDA0004030904600000031
wherein ,
Figure FDA0004030904600000032
is a membership function; l is the number of elements of s; n is any integer from 1 to N; i is any integer from 1 to l;
s42, defining a fuzzy logic rule;
s43, obtaining a smooth fuzzy function output K by using a Gaussian membership function, a fuzzy logic rule and a product inference engine and a central average defuzzifier; membership function of
Figure FDA0004030904600000033
i=1, 2,3; m=n=1, 2,3,4,5, each of the fuzzy function outputs is: />
Figure FDA0004030904600000034
wherein ,θM The free parameter of the Mth fuzzy system; m is the number of free parameters; j is any integer from 1 to M; a, a i Is the ith adjustable parameter, and a i ∈(0,1];s i Is the ith sliding die surface;
substituting K into equation (7) and replacing the discontinuous term thereof
Figure FDA0004030904600000035
Obtaining a control law of the fuzzy self-adaptive sliding mode controller:
Figure FDA0004030904600000036
5. the track tracking control method of the Delta parallel robot based on the fuzzy self-adaptive sliding mode according to claim 1, wherein the specific process of the step S5 is as follows:
s51, selecting a Lyapunov function as follows:
Figure FDA0004030904600000037
wherein V is Lyapunov function;
Figure FDA0004030904600000038
is the estimated deviation value, and +.>
Figure FDA0004030904600000039
θ ki Representing the free parameters; θ kid Is theta ki The adaptive law is selected as:
Figure FDA00040309046000000310
wherein ,
Figure FDA00040309046000000311
is an adaptive law; psi phi type ki (s i ) Is a fuzzy basis function;
s52, obtaining a first derivative of the Lyapunov function, and obtaining:
Figure FDA0004030904600000041
wherein ,
Figure FDA0004030904600000042
a first derivative of the Lyapunov function; s is(s) i Is a sliding die surface;
Figure FDA0004030904600000043
Is disturbance information received by the system; psi phi type ki (s i ) Is a fuzzy basis function; η is an adjustable parameter;
s53, in combination with the control law and the analysis of steps S51 and S52, selecting an adjustable parameter as λ=diag (10,10,10),
Figure FDA0004030904600000044
η=60, obtain Delta parallel robot output moment under the action of slip-form controller;
after a fuzzy self-adaptive control system is introduced, and the adjustable parameters are selected to be lambda=diag (10,10,10) and eta=100 by combining the step control law and the analysis of the steps S51 and S52, so that the output moment of the Delta parallel robot under the action of the fuzzy self-adaptive sliding mode controller is obtained;
s54, the Delta parallel robot outputs smooth moment under the action of the fuzzy sliding mode controller, each joint of the robot is driven to move, the actual rotation angle of each joint of the Delta parallel robot is obtained through measurement of the sensor, and the tracking error of each joint angle is calculated.
CN202211729052.3A 2022-12-30 2022-12-30 Track tracking control method of Delta parallel robot based on fuzzy self-adaptive sliding mode Active CN116184825B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211729052.3A CN116184825B (en) 2022-12-30 2022-12-30 Track tracking control method of Delta parallel robot based on fuzzy self-adaptive sliding mode

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211729052.3A CN116184825B (en) 2022-12-30 2022-12-30 Track tracking control method of Delta parallel robot based on fuzzy self-adaptive sliding mode

Publications (2)

Publication Number Publication Date
CN116184825A true CN116184825A (en) 2023-05-30
CN116184825B CN116184825B (en) 2025-10-17

Family

ID=86439561

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211729052.3A Active CN116184825B (en) 2022-12-30 2022-12-30 Track tracking control method of Delta parallel robot based on fuzzy self-adaptive sliding mode

Country Status (1)

Country Link
CN (1) CN116184825B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117850249A (en) * 2024-03-08 2024-04-09 山东科技大学 An adaptive fuzzy control method for AUV
CN119388447A (en) * 2025-01-02 2025-02-07 安徽大学 A fuzzy adaptive sliding mode control method for dual-arm collaborative robot
CN119871397A (en) * 2025-01-15 2025-04-25 华南理工大学 Track tracking control method of rope-driven flexible continuous robot based on sliding mode impedance

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106292287A (en) * 2016-09-20 2017-01-04 哈尔滨工程大学 A kind of UUV path following method based on adaptive sliding-mode observer
CN106527129A (en) * 2016-10-18 2017-03-22 长安大学 Parallel robot indirect self-adaptive fuzzy control parameter determining method
CN107942684A (en) * 2017-12-26 2018-04-20 电子科技大学 Mechanical arm trace tracking method based on the adaptive non-singular terminal sliding formwork of fractional order
CN115047882A (en) * 2022-06-23 2022-09-13 上海电机学院 Omnidirectional mobile robot track tracking method based on fuzzy sliding mode control

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106292287A (en) * 2016-09-20 2017-01-04 哈尔滨工程大学 A kind of UUV path following method based on adaptive sliding-mode observer
CN106527129A (en) * 2016-10-18 2017-03-22 长安大学 Parallel robot indirect self-adaptive fuzzy control parameter determining method
CN107942684A (en) * 2017-12-26 2018-04-20 电子科技大学 Mechanical arm trace tracking method based on the adaptive non-singular terminal sliding formwork of fractional order
CN115047882A (en) * 2022-06-23 2022-09-13 上海电机学院 Omnidirectional mobile robot track tracking method based on fuzzy sliding mode control

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
戴学丰等: "柔性臂机器人定位过程模糊滑模控制研究", 哈尔滨工业大学学报, vol. 37, no. 2, 28 February 2005 (2005-02-28), pages 148 - 150 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117850249A (en) * 2024-03-08 2024-04-09 山东科技大学 An adaptive fuzzy control method for AUV
CN117850249B (en) * 2024-03-08 2024-05-14 山东科技大学 An adaptive fuzzy control method for AUV
CN119388447A (en) * 2025-01-02 2025-02-07 安徽大学 A fuzzy adaptive sliding mode control method for dual-arm collaborative robot
CN119871397A (en) * 2025-01-15 2025-04-25 华南理工大学 Track tracking control method of rope-driven flexible continuous robot based on sliding mode impedance

Also Published As

Publication number Publication date
CN116184825B (en) 2025-10-17

Similar Documents

Publication Publication Date Title
CN116184825B (en) Track tracking control method of Delta parallel robot based on fuzzy self-adaptive sliding mode
Gao et al. Hierarchical model predictive image-based visual servoing of underwater vehicles with adaptive neural network dynamic control
CN115847420B (en) Mechanical arm vision tracking control method and system for moving target
Xu et al. Robot trajectory tracking control using learning from demonstration method
Kappler et al. A new data source for inverse dynamics learning
CN107894708A (en) A kind of synchronisation control means of annular coupled mode multi-axis robot system
CN114625136B (en) A robot trajectory tracking control method based on deep learning
Zhou et al. Torque sensorless force/position decentralized control for constrained reconfigurable manipulator with harmonic drive transmission
CN115179290B (en) Mechanical arm and track control method and device thereof
Capotondi et al. An online learning procedure for feedback linearization control without torque measurements
Blekas et al. RL-based path planning for an over-actuated floating vehicle under disturbances
Ren et al. A highly accurate model-free motion control system with a Mamdani fuzzy feedback controller Combined with a TSK fuzzy feed-forward controller
Yang et al. Position measurement based slave torque feedback control for teleoperation systems with time-varying communication delays
Rahali et al. Fault tolerant control of robot manipulators based on adaptive fuzzy type-2 backstepping in attendance of payload variation
Cruz et al. Application of robust discontinuous control algorithm for a 5-DOF industrial robotic manipulator in real-time
Panda et al. Combined online and offline inverse dynamics learning for a robot manipulator
CN107894709A (en) Controlled based on Adaptive critic network redundancy Robot Visual Servoing
CN119556552A (en) A PID control method for AGV wheel drive system
Liu et al. On adaptive force/motion control of constrained robots
Hashemi et al. Task space control of robot manipulators based on visual slam
Chuang et al. Adaptive fuzzy visual servoing in robot control
Zhu et al. Trajectory Tracking Control Strategy Based on Model-Free Adaptive Sliding Mode Control Approach for Robot Manipulator
He et al. Double-loop human-robot shared control for trajectory tracking of an underwater robot
Guerra et al. Decentralized neural block control for a robot manipulator based in ukf training
Ren et al. Discrete-time parallel robot motion control using adaptive neuro-fuzzy inference system based on improved subtractive clustering

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