Abstract
Mechatronics production line is widely used in the production and operation of all walks of life, which greatly reduces the amount of labor of employees, improves the production level of enterprises, and creates great social and economic benefits for enterprises. The traditional manipulator system has modeling uncertainty and is vulnerable to external interference. In this paper, a compound control scheme is designed by combining the torque controller and fuzzy compensator, which effectively improves the system's response speed and greatly reduces the steady-state tracking error of the system. At the same time, the tracking process of the scheme is stable and flexible, and the chattering is minimal, which effectively improves the trajectory tracking performance of the system. Experiments show that the algorithm effectively solves the contradiction between computational complexity and control accuracy, improves the system's response speed, and reduces the system's steady-state tracking error.
1. Introduction
“Mechatronics” is a composite comprehensive technology closely combined with various technologies, mainly including computer technology, information technology, mechanical technology, electronic technology, and other technologies. “Mechatronics” technology is a new integrated equipment control technology, which organically combines mechanical equipment with electronic equipment and supporting computer software [1]. The most important thing is to use mechanical and electrical technology to replace the most reliable electronic equipment [2]. The outstanding advantages of “mechatronics” are that it improves the equipment's safety, reliability, and performance. Mechatronics equipment has composite technology and composite function. Its self-inspection and monitoring function can automatically take measures against faults to make the work return to normal [3].
Manipulator has the characteristics of large load, low energy consumption, and small volume. It can complete maintenance, butt joint, welding, spraying, handling, and other operations and has been widely used in mechanical manufacturing equipment [4]. The manipulator is composed of multiple rods. Through the manipulation function of the connecting rod structure and the movement function of the moving base, the manipulator has a large working space. The stability of the manipulator is affected by friction, dead zone, and saturation. Through the research on the manipulator's automatic control method, the manipulator's dynamic performance is improved and the adaptability of the manipulator to the production line environment is improved [5].
With the development of the robot arm, it plays a more and more important role in the intelligent process of industrial manufacturing, aerospace, rail transit, and other fields. The increasingly customized and personalized production mode of the manufacturing industry puts forward higher requirements for the trajectory tracking control of the manipulator, which makes improving the trajectory tracking accuracy of the manipulator and enhancing its adaptability to different environments and tasks become the key technical problems to be solved in the application of the manipulator [6]. Due to the influence of uncertain factors such as modeling error, signal detection error, and external environmental interference, it brings great challenges to the control of manipulator. Therefore, scholars at home and abroad have proposed a variety of intelligent control strategies to improve the accuracy of manipulator trajectory tracking. The trajectory tracking control of manipulator based on the adaptive method has also been widely studied [7].
The adaptive algorithm can solve the problem of online estimation of unknown parameters in the manipulator model. On this basis, combined with the fuzzy control method, it can further improve the response speed and trajectory tracking accuracy of the manipulator [8]. Fayazi et al. [9] proposed an impedance sliding mode control method for the position and force control of manipulator. Literature [10] aims at the posture adjustment of minimally invasive surgical robot. Through the combination of fuzzy theory and reinforcement learning, it can adaptively adjust the model to respond to the intention of the controller and has good controllability. Li and Adeli [11] designed a hierarchical fuzzy control algorithm to actively suppress the vibration of flexible rod and improve the calculation efficiency of fuzzy controller. Urrea et al. [12] proposed a variable universe fuzzy adaptive control method, which solves the problem of inaccurate control in traditional fuzzy control. Llama et al. [13] realized the control of nonlinear systems such as four-stage inverted pendulum by using the variable universe fuzzy method. Zhang et al. [14] used the variable universe method to realize the vehicle lateral autonomous control. Ziani [15] introduced the idea of variable universe into the membership function of fuzzy control and designed the adaptive law of input function, which is suitable for nonlinear, time-varying, and complex uncertain systems. Li et al. [16] used fuzzy neural network to adjust the universe of T-S fuzzy controller variables, which improves the stability of vehicles during driving. Li et al. [17] solved the lateral vibration problem of urban rail train suspension system by using the explicit genetic fuzzy control method. Kassem et al. [18] adopted the double-loop hybrid control method to control the load frequency in the power grid. The internal loop adopts variable universe fuzzy to reduce the load disturbance, and the external loop uses incremental genetic algorithm to optimize the control parameters online. Du et al. [19] applied genetic variable universe fuzzy controller to the control of train lateral semi-active suspension system and achieved good control effect. Hrama et al. [20] studied the temperature control of evaporation source by using the variable universe fuzzy adaptive PID method. Wang et al. [21] analyzed the approximation conditions of variable universe fuzzy controller.
Due to the influence of uncertain factors such as modeling error, signal detection error, and external environmental interference, it brings great challenges to the control of manipulator. In this paper, the manipulator’s dynamic model and parameter uncertainty are considered. In order to improve the trajectory tracking accuracy of the manipulator, a composite control scheme is given by combining the nominal calculated torque controller and the variable universe fuzzy compensator method. The variable universe adaptive fuzzy controller is used to estimate and compensate the modeling uncertainty. The calculated torque controller is used to solve the nominal system control torque to reduce the mechanical trajectory tracking error, improve the trajectory tracking speed, and ensure the trajectory tracking performance. The experimental results show that the algorithm improves the system's response speed, reduces the system tracking error, and improves the overall performance.
2. Methodology
2.1. Variable Universe Fuzzy Adaptive Control
2.1.1. Basic Principles
Under the premise that the fuzzy rules remain unchanged, the scope of the variable universe fuzzy control system changes according to the change of the feedback error information. When the feedback error decreases, the reduction of the universe is equivalent to adding the number of rules to improve the control accuracy. When the feedback error increases, the increase of the universe is equivalent to reducing the number of rules and improving the convergence speed. Its essence is a dynamic point-by-point convergence interpolator.
Let be a set of fuzzy sets on a given domain I and be the peak of , if for any ,is established, and when , , is called the primitive of G, and G is called a primitive of I. Further, if and any adjacent primitives and satisfythen is called biphasic base tuple on . In particular, if is a linear function, is called a biphasic linear basis on . Considering the dual-input single-output manipulator system, the two input domains are given as and , where represents the trajectory tracking error domain, J represents the tracking error change rate domain, and is affected by . and are biphasic linear basis tuples on universe and , respectively. The single-output universe is , which represents the uncertainty compensation torque, and is the linear base on it.
The control structure is shown in Figure 1. z is the sampling time, and are the peak values of and fuzzy single value element at z time, respectively. and are the membership functions of deviation and deviation change rate at time z; then, a set of dynamic control rules can be obtained:
Then, the control function can be written as
2.1.2. Dual-Input Single-Output Variable Universe Fuzzy Control Algorithm
The algorithm steps are as follows.(1)Step 0: the initial value of the system input is , and the output is(2)Step 1: after acts on the object, the system output is generated. After comparing the output with the reference input, it is obtained that the input of the system controller is , and the output is(3)Step z: acts on the object to generate the system output. After the output is compared with the reference input, the input of the system controller is obtained; then, the controller output is
Since at any time, there is , that is, there is . Then, when , that is, the dual-input single-output system based on variable universe fuzzy control is convergent.
2.2. Design of Manipulator Controller
2.2.1. Controller Structure Design
In order to overcome the influence of uncertain factors and unknown disturbances on the trajectory tracking performance of manipulator, a composite controller was designed, composed of a computational torque controller and a variable theory domain fuzzy compensation controller . As shown in Figure 2, represents the expected value, represents the actual value, and the input torque of the manipulator is .
As can be seen from Figure 2, the controller's input is the trajectory tracking error and its change rate becomes a dimensionless value after corresponding quantization factors and , and their changes lead to the change of expansion factor . The controller's output is converted into by the proportional factor , and the output of the calculated torque constitutes the control torque of the manipulator.
2.2.2. Control Policy
Let be the actual measured values of angular displacement, angular velocity, and angular acceleration of the manipulator under consideration, respectively, and are the desired angular displacement and angular velocity; then, the tracking error can be taken as
Obviously, when there is no modeling uncertainty and external interference, if the error systemis established, then each joint of the manipulator can accurately track the desired trajectory, where are undetermined coefficients. In addition, the nominal dynamic model of the manipulator is
For nominal system (10), its control law is
Then, the above formula can be obtained simultaneously.
According to (12), the uncertainty contained in the controller will affect the stability of the system, so it needs to be compensated. The uncertain term in (12) is
To compensate for the influence on system stability, was identified. Therefore, the control law given in (11) is modified as
On this basis, the variable theory domain adaptive fuzzy compensator is used to approximate the uncertain term . Let be the estimate of , and its expression is
The adaptive fuzzy compensation term in the control system can be defined aswhere is a fuzzy basis function vector, is a weight vector, and its optimal value satisfies
According to (11) and (16), (14) can be further written as
Substitute it into (12) and obtainwhere is the approximation error term of the adaptive fuzzy compensator. If the output error vector of the manipulator is , the state space expression of the closed-loop error equation of the system shown in (19) is
Among them, .
Combining (18)–(20), the uncertain term can be further expressed as
Substituting (21) into (16), the fuzzy output factor in the variable theory domain affects the fuzzy basis function vector. Therefore, the variable theory domain adaptive compensator can be further expressed as
Take the Lyapunov function aswhere is a positive definite matrix and satisfies the following equation.where . Let , where is an estimate of . From the adaptive control law,
The derivative of (23) can be obtained:
Since is the minimum approximation error, according to the approximation theory of fuzzy control, as the eigenvalue of increases, the eigenvalue of decreases, and can be sufficiently small, which can be obtained from (26).
Substitute adaptive control law (25) into (27) and obtain
So, when , . In other words, under this condition, the manipulator system based on variable theory domain adaptive fuzzy control is asymptotically stable, and the tracking effect is better with the smaller upper bound of fuzzy control error .
3. Result Analysis and Discussion
3.1. Establishment of Mechanical Arm Structure Model
FANUC100i six-degree-of-freedom manipulator is selected in the experiment, and J1–J6 are defined as six steering joints of the manipulator system. Firstly, the manipulator system is modeled and analyzed by MATLAB software, and the D-H parameters of the system are determined. In the manipulator link coordinate system, is the length of each link, is the offset of each link, and is the rotation angle of the joint. Limited by the range of motion of the manipulator, the corresponding range needs to be set for the variation of the offset distance of the connecting rod and the selection angle of the joint. The specific parameters of D-H are shown in Table 1.
3.2. Tracking Deviation of Manipulator Joint Curve
Input the interpolation point data of the manipulator generated by the interpolation algorithm into the MATLAB software to generate the motion trajectory of the manipulator, as shown in Figure 3.
During the movement of the manipulator, the compound control scheme is used to participate in the real-time deviation correction of the motion trajectory. In the experiment, the deviation degree between the actual movement curve and the expected curve of the six joints under different control algorithms is analyzed. The movement and rotation data of joints 1–6 are statistically analyzed, as shown inFigures 4–6.
Contrast to the actual control effect of various trajectory control algorithms, the control effect of the compound control scheme in this paper is closer to the theoretical expected curve trajectory, and the tracking deviation is obviously less than the control scheme in literature [22] and literature [23]. The higher the complexity of the manipulator, the larger the deviation of the traditional scheme in the complex dynamic displacement and joint rotation. Especially in the first joint and the end joint, there is a greater control error, which directly affects the operation accuracy of the end effector. The compound control scheme combining the nominal calculated torque controller and variable universe fuzzy compensator can realize the step-by-step control of multiple joints and ensure the control accuracy of the manipulator.
3.3. Algorithm Complexity Analysis
On the one hand, the complexity of the algorithm in this paper will affect the manipulator control's response time and affect the applicability of the algorithm. The lower the complexity of the algorithm, the shorter the response time. The specific verification process is as follows.(1)Set the time point at the beginning of the manipulator trajectory control movement and start timing.(2)Solve the time interval at the adjacent interpolation points and record the response time and interval time in 10 times. The faster the response time and the shorter the intermediate interval, the better the applicability of the composite control scheme and the lower the complexity.
The data results based on MATLAB are shown in Tables 2 and 3.
In terms of system response time, the automatic generation time and interjoint acceleration time of this algorithm are 0.304 and 0.194 s, respectively, which are greatly reduced compared with the traditional methods. This is mainly due to the better control effect of the manipulator in the initial moving state. The system has better training effect on motion position movement data and joint rotation data. The complexity of network parameter selection is lower, which ensures faster system response speed.
Under this algorithm, the interval between information generation and instruction transmission between joints is very short. The automatic generation strategy of system instructions reduces the unnecessary parameter transmission between joints, reduces the burden of message transmission, and effectively makes up for the problem of weak real time and applicability of the system caused by the deviation correction of this algorithm.
3.4. Pose Accuracy Test
The pose accuracy of the method in this paper, the method in literature [24], and the method in literature [25] is tested, and the test results are shown in Figure 7.
(a)
(b)
(c)
It can be seen from Figure 7 that the pose accuracy of the method in this paper is higher than that of the method in literature [24] and literature [25], the method in this paper is basically consistent with the real pose of the manipulator, and the result shows effective improvement of the pose accuracy.
4. Conclusion
In this paper, a compound control scheme combining nominal calculated torque controller and variable universe fuzzy compensator is designed, in which the variable universe adaptive fuzzy controller is used to estimate and compensate the modeling uncertainty, and the calculated torque controller is used to solve the nominal system control torque. The adaptive law designed for the scaling factor can make the controller suitable for different regions of the state space at different times. By improving the system's response speed, the steady-state tracking error of the system is greatly reduced. At the same time, the minimal vibration also ensures that the tracking process is more stable and flexible and effectively improves the trajectory tracking performance of the system. By constructing the system model, the performance of the algorithm is verified. The results show that this model has obvious advantages in trajectory deviation control, algorithm complexity, and pose accuracy. In the future, how to ensure the stability of fuzzy control system, that is, how to solve the problems of stability and robustness in fuzzy control, will be the focus of the next research.
Data Availability
The labeled dataset used to support the findings of this study is available from the corresponding author upon request.
Conflicts of Interest
The author declares that there are no conflicts of interest.
Acknowledgments
This study was supported by the Science and Technology Research Program of Chongqing Municipal Education Commission (grant no. KJQN202103204).