Motion Trajectory Control System for Production Line Robots Based on Variable Domain Fuzzy Control

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 benets for enterprises. e traditional manipulator system hasmodeling 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 eectively 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 exible, and the chattering is minimal, which eectively improves the trajectory tracking performance of the system. Experiments show that the algorithm eectively solves the contradiction between computational complexity and control accuracy, improves the system’s response speed, and reduces the system’s steady-state tracking error.


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]. e most important thing is to use mechanical and electrical technology to replace the most reliable electronic equipment [2]. e 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]. e manipulator is composed of multiple rods. rough the manipulation function of the connecting rod structure and the movement function of the moving base, the manipulator has a large working space. e stability of the manipulator is a ected by friction, dead zone, and saturation. rough 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 elds. e 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 di erent environments and tasks become the key technical problems to be solved in the application of the manipulator [6]. Due to the in uence of uncertain factors such as modeling error, signal detection error, and external environmental interference, it brings great challenges to the control of manipulator. erefore, scholars at home and abroad have proposed a variety of intelligent control strategies to improve the accuracy of manipulator trajectory tracking.
e trajectory tracking control of manipulator based on the adaptive method has also been widely studied [7]. e 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. rough 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. e 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. e variable universe adaptive fuzzy controller is used to estimate and compensate the modeling uncertainty. e 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. e experimental results show that the algorithm improves the system's response speed, reduces the system tracking error, and improves the overall performance.

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-bypoint convergence interpolator. Let be a set of fuzzy sets on a given domain I and i x be the peak of G x , if for any i ∈ I, is established, and when , G x is called the primitive of G, and G is called a primitive of I. Further, if i ≠ i x and any adjacent primitives G x and G x+1 satisfy then G is called biphasic base tuple on I. In particular, if G(i) is a linear function, G is called a biphasic linear basis on I.
Considering the dual-input single-output manipulator system, the two input domains are given as where I represents the trajectory tracking error domain, J represents the tracking error change rate domain, and J is affected by are biphasic linear basis tuples on universe I and J, respectively. e single-output universe is K � [−P, P], which represents the uncertainty compensation torque, and C � k xy is the linear base on it.
e control structure is shown in Figure 1. z is the sampling time, and i z x , j z x , k z x are the peak values of i x , j x and fuzzy single value element k x at z time, respectively. G x (i z , z) and H y (i z , z) are the membership functions of deviation and deviation change rate at time z; then, a set of dynamic control rules can be obtained: 2 Advances in Multimedia en, the control function can be written as

Dual-Input Single-Output Variable Universe Fuzzy
Control Algorithm. e algorithm steps are as follows. (1) Step 0: the initial value of the system input is i 0 ∈ I, j 0 ∈ J, and the output is (2) Step 1: after k 1 x 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 i 1 x , and the output is (3) Step z: k z acts on the object to generate the system output. After the output is compared with the ref- of the system controller is obtained; then, the controller output is Since en, when i z ⟶ 0, j z ⟶ 0, that is, the dualinput single-output system based on variable universe fuzzy control is convergent.

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 τ c and a variable theory domain fuzzy compensation controller p f (e, _ e). As shown in Figure 2, v d represents the expected value, v represents the actual value, and the input torque of the manipulator is τ � τ c + p f (e, _ e). As can be seen from Figure 2, the controller's input is the trajectory tracking error e and its change rate ec becomes a dimensionless value e t after corresponding quantization factors Ze and Zec, and their changes lead to the change of expansion factor α(i), β(i, j), c(i). e controller's output is converted into p f (e, _ e) by the proportional factor Zp, and the output τ c of the calculated torque constitutes the control torque of the manipulator.

Control Policy.
Let v, _ v, € v be the actual measured values of angular displacement, angular velocity, and angular acceleration of the manipulator under consideration, respectively, and v d , _ v d 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 system is established, then each joint of the manipulator can accurately track the desired trajectory, where z u , z q are undetermined coefficients. In addition, the nominal dynamic model of the manipulator is Figure 1: Structure diagram of variable universe fuzzy control system.

Advances in Multimedia
For nominal system (10), its control law is en, 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. e uncertain term in (12) is To compensate for the influence on system stability, a was identified. erefore, the control law given in (11) is modified as On this basis, the variable theory domain adaptive fuzzy compensator p f (e, _ e) is used to approximate the uncertain term a. Let a(i) be the estimate of a, and its expression is e adaptive fuzzy compensation term p f (e, _ e) in the control system can be defined as where ξ 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 obtain where ε is the approximation error term of the adaptive fuzzy compensator. If the output error vector of the manipulator is i � [e N , _ e N ], 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 a can be further expressed as a(i|Θ) � Θ * ξ + ε.
Substituting (21) into (16), the fuzzy output factor c(k) in the variable theory domain affects the fuzzy basis function vector. erefore, the variable theory domain adaptive compensator can be further expressed as Take the Lyapunov function as where U is a positive definite matrix and satisfies the following equation.
From the adaptive control law,   Advances in Multimedia e derivative of (23) can be obtained: Since ε is the minimum approximation error, according to the approximation theory of fuzzy control, as the eigenvalue of V increases, the eigenvalue of U decreases, and ε can be sufficiently small, which can be obtained from (26).
Substitute adaptive control law (25) into (27) and obtain 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 ε.

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, h i is the length of each link, b i is the offset of each link, and β i 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. e specific parameters of D-H are shown in Table 1.

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. e 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]. e 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. e compound control scheme combining the nominal calculated torque controller and variable universe fuzzy compensator can realize the step-bystep control of multiple joints and ensure the control accuracy of the manipulator.

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. e lower the complexity of the algorithm, the shorter the response time. e specific verification process is as follows.
(1) Set the time point at the beginning of the manipulator trajectory control movement and start timing. is is mainly due to the better control effect of the manipulator in the initial moving state. e system has better training effect on motion position movement data and joint rotation data. e 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. e 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.

Pose Accuracy Test.
e 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.
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,

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. e 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. e 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
e labeled dataset used to support the findings of this study is available from the corresponding author upon request.

Conflicts of Interest
e author declares that there are no conflicts of interest.