Robot adaptive tracking control method based on improved dung beetle optimization algorithm
By improving the dung beetle optimization algorithm and adaptive RBF neural network, combined with the sliding mode variable structure torque controller, the problem of insufficient robustness and stability in robot tracking control is solved, and high-precision tracking and resistance in complex environments is achieved Interference capability.
Patent Information
- Application Number
- CN202411042759.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-31
- Publication Date
- 2024-11-08
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
When facing complex environments, the existing robot tracking control methods have weak ability to resist external uncertain interference and low robustness, resulting in poor tracking accuracy and insufficient system stability, making it difficult to achieve accurate tracking.
Adoptional tracking control method of robot based on improved dung beetle optimization algorithm, combined with kinematics and dynamic models, a sliding mode variable structure torque controller and an adaptive RBF neural network are designed, and the controller parameters are optimized through improved dung beetle optimization algorithm. Enhance the robustness and tracking performance of the system.
Effectively suppress external interference, improve the robustness and tracking accuracy of the robot system, realize accurate tracking of the expected trajectory, and enhance the system's anti-interference ability and adaptability.
Smart Images

Figure CN118915461A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of robot intelligent control, and in particular to a robot adaptive tracking control method and device based on an improved dung beetle optimization algorithm. Background Art
[0002] In recent years, mobile robots have been applied to various fields. Due to the complexity and high nonlinearity of the external environment and the strong coupling of mobile robots, the control process of the entire system becomes difficult. The traditional mobile robot tracking control method is based on the kinematic model design, which is only suitable for scenes with slow speed and low precision requirements. The tracking accuracy is greatly affected by the parameters. Once the external environment changes, the tracking accuracy will be greatly reduced, or even the tracking will fail. At present, most mobile robot tracking control methods fail to consider the tracking accuracy and uncertain interference and parameter adaptation at the same time. Neural networks have the ability to approximate arbitrary nonlinear functions, which provides a basic guarantee for dealing with the influence of disturbances. In addition, the parameter selection in past studies often relies on empirical adjustment, which brings great challenges to the system to select appropriate parameters. With the breakthrough of optimization technology, this provides new ideas for the field of mobile robot tracking control. The optimization algorithm has a strong optimization ability, which can find the best option from a large amount of big data and effectively deal with the influence of parameters on the system tracking accuracy in various environments. With the support of the optimization algorithm, the mobile robot can autonomously complete parameter selection in different scenarios and achieve intelligence.
[0003] The sliding mode control method has been studied and applied to a certain extent in the field of mobile robot tracking control, but there are still many problems, such as being affected by chattering, weak ability to resist external uncertain interference, and low robustness. The existing research methods improve the response speed and robustness of the system by combining kinematic and dynamic models, but they are still affected by external interference and parameter changes. In addition, the reasoning and approximation capabilities of fuzzy neural networks are used to estimate the uncertainty of the system and solve the input constraints and rule redundancy problems inherent in traditional approximation networks. Adaptive neural networks are used to compensate for the uncertainty and nonlinearity in mobile robot systems based on adaptive estimation. The current processing method only stays at the level of the mobile robot's own model, and it is difficult to overcome external interference and the influence of controller parameters on system stability and accuracy. This leads to the lack of adaptability of the existing methods when the mobile robot is in complex scenes, and it is easy to have tracking failures and poor accuracy. Problems, seriously affecting the overall accuracy and reliability, are obviously not the most ideal solution.
[0004] In the prior art, there is a lack of an adaptive tracking control method with high accuracy and good robustness for robot movement. Summary of the invention
[0005] In order to solve the technical problem of the weak ability to resist external uncertain interference in the prior art, the embodiment of the present invention provides a robot adaptive tracking control method and device based on an improved dung beetle optimization algorithm. The technical solution is as follows:
[0006] On the one hand, a robot adaptive tracking control method based on an improved dung beetle optimization algorithm is provided, the method is implemented by an adaptive tracking control device, and the method includes:
[0007] Obtain the parameters of the mobile robot; collect data on the motion state of the mobile robot through sensors to obtain motion state information;
[0008] Constructing a model based on the robot parameters and motion state information to obtain a robot kinematic model and a robot dynamic model;
[0009] According to the robot kinematic model, a controller is designed by adopting a backstepping method to obtain a kinematic controller;
[0010] According to the robot dynamics model, a sliding mode control method based on a combined reaching law is used to design a controller to obtain a first dynamics controller;
[0011] Based on the first dynamics controller and according to the robot dynamics model, an adaptive RBF neural network is used to compensate for the interference effect of the motion control to obtain a second dynamics controller;
[0012] Using an improved dung beetle optimization algorithm, the parameters of the second dynamics controller are optimized to obtain a third dynamics controller;
[0013] Obtaining an adaptive tracking controller according to the kinematic controller and the third dynamics controller;
[0014] Obtaining a desired motion trajectory; and performing motion control by the adaptive tracking controller of the mobile robot according to the desired motion trajectory.
[0015] On the other hand, a robot adaptive tracking control device based on an improved dung beetle optimization algorithm is provided, and the device is applied to a robot adaptive tracking control method based on an improved dung beetle optimization algorithm, and the device comprises:
[0016] The information acquisition module is used to obtain the parameters of the mobile robot; the motion state of the mobile robot is collected by sensors to obtain motion state information;
[0017] A model building module, used to build a model according to the robot parameters and motion state information to obtain a robot kinematic model and a robot dynamic model;
[0018] A kinematic controller building module is used to design a controller using a backstepping method according to the robot kinematic model to obtain a kinematic controller;
[0019] A first dynamics controller building module is used to design a controller according to the robot dynamics model by using a sliding mode control method based on a combined reaching law to obtain a first dynamics controller;
[0020] A second dynamics controller building module is used to compensate for the interference effect of the motion control by using an adaptive RBF neural network based on the first dynamics controller and according to the robot dynamics model, so as to obtain a second dynamics controller;
[0021] A third dynamics controller building module, used to optimize the parameters of the second dynamics controller by using an improved dung beetle optimization algorithm to obtain a third dynamics controller;
[0022] An adaptive tracking controller building module, used for obtaining an adaptive tracking controller according to the kinematic controller and the third dynamics controller;
[0023] The robot motion control module is used to obtain a desired motion trajectory; according to the desired motion trajectory, motion control is performed through the adaptive tracking controller of the mobile robot.
[0024] On the other hand, an adaptive tracking control device is provided, comprising: a processor; a memory, wherein the memory stores computer-readable instructions, and when the computer-readable instructions are executed by the processor, any one of the above-mentioned robot adaptive tracking control methods based on the improved dung beetle optimization algorithm is implemented.
[0025] On the other hand, a computer-readable storage medium is provided, wherein at least one instruction is stored in the storage medium, and the at least one instruction is loaded and executed by a processor to implement any one of the above-mentioned robot adaptive tracking control methods based on the improved dung beetle optimization algorithm.
[0026] The beneficial effects brought about by the technical solution provided by the embodiment of the present invention include at least:
[0027] The present invention proposes a robot adaptive tracking control method based on an improved dung beetle optimization algorithm. Based on the kinematic and dynamic models of the mobile robot, a sliding mode variable structure torque controller based on the combined reaching law is designed to ensure speed tracking, so that the system can better solve the chattering problem. In view of the unknown external interference faced by the mobile robot system, an adaptive RBF neural network is designed. It can reduce the impact of interference on the system and improve the robustness and tracking performance of the system. Through the improved dung beetle optimization algorithm, the adaptability of controller parameter setting is enhanced, and the robustness and tracking performance of the system are improved. The present invention takes into account the external interference of the mobile robot and designs a control method based on the improved dung beetle optimization algorithm, which can effectively suppress the interference received by the mobile robot system and can accurately track the desired trajectory. The present invention is an adaptive tracking control method with high accuracy and good robustness for robot movement. BRIEF DESCRIPTION OF THE DRAWINGS
[0028] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0029] Figure 1 It is a flow chart of a robot adaptive tracking control method based on an improved dung beetle optimization algorithm provided by an embodiment of the present invention;
[0030] Figure 2 is a schematic diagram of a mobile robot provided by an embodiment of the present invention;
[0031] Figure 3 It is a block diagram of a robot adaptive tracking control device based on an improved dung beetle optimization algorithm provided by an embodiment of the present invention;
[0032] Figure 4 It is a structural schematic diagram of an adaptive tracking control device provided by an embodiment of the present invention. DETAILED DESCRIPTION
[0033] The technical solution of the present invention is described below in conjunction with the accompanying drawings.
[0034] In the embodiments of the present invention, words such as "exemplarily" and "for example" are used to indicate examples, illustrations or explanations. Any embodiment or design described as "example" in the present invention should not be interpreted as being more preferred or more advantageous than other embodiments or designs. Specifically, the use of the word "example" is intended to present the concept in a specific way. In addition, in the embodiments of the present invention, the meaning expressed by "and / or" can be both, or it can be either of the two.
[0035] In the embodiments of the present invention, "image" and "picture" can sometimes be used interchangeably. It should be noted that when the difference between them is not emphasized, the meanings they intend to express are the same. "of", "corresponding, relevant" and "corresponding" can sometimes be used interchangeably. It should be noted that when the difference between them is not emphasized, the meanings they intend to express are the same.
[0036] In the embodiments of the present invention, sometimes the subscripts such as W 1 It may be written in non-subscript form such as W1. When the difference is not emphasized, the meaning is the same.
[0037] In order to make the technical problems, technical solutions and advantages to be solved by the present invention more clear, a detailed description will be given below with reference to the accompanying drawings and specific embodiments.
[0038] The embodiment of the present invention provides a robot adaptive tracking control method based on an improved dung beetle optimization algorithm. The method can be implemented by an adaptive tracking control device, which can be a terminal or a server. Figure 1 The flowchart of the robot adaptive tracking control method based on the improved dung beetle optimization algorithm is shown in FIG. 1 . The processing flow of the method may include the following steps:
[0039] S1. Obtaining the parameters of the mobile robot; collecting data on the motion state of the mobile robot through sensors to obtain motion state information.
[0040] In a feasible implementation, the mobile robot parameters include length, mass, rigid body mass, inertia and other intrinsic parameters. The motion state information of the mobile robot is collected by sensors mounted on the mobile robot, including the linear velocity, angular velocity and other motion-related state information of the mobile robot.
[0041] S2. Build a model based on robot parameters and motion state information to obtain a robot kinematic model and a robot dynamic model.
[0042] In a feasible implementation, Figure 2 The global coordinate system is constructed based on the mobile robot. , the center of mass of the moving robot coincides with the axis of the two wheels point, is the heading angle, relative to the center of mass of the moving robot Perform physical analysis to make its posture ,speed ,in, is the forward linear speed, is the angular velocity.
[0043] Under the condition of pure rolling without slip, the kinematic model is as follows (1):
[0044] (1)
[0045] in, is the Jacobian matrix, which defines the relative relationship between attitude and velocity. Assume that it is from the current previous attitude Move to the desired posture , then the expected speed is To achieve trajectory tracking, the pose tracking error is defined as ,in , and They are lateral error, longitudinal error and heading angle error respectively.
[0046] The posture error equation of the mobile robot is as follows (2):
[0047] (2)
[0048] Considering the influence of unknown temporal and spatial disturbances, and taking it as one of the inputs of the system, we can get the relationship between the state variables and the control input of the system. and moment of inertia , its simplified kinetic model is as follows (3):
[0049] (3)
[0050] in , , and is the torque of the mobile robot. , It is an unknown disturbance of space-time changes.
[0051] S3. Based on the robot kinematic model, the backstepping method is used to design the controller to obtain the kinematic controller.
[0052] Optionally, a backstepping method is used to design a controller according to the robot kinematic model to obtain a kinematic controller, including:
[0053] Determine the displacement error based on the robot kinematic model;
[0054] According to the robot kinematics model and displacement error, the function is constructed to obtain the Lyapunov function of the mobile robot motion;
[0055] Calculate according to Lyapunov function and get the speed control law;
[0056] According to the speed control law, the controller is designed by backstepping method to obtain the kinematic controller.
[0057] In a feasible implementation, in the kinematic controller part, a backstepping control law is designed using a virtual error signal , realize the robot's posture tracking, according to the kinematic model of the mobile robot, when , With the help of the design idea of the backstepping method, the Lyapunov function is designed for the kinematic model subsystem. The Lyapunov function of the kinematic control law is as follows (4):
[0058] (4)
[0059] Through the system status Taking the derivative, we can get that In the case of The designed speed control law is as follows (5):
[0060] (5)
[0061] in, , , The coefficients of the backstepping controller are all positive real numbers.
[0062] S4. According to the robot dynamics model, a sliding mode control method based on the combined reaching law is used to design a controller to obtain a first dynamics controller.
[0063] Optionally, according to the robot dynamics model, a sliding mode control method based on a combined reaching law is used to design a controller to obtain a first dynamics controller, including:
[0064] Determine the actual-output linear velocity error and the actual-output angular velocity error according to the robot dynamics model;
[0065] Construct a torque control law based on the actual-output linear velocity error and the actual-output angular velocity error;
[0066] The sliding surface is designed according to the robot dynamics model to obtain the proportional-integral sliding surface;
[0067] Based on the sliding mode motion law of the mobile robot, the combined reaching law is constructed using the exponential reaching law and the variable speed reaching law.
[0068] The sliding mode controller is constructed according to the torque control law, proportional-integral sliding surface and combined reaching law to obtain the first dynamics controller.
[0069] In a feasible embodiment, in the present invention, the kinematic controller is designed to adjust the speed so that when Sometimes converges to the desired speed . Using the actual speed of the moving robot Output speed with motion controller The error between Design of sliding mode variable structure torque control law .
[0070] By applying this control law, the actual speed of the moving robot is obtained. , ensuring effective speed tracking. Based on the above analysis, a proportional-integral sliding surface can be designed. As shown in formula (6):
[0071] (6)
[0072] in, is the integral parameter of the sliding surface. Right now and When and Converges to zero, achieving the trajectory tracking of the mobile robot.
[0073] Torque control law Discontinuous items in This will cause the system to switch back and forth between different control logics, thus causing system chattering. Therefore, the combined reaching law is introduced into the tracking problem of the mobile robot, and the symbol function is replaced by To reduce the chattering problem in sliding mode motion.
[0074] In the early stage of sliding mode movement, that is, when , When , the exponential reaching law is selected, and the sliding surface is shown in the following formula (7):
[0075] (7)
[0076] in, and are the judgment thresholds in the early stage of sliding mode motion and the judgment thresholds in the late stage of sliding mode motion, and both are positive real numbers.
[0077] According to the dynamic model of the mobile robot, the torque control law of the system is shown in equation (8):
[0078] (8)
[0079] in, and are the coefficients of the sliding mode controller and , .
[0080] In the later stage of sliding mode movement, when , When the variable speed reaching law is selected, the sliding surface is shown in the following formula (9):
[0081] (9)
[0082] At this time, the torque control law is as follows (10):
[0083] (10)
[0084] in, and are the coefficients of the sliding mode controller and , , .
[0085] S5. Based on the first dynamics controller and according to the robot dynamics model, an adaptive RBF neural network is used to compensate for the interference effect of the motion control to obtain a second dynamics controller.
[0086] Optionally, based on the first dynamics controller and according to the robot dynamics model, an adaptive RBF neural network is used to compensate for the interference effect of the motion control to obtain a second dynamics controller, including:
[0087] Determining an actual-output linear velocity error, an actual-output angular velocity error, an actual-output linear velocity error derivative, and an actual-output angular velocity error derivative according to a robot dynamics model;
[0088] The actual-output linear velocity error, the actual-output angular velocity error, the actual-output linear velocity error derivative and the actual-output angular velocity error derivative are input into the adaptive RBF neural network to simulate the interference effect and obtain the approximate value of the interference term;
[0089] The interference term is replaced according to the preset adaptive rate, the interference term approximation and the torque control law to obtain the second torque control law;
[0090] The sliding mode controller is constructed according to the second torque control law to obtain the second dynamics controller.
[0091] In a feasible implementation manner, in order to improve the motion quality of the wheeled mobile robot's trajectory tracking, the present invention takes into account factors such as external interference on the system, designs an adaptive radial basis function (RBF) neural network to compensate for the impact of interference on the system, and ensures that the wheeled mobile robot quickly approaches the sliding surface at the initial position while reducing the jitter phenomenon of the system itself.
[0092] An adaptive RBF neural network is introduced to approximate the equivalent control law. The neural network input is taken as , then the approximate value of the interference term is as follows (11):
[0093] (11)
[0094] in, is the output of the RBF neural network. is the optimal weight matrix of the neural network, is the Gaussian basis function, as shown in equation (12):
[0095] (12)
[0096] in, represents the output of the Gaussian basis function. Corresponding to The center of the basis function, represents the width of the basis function, Indicates the number of hidden nodes.
[0097] The adaptive law used is as follows (13):
[0098] (13)
[0099] in is an adaptive parameter, and . is a positive definite symmetric matrix. .
[0100] An adaptive RBF neural network is used to effectively approximate the uncertainty terms in the system. The torque control law after using the neural network replacement is as follows (14):
[0101] (14)
[0102] Through the Lyapunov stability proof, the global Lyapunov function of the system is designed as follows (15)
[0103] (15)
[0104] Among them, the definition , is the trace of the matrix, . is the system state equation. After a series of derivative changes of the function, the system state can be finally obtained The conclusion can prove that the designed closed-loop system is semi-globally consistent and ultimately bounded.
[0105] S6. Using an improved dung beetle optimization algorithm, perform parameter optimization on the second dynamics controller to obtain a third dynamics controller.
[0106] Optionally, an improved dung beetle optimization algorithm is used to optimize the parameters of the second dynamics controller to obtain a third dynamics controller, including:
[0107] According to the second dynamic controller, controller parameters are obtained; the controller parameters are used as dung beetle population parameters; the dung beetle population parameters are initialized;
[0108] The absolute value integral of time-error is used as the optimization target of the improved dung beetle optimization algorithm;
[0109] Calculate the position of dung beetles according to the population parameters of dung beetles to obtain the position of dung beetles;
[0110] Calculate according to the dung beetle population parameters and optimization objectives to obtain the parameter fitness value;
[0111] Based on the parameter fitness value, the position of the dung beetle is optimized and adjusted to obtain the optimal dung beetle position; according to the optimal dung beetle position, the optimal controller parameters corresponding to the optimal dung beetle position are obtained;
[0112] The optimal controller parameters are input into the second dynamics controller to obtain the third dynamics controller.
[0113] In a feasible implementation, an improved dung beetle optimization algorithm is used to optimize the sliding mode controller parameters, and the dung beetle individuals exist in the form of a one-element array. The selection of the population fitness function is the key to the optimization effect.
[0114] Determine the parameters and optimization objectives of the improved dung beetle optimization algorithm, and use the absolute value integral index of time multiplied by error The parameters in the controller are optimized as the optimization target of the improved dung beetle optimization algorithm. The algorithm first randomly selects a population and its related parameters in the search space.
[0115] The fitness value of each intelligent agent is calculated according to the objective function to adjust its own position, and the global optimal solution and its fitness value are obtained through continuous iteration until the termination criterion is met.
[0116] Among them, the improved dung beetle optimization algorithm is an improved algorithm that introduces cube chaos theory and reverse refraction mechanism into the dung beetle optimization algorithm.
[0117] In a feasible implementation, Dung Beetle Optimization (DBO) is a new swarm intelligence algorithm proposed by imitating certain behavioral characteristics of dung beetles, which is mainly inspired by the rolling, reproduction, foraging and stealing behaviors of dung beetles.
[0118] Initialize the parameters related to the dung beetle population, dung beetle individuals When there are no obstacles or obstacles in the direction of motion, the position is as follows (16):
[0119] (16)
[0120] in, Indicates the current iteration number, It is Dung beetle individuals The position after iterations. is a constant representing the offset factor. is any fixed value in (0, 1), Represents the natural coefficient. Worst indicates the worst position among the current species. is the direction angle, when The dung beetle remains in the same position.
[0121] In the dung beetle reproduction stage, in each iteration, the female dung beetle lays an egg. The egg-laying area is dynamically adjusted corresponding to the changing number of iterations. Therefore, the position of the offspring during each iteration is also dynamic, and the dynamic position is as follows (17):
[0122] (17)
[0123] In the given equation, It is Individual in the The position in the iteration. and represents two vectors, each with Quantity, of which Indicates the parameter dimension. and They represent the upper and lower boundaries of the spawning area respectively.
[0124] The position update of the individual dung beetle in the foraging stage is as follows (18):
[0125] (18)
[0126] in, is a scalar variable that follows a normal distribution when randomly sampled, that is, .on the other hand, is a dimension of A random vector of Every element of falls in the interval (0, 1). and Represents the upper and lower limits for finding food.
[0127] This is called stealing position update as follows:
[0128] (19)
[0129] in, Represents a dimension is a randomly selected vector whose elements are sampled from a normal distribution. In addition, Represents a constant value.
[0130] Based on the dung beetle optimization algorithm, an improved dung beetle optimizer (IDBO) was proposed to address the uneven distribution of populations by introducing a method combining cubic chaos with the reverse refraction mechanism to enrich the diversity of the population.
[0131] In response to the premature convergence of the algorithm, a hybrid reverse learning strategy that combines the pinhole imaging reverse learning strategy with the best-worst reverse learning strategy is adopted to improve the global search capability of the algorithm while helping the algorithm fall into the local optimum.
[0132] For the optimal individual position of dung beetles, reverse learning is performed to improve the local exploration ability of the algorithm and avoid premature convergence of the algorithm. The optimal individual position of dung beetles is as follows (20):
[0133] (20)
[0134] in, and are the lower and upper limits of the current optimal individual, is the current optimal dung beetle position vector, is the corresponding reverse position vector.
[0135] The global search capability can be improved by performing a random reverse learning strategy on the worst individual position of dung beetles. The worst individual position of dung beetles is as follows (21):
[0136] (twenty one)
[0137] in, and is the upper and lower limits of the current worst individual, is a random vector, Worst is the current worst dung beetle position vector, The worst is the corresponding reverse position vector.
[0138] The reverse learning strategy based on lens imaging dynamically adjusts the number of reverse solutions according to the scaling factor. Its principle is as follows:
[0139] (twenty two)
[0140] in, and is the interval range of feasible solutions and is a fixed value. The distance between the current solution and the inverse solution is determined by the proportional factor Decide, with As the value increases, the range of the inverse solution is closer to the current solution.
[0141] S7. Obtain an adaptive tracking controller according to the kinematic controller and the third dynamics controller.
[0142] In a feasible implementation manner, the present invention proposes an adaptive tracking controller. The controller consists of two parts: a kinematic controller based on backstepping method and a third dynamic controller based on sliding mode control.
[0143] The controller introduces the combined reaching law into the tracking problem of the mobile robot, and weakens the chattering problem in the sliding mode motion by replacing the sign function, and ensures the rapidity and stability of the tracking process. When the system is affected by interference, the adaptive RBF neural network is introduced to compensate the system, ensuring the stability of the control system performance.
[0144] S8. Obtain a desired motion trajectory; and perform motion control through an adaptive tracking controller of the mobile robot according to the desired motion trajectory.
[0145] In a feasible implementation manner, in order to verify the effectiveness and stability of the proposed algorithm, the present invention adopts MATLAB 2018a as the mobile robot simulation platform. In order to compare the control effects of traditional control methods and some advanced control methods with the composite control method with adaptive RBF neural network and improved dung beetle optimizer mentioned in the present invention in the mobile robot system, the three control methods of sliding mode control, neural network control and composite control are simulated on the mobile robot system.
[0146] The sliding mode control, neural network control and the composite controller proposed in this paper are designed using the Simulink module in MATLAB. The sliding mode control and neural network control are used to compare with the adaptive RBF neural network and improved dung beetle optimization control method proposed in this invention.
[0147] In implementation scenario 1, the mobile robot model parameters are: , The kinematic controller parameters are: , , The best combination of sliding mode controller parameters after optimization is: , , , , , , , , , , , The neural network parameters are set as: , , , , The expected trajectory is: , The simulated external disturbance is: The expected speed is: , .
[0148] Under the sliding mode control method, the tracking effect of the mobile robot on the reference trajectory is poor. Considering the influence of external interference, the tracking performance of the system is significantly improved after adding the neural network. The IDBO algorithm is used to optimize the system parameters, so that the system has higher tracking accuracy and robustness. In order to better evaluate the trajectory tracking performance of the mobile robot, the integral absolute error, integral square error and integral time weighted error are introduced.
[0149] The robot control results are shown in Table 1 (Comparison table of control results of implementation scenario 1). It can be seen from Table 1 that under the sliding mode control method, when disturbed, the lateral, longitudinal and angular errors of the mobile robot in the tracking process fluctuate greatly, and the tracking accuracy is poor. When the neural network is added, the system can offset the influence of the disturbance well. Compared with the neural network method, the integral absolute error values of the lateral error, longitudinal error and angular error of the composite control method proposed in the present invention with the addition of the optimization algorithm are reduced by 38.9%, 26.9% and 4.0%, respectively. The integral square error values are reduced by 30.3%, 24.0% and 23.3%, respectively, and the integral time weighted error values are reduced by 68.0%, 71.7% and 11.8%, respectively. In addition, compared with the sliding mode control and neural network control, the mobile robot controlled by the present invention reaches the required linear velocity and angular velocity in a shorter time, showing a faster convergence speed. This improved convergence speed is crucial to maintaining the stability of the mobile robot and ensuring the accuracy of tracking the desired trajectory.
[0150] Table 1
[0151]
[0152] In a feasible implementation, in order to improve the credibility and universality of the results, a tracking control simulation of a mobile robot in a high-speed scenario is added. The model parameters of the mobile robot and the neural network parameters are the same as those in scenario 1. The kinematic controller parameters are: , , The best combination of sliding mode controller parameters after optimization is: , , , , , , , , , , , .
[0153] The expected trajectory is: , The simulated external disturbance is: The expected speed is: , .
[0154] In high-speed scenarios, the mobile robot system can still achieve tracking control performance under the three control modes. Table 2 (Comparison of control results of implementation scenario 2) shows the integral absolute error, integral square error and integral time weighted error values of the three control methods. The results show that the system under the control method proposed by the present invention has a faster convergence speed and more stable tracking performance than the sliding mode control and neural network control methods. The anti-interference ability of the system is significantly enhanced, and due to the addition of the IDBO algorithm, the adaptability of the system parameters is greatly enhanced, enabling the system to perform excellent performance in various complex environments.
[0155] Compared with the neural network control method, the integrated absolute error values of the lateral error, longitudinal error and angular error of the composite method were reduced by 58.3%, 76.0% and 58.1% respectively. The integrated square error values were reduced by 63.6%, 90.1% and 66.2% respectively, and the integrated time-weighted error values were reduced by 76.7%, 68.8% and 75.6% respectively. In addition, under the control method of the present invention, the mobile robot can quickly reach the required linear velocity and angular velocity, so that the robot can quickly adjust its posture to ensure the stability of the system.
[0156] Table 2
[0157]
[0158] In a feasible implementation, in order to verify the optimization performance of the IDBO algorithm, the algorithm is applied to the above two scenarios of the mobile robot trajectory tracking system. In order to show that the IDBO algorithm is superior to other optimization algorithms, it is compared with other well-studied optimization techniques, such as Grey Wolf Optimizer (GWO), Whale Optimization Algorithm (WOA), Gaussian Quantum Improved Particle Swarm Optimization (GQPSO), Joint Approximate Diagonalization of Eigenmatrices (JADE), Adaptive Gaining-Sharing Knowledge Based Algorithm (AGSK), Newton-Raphson-based Optimizer (NRBO), Secretary Bird Optimization Algorithm (SBOA), and Dung Beetle Optimizer (DBO). Their computational costs are compared and analyzed to show the difference in computational time between algorithms.
[0159] By observing the convergence curves of the experimental results of optimization methods such as the IDBO algorithm in the mobile robot tracking system, it is found that the convergence curve of IDBO has multiple turning points, indicating that the IDBO algorithm can balance the ability of local search and global search to avoid the algorithm from falling into the local optimum. The convergence speed and convergence accuracy of the IDBO method are better than other optimization methods. From Table 3 (comparison table of experimental results of two scenarios), it can be seen that IDBO has the best ranking in terms of time spent and the best score. The results show that compared with other excellent optimization algorithms, the IDBO algorithm can find the global optimal solution faster, which effectively proves that IDBO is the most effective method to solve practical engineering design problems.
[0160] Table 3
[0161]
[0162] The present invention proposes a robot adaptive tracking control method based on an improved dung beetle optimization algorithm. Based on the kinematic and dynamic models of the mobile robot, a sliding mode variable structure torque controller based on the combined reaching law is designed to ensure speed tracking, so that the system can better solve the chattering problem. In view of the unknown external interference faced by the mobile robot system, an adaptive RBF neural network is designed. It can reduce the impact of interference on the system and improve the robustness and tracking performance of the system. Through the improved dung beetle optimization algorithm, the adaptability of controller parameter setting is enhanced, and the robustness and tracking performance of the system are improved. The present invention takes into account the external interference of the mobile robot and designs a control method based on the improved dung beetle optimization algorithm, which can effectively suppress the interference received by the mobile robot system and can accurately track the desired trajectory. The present invention is an adaptive tracking control method with high accuracy and good robustness for robot movement.
[0163] Figure 3 The block diagram of a robot adaptive tracking control device based on an improved dung beetle optimization algorithm is shown according to an exemplary embodiment. The device is used in a robot adaptive tracking control method based on an improved dung beetle optimization algorithm. Figure 1 The device includes an information acquisition module 310, a model building module 320, a kinematic controller building module 330, a first dynamics controller building module 340, a second dynamics controller building module 350, a third dynamics controller building module 360, an adaptive tracking controller building module 370 and a robot motion control module 380. Among them:
[0164] The information acquisition module 310 is used to acquire the parameters of the mobile robot; the sensor is used to collect data on the motion state of the mobile robot to obtain motion state information;
[0165] A model building module 320 is used to build a model according to robot parameters and motion state information to obtain a robot kinematic model and a robot dynamic model;
[0166] A kinematic controller building module 330 is used to design a controller using a backstepping method according to a robot kinematic model to obtain a kinematic controller;
[0167] A first dynamics controller building module 340 is used to design a controller according to the robot dynamics model by using a sliding mode control method based on a combined reaching law to obtain a first dynamics controller;
[0168] A second dynamics controller building module 350 is used to compensate for the interference effect of the motion control by using an adaptive RBF neural network based on the first dynamics controller and according to the robot dynamics model, so as to obtain a second dynamics controller;
[0169] A third dynamics controller building module 360 is used to optimize the parameters of the second dynamics controller using an improved dung beetle optimization algorithm to obtain a third dynamics controller;
[0170] An adaptive tracking controller building module 370, used to obtain an adaptive tracking controller according to the kinematic controller and the third dynamic controller;
[0171] The robot motion control module 380 is used to obtain a desired motion trajectory; according to the desired motion trajectory, motion control is performed through an adaptive tracking controller of the mobile robot.
[0172] Optionally, the kinematic controller construction module 330 is further configured to:
[0173] Determine the displacement error based on the robot kinematic model;
[0174] According to the robot kinematics model and displacement error, the function is constructed to obtain the Lyapunov function of the mobile robot motion;
[0175] Calculate according to Lyapunov function and get the speed control law;
[0176] According to the speed control law, the controller is designed by backstepping method to obtain the kinematic controller.
[0177] Optionally, the first dynamics controller construction module 340 is further configured to:
[0178] Determine the actual-output linear velocity error and the actual-output angular velocity error according to the robot dynamics model;
[0179] Construct a torque control law based on the actual-output linear velocity error and the actual-output angular velocity error;
[0180] The sliding surface is designed according to the robot dynamics model to obtain the proportional-integral sliding surface;
[0181] Based on the sliding mode motion law of the mobile robot, the combined reaching law is constructed using the exponential reaching law and the variable speed reaching law.
[0182] The sliding mode controller is constructed according to the torque control law, proportional-integral sliding surface and combined reaching law to obtain the first dynamics controller.
[0183] Optionally, the second dynamics controller construction module 350 is further configured to:
[0184] Determining an actual-output linear velocity error, an actual-output angular velocity error, an actual-output linear velocity error derivative, and an actual-output angular velocity error derivative according to a robot dynamics model;
[0185] The actual-output linear velocity error, the actual-output angular velocity error, the actual-output linear velocity error derivative and the actual-output angular velocity error derivative are input into the adaptive RBF neural network to simulate the interference effect and obtain the approximate value of the interference term;
[0186] The interference term is replaced according to the preset adaptive rate, the interference term approximation and the torque control law to obtain the second torque control law;
[0187] The sliding mode controller is constructed according to the second torque control law to obtain the second dynamics controller.
[0188] Optionally, the third dynamics controller construction module 360 is further configured to:
[0189] According to the second dynamic controller, controller parameters are obtained; the controller parameters are used as dung beetle population parameters; the dung beetle population parameters are initialized;
[0190] The absolute value integral of time-error is used as the optimization target of the improved dung beetle optimization algorithm;
[0191] Calculate the position of dung beetles according to the population parameters of dung beetles to obtain the position of dung beetles;
[0192] Calculate according to the dung beetle population parameters and optimization objectives to obtain the parameter fitness value;
[0193] Based on the parameter fitness value, the position of the dung beetle is optimized and adjusted to obtain the optimal dung beetle position; according to the optimal dung beetle position, the optimal controller parameters corresponding to the optimal dung beetle position are obtained;
[0194] The optimal controller parameters are input into the second dynamics controller to obtain the third dynamics controller.
[0195] Among them, the improved dung beetle optimization algorithm is an improved algorithm that introduces cube chaos theory and reverse refraction mechanism into the dung beetle optimization algorithm.
[0196] The present invention proposes a robot adaptive tracking control method based on an improved dung beetle optimization algorithm. Based on the kinematic and dynamic models of the mobile robot, a sliding mode variable structure torque controller based on the combined reaching law is designed to ensure speed tracking, so that the system can better solve the chattering problem. In view of the unknown external interference faced by the mobile robot system, an adaptive RBF neural network is designed. It can reduce the impact of interference on the system and improve the robustness and tracking performance of the system. Through the improved dung beetle optimization algorithm, the adaptability of controller parameter setting is enhanced, and the robustness and tracking performance of the system are improved. The present invention takes into account the external interference of the mobile robot and designs a control method based on the improved dung beetle optimization algorithm, which can effectively suppress the interference received by the mobile robot system and can accurately track the desired trajectory. The present invention is an adaptive tracking control method with high accuracy and good robustness for robot movement.
[0197] Figure 4 is a schematic diagram of the structure of an adaptive tracking control device provided by an embodiment of the present invention, such as Figure 4 As shown, the adaptive tracking control device may include the above Figure 3 The robot adaptive tracking control device based on the improved dung beetle optimization algorithm is shown. Optionally, the adaptive tracking control device 410 may include a first processor 2001.
[0198] Optionally, the adaptive tracking control device 410 may further include a memory 2002 and a transceiver 2003 .
[0199] The first processor 2001, the memory 2002 and the transceiver 2003 may be connected via a communication bus.
[0200] Combine the following Figure 4 The components of the adaptive tracking control device 410 are specifically introduced as follows:
[0201] The first processor 2001 is the control center of the adaptive tracking control device 410, and may be a processor or a general term for multiple processing elements. For example, the first processor 2001 is one or more central processing units (CPUs), or may be application specific integrated circuits (ASICs), or may be configured to implement one or more integrated circuits of the embodiments of the present invention, such as one or more microprocessors (digital signal processors, DSPs), or one or more field programmable gate arrays (field programmable gate arrays, FPGAs).
[0202] Optionally, the first processor 2001 may perform various functions of the adaptive tracking control device 410 by running or executing a software program stored in the memory 2002 and calling data stored in the memory 2002 .
[0203] In a specific implementation, as an embodiment, the first processor 2001 may include one or more CPUs, such as Figure 4 CPU0 and CPU1 are shown in FIG.
[0204] In a specific implementation, as an embodiment, the adaptive tracking control device 410 may also include multiple processors, such as Figure 4 The first processor 2001 and the second processor 2004 are shown in FIG. Each of these processors may be a single-core processor (single-CPU) or a multi-core processor (multi-CPU). The processor here may refer to one or more devices, circuits, and / or processing cores for processing data (e.g., computer program instructions).
[0205] The memory 2002 is used to store the software program for executing the solution of the present invention, and is controlled to be executed by the first processor 2001. The specific implementation method can refer to the above method embodiment, which will not be repeated here.
[0206] Optionally, the memory 2002 may be a read-only memory (ROM) or other types of static storage devices that can store static information and instructions, a random access memory (RAM) or other types of dynamic storage devices that can store information and instructions, or an electrically erasable programmable read-only memory (EEPROM), a compact disc read-only memory (CD-ROM) or other optical disc storage, optical disc storage (including compressed optical disc, laser disc, optical disc, digital versatile disc, Blu-ray disc, etc.), a magnetic disk storage medium or other magnetic storage device, or any other medium that can be used to carry or store the desired program code in the form of instructions or data structures and can be accessed by a computer, but is not limited thereto. The memory 2002 may be integrated with the first processor 2001, or may exist independently, and may be accessed through the interface circuit ( Figure 4 (not shown) is coupled to the first processor 2001, which is not specifically limited in this embodiment of the present invention.
[0207] The transceiver 2003 is used to communicate with a network device or a terminal device.
[0208] Optionally, the transceiver 2003 may include a receiver and a transmitter ( Figure 4 The receiver is used to implement a receiving function, and the transmitter is used to implement a sending function.
[0209] Optionally, the transceiver 2003 may be integrated with the first processor 2001, or may exist independently and be controlled through the interface circuit ( Figure 4 (not shown) is coupled to the first processor 2001, which is not specifically limited in this embodiment of the present invention.
[0210] It should be noted that Figure 4 The structure of the adaptive tracking control device 410 shown in the figure does not constitute a limitation on the router, and the actual knowledge structure recognition device may include more or fewer components than shown in the figure, or combine certain components, or arrange the components differently.
[0211] In addition, the technical effects of the adaptive tracking control device 410 can refer to the technical effects of the robot adaptive tracking control method based on the improved dung beetle optimization algorithm described in the above method embodiment, which will not be repeated here.
[0212] It should be understood that the first processor 2001 in the embodiment of the present invention may be a central processing unit (CPU), and the processor may also be other general-purpose processors, digital signal processors (DSP), application specific integrated circuits (ASIC), field programmable gate arrays (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or the processor may also be any conventional processor, etc.
[0213] It should also be understood that the memory in the embodiments of the present invention may be a volatile memory or a non-volatile memory, or may include both volatile and non-volatile memories. Among them, the non-volatile memory may be a read-only memory (ROM), a programmable read-only memory (PROM), an erasable programmable read-only memory (EPROM), an electrically erasable programmable read-only memory (EEPROM), or a flash memory. The volatile memory may be a random access memory (RAM), which is used as an external cache. By way of example and not limitation, many forms of random access memory (RAM) are available, such as static RAM (SRAM), dynamic random access memory (DRAM), synchronous DRAM (SDRAM), double data rate synchronous dynamic random access memory (DDR SDRAM), enhanced synchronous dynamic random access memory (ESDRAM), synchronous link DRAM (SLDRAM), and direct rambus RAM (DR RAM).
[0214] The above embodiments can be implemented in whole or in part by software, hardware (such as circuits), firmware or any other combination. When implemented by software, the above embodiments can be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer instructions or computer programs. When the computer instructions or computer programs are loaded or executed on a computer, the process or function described in the embodiment of the present invention is generated in whole or in part. The computer can be a general-purpose computer, a special-purpose computer, a computer network, or other programmable device. The computer instructions can be stored in a computer-readable storage medium, or transmitted from one computer-readable storage medium to another computer-readable storage medium. For example, the computer instructions can be transmitted from one website, computer, server or data center to another website, computer, server or data center by wired (such as infrared, wireless, microwave, etc.). The computer-readable storage medium can be any available medium that can be accessed by a computer or a data storage device such as a server or data center that contains one or more available media sets. The available medium can be a magnetic medium (for example, a floppy disk, a hard disk, a tape), an optical medium (for example, a DVD), or a semiconductor medium. The semiconductor medium can be a solid-state hard disk.
[0215] It should be understood that the term "and / or" in this article is only a description of the association relationship of associated objects, indicating that there can be three relationships. For example, A and / or B can represent: A exists alone, A and B exist at the same time, and B exists alone. A and B can be singular or plural. In addition, the character " / " in this article generally indicates that the associated objects before and after are in an "or" relationship, but it may also indicate an "and / or" relationship. Please refer to the context for specific understanding.
[0216] In the present invention, "at least one" means one or more, and "plurality" means two or more. "At least one of the following" or similar expressions refers to any combination of these items, including any combination of single items or plural items. For example, at least one of a, b, or c can mean: a, b, c, ab, ac, bc, or abc, where a, b, and c can be single or multiple.
[0217] It should be understood that in various embodiments of the present invention, the size of the serial numbers of the above-mentioned processes does not mean the order of execution. The execution order of each process should be determined by its function and internal logic, and should not constitute any limitation on the implementation process of the embodiments of the present invention.
[0218] Those skilled in the art will appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.
[0219] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the above-described equipment, devices and units can refer to the corresponding processes in the aforementioned method embodiments and will not be repeated here.
[0220] In the several embodiments provided by the present invention, it should be understood that the disclosed devices, apparatuses and methods can be implemented in other ways. For example, the device embodiments described above are only schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another device, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms.
[0221] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0222] In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit.
[0223] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, or the part that contributes to the prior art, or the part of the technical solution, can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions for enabling a computer device (which can be a personal computer, server, or network device, etc.) to perform all or part of the steps of the methods described in various embodiments of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM), random access memory (RAM), disk or optical disk, and other media that can store program codes.
[0224] The above is only a specific embodiment of the present invention, but the protection scope of the present invention is not limited thereto. Any person skilled in the art can easily think of changes or substitutions within the technical scope disclosed by the present invention, which should be included in the protection scope of the present invention. Therefore, the protection scope of the present invention should be based on the protection scope of the claims.
Claims
1. A robot adaptive tracking control method based on improved dung beetle optimization algorithm, It is characterized in that The method comprises: Obtain the parameters of the mobile robot; collect data on the motion state of the mobile robot through sensors to obtain motion state information; Constructing a model based on the robot parameters and motion state information to obtain a robot kinematic model and a robot dynamic model; According to the robot kinematic model, a controller is designed by adopting a backstepping method to obtain a kinematic controller; According to the robot dynamics model, a sliding mode control method based on a combined reaching law is used to design a controller to obtain a first dynamics controller; Based on the first dynamics controller and according to the robot dynamics model, an adaptive RBF neural network is used to compensate for the interference effect of the motion control to obtain a second dynamics controller; Using an improved dung beetle optimization algorithm, the parameters of the second dynamics controller are optimized to obtain a third dynamics controller; Obtaining an adaptive tracking controller according to the kinematic controller and the third dynamics controller; Obtaining a desired motion trajectory; and performing motion control by the adaptive tracking controller of the mobile robot according to the desired motion trajectory.
2. The robot adaptive tracking control method based on the improved dung beetle optimization algorithm according to claim 1, It is characterized in that The controller design is performed according to the robot kinematic model by using the backstepping method to obtain the kinematic controller, including: determining a displacement error according to the robot kinematic model; Constructing a function according to the robot kinematics model and the displacement error to obtain a Lyapunov function of the mobile robot motion; Calculating according to the Lyapunov function, obtaining a speed control law; According to the speed control law, a controller is designed by backstepping method to obtain a kinematic controller.
3. The robot adaptive tracking control method based on the improved dung beetle optimization algorithm according to claim 1, It is characterized in that According to the robot dynamics model, a sliding mode control method based on a combined reaching law is used to design a controller to obtain a first dynamics controller, including: Determining an actual-output linear velocity error and an actual-output angular velocity error according to the robot dynamics model; Constructing a torque control law according to the actual-output linear velocity error and the actual-output angular velocity error; Designing a sliding surface according to the robot dynamics model to obtain a proportional-integral sliding surface; Based on the sliding mode motion law of the mobile robot, the combined reaching law is constructed using the exponential reaching law and the variable speed reaching law. A sliding mode controller is constructed according to the torque control law, the proportional-integral sliding mode surface, and the combined reaching law to obtain a first dynamics controller.
4. The robot adaptive tracking control method based on the improved dung beetle optimization algorithm according to claim 3, It is characterized in that The method of compensating the interference effect of the motion control by using an adaptive RBF neural network based on the first dynamics controller according to the robot dynamics model to obtain a second dynamics controller includes: Determining an actual-output linear velocity error, an actual-output angular velocity error, an actual-output linear velocity error derivative, and an actual-output angular velocity error derivative according to the robot dynamics model; Inputting the actual-output linear velocity error, the actual-output angular velocity error, the actual-output linear velocity error derivative and the actual-output angular velocity error derivative into an adaptive RBF neural network to simulate interference effects, and obtain an approximate value of the interference term; Replacing the interference term according to a preset adaptive rate, the interference term approximation and the torque control law to obtain a second torque control law; A sliding mode controller is constructed according to the second torque control law to obtain a second dynamics controller.
5. The robot adaptive tracking control method based on the improved dung beetle optimization algorithm according to claim 1, It is characterized in that The improved dung beetle optimization algorithm is used to optimize the parameters of the second dynamics controller to obtain the third dynamics controller, including: According to the second dynamic controller, controller parameters are obtained; the controller parameters are used as dung beetle population parameters; and the dung beetle population parameters are initialized; The absolute value integral of time-error is used as the optimization target of the improved dung beetle optimization algorithm; Calculating the position of the dung beetle according to the dung beetle population parameters to obtain the position of the dung beetle; Calculating according to the dung beetle population parameters and the optimization target to obtain a parameter fitness value; Based on the parameter fitness value, the dung beetle position is optimized and adjusted to obtain an optimal dung beetle position; according to the optimal dung beetle position, an optimal controller parameter corresponding to the optimal dung beetle position is obtained; The optimal controller parameters are input into the second dynamics controller to obtain a third dynamics controller.
6. The robot adaptive tracking control method based on the improved dung beetle optimization algorithm according to claim 5, It is characterized in that The improved dung beetle optimization algorithm is an improved algorithm that introduces cube chaos theory and reverse refraction mechanism into the dung beetle optimization algorithm.
7. A robot adaptive tracking control device based on an improved dung beetle optimization algorithm, wherein the robot adaptive tracking control device based on the improved dung beetle optimization algorithm is used to implement the robot adaptive tracking control method based on the improved dung beetle optimization algorithm as claimed in any one of claims 1 to 6, It is characterized in that The device comprises: The information acquisition module is used to obtain the parameters of the mobile robot; the motion state of the mobile robot is collected by sensors to obtain motion state information; A model building module, used to build a model according to the robot parameters and motion state information to obtain a robot kinematic model and a robot dynamic model; A kinematic controller building module is used to design a controller using a backstepping method according to the robot kinematic model to obtain a kinematic controller; A first dynamics controller building module is used to design a controller according to the robot dynamics model by using a sliding mode control method based on a combined reaching law to obtain a first dynamics controller; A second dynamics controller building module is used to compensate for the interference effect of the motion control by using an adaptive RBF neural network based on the first dynamics controller and according to the robot dynamics model, so as to obtain a second dynamics controller; A third dynamics controller building module, used to optimize the parameters of the second dynamics controller by using an improved dung beetle optimization algorithm to obtain a third dynamics controller; An adaptive tracking controller building module, used for obtaining an adaptive tracking controller according to the kinematic controller and the third dynamics controller; The robot motion control module is used to obtain a desired motion trajectory; according to the desired motion trajectory, motion control is performed through the adaptive tracking controller of the mobile robot.
8. The robot adaptive tracking control device based on the improved dung beetle optimization algorithm according to claim 7, It is characterized in that The kinematic controller building block is further used to: determining a displacement error according to the robot kinematic model; Constructing a function according to the robot kinematics model and the displacement error to obtain a Lyapunov function of the mobile robot motion; Calculating according to the Lyapunov function, obtaining a speed control law; According to the speed control law, a controller is designed by backstepping method to obtain a kinematic controller.
9. An adaptive tracking control device, It is characterized in that The adaptive tracking control device comprises: processor; A memory having computer-readable instructions stored thereon, wherein when the computer-readable instructions are executed by the processor, the method according to any one of claims 1 to 6 is implemented.
10. A computer-readable storage medium, It is characterized in that The computer-readable storage medium stores program codes, which can be called by a processor to execute the method according to any one of claims 1 to 6.
Citation Information
Patent Citations
Agricultural machine path planning method based on improved WOA algorithm
CN115936274A
Robot path planning method
CN116430873A
Multi-robot task allocation method based on chaos adaptive dung beetle optimization algorithm
CN116777170A
Magnetic-levitation train operation optimization method and system based on improved dung beetle optimization algorithm
CN117034459A
Cutter signal noise reduction method for optimizing wavelet parameters based on IWOA
CN117056674A
Cited By
Mechanical arm control method and device based on multi-objective optimization and electronic equipment
CN119567249A
