Trajectory tracking control method for automatic feeding and discharging robot of steel shaft production line

By designing a fractional-order fuzzy PID controller, the problem of insufficient accuracy and stability of traditional control methods in complex steel shaft production line environments is solved, and higher trajectory tracking accuracy and response speed are achieved, improving the overall performance of the production line.

CN119057793AInactive Publication Date: 2024-12-03刘思敏

Patent Information

Application Number
CN202411474569.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-10-22
Publication Date
2024-12-03
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

Traditional robot control methods, such as PID controllers, are difficult to cope with the system's nonlinearity, time-varying and external interference in complex steel shaft production line environments, resulting in a decrease in control accuracy, slower response speed, and even control instability, affecting the production line. stability and production capacity.

Method used

A fractional-order fuzzy PID controller is designed. By obtaining the expected end of the robot arm, the error function is established, and the fractional-order PID controller is designed according to the error function, and further adjusting it to a fuzzy fractional-order PID controller. , to improve trajectory tracking accuracy and anti-interference ability.

Benefits of technology

Achieve higher trajectory tracking accuracy and response speed in complex environments, enhance the adaptability and robustness of the robot, reduce the occurrence of failures, ensure the continuity and stability of the production line, and improve the automation level and production efficiency. .

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119057793A_ABST
    Figure CN119057793A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of mechanical arm control, in particular to a trajectory tracking control method for an automatic feeding and discharging robot of a steel shaft production line. The method comprises the following steps that firstly, according to the feeding and discharging process of the steel shaft production line, an expected tail end grabbing point of a mechanical arm is obtained, and a coordinate transformation matrix of the mechanical arm is established; then, an expected joint angle is obtained according to the expected tail end grabbing point and the coordinate transformation matrix, and an expected track is obtained according to the expected joint angle; thirdly, establishing an error function according to the expected trajectory; and finally, according to the error function, designing a fractional order PID controller, and according to the fractional order PID controller, designing a fuzzy fractional order PID controller.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of robot arm control, and in particular to a trajectory tracking control method for an automatic loading and unloading robot of a steel shaft production line. Background Art

[0002] With the continuous improvement of the level of automation in modern industry, automatic loading and unloading robots in steel shaft production lines have gradually become key equipment for improving production efficiency and reducing labor costs. These robots perform key tasks on the production line, such as moving steel shafts from one station to another, or loading finished steel shafts onto transport vehicles. The accuracy and efficiency of these operations are directly related to the operating efficiency and product quality of the entire production line. However, due to the complexity and variability of the steel shaft production environment, traditional control methods have shown many shortcomings in dealing with these challenges.

[0003] Traditional robot control methods, such as PID controllers, are usually used to achieve trajectory tracking control of robots. However, in complex industrial environments such as steel shaft production lines, PID controllers often have difficulty coping with factors such as system nonlinearity, time-varying, and external interference. These factors can lead to reduced robot control accuracy, slower response speed, and even control instability. In this case, the robot's work efficiency and product quality will be negatively affected, which in turn affects the stability and capacity of the entire production line. For complex industrial environments, control methods need to have stronger adaptability and robustness to cope with various uncertainties that may arise in the production process. By optimizing the control strategy, enabling the robot to complete tasks stably and efficiently in a complex and changing environment has become the key to improving the overall performance of the production line.

[0004] Therefore, a trajectory tracking control method for an automatic loading and unloading robot in a steel shaft production line is proposed. This method designs a fractional-order fuzzy PID controller to provide a more stable trajectory tracking control, thereby improving the working efficiency of the automatic loading and unloading robot and the overall performance of the system. Summary of the invention

[0005] The present invention provides a trajectory tracking control method for an automatic loading and unloading robot of a steel shaft production line, which is used to solve the above technical problems. First, according to the loading and unloading process of the steel shaft production line, the expected end grasping point of the robot arm is obtained and the coordinate transformation matrix of the robot arm is established; then, the expected joint angle is obtained according to the expected end grasping point and the coordinate transformation matrix, and the expected trajectory is obtained according to the expected joint angle; then, an error function is established according to the expected trajectory; finally, a fractional-order PID controller is designed according to the error function, and a fuzzy fractional-order PID controller is designed according to the fractional-order PID controller.

[0006] A trajectory tracking control method for an automatic loading and unloading robot of a steel shaft production line comprises the following steps:

[0007] S1. According to the loading and unloading process of the steel shaft production line, the desired end grasping point of the robot arm is obtained and the coordinate transformation matrix of the robot arm is established;

[0008] S2, obtaining an expected joint angle according to the expected end grasping point and the coordinate transformation matrix, and obtaining an expected trajectory according to the expected joint angle;

[0009] S3, establishing an error function according to the desired trajectory;

[0010] S4. Design a fractional-order PID controller according to the error function, and design a fuzzy fractional-order PID controller according to the fractional-order PID controller.

[0011] Furthermore, according to the loading and unloading process of the steel shaft production line, the desired end grasping point of the robot arm is obtained and the coordinate transformation matrix of the robot arm is established. The coordinate transformation matrix of the robot arm is:

[0012]

[0013] Among them, i is an auxiliary variable, is the homogeneous transformation matrix of coordinate system i-1 relative to coordinate system i;

[0014] θ i is the joint angle, indicating the rotation of the i-th joint around z i-1 Angle of axis rotation, z i-1 represents the coordinate axis perpendicular to the xy plane in the coordinate system of the i-1th joint; d i is the joint offset, indicating the i-1 The offset of the axis, i.e. from z i-1 Axis to z i The distance between the axes; a i is the length, indicating that from x i-1 Axis to x i The distance along the z axis, usually i-1 Axis projection; α i is the joint rotation angle, indicating the rotation angle from z i-1 Axis to z i The rotation angle of the axis.

[0015] Furthermore, the expected joint angle is obtained according to the expected end grasping point and inverse kinematics, and the expected joint angle is obtained according to the expected end grasping point and inverse kinematics.

[0016] Furthermore, the expected trajectory is obtained according to the expected joint angle, and the expected trajectory is:

[0017] θ(t)=a0+a1(t-t0)+a2(t-t0) 2 +a3(t-t0) 3 ;

[0018] Among them, a0, a1, a2, and a3 are intermediate variables, expressed as:

[0019]

[0020] Among them, θ is the rotation angle of the robot joint, t is the movement time of the robot joint, t0 is the starting time of the robot joint movement, t f is the termination time of the robot joint motion, θ(t) is the function of the robot joint angle changing with time, θ0 is the initial angle of the robot joint, is the value of the first-order derivative of θ(t) at t=0, θ f is the robot joint at t = t f The angle of is the first-order derivative of θ(t) at t=t f The value at .

[0021] Furthermore, an error function is established according to the expected trajectory, and the error function is:

[0022] e i =θ i -θ di ;

[0023] Among them, e i is the tracking error of the i-th joint, θ i is the actual output angle of the i-th joint, θ di is the desired angle of the i-th joint.

[0024] Furthermore, a fractional-order PID controller is established according to the error function, and the control law of the fractional-order PID controller is:

[0025]

[0026] Among them, K p0 , K i0 , K d0 are the three initial parameters of the system, λ is the differential order, and μ is the integral order.

[0027] Furthermore, a fuzzy PID controller is designed according to the fractional-order PID controller to adjust the parameters of the fractional-order PID controller. The fuzzy fractional-order PID controller is:

[0028]

[0029] The input quantities e and e of the systemc , and the output ΔK p , ΔK i , ΔK d , λ and μ are quantized as fuzzy sets.

[0030] Among them, K p , K i , K d are the three parameters of the PID controller, Kp0 is the initial K of the control system p Value, K i0 is the initial K of the control system i Value, K d0 is the initial K of the control system d Value, ΔK p , ΔK i and ΔK d is the incremental value, α, β and γ are the incremental values ​​ΔK p , ΔK i and ΔK d is the adjustment coefficient, λ and μ are the differential order and integral order of the fractional-order PID controller.

[0031] Furthermore, the established fractional-order PID control law is as follows:

[0032]

[0033] Among them, K p , K i , K d are the three parameters of the PID controller, λ is the differential order, μ is the integral order, and e(t) is the error function.

[0034] Compared with the prior art, the present invention has the following beneficial effects:

[0035] 1. By adopting the fractional-order fuzzy PID controller, the automatic loading and unloading robot can achieve higher trajectory tracking accuracy in the complex steel shaft production environment. The controller can more accurately adjust the robot's motion trajectory, reduce position deviation, and ensure the precise execution of handling and loading tasks, thereby improving product quality and the overall efficiency of the production line.

[0036] 2. The fractional-order fuzzy PID controller shows stronger adaptability and anti-interference ability when facing nonlinearity and external interference in the steel shaft production line. This controller can effectively deal with various uncertainties in the production process, ensure the stable operation of the robot under different working conditions, reduce the occurrence of failures, and ensure the continuity and stability of the production line.

[0037] 3. The fractional-order fuzzy PID controller can significantly improve the response speed and dynamic performance of the automatic loading and unloading robot by optimizing the control parameters. This enables the robot to quickly adapt to changing environmental conditions when performing complex tasks, improve operating efficiency, and reduce task execution time, thereby greatly improving the automation level and production efficiency of the steel shaft production line. BRIEF DESCRIPTION OF THE DRAWINGS

[0038] Figure 1 It is a schematic diagram of the process of the present invention. DETAILED DESCRIPTION

[0039] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0040] In modern packaging and printing equipment, the control of the six-degree-of-freedom mechanical arm of the composite robot has an important impact on the automation and intelligent level of the steel shaft processing process. Although the more traditional PID controller has a good control effect on the six-degree-of-freedom mechanical arm, and is widely used because of its simple control structure and its independence from specific system models, the multi-degree-of-freedom mechanical arm is a complex structure with nonlinear, strong coupling and time-varying characteristics. The anti-interference ability of the traditional PID control is not strong enough, and its accuracy cannot be guaranteed. To this end, the present invention provides a trajectory tracking control method for an automatic loading and unloading robot of a steel shaft production line. By designing a fuzzy fractional-order PID controller, the method not only has anti-interference ability, but also can make the trajectory tracking more accurate and the control error smaller. This control strategy enhances the flexibility and adaptability of the robot in the loading and unloading process, so that the control parameters can change rapidly with the changes in the environment, so that the control maintains stability and accuracy. In order to illustrate the feasibility of the present invention, two specific embodiments will be described below.

[0041] Embodiment 1

[0042] In the embodiment of the present application, a trajectory tracking control method of an automatic loading and unloading robot of a steel shaft production line is adopted; the specific implementation process is as follows Figure 1 As shown, first, according to the loading and unloading process of the steel shaft production line, the expected end grasping point of the robot arm is obtained; then, the kinematic analysis of the robot arm is performed to establish the coordinate transformation matrix of the robot arm; then, the expected joint angle is obtained according to the expected end grasping point and the coordinate transformation matrix, and the expected trajectory is obtained according to the expected joint angle; then, an error function is established according to the expected trajectory; finally, a fuzzy PID controller is established according to the error function.

[0043] Furthermore, the specific implementation process of the embodiment of the present application is as follows: the DH parameter table of the robot arm selected in the embodiment of the present application is shown in Table 1;

[0044] Table 1 Parameters of the robot arm DH in Example 1

[0045]

[0046] Among them, a i is the length of the i-th connecting rod, α i It refers to the rotation angle of the i-th joint axis around the z-axis of the i-1-th joint axis, d i is the distance between the i-th joint and the i-1-th joint, θ i It refers to the rotation angle of the i-th joint axis around the i-1-th joint axis.

[0047] According to the loading and unloading process of the steel shaft production line, the desired end gripping point of the robot arm is obtained:

[0048] X=-228.85mm, Y=-775.43mm, Z=-23.77mm, roll=0.6°, pitch=0°, yaw=-180°; where X refers to the horizontal coordinate of the grasping point, Y refers to the vertical coordinate of the grasping point, Z refers to the vertical position of the grasping point, roll refers to the rolling angle, which indicates the angle of rotation around the object's own X axis; pitch refers to the pitch angle, which indicates the angle of rotation around the object's own Y axis; yaw refers to the yaw angle, which indicates the angle of rotation around the object's own Z axis.

[0049] In the embodiment of the present application, by obtaining the desired end gripping point of the robot arm and calculating it in combination with the DH parameter model, the system can accurately adjust the angles of each joint of the robot arm, thereby achieving high-precision positioning of the gripping point. This method can effectively reduce the positioning error caused by external interference and changes in working conditions, reduce operational errors and material losses in the production process, and further improve the operation stability and product quality of the overall production line.

[0050] Furthermore, a kinematic analysis is performed on the robot arm to establish a coordinate transformation matrix of the robot arm. The coordinate transformation matrix of the robot arm is:

[0051]

[0052] In the formula, is the homogeneous transformation matrix of coordinate system i-1 relative to coordinate system i; θ i is the joint angle, indicating the rotation of the i-th joint around z i-1 The angle of axis rotation; d i is the joint offset, indicating the i-1 The offset of the axis, i.e. from zi-1 Axis to z i The distance between the axes; a i is the length, indicating that from x i-1 Axis to x i The distance along the z axis, usually i-1 Axis projection; α i is the joint rotation angle, indicating the rotation angle from z i-1 Axis to z i The rotation angle of the axis.

[0053] In the embodiment of the present application, the kinematic analysis of the robot arm is performed, and the coordinate transformation matrix of the robot arm is established. The system can transform the position and posture of each joint of the robot arm into the coordinate system of the end effector of the robot arm, so as to accurately locate and control it. This method can realize precise motion control of the system.

[0054] Further, the expected joint angles are obtained according to the expected end grasping point and inverse kinematics, and the expected trajectory is obtained according to the expected joint angles, and the expected joint angles are θ1=-97.8°, θ2=-68.4°, θ3=-54°, ​​θ4=32.4°, θ5=90°, θ6=-7.2°;

[0055] Among them, θ i is the joint angle, indicating the rotation of the i-th joint around z i-1 The angle of axis rotation.

[0056] In the embodiment of the present application, the desired joint angle is obtained according to the desired end grasping point and the coordinate transformation matrix, and the desired joint angle of the robot arm can be quickly and accurately obtained by inversely solving the coordinate transformation matrix. This method can accurately control the robot arm and also help the robot arm better adjust the grasping posture and increase the stability of the operation.

[0057] Furthermore, the expected trajectory is:

[0058] θ(t)=a0+a1(t-t0)+a2(t-t0) 2 +a3(t-t0) 3 ;

[0059] Among them, a0, a1, a2 and a3 are intermediate variables, and the joint angles of the initial and end points are set to θ(0) = θ0, θ(t f )=θ f , and the initial velocity condition is The expressions of a0, a1, a2 and a3 are:

[0060]

[0061] The obtained trajectory expression is:

[0062]

[0063] Among them, θ is the rotation angle of the robot joint, t is the movement time of the robot joint, t0 is the starting time of the robot joint movement, t f is the end time of the robot joint motion, θ0 is the initial angle of the robot joint, θ f is the robot joint at t = t f θ(t) is the angle at which the robot joint angle changes with time. is the first-order derivative of θ(t), is the second-order derivative of θ(t).

[0064] In the embodiment of the present application, the trajectory expression of each joint of the robot arm is established, which can accurately define the motion path of the end effector of the robot arm and realize the precise control and execution of the robot arm. This method can effectively ensure that the robot arm performs tasks according to the predetermined path and time, improve the accuracy and consistency of task execution, and also help optimize the motion path, thereby improving the efficiency and performance of the system.

[0065] Furthermore, an error function is established according to the expected trajectory, and the error function is:

[0066]

[0067] Among them, e1, e2, e3, e4, e5, and e6 are the tracking errors of the 1st to 6th joints, and θ1, θ2, θ3, θ4, θ5, and θ6 are the actual output angles of the 1st to 6th joints;

[0068] According to the trajectory expression, the tracking error function of the i-th joint is obtained, and the formula of the tracking error function is:

[0069]

[0070] Among them, e ci is the error change rate of the i-th joint, e i is the tracking error of the ith joint, Yes i The first-order derivative of , t is the motion time of the robot joint, t f is the end time of the robot joint motion, θ0 is the initial angle of the robot joint, θ f is the robot joint at t = t f The angle of

[0071] In the embodiment of the present application, the tracking error of each joint of the robot arm is defined. By clarifying the tracking error, the control system can adjust and reduce the error. This method can effectively reflect the problems existing in the system through the error function, so that the system can correct the movement of the robot arm in real time to ensure that the joints of the robot arm can accurately follow the target value, which is conducive to improving the control accuracy of the system.

[0072] Furthermore, a fractional-order PID controller is established according to the error function, and the control law of the fractional-order PID controller is:

[0073]

[0074] Among them, K p0 , K i0 , K d0 are the three initial parameters of the system, λ is the differential order, and μ is the integral order.

[0075] In the embodiment of the present application, a fractional-order PID controller is established, so that the differential order and integral order of the controller can be adjusted, thereby improving the flexibility of the controller. This method can expand the order of the differential and integral operators from integers to any real number, improve the flexibility of the system, and also improve its robustness and dynamic performance, and can provide smoother control input, thereby reducing the oscillation and instability of the system during the transition process.

[0076] Furthermore, a fuzzy PID controller is designed according to the fractional-order PID controller to adjust the parameters of the fractional-order PID controller. The fuzzy fractional-order PID controller is:

[0077]

[0078] The input quantities e and e of the system c , and the output ΔK p , ΔK i , ΔK d , λ and μ are quantized as fuzzy sets.

[0079] Among them, K p , K i , K d are the three parameters of the PID controller, K p0 is the initial K of the control system p Value, K i0 is the initial K of the control system i Value, K d0 is the initial K of the control system d Value, ΔK p , ΔK i and ΔK d is the incremental value, α, β and γ are the incremental values ​​ΔKp , ΔK i and ΔK d is the adjustment coefficient, λ and μ are the differential order and integral order of the fractional-order PID controller.

[0080] The input quantities e and e of the system are c , and the output ΔK p , ΔK i , ΔK d , λ and μ are quantified into fuzzy sets and the value selection rules are determined. Table 2 Fuzzy rule table of PID parameters.

[0081] Table 2 PID parameter fuzzy rule table

[0082]

[0083] The fuzzy subset is composed of {NB, NM, NS, ZO, PS, PM, PB}, and its input is e, e c , the output is ΔK p , ΔK i and ΔK d , the quantization domain of the above parameters is [-3, 3], and the quantization domain of λ and μ is (0, 2).

[0084] Among them, NB means very negative, NM means negative, NS means slightly negative, ZO means zero, PS means slightly positive, PM means positive, and PB means very positive.

[0085] In the embodiment of the present application, fuzzy logic is introduced into the fractional-order PID controller so that the parameters of the controller are adjusted according to fuzzy rules, so that the system can handle uncertain and fuzzy information and make the control of the system more flexible. This method can effectively improve the adaptability and robustness of the system, enable the control system to more accurately adapt to the actual engineering needs, and improve production efficiency and quality control level.

[0086] Furthermore, the established fuzzy fractional-order PID control law is as follows:

[0087]

[0088] Among them, K p , K i , K d are the three parameters of the PID controller, λ is the differential order, μ is the integral order, and e(t) is the error function.

[0089] In the embodiment of the present application, the control law of the fuzzy fractional-order PID controller is established, and the processing of uncertain information by fuzzy logic and the flexible adjustment of the fractional order of the fractional-order PID controller are combined, so that the control of the system can be more flexible and accurate. This method can effectively cope with complex and changing control environments, not only can it handle nonlinearity and uncertainty, but also can automatically adjust the control strategy under different operating conditions, thereby improving the response speed and stability of the system.

[0090] Embodiment 2

[0091] The parameters of the robot arm selected in the embodiment of the present application are shown in Table 3;

[0092] Table 3 Parameters of the robot arm DH in Example 2

[0093]

[0094] Get the expected end grab point:

[0095] X=-0.5126mm, Y=-0.4968mm, Z=-0.0404mm, roll=18.94°, pitch=-47.10°, yaw=-89.87°;

[0096] Among them, X refers to the horizontal coordinate of the grasping point, Y refers to the vertical coordinate of the grasping point, Z refers to the vertical position of the grasping point, roll refers to the rolling angle, which indicates the angle of rotation around the object's own X axis; pitch refers to the pitch angle, which indicates the angle of rotation around the object's own Y axis; yaw refers to the yaw angle, which indicates the angle of rotation around the object's own Z axis.

[0097] Furthermore, a kinematic analysis is performed on the robot arm to establish a coordinate transformation matrix of the robot arm. The coordinate transformation matrix of the robot arm is:

[0098]

[0099] In the formula, is the homogeneous transformation matrix of coordinate system i-1 relative to coordinate system i; θ i is the joint angle, indicating the rotation of the i-th joint around z i-1 The angle of axis rotation; d i is the joint offset, indicating the i-1 The offset of the axis, i.e. from z i-1 Axis to z i The distance between the axes; a i is the length, indicating that from x i-1 Axis to x i The distance along the z axis, usually i-1 Axis projection; α i is the joint rotation angle, indicating the rotation angle from zi-1 Axis to z i The rotation angle of the axis.

[0100] Further, the expected joint angles are obtained according to the expected end grasping point and inverse kinematics, and the expected trajectory is obtained according to the expected joint angles, and the expected joint angles are θ1=67.9°, θ2=33.6°, θ3=-19.41, θ4=60°, θ5=110°, and θ6=100.7°;

[0101] Among them, θ i is the joint angle, indicating the rotation of the i-th joint around z i-1 The angle of axis rotation.

[0102] Furthermore, the expected trajectory is:

[0103] θ(t)=a0+a1(t-t0)+a2(t-t0) 2 +a3(t-t0) 3 ;

[0104] Among them, a0, a1, a2 and a3 are intermediate variables, and the joint angles of the initial and end points are set to θ(0) = θ0, θ(t f )=θ f , and the initial velocity condition is The expressions of a0, a1, a2 and a3 are:

[0105]

[0106] The obtained trajectory expression is:

[0107]

[0108] Among them, θ is the rotation angle of the robot joint, t is the movement time of the robot joint, t0 is the starting time of the robot joint movement, t f is the end time of the robot joint motion, θ0 is the initial angle of the robot joint, θ f is the robot joint at t = t f θ(t) is the angle at which the robot joint angle changes with time. is the first-order derivative of θ(t), is the second-order derivative of θ(t).

[0109] Furthermore, an error function is established according to the expected trajectory, and the error function is:

[0110]

[0111] Among them, e1, e2, e3, e4, e5, and e6 are the tracking errors of the 1st to 6th joints respectively, and θ1, θ2, θ3, θ4, θ5, and θ6 are the actual output angles of the 1st to 6th joints.

[0112] According to the trajectory expression, the tracking error function of the i-th joint is obtained, and the formula of the tracking error function is:

[0113]

[0114] Among them, e ci is the error change rate of the i-th joint, e i is the tracking error of the ith joint, Yes i The first-order derivative of , t is the motion time of the robot joint, t f is the end time of the robot joint motion, θ0 is the initial angle of the robot joint, θ f is the robot joint at t = t f The angle of time.

[0115] Furthermore, a fractional-order PID controller is established according to the error function, and the control law of the fractional-order PID controller is:

[0116]

[0117] Among them, K p0 , K i0 , K d0 are the three initial parameters of the system, λ is the differential order, and μ is the integral order.

[0118] Furthermore, a fuzzy PID controller is designed according to the fractional-order PID controller to adjust the parameters of the fractional-order PID controller. The fuzzy fractional-order PID controller is:

[0119]

[0120] The input quantities e and e of the system c , and the output ΔK p , ΔK i , ΔK d , λ and μ are quantized as fuzzy sets.

[0121] Among them, K p , K i , K d are the three parameters of the PID controller, K p0 is the initial K of the control system p Value, K i0 is the initial K of the control system i Value, Kd0 is the initial K of the control system d Value, ΔK p , ΔK i and ΔK d is the incremental value, α, β and γ are the incremental values ​​ΔK p , ΔK i and ΔK d is the adjustment coefficient, λ and μ are the differential order and integral order of the fractional-order PID controller.

[0122] The input quantities e and e of the system are c , and the output ΔK p , ΔK i , ΔK d , λ and μ are quantified into fuzzy sets, and the value selection rules are determined. Table 2 is the fuzzy rule table of the formulated PID parameters.

[0123] The fuzzy subset is composed of {NB, NM, NS, ZO, PS, PM, PB}, and its input is e, e c , the output is ΔK p , ΔK i and ΔK d , the quantization domain of the above parameters is [-3, 3], and the quantization domain of λ and μ is (0, 2).

[0124] Among them, NB means very negative, NM means negative, NS means slightly negative, ZO means zero, PS means slightly positive, PM means positive, and PB means very positive.

[0125] Furthermore, the established fuzzy fractional-order PID control law is as follows:

[0126]

[0127] Among them, K p , K i , K d are the three parameters of the PID controller, λ is the differential order, μ is the integral order, and e(t) is the error function.

[0128] The above is only a preferred embodiment of the present invention. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principle of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.

Claims

1. A trajectory tracking control method for an automatic loading and unloading robot of a steel shaft production line, characterized in that: The following steps are involved: S1. According to the loading and unloading process of the steel shaft production line, the desired end grasping point of the robot arm is obtained and the coordinate transformation matrix of the robot arm is established; S2, obtaining an expected joint angle according to the expected end grasping point and the coordinate transformation matrix, and obtaining an expected trajectory according to the expected joint angle; S3, establishing an error function according to the desired trajectory; S4. Design a fractional-order PID controller according to the error function, and design a fuzzy fractional-order PID controller according to the fractional-order PID controller.

2. The trajectory tracking control method of an automatic loading and unloading robot of a steel shaft production line according to claim 1 is characterized in that: According to the loading and unloading process of the steel shaft production line, the desired end grasping point of the robot arm is obtained and the coordinate transformation matrix of the robot arm is established. The coordinate transformation matrix of the robot arm is: Among them, i is an auxiliary variable, is the homogeneous transformation matrix of coordinate system i-1 relative to coordinate system i; θ i is the joint angle, indicating the rotation of the i-th joint around z i-1 Angle of axis rotation, z i-1 represents the coordinate axis perpendicular to the xy plane in the coordinate system of the i-1th joint; d i is the joint offset, indicating the i-1 The offset of the axis, i.e. from z i-1 Axis to z i The distance between the axes; a i is the length, indicating that from x i-1 Axis to x i The distance along the z axis, usually i-1 Axis projection; α i is the joint rotation angle, indicating the rotation angle from z i-1 Axis to z i The rotation angle of the axis.

3. The trajectory tracking control method of an automatic loading and unloading robot of a steel shaft production line according to claim 1 is characterized in that: The expected joint angle is obtained according to the expected end grasping point and the coordinate transformation matrix.

4. The trajectory tracking control method of an automatic loading and unloading robot of a steel shaft production line according to claim 3 is characterized in that: The expected trajectory is obtained according to the expected joint angle, and the expected trajectory is: θ(t)=a0+a1(t-t0)+a2(t-t0) 2 +a3(t-t0) 3 ; Among them, a0, a1, a2, and a3 are intermediate variables, expressed as: Among them, θ is the rotation angle of the robot joint, t is the movement time of the robot joint, t0 is the starting time of the robot joint movement, t f is the termination time of the robot joint motion, θ(t) is the function of the robot joint angle changing with time, θ0 is the initial angle of the robot joint, is the value of the first-order derivative of θ(t) at t=0, θ f is the robot joint at t = t f The angle of is the first-order derivative of θ(t) at t=t f The value at .

5. The trajectory tracking control method of an automatic loading and unloading robot for a steel shaft production line according to claim 1 is characterized in that: An error function is established according to the expected trajectory, and the error function is: e i =θ i -θ di ; Among them, e i is the tracking error of the i-th joint, θ i is the actual output angle of the i-th joint, θ di is the desired angle of the i-th joint.

6. The trajectory tracking control method of an automatic loading and unloading robot of a steel shaft production line according to claim 1 is characterized in that: A fractional-order PID controller is established according to the error function, and the control law of the fractional-order PID controller is: Among them, K p0 , K i0 , K d0 are the three initial parameters of the system, λ is the differential order, and μ is the integral order.

7. The trajectory tracking control method of the automatic loading and unloading robot of the steel shaft production line according to claim 6 is characterized in that: A fractional-order fuzzy PID controller is established, and the fuzzy algorithm is introduced into the fractional-order PID controller to obtain new control parameters: Among them, K p , K i , K d are the three parameters of the PID controller, K p0 is the initial K of the control system p Value, K i0 is the initial K of the control system i Value, K d0 is the initial K of the control system d Value, ΔK p , ΔK i and ΔK d is the incremental value, α, β and γ are the incremental values ​​ΔK p , ΔK i and ΔK d The adjustment factor.

8. The trajectory tracking control method of the automatic loading and unloading robot of the steel shaft production line according to claim 7 is characterized in that: A fuzzy fractional-order PID controller is established, and the established fuzzy fractional-order PID control law is as follows: Where λ is the differential order, μ is the integral order, and e(t) is the error function.

Citation Information

Patent Citations

  • Movement control method of six-degree-of-freedom wrist offset type serial mechanical arm

    CN108673509A

  • Genetic optimization trajectory tracking control system based on hybrid coding

    CN110908277A

  • Method for designing the controller for suppressing the maximum amplitude of trajectory tracking errors and Controller using the same

    KR1020170119197A

  • Kinematics model-free trajectory tracking method for robotic arms and robotic arm system

    US20220314445A1

Cited By

  • Intelligent torque method for optimizing adaptive fuzzy PID based on DWOA algorithm

    CN119916682A