A method, device and electronic device for quantized sliding mode control of a robotic arm

By incorporating model parameter perturbations and unknown bounded disturbances into the dynamic equations of the robotic arm, a PD-type sliding modal surface was constructed and the system control law was determined, thus solving the robotic arm chattering problem and achieving accuracy improvement within a finite time.

CN117325176BActive Publication Date: 2024-11-15LONGWOOD VALLEY MEDICAL TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202311452102.2
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-11-02
Publication Date
2024-11-15
Estimated Expiration
2043-11-02

AI Technical Summary

Technical Problem

The robotic arm experiences system chattering due to model parameter perturbations and unknown bounded disturbances, resulting in low operational accuracy.

Method used

By establishing the dynamic equations of the robotic arm, incorporating model parameter perturbations and unknown bounded disturbances, a PD-type sliding mode surface is constructed. The quantization error of the sliding mode switching function is determined, and the system control law is determined based on higher-order sliding mode theory to counteract model parameter perturbations and unknown bounded disturbances.

Benefits of technology

To reduce or eliminate system chatter within a limited time, thereby improving the operating accuracy and performance of the robotic arm.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117325176B_ABST
    Figure CN117325176B_ABST
Patent Text Reader

Abstract

The present application provides a method, device and electronic device for quantitative sliding mode control of a robot arm, the method comprising: establishing the dynamic equation of the robot arm based on the connecting rod characteristics of the robot arm dynamics; adding model parameter perturbations and unknown bounded disturbances to the dynamic equations; constructing a PD-type sliding mode surface; determining the quantization error of the sliding mode switching function; determining the system control law based on high-order sliding mode theory; determining the parameter conditions and convergence domain that make the system state converge in a finite time based on the system control law; controlling the robot arm according to the system control law, parameter conditions and convergence domain to perform the predetermined task objectives. In the present application, by adding model parameter perturbations and unknown bounded disturbances to the dynamic equations, and by constructing sliding mode surfaces and system control laws to offset them, the model parameter perturbations and unknown bounded disturbances are eliminated in the control system, thereby avoiding the adverse consequences of system jitter and jitter caused by them.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of data processing technology, and in particular to a method, device and electronic equipment for quantized sliding mode control of a robotic arm. Background Art

[0002] The surgical robot system is a comprehensive system that integrates a number of modern high-tech means. It has a wide range of uses and is widely used in clinical surgery. Through the surgical robot system, hip replacement surgery, knee replacement surgery, spinal surgery and other bone and joint surgeries can be completed to treat pain and dysfunction caused by severe joint injuries or diseases, and significantly reduce hip pain, thereby improving the quality of life of patients.

[0003] The core of the surgical robot system is the robotic arm, which performs surgical actions to complete joint surgery. Due to its complex mechanical structure and high coupling interaction force, the dynamic equation of the robotic arm presents complex nonlinear characteristics; when there are model parameter perturbations and unknown bounded disturbances, the system will cause jitter, which is difficult to measure and will seriously affect the operation accuracy and working performance of the robotic arm. Summary of the invention

[0004] The problem that this application solves is that the current robotic arm has system jitter caused by model parameter perturbations and unknown bounded disturbances, resulting in low operating accuracy.

[0005] In order to solve the above problems, the first aspect of the present application provides a quantized sliding mode control method for a robot arm, comprising:

[0006] Based on the connecting rod characteristics of the robot arm dynamics, the dynamic equation of the robot arm is established;

[0007] Adding model parameter perturbations and unknown bounded disturbances to the dynamic equations;

[0008] Construct PD type sliding mode surface;

[0009] Determine a quantization error of a sliding mode switching function, the sliding mode switching function being a functional representation of a sliding mode surface;

[0010] The system control law is determined based on the high-order sliding mode theory, which can make the sliding mode state converge in a finite time;

[0011] Based on the system control law, determining the parameter conditions and convergence domain that make the system state converge in finite time;

[0012] The robot arm is controlled according to the system control law, parameter conditions and convergence domain to execute the established task objectives.

[0013] A second aspect of the present application provides a quantized sliding mode control device for a robotic arm, comprising:

[0014] An equation building module, which is used to build the dynamic equations of the robot arm based on the connecting rod characteristics of the robot arm dynamics;

[0015] A disturbance setting module, which is used to add model parameter perturbations and unknown bounded disturbances to the dynamic equations;

[0016] Sliding mode construction module, which is used to construct PD type sliding mode surface;

[0017] A quantization error module, which is used to determine the quantization error of the sliding mode switching function, the sliding mode switching function is a functional representation of the sliding mode surface;

[0018] A control law determination module, which is used to determine the system control law based on the high-order sliding mode theory, and the system control law can make the sliding mode state converge in a finite time;

[0019] The parameter determination module is used to determine the parameter conditions and convergence domain that make the system state converge in finite time based on the system control law.

[0020] The robot arm control module is used to control the robot arm according to the system control law, parameter conditions and convergence domain to execute the predetermined task objectives.

[0021] A third aspect of the present application provides an electronic device, comprising: a memory and a processor;

[0022] The memory is used to store programs;

[0023] The processor, coupled to the memory, is configured to execute the program to:

[0024] Based on the connecting rod characteristics of the robot arm dynamics, the dynamic equation of the robot arm is established;

[0025] Adding model parameter perturbations and unknown bounded disturbances to the dynamic equations;

[0026] Construct PD type sliding mode surface;

[0027] Determine a quantization error of a sliding mode switching function, the sliding mode switching function being a functional representation of a sliding mode surface;

[0028] The system control law is determined based on the high-order sliding mode theory, which can make the sliding mode state converge in a finite time;

[0029] Based on the system control law, determining the parameter conditions and convergence domain that make the system state converge in finite time;

[0030] The robot arm is controlled according to the system control law, parameter conditions and convergence domain to execute the established task objectives.

[0031] A fourth aspect of the present application provides a computer-readable storage medium having a computer program stored thereon, wherein the program is executed by a processor to implement the above-mentioned robot arm quantitative sliding mode control method.

[0032] In the present application, by adding model parameter perturbations and unknown bounded disturbances to the dynamic equations and offsetting them by constructing sliding mode surfaces and system control laws, model parameter perturbations and unknown bounded disturbances are reduced or eliminated in the control system, thereby avoiding system jitter and the adverse consequences of jitter. BRIEF DESCRIPTION OF THE DRAWINGS

[0033] Figure 1 is a flow chart of a quantized sliding mode control method for a robotic arm according to an embodiment of the present application;

[0034] Figure 2 A comparison diagram of the results of the quantized sliding mode control of the robot arm according to an embodiment of the present application;

[0035] Figure 3 is a structural block diagram of a quantized sliding mode control device for a robotic arm according to an embodiment of the present application;

[0036] Figure 4 is a structural block diagram of an electronic device according to an embodiment of the present application. DETAILED DESCRIPTION

[0037] In order to make the above-mentioned purposes, features and advantages of the present application more obvious and easy to understand, the specific embodiments of the present application are described in detail below in conjunction with the accompanying drawings. Although the exemplary embodiments of the present application are shown in the accompanying drawings, it should be understood that the present application can be implemented in various forms and should not be limited by the embodiments described herein. On the contrary, these embodiments are provided in order to enable a more thorough understanding of the present application and to fully convey the scope of the present application to those skilled in the art.

[0038] It should be noted that, unless otherwise specified, the technical terms or scientific terms used in this application should have the common meanings understood by technicians in the field to which this application belongs.

[0039] The surgical robot system is a comprehensive system that integrates a number of modern high-tech means. It has a wide range of uses and is widely used in clinical surgery. Through the surgical robot system, hip replacement surgery, knee replacement surgery, spinal surgery and other bone and joint surgeries can be completed to treat pain and dysfunction caused by severe joint injuries or diseases, and significantly reduce hip pain, thereby improving the quality of life of patients.

[0040] The core of the surgical robot system is the robotic arm, which performs surgical actions to complete joint surgery. Due to its complex mechanical structure and high coupling interaction force, the dynamic equation of the robotic arm presents complex nonlinear characteristics; when there are model parameter perturbations and unknown bounded disturbances, the system will cause jitter, which is difficult to measure and will seriously affect the operation accuracy and working performance of the robotic arm.

[0041] In response to the above problems, the present application provides a new quantized sliding mode control scheme for a robotic arm, which can solve the problem of low operation accuracy caused by system jitter caused by model parameter perturbations and unknown bounded disturbances in the current robotic arm by introducing model parameter perturbations and unknown bounded disturbances and offsetting them.

[0042] The present application embodiment provides a method for quantized sliding mode control of a robot arm. The specific scheme of the method is as follows: Figure 1-Figure 2 As shown, the method can be performed by a robot arm quantized sliding mode control device, and the robot arm quantized sliding mode control device can be integrated in electronic devices such as computers, servers, computers, server clusters, and data centers. Figure 1 As shown, it is a flow chart of a quantized sliding mode control method for a manipulator according to an embodiment of the present application; wherein the quantized sliding mode control method for a manipulator includes:

[0043] S101, based on the connecting rod characteristics of the robot arm dynamics, establish the dynamic equation of the robot arm;

[0044] Analyzing the robotic arm, it can be seen that the robotic arm is formed by connecting several rods (the place where two rods are connected is a joint), and these rods in the robotic arm are called connecting rods. Each connecting rod can rotate around a certain axis based on the husband connecting rod (the previous connecting rod) (the joint drives the connecting rod to rotate through the rotation of the motor), and this axis is only relative to the husband connecting rod. This results in that once multiple connecting rods are moving, the connecting rod can only have a direct spatial conversion relationship with the "previous level connecting rod" and the "next level connecting rod", that is, when the rotation angle of the first connecting rod is determined, the specific position of the first connecting rod can be calculated according to the spatial coordinates of the base, and then the position of the end robotic arm can be obtained by calculating backward one level at a time, which is the end position of the loading and unloading ratio.

[0045] In one embodiment, the dynamic equation of the robotic arm is:

[0046]

[0047] Where M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, the control input τ is the n×1 joint torque vector, n is the number of robot joints, q is the actual trajectory, is the time derivative of q, for The derivative in time.

[0048] S102, adding model parameter perturbations and unknown bounded disturbances to the dynamic equation;

[0049] For the control process of the robot arm, there are parameter perturbations between model parameters and unknown disturbances; the specific conditions of parameter perturbations and disturbances cannot be fully known, and modeling analysis cannot be performed. In this application, the sum of model parameter perturbations and unknown bounded disturbances is directly set to represent the overall disturbance of model parameter perturbations and unknown bounded disturbances, so that parameter perturbations and unknown disturbances can be solved / eliminated without analyzing and modeling the specific conditions.

[0050] In one embodiment, the dynamic equation of the robot arm after adding the model parameter perturbation and the unknown bounded disturbance is:

[0051]

[0052]

[0053] 0<δ(t)<η

[0054] Among them, d(t) is an n×1 vector, which is the sum of the inertial parameter perturbation and the unknown working environment disturbance. is the derivative, t is time, δ(t) is a bounded function related to time, η is a known limit, and sign(*) is the sign function.

[0055] S103, constructing PD type sliding mode surface;

[0056] Sliding mode is a form of motion that occurs and is maintained on the switching surface in a variable structure control system. Sliding mode is one of the main characteristics of a sliding mode variable structure control system.

[0057] The basic idea of ​​sliding mode variable structure control is to first divide the sliding mode motion of the system into two parts. The first part is the motion stage of the system from the initial state to the switching surface, which is called the arrival section; the second part is the motion stage of the system on the switching surface, namely the sliding mode section. Secondly, the design of the sliding mode controller is also divided into two parts. The first part is to design the mode surface of the sliding mode section according to the desired system dynamic characteristics to obtain satisfactory control performance; the second part is to design the arrival section of the sliding mode motion, usually according to the existence conditions of the sliding mode, to design the switching control so that the system state can enter the sliding mode surface designed in the first part under any initial conditions.

[0058] In one embodiment, the constructed PD type sliding mode surface is:

[0059]

[0060] e=q r -q

[0061] Where s is the sliding mode hyperplane, e is the error, is the time derivative of e, q r is the expected trajectory, is an n×1 dimensional vector, and q is the actual trajectory.

[0062] S104, determining a quantization error of a sliding mode switching function, where the sliding mode switching function is a functional representation of a sliding mode surface;

[0063] In the present application, the sliding mode switching function is a functional representation of the sliding mode surface.

[0064] In the present application, when performing specific robotic arm control, there are delay and bandwidth limitations when the sensor collects data and processes it through the host computer. This limitation can be represented by quantizing the sliding mode switching function, and the corresponding quantization error can be determined based on the quantization.

[0065] In one implementation, the quantization error is:

[0066] q(s)-s=e qs

[0067]

[0068] Among them, e qs is the quantization error, μ is the quantization parameter, q(s) is the quantized sliding mode switching function, and round() is the nearest integer operation.

[0069] In one implementation, based on the quantization error formula, it can be determined that:

[0070]

[0071] Among them, μ>0 is the quantization parameter, e qs Based on this, the bounds of the quantization error can be determined.

[0072] S105, determining a system control law based on a high-order sliding mode theory, where the system control law can make the sliding mode state converge within a finite time;

[0073] The sliding order refers to the number of continuous total derivatives (including zero order) of the sliding mode variable s that are 0 on the sliding surface s = 0. The sliding order describes the dynamic smoothness of the motion of the system constrained on the sliding surface s = 0. According to this definition, the sliding order of the traditional sliding mode is 1, and the sliding order of the high-order sliding mode is greater than 1.

[0074] In one embodiment, the system control law is:

[0075]

[0076]

[0077] Among them, sign(*) is the sign function, Φ is the intermediate parameter, τ is the control input, k1 and k2 are the control law parameters, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, Q r The derivative of , q(s) is the quantized sliding mode switching function.

[0078] In the present application, the above system control law can be used to offset the sum d(t) of the inertia parameter perturbation and the unknown working environment disturbance.

[0079] In one embodiment, the derivative of the sliding mode switching function is determined based on the system control law, so that a factor of the derivative is the sum of the model parameter perturbation and the unknown bounded disturbance to offset the model parameter perturbation and the unknown bounded disturbance.

[0080] In one implementation, based on the system control law, the constructed PD type sliding mode surface is derived to obtain:

[0081]

[0082] Among them, the sum of inertia parameter perturbation and unknown working environment disturbance d(t) appears in the differentiated expression; based on this formula, the model parameter perturbation and unknown bounded disturbance added to the dynamic equation can be offset, thereby reducing or eliminating the model parameter perturbation and unknown bounded disturbance in the control system.

[0083] S106, based on the system control law, determining parameter conditions and a convergence domain that make the system state converge in a finite time;

[0084] In one implementation, the restriction conditions of the control law parameters are:

[0085]

[0086] Among them, k1 and k2 are control law parameters, and η is the known limit.

[0087] In one implementation, the convergence region is:

[0088]

[0089]

[0090]

[0091] Where k1 and k2 are control law parameters, η is the known limit, P is the parameter matrix, Q(η) is the matrix containing the parameter η, ω is a constant, and λ max (*) is the largest characteristic root, λ min (*) is the minimum characteristic root, p 11 、p 12 is an element in the matrix P, and Ω(μ) is a constant containing the quantizer parameter μ.

[0092] Among them, ω∈(0,1).

[0093] S107, controlling the robot arm according to the system control law, parameter conditions and convergence domain to execute the predetermined task objectives.

[0094] In the present application, by adding model parameter perturbations and unknown bounded disturbances to the dynamic equations and offsetting them by constructing sliding mode surfaces and system control laws, model parameter perturbations and unknown bounded disturbances are reduced or eliminated in the control system, thereby avoiding system jitter and the adverse consequences of jitter.

[0095] Combination Figure 2 As shown, it is a comparison chart of the results of the quantized sliding mode control of the robot arm, that is, a comparison chart of the ideal execution situation (no system jitter) and the execution process of eliminating system jitter; the horizontal axis in the figure represents time, and the vertical axis represents the change in joint angle, so as to show the specific process of joint angle change over time; and the curve starting with 0 in the figure (at time 0) is the execution curve under the ideal environment, and the curve starting with 9 (at time 0) is the execution curve under the actual execution situation when eliminating jitter, the execution unit of the horizontal axis is s, and the execution unit of the vertical axis is °; the result comparison chart is made based on the actual execution situation when one of the multiple joints tracks the expected trajectory. Figure 2 It can be seen that the system's offset execution decreases rapidly over time, and after the decrease, it always maintains very small jitter and completely coincides with the ideal execution.

[0096] Furthermore, the actual process of the quantized sliding mode control method of the robot arm is described in detail as follows:

[0097] The Lagrangian dynamics equation of the robotic arm is as follows:

[0098]

[0099] Where M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, the control input τ is the n×1 joint torque vector, n is the number of robot arm shutdowns, and when the dynamic model has model parameter perturbations and unknown bounded disturbances, it is expressed as:

[0100]

[0101] Where d(t) is an n×1 vector, representing the sum of the inertial parameter perturbation and the unknown working environment disturbance. t is time. d(t) is continuous in the time domain and its derivative is bounded: where δ(t) is a bounded function related to time, satisfying 0<δ(t)<η, η is a known limit,

[0102] Define the target trajectory as q r The same is an n×1 dimensional vector, and the error is defined as e=q r -q; construct the following PD type sliding mode hyperplane s:

[0103]

[0104] in is the derivative of e with respect to time.

[0105] Consider using a logarithmic quantizer to quantize the sliding mode switching function to represent the delay and bandwidth limitations of the sensor collecting data and processing it through the host computer. The following balanced quantizer form is given

[0106]

[0107] μ>0 is the quantization parameter, round() means the nearest integer operation, and the quantization error is

[0108] q(s)-s=e qs (5)

[0109] From (5), we can get

[0110] Design the following control rate:

[0111]

[0112] in sign(*) is the sign function. By taking the derivative of formula (3), we can get:

[0113]

[0114] The control gain is selected to satisfy the following form

[0115]

[0116] The system state will be in a finite time t f The inner convergence is to the region ‖ξ‖≤Ω(μ), where Ω(μ) is a constant containing the quantizer parameter μ. Rewriting (6) into vector form

[0117]

[0118]

[0119] where λ min (*), λ max (*) is the minimum and maximum characteristic root, ω∈(0,1) is a constant, and the form of the matrix P and Q(η) will be given as follows, p ij is an element in P, and ξ is an intermediate variable.

[0120] In one embodiment, the robot arm quantized sliding mode control method further includes:

[0121] Verify that the system control law, the parameter conditions and the convergence domain converge within a finite time; if the verification passes, control the robot arm to perform the established task objectives; if the verification fails, re-execute S102, add model parameter perturbations and unknown bounded disturbances to the dynamic equations until the verification passes.

[0122] In the present application, the convergence condition is verified to determine whether the system control law, the parameter conditions and the convergence domain can stably control the robot arm within a limited time.

[0123] In one embodiment, verifying that the system control law, the parameter conditions, and the convergence domain converge within a finite time includes:

[0124] According to the Cauchy inequality, we have the following relationship:

[0125]

[0126] Among them, s is the sliding mode hyperplane, e qs is the quantization error, μ is the quantization parameter, and q(s) is the quantized sliding mode switching function.

[0127] when When sign(q(s))=sign(s), when When q(s) = 0, (6) can be rewritten as

[0128]

[0129] Among them, f(e qs ) is the quantization error correlation function, is the derivative of r, and r is the intermediate replacement.

[0130] Taking the derivative of formula (8) we can get

[0131]

[0132] Where ξ1 is the first element of ξ and A is the abbreviation replacement.

[0133] Define the Lyapunov function:

[0134] V(ξ)=ξ T Pξ (13)

[0135] in,

[0136]

[0137] Where V is the Lyapunov function.

[0138] Taking the derivative of (13), we get:

[0139]

[0140] Among them, A is the abbreviation replacement.

[0141] From the previous text, we know that 0<δ(t)<η, and Available

[0142]

[0143] in

[0144]

[0145] From the properties of Schur complement, we can see that when the parameters are selected to satisfy (7), Q(η) is a positive definite matrix, ξ T Q(η)ξ satisfies the inequality

[0146] λ min (Q(η))||ξ|| 2 ≤ξ T Q(η)ξ≤λ max (Q(η))||ξ|| 2 (18)

[0147] and |ξ1|≤||ξ||, From this we can get:

[0148]

[0149] when Sometimes

[0150]

[0151] According to the finite time convergence theory, there exists a time t f Make t>t f When ‖ξ‖≤Ω(μ), the system will f From any initial position, it converges to Ω(μ)

[0152]

[0153] At this time, it is determined that the system control law, the parameter conditions and the convergence domain converge within a finite time.

[0154] An embodiment of the present application provides a robot arm quantized sliding mode control device, which is used to execute the robot arm quantized sliding mode control method described in the above content of the present application. The robot arm quantized sliding mode control device is described in detail below.

[0155] like Figure 3 As shown, the robot arm quantitative sliding mode control device comprises:

[0156] An equation building module 101 is used to build a dynamic equation of the robot arm based on the connecting rod characteristics of the robot arm dynamics;

[0157] A disturbance setting module 102, which is used to add model parameter perturbations and unknown bounded disturbances to the dynamic equations;

[0158] A sliding mode construction module 103, which is used to construct a PD type sliding mode surface;

[0159] A quantization error module 104, which is used to determine the quantization error of the sliding mode switching function, the sliding mode switching function is a functional representation of the sliding mode surface;

[0160] A control law determination module 105, which is used to determine the system control law based on the high-order sliding mode theory, and the system control law can make the sliding mode state converge within a finite time;

[0161] The parameter determination module 106 is used to determine the parameter conditions and convergence domain that make the system state converge in a finite time based on the system control law.

[0162] The robot arm control module 107 is used to control the robot arm according to the system control law, parameter conditions and convergence domain to perform the predetermined task objectives.

[0163] In one embodiment, the dynamic equation of the robotic arm is:

[0164]

[0165] Where M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, the control input τ is the n×1 joint torque vector, n is the number of robot joints, q is the actual trajectory, is the time derivative of q, for The derivative in time.

[0166] In one embodiment, the dynamic equation of the robot arm after adding the model parameter perturbation and the unknown bounded disturbance is:

[0167]

[0168]

[0169] 0<δ(t)<η

[0170] Among them, d(t) is an n×1 vector, which is the sum of the inertial parameter perturbation and the unknown working environment disturbance. is the derivative, t is time, δ(t) is a bounded function related to time, η is a known limit, and sign(*) is the sign function.

[0171] In one embodiment, the constructed PD type sliding mode surface is:

[0172]

[0173] e=q r -q

[0174] Where s is the sliding mode hyperplane, e is the error, is the time derivative of e, q r is the expected trajectory, is an n×1 dimensional vector, and q is the actual trajectory.

[0175] In one implementation, the quantization error is:

[0176] q(s)-s=e qs

[0177]

[0178] Among them, e qs is the quantization error, μ is the quantization parameter, q(s) is the quantized sliding mode switching function, and round() is the nearest integer operation.

[0179] In one embodiment, the system control law is:

[0180]

[0181]

[0182] Among them, sign(*) is the sign function, Φ is the intermediate parameter, τ is the control input, k1 and k2 are the control law parameters, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, for q r The derivative of , q(s) is the quantized sliding mode switching function.

[0183] In one implementation, the restriction conditions of the control law parameters are:

[0184]

[0185] Among them, k1 and k2 are control law parameters, and η is the known limit.

[0186] The robot arm quantized sliding mode control device provided in the above-mentioned embodiment of the present application and the robot arm quantized sliding mode control method provided in the embodiment of the present application are based on the same inventive concept and have the same beneficial effects as the methods adopted, run or implemented by the application programs stored therein.

[0187] The above describes the internal functions and structure of the robot arm quantitative sliding mode control device. Figure 4 As shown, in practice, the robot arm quantitative sliding mode control device can be implemented as an electronic device, including: a memory 301 and a processor 303.

[0188] The memory 301 may be configured to store programs.

[0189] In addition, the memory 301 may also be configured to store various other data to support operations on the electronic device. Examples of such data include instructions for any application or method operating on the electronic device, contact data, phone book data, messages, pictures, videos, etc.

[0190] The memory 301 can be implemented by any type of volatile or non-volatile storage device or a combination thereof, such as static random access memory (SRAM), electrically erasable programmable read-only memory (EEPROM), erasable programmable read-only memory (EPROM), programmable read-only memory (PROM), read-only memory (ROM), magnetic memory, flash memory, magnetic disk or optical disk.

[0191] The processor 303 is coupled to the memory 301 and is configured to execute a program in the memory 301 to:

[0192] Based on the connecting rod characteristics of the robot arm dynamics, the dynamic equation of the robot arm is established;

[0193] Adding model parameter perturbations and unknown bounded disturbances to the dynamic equations;

[0194] Construct PD type sliding mode surface;

[0195] Determine a quantization error of a sliding mode switching function, the sliding mode switching function being a functional representation of a sliding mode surface;

[0196] The system control law is determined based on the high-order sliding mode theory, which can make the sliding mode state converge in a finite time;

[0197] Based on the system control law, determining the parameter conditions and convergence domain that make the system state converge in finite time;

[0198] The robot arm is controlled according to the system control law, parameter conditions and convergence domain to execute the established task objectives.

[0199] In one embodiment, the dynamic equation of the robotic arm is:

[0200]

[0201] Where M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, the control input τ is the n×1 joint torque vector, n is the number of robot joints, q is the actual trajectory, is the time derivative of q, for The derivative in time.

[0202] In one embodiment, the dynamic equation of the robot arm after adding the model parameter perturbation and the unknown bounded disturbance is:

[0203]

[0204]

[0205] 0<δ(t)<η

[0206] Among them, d(t) is an n×1 vector, which is the sum of the inertial parameter perturbation and the unknown working environment disturbance. is the derivative, t is time, δ(t) is a bounded function related to time, η is a known limit, and sign(*) is the sign function.

[0207] In one embodiment, the constructed PD type sliding mode surface is:

[0208]

[0209] e=q r -q

[0210] Where s is the sliding mode hyperplane, e is the error, is the derivative of e with respect to time, qr is the expected trajectory, is an n×1 dimensional vector, and q is the actual trajectory.

[0211] In one implementation, the quantization error is:

[0212] q(s)-s=e qs

[0213]

[0214] Among them, e qs is the quantization error, μ is the quantization parameter, q(s) is the quantized sliding mode switching function, and round() is the nearest integer operation.

[0215] In one embodiment, the system control law is:

[0216]

[0217]

[0218] Among them, sign(*) is the sign function, Φ is the intermediate parameter, τ is the control input, k1 and k2 are the control law parameters, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, for q r The derivative of , q(s) is the quantized sliding mode switching function.

[0219] In one implementation, the restriction conditions of the control law parameters are:

[0220]

[0221] Among them, k1 and k2 are control law parameters, and η is the known limit.

[0222] In the present application, the processor is also specifically used to execute all processes and steps of the above-mentioned robot arm quantized sliding mode control method. The specific content can refer to the records in the robot arm quantized sliding mode control method, and will not be repeated in this application.

[0223] In this application, Figure 4 Only some components are shown schematically, which does not mean that the electronic device only includes Figure 4 Components shown.

[0224] The electronic device provided in this embodiment is based on the same inventive concept as the robot arm quantized sliding mode control method provided in the embodiment of the present application, and has the same beneficial effects as the method adopted, run or implemented by the application program stored therein.

[0225] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment in combination with software and hardware. Moreover, the present application may adopt the form of a computer program product implemented in one or more computer-readable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) that contain computer-usable program code.

[0226] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0227] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0228] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0229] In a typical configuration, a computing device includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.

[0230] The memory may include non-permanent storage in a computer-readable medium, random access memory (RAM) and / or non-volatile memory in the form of read-only memory (ROM) or flash RAM. The memory is an example of a computer-readable medium.

[0231] The present application also provides a computer-readable storage medium corresponding to the robot arm quantized sliding mode control method provided in the aforementioned embodiment, on which a computer program (i.e., a program product) is stored. When the computer program is run by a processor, it will execute the robot arm quantized sliding mode control method provided in any of the aforementioned embodiments.

[0232] Computer readable media include permanent and non-permanent, removable and non-removable media that can be implemented by any method or technology to store information. Information can be computer readable instructions, data structures, program modules or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technology, compact disk read-only memory (CD-ROM), digital versatile disk (DVD) or other optical storage, magnetic cassettes, magnetic tape magnetic disk storage or other magnetic storage devices or any other non-transmission media that can be used to store information that can be accessed by a computing device. As defined herein, computer readable media does not include temporary computer readable media (transitory media), such as modulated data signals and carrier waves.

[0233] The computer-readable storage medium provided in the above-mentioned embodiments of the present application and the robot arm quantitative sliding mode control method provided in the embodiments of the present application are based on the same inventive concept and have the same beneficial effects as the methods adopted, run or implemented by the application programs stored therein.

[0234] It should be noted that in the description provided herein, a large number of specific details are described. However, it is understood that the embodiments of the present application can be practiced without these specific details. In some instances, well-known structures and technologies are not shown in detail so as not to obscure the understanding of this description.

[0235] It should also be noted that the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, commodity or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, commodity or device. In the absence of more restrictions, the elements defined by the sentence "comprises a ..." do not exclude the existence of other identical elements in the process, method, commodity or device including the elements.

[0236] The above is only an embodiment of the present application and is not intended to limit the present application. For those skilled in the art, the present application may have various changes and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application should be included in the scope of the claims of the present application.

Claims

1. A quantized sliding mode control method for a robotic arm, characterized in that: include: Based on the connecting rod characteristics of the robot arm dynamics, the dynamic equation of the robot arm is established; Adding model parameter perturbations and unknown bounded disturbances to the dynamic equations; Construct PD type sliding mode surface; Determine a quantization error of a sliding mode switching function, the sliding mode switching function being a functional representation of a sliding mode surface; The system control law is determined based on the high-order sliding mode theory, which can make the sliding mode state converge in a finite time; Based on the system control law, determining the parameter conditions and convergence domain that make the system state converge in finite time; Control the robot arm according to the system control law, parameter conditions and convergence domain to execute the predetermined task objectives; The dynamic equation of the robotic arm is: Where M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, the control input τ is the n×1 joint torque vector, n is the number of robot joints, q is the actual trajectory, is the time derivative of q, for derivatives in time; The dynamic equation of the manipulator after adding the model parameter perturbation and unknown bounded disturbance is: 0<δ(t)<η Among them, d(t) is an n×1 vector, which is the sum of the inertial parameter perturbation and the unknown working environment disturbance. is the derivative, t is time, δ(t) is a bounded function related to time, η is a known limit, and sign(*) is a sign function; The constructed PD type sliding mode surface is: e=q r -q Where s is the sliding mode hyperplane, e is the error, is the time derivative of e, q r is the expected trajectory, is an n×1 dimensional vector, and q is the actual trajectory; The quantization error is: q(s)-s=eqs Among them, e qs is the quantization error, μ is the quantization parameter, q(s) is the sliding mode switching function after quantization, and round() is the nearest integer operation; The system control law is: Among them, sign(*) is the sign function, Φ is the intermediate parameter, τ is the control input, k1 and k2 are the control law parameters, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, Q r The derivative of , q(s) is the quantized sliding mode switching function; The constraints on the control law parameters are: Among them, k1 and k2 are control law parameters, and η is the known limit; The convergence region is: Where k1 and k2 are control law parameters, η is the known limit, P is the parameter matrix, Q(η) is the matrix containing the parameter η, ω is a constant, and λ max (*) is the largest characteristic root, λ min (*) is the minimum characteristic root, p 11 、p 12 is an element in the matrix P, and Ω(μ) is a constant containing the quantizer parameter μ.

2. A quantized sliding mode control device for a robotic arm, characterized in that: include: An equation building module, which is used to build the dynamic equations of the robot arm based on the connecting rod characteristics of the robot arm dynamics; A disturbance setting module, which is used to add model parameter perturbations and unknown bounded disturbances to the dynamic equations; Sliding mode construction module, which is used to construct PD type sliding mode surface; A quantization error module, which is used to determine the quantization error of the sliding mode switching function, the sliding mode switching function is a functional representation of the sliding mode surface; A control law determination module, which is used to determine the system control law based on the high-order sliding mode theory, and the system control law can make the sliding mode state converge in a finite time; A parameter determination module, which is used to determine the parameter conditions and convergence domain that make the system state converge in a finite time based on the system control law; A robot arm control module, which is used to control the robot arm according to the system control law, parameter conditions and convergence domain to perform the predetermined task objectives; The dynamic equation of the robotic arm is: Where M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, the control input τ is the n×1 joint torque vector, n is the number of robot joints, q is the actual trajectory, is the time derivative of q, for derivatives in time; The dynamic equation of the manipulator after adding the model parameter perturbation and unknown bounded disturbance is: 0<δ(t)<η Among them, d(t) is an n×1 vector, which is the sum of the inertial parameter perturbation and the unknown working environment disturbance. is the derivative, t is time, δ(t) is a bounded function related to time, η is a known limit, and sign(*) is a sign function; The constructed PD type sliding mode surface is: e=q r -q Where s is the sliding mode hyperplane, e is the error, is the time derivative of e, q r is the expected trajectory, is an n×1 dimensional vector, and q is the actual trajectory; The quantization error is: q(s)-s=eqs Among them, e qs is the quantization error, μ is the quantization parameter, q(s) is the sliding mode switching function after quantization, and round() is the nearest integer operation; The system control law is: Among them, sign(*) is the sign function, Φ is the intermediate parameter, τ is the control input, k1 and k2 are the control law parameters, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, for q r The derivative of , q(s) is the quantized sliding mode switching function; The constraints on the control law parameters are: Among them, k1 and k2 are control law parameters, and η is the known limit; The convergence region is: Where k1 and k2 are control law parameters, η is the known limit, P is the parameter matrix, Q(η) is the matrix containing the parameter η, ω is a constant, and λ max (*) is the largest characteristic root, λ min (*) is the minimum characteristic root, p 11 、p 12 is an element in the matrix P, and Ω(μ) is a constant containing the quantizer parameter μ.

3. An electronic device, characterized in that: include: Memory and processor; The memory is used to store programs; The processor, coupled to the memory, is configured to execute the program to: Based on the connecting rod characteristics of the robot arm dynamics, the dynamic equation of the robot arm is established; Adding model parameter perturbations and unknown bounded disturbances to the dynamic equations; Construct PD type sliding mode surface; Determine a quantization error of a sliding mode switching function, the sliding mode switching function being a functional representation of a sliding mode surface; The system control law is determined based on the high-order sliding mode theory, which can make the sliding mode state converge in a finite time; Based on the system control law, determining the parameter conditions and convergence domain that make the system state converge in finite time; Control the robot arm according to the system control law, parameter conditions and convergence domain to execute the predetermined task objectives; The dynamic equation of the robotic arm is: Where M(q) is the n×n dimensional positive definite inertia matrix, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, the control input τ is the n×1 joint torque vector, n is the number of robot joints, q is the actual trajectory, is the time derivative of q, for derivatives in time; The dynamic equation of the manipulator after adding the model parameter perturbation and unknown bounded disturbance is: 0<δ(t)<η Among them, d(t) is an n×1 vector, which is the sum of the inertial parameter perturbation and the unknown working environment disturbance. is the derivative, t is time, δ(t) is a bounded function related to time, η is a known limit, and sign(*) is a sign function; The constructed PD type sliding mode surface is: e=q r -q Where s is the sliding mode hyperplane, e is the error, is the time derivative of e, q r is the expected trajectory, is an n×1 dimensional vector, and q is the actual trajectory; The quantization error is: q(s)-s=eqs Among them, e qs is the quantization error, μ is the quantization parameter, q(s) is the sliding mode switching function after quantization, and round() is the nearest integer operation; The system control law is: Among them, sign(*) is the sign function, Φ is the intermediate parameter, τ is the control input, k1 and k2 are the control law parameters, is the n×n dimensional centrifugal force and Coriolis force matrix, G(q) is the n×1 dimensional gravity term vector, for q r The derivative of , q(s) is the quantized sliding mode switching function; The constraints on the control law parameters are: Among them, k1 and k2 are control law parameters, and η is the known limit; The convergence region is: Where k1 and k2 are control law parameters, η is the known limit, P is the parameter matrix, Q(η) is the matrix containing the parameter η, ω is a constant, and λ max (*) is the largest characteristic root, λ min (*) is the minimum characteristic root, p 11 、p 12 is an element in the matrix P, and Ω(μ) is a constant containing the quantizer parameter μ.

4. A computer-readable storage medium having a computer program stored thereon, characterized in that: The program is executed by the processor to implement the robot arm quantitative sliding mode control method described in claim 1.