Quadruped robot single-leg trajectory tracking control method and system

A quadruped robot, trajectory tracking technology, applied in general control system, control/adjustment system, adaptive control, etc., to achieve the effect of improving trajectory tracking performance, high-precision trajectory tracking control, and improving performance

Pending Publication Date: 2021-08-06
QILU UNIV OF TECH
6 Cites 2 Cited by

AI-Extracted Technical Summary

Problems solved by technology

[0005] In order to solve the above problems, this disclosure aims at the single leg of the quadruped robot, and uses the excellent nonlinear approximation ability of the neural network to propose a quadruped robot single leg based on RBF (Radial Basis Function) neural network (NN, Neural Networks) compensation control. The leg trajectory tracking control method is used to compensate the influence of nonlinearity and error, improve the performance of the nonlinear control system of the qua...
View more

Method used

Because there is uncertainty in parameter M (x1), C (x1, x2), G (x1), f, utilize RBF neural network estimator to approach the uncertainty of robot parameter, improve the tracking performance of robot , the control rate is redesigned as:
Promptly utilize RBF neural network estimator to approach the uncertainty of robot parameter, improve the tracking performance of robot, control rate is designed as:
Step 3, considering the quadruped robot single-leg dynamic model under the...
View more

Abstract

The invention provides a quadruped robot single-leg trajectory tracking control method and system. The quadruped robot single-leg trajectory tracking control method comprises the steps of obtaining joint parameters of a quadruped robot; establishing a single-leg dynamic model according to the joint parameters; correcting the single-leg dynamical model based on disturbance and a neural network, constructing a single-leg dynamical model under the condition of considering disturbance, and assuming a reference trajectory; obtaining an optimal parameter of the reference trajectory by using a value function approximation method based on neural network learning, and obtaining an optimal control rate; and achieving single-leg trajectory tracking control of the quadruped robot based on the optimal control rate. The method solves the problem of how to compensate the influence of nonlinearity and errors, improves the performance of a nonlinear control system of the quadruped robot, guarantees that the trajectory tracking error of the quadruped robot is gradually converged to zero, and achieves the high-precision trajectory tracking control of the quadruped robot.

Application Domain

Adaptive control

Technology Topic

Linear control systemsFunction approximation +8

Image

  • Quadruped robot single-leg trajectory tracking control method and system
  • Quadruped robot single-leg trajectory tracking control method and system
  • Quadruped robot single-leg trajectory tracking control method and system

Examples

  • Experimental program(4)

Example Embodiment

[0034] Example 1
[0035] like figure 1 As shown, a four-legged robot single leg trajectory tracking control method, including:
[0036] Get the joint parameters of the quadruple robot;
[0037] Establish a single leg dynamics model according to joint parameters;
[0038] Based on disturbance and neural network to correct single leg dynamics model, construct a single leg dynamics model in the case of disturbance, and assume a reference trajectory;
[0039] Using a value-based function approximation method based on neural network learning, the optimal parameters of the reference trajectory are obtained, and the optimal control rate is obtained;
[0040] Based on the optimal control rate to realize the single leg trajectory tracking control of the quadruple robot.
[0041] Further, the joint parameters include joint position, speed, and acceleration vectors.
[0042] Further, according to the joint parameters, the one-leg dynamic model is established, and the control torque vector is obtained according to the symmetrical inertial matrix of the joint position, the speed, the acceleration vector, and the CCC and the centrifugal force matrix and the gravity vector are obtained.
[0043] Specifically, 1.1 four-foot robot single leg 3 free simplified kinetic model is expressed as:
[0044]
[0045] in The joint position, speed, and acceleration vector, M (θ) are symmetrical inertial matrices, For the Corosary and Ceremony Matrix, For the gravity vector, u (θ) is gravity, τ = r n×n For the control torque vector.
[0046] 1.2 According to the actual quadruple robot joint parameters, the specific parameters of the kinetic equation of the four-legged robot 3 freedom single legs are as follows
[0047]
[0048] in,
[0049]
[0050]
[0051]
[0052] in,
[0053]
[0054]
[0055]
[0056]
[0057]
[0058] Further, the neural network is an RBF neural network, using a neural network approximate continuous function, and the weight of the neural network is defined by an error between input and desired output. The process is as follows:
[0059] 2.1RBF neural network for approximate continuous functions h (x): r n → r
[0060]
[0061] Where X is the input variable, It is the connection between the hidden layer and the output layer, It is a base function.
[0062] RBF neural networks can put continuous function h (x) in a tight Ω Z It is approximated to any desired accuracy, as shown below:
[0063]
[0064] Where W * It is an ideal weight, and || Δ || ≤ ε is approximation error, where ε> 0 is a constant.
[0065] Further, the neural network based on the single leg dynamics model considering disturbance includes,
[0066] Redefine the joint parameters of the robot according to the external disturbance parameters received by the robot;
[0067] Set the reference trajectory according to the redefined joint parameter, define the generalized tracking error;
[0068] Introduce virtual control and second error variables and get gain matrices;
[0069] Time-guided gain matrix, based on the Lee Point candidate function to obtain a single leg dynamics model considering disturbance.
[0070] The external disturbance parameters are large-scale disturbances and parameters uncertainty in practical applications. When the perturbation performance is mainly interactively interactively interact with complex terrain, the parameter uncertainty is mainly manifested by the uncertainty of the late disturbance or slip. Some kinetic parameters, such as rotation inertia, etc. are estimated; due to the external disturbance parameters, it is necessary to obtain real-time acquisition according to actual impact scenarios. This application uses disturbance and neural network to correct single leg dynamics models, and construct consider disturbance. The single leg dynamics model is assumed, and the reference trajectory is assumed; the accurate external disturbance parameters are acquired using a value function based on neural network learning, thereby obtaining the optimal control rate, thereby tracking the four-legged robot single leg trajectory tracking control.
[0071] Specifically, the three-legged kinetic equation of the four-legged robot considers the extrusion time, and it can be written as the following form.
[0072]
[0073] Where f is an external disturbance from the robot. Redefine parameters, let X 1 = Θ, available:
[0074]
[0075]
[0076] 3.2 In order to design control torque, the system can achieve better target tracking, and set the reference track x r (t) can be expressed as X r (t) = [ 1r (t), θ 2r (t), θ 3r (t)] T. When status information X 1 X 2 Fully known, define a generalized tracking error z 1 (t) = x 1 (t) -X r (t), and
[0077] 3.3 Introducing a virtual control α 1 (t) and the second error variable defined as z 2 (t) = x 2 (t) -α 1 (t). choose
[0078]
[0079] Gain matrix K 1 = K 1 T 0, then
[0080]
[0081] Time to guide
[0082]
[0083] 3.4 Consider a Li Yapuov candidate function:
[0084]
[0085] Combined equation (9) to V 1 Seek time derivative:
[0086]
[0087] Then consider the Li Yapanov candidate function:
[0088]
[0089] The above formula is guided
[0090]
[0091] 3.5 The model-based control can be designed as follows:
[0092]
[0093] Gain matrix K 2 = K 2 T 0, the equation (14) is brought into the Li Yapanov candidate function:
[0094]
[0095] Further, the optimal parameters of the reference trajectory are obtained using the value of the value based on neural network learning, and the optimal control rate includes,
[0096] Set the normal number of external disturbance parameters Define the operator and establish a model to establish a controller according to the model;
[0097] The optimal parameters of the reference trajectory are obtained using the value of the reference trajectory to obtain the optimal parameters of the reference trajectory, and the controller is determined in the optimal control rate.
[0098] That is, using the RBF neural network estimator to approximate the uncertainty of robot parameters, improve the tracking performance of robots, and the control rate is designed:
[0099]
[0100] here Is the weight of the neural network, Is a base function, this neural network Approximate
[0101] Specifically, f is an unknown amount, that is, there is a normal number vector when Time Because when the flow of f (t) has limited energy, it is bound to be bound, ie f (t) ∈L ∞.
[0102] Definition operator "⊙"
[0103]
[0104]
[0105] Here A = [A 1 , a 2 ] T And b = [b 1 , B 2 ] T It is two two-dimensional vector.
[0106] The controller based on the above model is:
[0107]
[0108] Gain matrix K 2 = K 2 T 0, thus
[0109]
[0110] Due to the parameter M (X 1 ), C (x 1 , X 2 ), G (x 1 ), There is uncertainty in f, using the RBF neural network estimator to approximate the uncertainty of robot parameters, and improve the tracking performance of the robot, and the control rate is redesigned as:
[0111]
[0112] here Is the weight of the neural network, Is a base function, this neural network Approximate which is:
[0113]
[0114] here Is the input variable of the neural network, It is approximate error, and the adaptation rate is designed as:
[0115]
[0116] Γ here i Is a constant gain matrix, and φ i 0, i = 1, 2, ... n, is a small value constant.

Example Embodiment

[0117] Example 2
[0118] The present disclosure provides a four-legged single leg trajectory tracking controller, including:
[0119] The data acquisition module is configured to obtain joint parameters of the four-legged robot;
[0120] Single leg dynamics model establishment module is configured to establish a single leg dynamics model according to joint parameters;
[0121] The reference track establishment module is configured to correct the single leg dynamics model based on the disturbance and neural network, construct a single leg dynamics model in the case of disturbance, and assume the reference trajectory;
[0122] The control rate acquisition module is configured to obtain the optimal parameters of the reference trajectory using a value function based on neural network learning, and obtain the optimal control rate;
[0123] The tracking control module is configured to implement a single leg trajectory tracking control based on the optimal control rate.
[0124] Further, the data acquisition module, the single leg dynamics model establishment module, the reference track establishment module, the control rate acquisition module, and the tracking control module are configured, respectively, corresponding to the four-legged robot one leg described in the above embodiment. The specific steps of the trajectory tracking control method.

Example Embodiment

[0125] Example 3
[0126] The present disclosure provides a four-legged robot single leg trajectory tracking control system, which includes a four-foot robot single leg trajectory tracking controller as described above.

PUM

no PUM

Description & Claims & Application Information

We can also present the details of the Description, Claims and Application information to help users get a comprehensive understanding of the technical details of the patent, such as background art, summary of invention, brief description of drawings, description of embodiments, and other original content. On the other hand, users can also determine the specific scope of protection of the technology through the list of claims; as well as understand the changes in the life cycle of the technology with the presentation of the patent timeline. Login to view more.

Similar technology patents

Method and apparatus of transmitting information in wireless communication system

ActiveUS20110170489A1improve performanceeffectively transmit information
Owner:LG ELECTRONICS INC

Storage system and data processing system

InactiveUS20060031647A1avoid affect communicationimprove performance
Owner:HITACHI LTD

Classification and recommendation of technical efficacy words

Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products