Construction machinery boom control methods, devices and construction machinery

By using dynamic modeling and sliding mode control algorithms, the problems of robustness and accuracy degradation in the control of engineering machinery booms were solved, achieving real-time and accurate tracking of the actual trajectory to the planned trajectory, thus enhancing the stability and robustness of the system.

CN118273402BActive Publication Date: 2026-11-17ZOOMLION EARTHMOVING MASCH CO LTD +1
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
CN202410196384.2
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-02-22
Publication Date
2026-11-17
Estimated Expiration
2044-02-22

AI Technical Summary

Technical Problem

Existing control methods for engineering machinery booms, such as PID algorithms, suffer from reduced robustness and accuracy in nonlinear control systems, making it difficult to achieve real-time and accurate tracking of the actual trajectory against the planned trajectory.

Method used

By employing dynamic modeling and sliding mode control algorithms, a dynamic model is constructed by acquiring multiple joint angles, and a sliding mode controller is designed to achieve trajectory tracking control of the boom of the engineering machinery. The sliding mode control law is used to control each joint.

Benefits of technology

It improves the robustness and accuracy of the boom of engineering machinery in nonlinear systems, realizes real-time and accurate tracking of the actual trajectory to the planned trajectory, and enhances the stability of the system under uncertain conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118273402B_ABST
    Figure CN118273402B_ABST
Patent Text Reader

Abstract

This invention provides a control method, device, and construction machinery for a boom, belonging to the field of construction machinery control technology. The boom control method includes: real-time acquisition of multiple joint angles; dynamic modeling based on the joint parameters and joint angles of the boom; trajectory tracking control of the boom using a sliding mode control algorithm based on the dynamic model to obtain a sliding mode control law; and control of each joint of the boom based on the sliding mode control law. By using the sliding mode control law obtained from the sliding mode control algorithm to control the torque of each joint of the boom, real-time and accurate tracking of the actual trajectory to the planned trajectory can be achieved, and robustness is improved. Acquiring multiple joint angles to construct a dynamic model facilitates modeling of multiple degrees of freedom, further improving the accuracy of trajectory tracking.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of engineering machinery control technology, specifically to an engineering machinery boom control method, an engineering machinery boom control device, an engineering machinery, a machine-readable storage medium, and an electronic device. Background Technology

[0002] Many construction machines, such as excavators and truck cranes, are equipped with booms, which allow for trajectory tracking. For example, excavators are essential tools in modern engineering construction and production, widely used in earthwork, infrastructure, water conservancy, transportation, and mining. Their main functions include excavation, loading, transportation, and leveling. Excavator control systems are nonlinear, time-varying, and strongly coupled multi-input multi-output systems. Achieving robust, real-time, and accurate trajectory tracking of the excavator bucket is a hot topic in excavator control.

[0003] However, the commonly used control method is the proportional-integral-derivative (PID) algorithm. The PID algorithm is a linear controller, and for nonlinear control systems, the robustness and accuracy of the PID algorithm will decrease. Summary of the Invention

[0004] The purpose of this invention is to provide a method for controlling the boom of construction machinery, a device for controlling the boom of construction machinery, a type of construction machinery, a machine-readable storage medium, and an electronic device. This method for controlling the boom of construction machinery can achieve real-time and accurate tracking of the actual trajectory to the planned trajectory and improve robustness.

[0005] To achieve the above objectives, the first aspect of this application provides a method for controlling an engineering machinery boom, comprising:

[0006] Real-time acquisition of multiple joint angles;

[0007] Based on the joint parameters of the engineering machinery boom and the multiple joint angles, a dynamic model is obtained by using dynamic modeling.

[0008] Based on the dynamic model, a sliding mode control algorithm is used to perform trajectory tracking control on the boom of the engineering machinery to obtain the sliding mode control law;

[0009] Based on the sliding mode control law, each joint of the engineering machinery boom is controlled.

[0010] In this embodiment of the application, the step of using a sliding mode control algorithm to perform trajectory tracking control on the boom of the engineering machinery based on the dynamic model to obtain the sliding mode control law includes:

[0011] Based on the desired trajectory and the joint angle matrix composed of the multiple joint angles, a sliding surface is constructed;

[0012] Based on the sliding surface, the Lyapunov function is constructed;

[0013] Based on the aforementioned dynamic model and Lyapunov function, a sliding mode controller is constructed.

[0014] The stability analysis of the sliding mode controller is performed using the Lyapunov function, and the sliding mode control law is obtained after the stability analysis is completed.

[0015] In this embodiment of the application, the construction of the sliding mode controller based on the dynamic model and the Lyapunov function includes:

[0016] The dynamic model is linearized to obtain a linearized expression;

[0017] Based on the Lyapunov function, the maximum value of the linearized expression is taken to construct the sliding mode controller.

[0018] In this embodiment of the application, the sliding mode controller is:

[0019]

[0020] Where τ is the sliding mode control law, n is the number of joints in the boom of the engineering machinery, s is the sliding surface, and s1, s n Let sgn be the element in the matrix corresponding to the sliding mode surface, k be the sign function, and k1 and k2 be the coefficients. n These are the elements in the matrix corresponding to the coefficients.

[0021] In this embodiment of the application, the sliding mode controller is used to implement quasi-sliding mode control.

[0022] In this embodiment of the application, the sliding mode controller is:

[0023]

[0024] Where τ is the sliding mode control law, n is the number of joints in the boom of the engineering machinery, s is the sliding surface, and s1, s n Let be the elements in the matrix corresponding to the sliding mode surface, sat be the saturation function, k be the coefficients, and k1, k2, k3, k4, k5, k6, k7, k8, k9, k1, k9, k1, k2 ... n These are the elements in the matrix corresponding to the coefficients.

[0025] A second aspect of this application provides a control device for an engineering machinery boom, comprising:

[0026] The acquisition module is used to acquire multiple joint angles in real time;

[0027] The modeling module is used to obtain a dynamic model based on the joint parameters of the engineering machinery boom and the multiple joint angles using dynamic modeling.

[0028] The tracking module is used to perform trajectory tracking control of the engineering machinery boom based on the dynamic model and using a sliding mode control algorithm to obtain the sliding mode control law;

[0029] The control module is used to control each joint of the engineering machinery boom based on the sliding mode control rate.

[0030] A third aspect of this application provides an engineering machinery, including a mechanical boom, wherein the mechanical boom is controlled by the above-described engineering machinery boom control method.

[0031] A fourth aspect of this application provides an electronic device, the electronic device comprising:

[0032] At least one processor;

[0033] A memory connected to the at least one processor;

[0034] The memory stores instructions that can be executed by the at least one processor, and the at least one processor implements the above-described engineering machinery boom control method by executing the instructions stored in the memory.

[0035] A fifth aspect of this application provides a machine-readable storage medium storing instructions that, when executed by a processor, configure the processor to perform the above-described engineering boom control method.

[0036] The above technical solution involves acquiring multiple joint angles in real time. Based on the joint parameters and these angles of the engineering machinery boom, a dynamic model is obtained through dynamic modeling. Based on this model, a sliding mode control algorithm is used to track the trajectory of the boom, yielding a sliding mode control law. This sliding mode control law is then used to control each joint of the boom. Since sliding mode control is a nonlinear control method, it is independent of external disturbances and system parameters, thus exhibiting strong robustness to changes in system parameters and external disturbances. This ensures the stability and robustness of the system under uncertain conditions. Therefore, using the sliding mode control law obtained through the sliding mode control algorithm to control the torque of each joint of the boom enables real-time and accurate tracking of the actual trajectory to the planned trajectory, improving robustness. Furthermore, acquiring multiple joint angles to construct a dynamic model facilitates modeling of multiple degrees of freedom, further enhancing the accuracy of trajectory tracking.

[0037] Other features and advantages of the embodiments of the present invention will be described in detail in the following detailed description section. Attached Figure Description

[0038] The accompanying drawings are provided to further illustrate embodiments of the present invention and form part of the specification. They are used together with the following detailed description to explain the embodiments of the present invention, but do not constitute a limitation thereof. In the drawings:

[0039] Figure 1 The schematic diagram illustrates a flow chart of a control method for an engineering machinery boom according to an embodiment of this application;

[0040] Figure 2 A schematic diagram of an excavator bucket according to an embodiment of this application is shown;

[0041] Figure 3 The diagram schematically illustrates the position and velocity tracking curve of the upper arm joint according to an embodiment of this application.

[0042] Figure 4 The diagram schematically illustrates the position and velocity tracking curve of the forearm joint according to an embodiment of this application.

[0043] Figure 5 The diagram schematically illustrates the control torque curves of the upper arm joint and forearm joint under quasi-sliding mode control according to an embodiment of this application.

[0044] Figure 6 This illustration schematically shows a structural diagram of an engineering machinery boom control device according to an embodiment of this application;

[0045] Figure 7 The diagram illustrates the internal structure of a computer device according to an embodiment of this application.

[0046] Explanation of reference numerals in the attached figures

[0047] 410 - Acquisition Module; 420 - Modeling Module; 430 - Tracking Module; 440 - Control Module; A01 - Processor; A02 - Network Interface; A03 - Internal Memory; A04 - Display Screen; A05 - Input Device; A06 - Non-volatile Storage Medium; B01 - Operating System; B02 - Computer Program. Detailed Implementation

[0048] The specific embodiments of the present invention will be described in detail below with reference to the accompanying drawings. It should be understood that the specific embodiments described herein are for illustration and explanation only and are not intended to limit the scope of the present invention.

[0049] This embodiment provides a control method for the boom of construction machinery. A dynamic model of the excavator bucket is derived through dynamic analysis. Based on this model, a sliding mode control algorithm is used to design a sliding mode control law, and its stability is proven. This law then controls the various joints of the construction machinery boom. This boom control method can output the torque of each joint to achieve robust, real-time, and accurate tracking of the actual trajectory against the planned trajectory.

[0050] It should be noted that the boom control method for construction machinery provided in this embodiment is applicable to various construction machinery equipped with booms, such as excavators and truck cranes. For ease of explanation, this embodiment mainly uses an excavator as an example, and can achieve robust, real-time, and precise trajectory tracking of the excavator bucket.

[0051] Please refer to Figure 1 , Figure 1 The illustration schematically shows a flowchart of a boom control method for construction machinery according to an embodiment of this application. This embodiment provides a boom control method for construction machinery, including the following steps:

[0052] Step 210: Acquire multiple joint angles in real time;

[0053] In this embodiment, the aforementioned multiple joint angles can be obtained in real time by angle sensors on the boom. There can be multiple joint angles, specifically determined based on the rotary joints (hereinafter referred to as joints) of the construction machinery boom. For example, one rotary joint corresponds to one joint angle. For a spherical joint, there are three degrees of freedom, thus three joint angles. Taking an excavator as an example, an actual excavator bucket has four rotary joints, therefore four degrees of freedom, and the corresponding joint angles can be four. Please refer to... Figure 2 , Figure 2 A schematic diagram of an excavator bucket according to an embodiment of this application is shown. The excavator boom in the figure includes four joints: the body, the boom, the arm, and the bucket, with corresponding joint angles of θ1, θ2, θ3, and θ4. Multiple joint angles are obtained to facilitate modeling from multiple degrees of freedom.

[0054] Step 220: Based on the joint parameters of the engineering machinery boom and the multiple joint angles, dynamic modeling is used to obtain the dynamic model;

[0055] In this embodiment, the parameters of each joint of the aforementioned construction machinery boom can be obtained in advance. These parameters include joint length, weight, center of gravity, and other parameters. For example, taking an excavator as an example of construction machinery, please refer to... Figure 2The parameters for each joint include: the height d1 from the boom joint to the base; the lateral distance L0 from the boom joint to the base, weight m0, and center of gravity at l0; the boom length L1, weight m1, and center of gravity at l1; the forearm length L2, weight m2, and center of gravity at l2; and the bucket length L3, weight m3, and center of gravity at l3. The process of constructing the dynamic model can be as follows: first, calculate the gravitational potential energy and the kinetic energy of each joint rotation based on the joint parameters and angles of the engineering machinery boom; then, use the Lagrangian function to obtain the required torque for each joint; and finally, construct the dynamic model based on the required torque for each joint.

[0056] Taking excavators as an example of construction machinery, please refer to... Figure 2 First, calculate the gravitational potential energy, the kinetic energy of the entire system rotating in the xy plane, the kinetic energy of the boom rotating in the xz plane, the kinetic energy of the forearm rotating in the xz plane, and the kinetic energy of the bucket rotating in the xz plane. Specifically:

[0057] The gravitational potential energy is:

[0058] P=m0gd1+m1g(d1-l1sinθ2)+m2g(d1-L1sinθ2-l2sin(θ2+θ3))+m3g(d1-L1sinθ2-L2sin(θ2+θ3)-l3sin(θ2+θ3+θ4));

[0059] The kinetic energy of the entire system rotating in the xy plane is:

[0060]

[0061] The kinetic energy of the upper arm rotating in the xz plane is:

[0062]

[0063] The kinetic energy of the forearm rotating in the xz plane is:

[0064]

[0065] The kinetic energy of the bucket rotating in the xz plane is:

[0066]

[0067] In the above formula, g is the acceleration due to gravity.

[0068] Then we obtain the Lagrange function: L = K1 + K2 + K3 + K4 - P. By taking the partial derivative of the Lagrange function with respect to the following equation, we can obtain the torque required for each joint:

[0069] Among them, F i This refers to the torque required for each joint.

[0070] After obtaining the required torques for each joint, the dynamic model of the excavator bucket can be written as: Where τ is the control signal, which is also the joint driving torque, and is determined by F. i The matrix formed by these components, H(q), is the positive definite mass inertia matrix. G(q) is the Coriolis force matrix, G(q) is the gravity matrix, and q is the joint angle matrix, which is a matrix composed of 4 joint angles.

[0071] Step 230: Based on the dynamic model, a sliding mode control algorithm is used to perform trajectory tracking control on the boom of the engineering machinery to obtain the sliding mode control law;

[0072] In this embodiment, after obtaining the dynamic model, sliding mode control is further implemented. Sliding mode control is a nonlinear control method that achieves stable system control by introducing a sliding surface. A key characteristic of sliding mode control is its strong robustness to changes in system parameters and external disturbances. Specifically, sliding mode control involves introducing a sliding surface, allowing the system state to slide rapidly along this surface, thereby achieving system control. When the system state enters the sliding surface, the controller applies a sufficiently large control force to rapidly slide the system state along the sliding surface, thus achieving stable system control. The aforementioned sliding mode control law is essentially a control signal, which can be used to control the various joints of the engineering machinery boom.

[0073] In some embodiments, the step of using a sliding mode control algorithm to perform trajectory tracking control on the boom of the engineering machinery based on the dynamic model to obtain the sliding mode control law includes the following steps:

[0074] First, a sliding surface is constructed based on the desired trajectory and the joint angle matrix composed of the multiple joint angles;

[0075] In this embodiment, the desired trajectory is predetermined and can be represented as a time-varying desired trajectory q. d (t). The construction of the above sliding surface can be achieved by first determining the position tracking error based on the desired trajectory and the joint angle matrix composed of the multiple joint angles. The position tracking error can be expressed as: e = q d -q, where e is the position tracking error, q d Let be the desired trajectory, and q be the joint angle matrix. Then define: Where λ is a diagonal matrix. The sliding surface is then constructed as follows: The aforementioned sliding surface is actually a 1*n matrix, where n is the number of joints.

[0076] Then, based on the sliding surface, the Lyapunov function is constructed;

[0077] Then, based on the dynamic model and the Lyapunov function, a sliding mode controller is constructed.

[0078] Then, the Lyapunov function is used to perform stability analysis on the sliding mode controller, and the sliding mode control law is obtained after the stability analysis is completed.

[0079] In this embodiment, the Lyapunov function is:

[0080]

[0081] Where s is the sliding surface, H(q) is the positive definite mass inertia matrix, and V(t) is the Lyapunov function value.

[0082] The stability analysis process described above includes: First, by taking the first derivative of the Lyapunov function expression, we can obtain:

[0083]

[0084] Since H-2C exhibits oblique symmetry, then:

[0085]

[0086] Where τ is the sliding mode controller, and the calculated value is the sliding mode control law.

[0087] In some embodiments, considering the upper bound of the model, constructing a sliding mode controller based on the dynamic model and the Lyapunov function includes the following steps:

[0088] First, the dynamic model is linearized to obtain a linearized expression;

[0089] Then, based on the Lyapunov function, the maximum value of the linearized expression is taken to construct the sliding mode controller.

[0090] Specifically, the dynamic system has the following property: there exists a vector p∈R m They satisfy a linear relationship:

[0091] That is, we obtain the linearized expression.

[0092] therefore:

[0093] In the formula: p = [p1, ..., p m ] T ,|p i |≤a i i = 1, ..., m

[0094] Among them, a i For |p i The maximum value that can be obtained can be preset, where n is the number of joints and m is obtained by linearizing the dynamic equations of the above dynamic model. for The element in the i-th row and j-th column of the above dynamic model. The process of linearizing the dynamic equations of the above dynamic model is existing technology and will not be described in detail here.

[0095] Simply select:

[0096]

[0097] In the formula: τ is the sliding mode control law, n is the number of joints of the engineering machinery boom, s is the sliding surface, s1, s n Let sgn be the element in the matrix corresponding to the sliding mode surface, k be the sign function, and k1 and k2 be the coefficients. n These are the elements in the coefficient matrix. Where k = [k1, ..., k n ] T , Since k affects the dynamic response of the system, it can be increased when a faster settling time is needed. Specifically, this can be achieved by adjusting a. j The value is achieved. The above formula for calculating the sliding mode control law is the constructed sliding mode controller.

[0098] By designing a sliding mode surface and constructing a sliding mode controller based on the upper bound of the model, the sliding mode controller constructed using a sign function can achieve switching control of the control signal, thus ensuring stable tracking control. Compared to direct control using a dynamic model, the sliding mode control law in this scheme is error-dependent, making it a closed-loop control and thus guaranteeing control stability.

[0099] Based on the above sliding mode controller, then:

[0100]

[0101] According to LaSalle's theorem, the control system is asymptotically stable.

[0102] Step 240: Based on the sliding mode control law, control each joint of the engineering machinery boom.

[0103] In this embodiment, the aforementioned sliding mode control law is actually a control signal, namely the joint driving torque. After obtaining the sliding mode control law, each joint can be controlled according to the sliding mode control law to achieve the tracking of the actual trajectory with the planned trajectory. It should be noted that the above tracking can be position tracking, and velocity tracking can also be achieved on the basis of position tracking.

[0104] In the above implementation process, multiple joint angles are acquired in real time. Based on the joint parameters of the engineering machinery boom and the multiple joint angles, a dynamic model is obtained through dynamic modeling. Based on the dynamic model, a sliding mode control algorithm is used to perform trajectory tracking control on the engineering machinery boom, obtaining the sliding mode control law. Based on the sliding mode control law, each joint of the engineering machinery boom is controlled. A sliding mode controller was designed based on the dynamic model, and its stability was proven. Since sliding mode control is a nonlinear control method, it is independent of external disturbances and system parameters, thus exhibiting strong robustness to changes in system parameters and external disturbances. It can ensure the stability and robustness of the system under uncertain conditions. Therefore, by using the sliding mode control law obtained by the sliding mode control algorithm to control the torque of each joint of the engineering machinery boom, real-time and accurate tracking of the actual trajectory to the planned trajectory can be achieved, and robustness is improved. Simultaneously, acquiring multiple joint angles to construct a dynamic model facilitates modeling of multiple degrees of freedom, further improving the accuracy of trajectory tracking.

[0105] Taking excavators as an example of construction machinery, you can refer to [link / reference]. Figure 2 The excavator includes four joints. Using the boom control method described in this embodiment, the boom joint position tracking curve and boom joint speed tracking curve can be obtained, as shown below. Figure 3 As shown, Figure 3 The diagram schematically illustrates the position and velocity tracking curves of the upper arm joint according to an embodiment of this application. The position and velocity tracking curves of the forearm joint can be obtained as follows: Figure 4 As shown, Figure 4 The diagram schematically illustrates the position and velocity tracking curve of the forearm joint according to an embodiment of this application. Figure 3 and Figure 4 It can be seen that after a period of time, both the upper arm joint and the forearm joint can achieve precise tracking of position and speed.

[0106] In some embodiments, to prevent chattering, the sliding mode controller can be improved to achieve quasi-sliding mode control. Specifically, the sliding mode controller is:

[0107]

[0108] Where τ is the sliding mode control law, n is the number of joints in the boom of the engineering machinery, s is the sliding surface, and s1, s n Let be the elements in the matrix corresponding to the sliding mode surface, sat be the saturation function, k be the coefficients, and k1, k2, k3, k4, k5, k6, k7, k8, k9, k1, k9, k1, k2 ... n These are the elements in the matrix corresponding to the coefficients.

[0109] Specifically, In the formula, k>1.

[0110] In this embodiment, to prevent chattering, the sliding mode control is improved by replacing the sign function sgn in the design term τ with the saturation function sat. This is equivalent to adding a boundary layer, forming quasi-sliding mode control, without affecting its stability. It should be noted that the quasi-sliding mode control process is the same as the sliding mode control process, the difference being the function used, which will not be elaborated further here.

[0111] In the above implementation process, by improving the sliding mode control and replacing the sign function sgn with the saturation function sat, quasi-sliding mode control can be achieved. This can reduce system oscillations and high-frequency interference while maintaining robustness, thereby effectively avoiding chattering while achieving accurate trajectory tracking.

[0112] In some embodiments, the above-described quasi-sliding mode control can also be achieved by replacing the sign function sgn with a function that converges at both ends, specifically, the function expression is as follows:

[0113]

[0114] In the formula, δ is a very small positive number that can be preset.

[0115] Quasi-sliding mode control can also be achieved by replacing the symbolic function sgn with a function that converges at both ends. Compared with the symbolic function sgn, the sliding mode controller constructed with the function that converges at both ends has a faster convergence speed, higher robustness, and further improves the stability of the control.

[0116] In some embodiments, the above-mentioned implementation of quasi-sliding mode control can also be achieved by replacing the symbolic function sgn with a sig-like function, the specific function expression of which is:

[0117]

[0118] In the formula, a>1 can be preset.

[0119] The sig function is smoother than the saturation function sat, making the control more stable.

[0120] Taking excavators as an example of construction machinery, you can refer to [link / reference]. Figure 2The excavator includes four joints. Using the quasi-slip mode control method for the boom of this engineering machinery, the control torques for the boom and arm joints under quasi-slip mode control can be obtained as follows: Figure 5 As shown, Figure 5 The diagram schematically illustrates the control torque curves of the boom and forearm joints under quasi-slip mode control according to an embodiment of this application. As can be seen from the diagram, the control torques of the boom and forearm joints tend to stabilize. By optimizing the slip mode control into quasi-slip mode control, the actual trajectory of the bucket accurately tracks the desired trajectory, effectively avoiding vibration.

[0121] Figure 1 This is a flowchart illustrating the control method for the boom of construction machinery in this embodiment. It should be understood that, although... Figure 1 The steps in the flowchart are shown sequentially as indicated by the arrows, but these steps are not necessarily executed in the order indicated by the arrows. Unless otherwise specified herein, there is no strict order in which these steps are executed, and they can be performed in other orders. Figure 1 At least some of the steps in the process may include multiple sub-steps or multiple stages. These sub-steps or stages are not necessarily completed at the same time, but can be executed at different times. The execution order of these sub-steps or stages is not necessarily sequential, but can be executed in turn or alternately with other steps or at least some of the sub-steps or stages of other steps.

[0122] This embodiment provides an engineering machine, including a mechanical boom, which is controlled by the above-described engineering machine boom control method.

[0123] In this embodiment, the aforementioned construction machinery may be an excavator, crane, etc. The mechanical boom includes multiple joints. By controlling the mechanical boom through the aforementioned construction machinery boom control method, precise trajectory tracking can be achieved, thereby enabling the construction machinery to operate stably.

[0124] Please refer to Figure 6 , Figure 6 The schematic diagram illustrates a structural schematic of a boom control device for construction machinery according to an embodiment of this application. This embodiment also provides a boom control device for construction machinery, including: an acquisition module 410, a modeling module 420, a tracking module 430, and a control module 440, wherein:

[0125] The acquisition module 410 is used to acquire multiple joint angles in real time;

[0126] Modeling module 420 is used to obtain a dynamic model by using dynamic modeling based on the joint parameters of the engineering machinery boom and the multiple joint angles;

[0127] The tracking module 430 is used to perform trajectory tracking control on the engineering machinery boom based on the dynamic model and using a sliding mode control algorithm to obtain the sliding mode control law.

[0128] The control module 440 is used to control each joint of the engineering machinery boom based on the sliding mode control rate.

[0129] The engineering machinery boom control device includes a processor and a memory. The acquisition module 410, modeling module 420, tracking module 430 and control module 440 are all stored as program units in the memory. The processor executes the program units stored in the memory to realize the corresponding functions.

[0130] The processor contains a kernel, which retrieves the corresponding program unit from memory. One or more kernels can be configured; by adjusting kernel parameters, real-time and accurate tracking of the planned trajectory by the actual trajectory can be achieved, thus improving robustness.

[0131] The memory may include non-permanent memory in computer-readable media, such as random access memory (RAM) and / or non-volatile memory, such as read-only memory (ROM) or flash RAM, and the memory includes at least one memory chip.

[0132] This invention provides a machine-readable storage medium storing a program that, when executed by a processor, implements the engineering machinery boom control method.

[0133] This invention provides a processor for running a program, wherein the program executes the engineering machinery boom control method during runtime.

[0134] In one embodiment, a computer device is provided, which may be a terminal, and its internal structure diagram may be as follows: Figure 7As shown in the figure, the computer device includes a processor A01, a network interface A02, a display screen A04, an input device A05, and a memory (not shown) connected via a system bus. The processor A01 provides computing and control capabilities. The memory includes internal memory A03 and a non-volatile storage medium A06. The non-volatile storage medium A06 stores an operating system B01 and a computer program B02. The internal memory A03 provides an environment for the operation of the operating system B01 and the computer program B02 stored in the non-volatile storage medium A06. The network interface A02 is used for communication with external terminals via a network connection. When the computer program is executed by the processor A01, it implements a method for controlling an engineering machinery boom. The display screen A04 can be a liquid crystal display (LCD) or an e-ink display. The input device A05 can be a touch layer covering the display screen, buttons, a trackball, or a touchpad mounted on the computer device casing, or an external keyboard, touchpad, or mouse.

[0135] Those skilled in the art will understand that Figure 7 The structure shown is merely a block diagram of a portion of the structure related to the present application and does not constitute a limitation on the computer device to which the present application is applied. Specific computer devices may include more or fewer components than those shown in the figure, or combine certain components, or have different component arrangements.

[0136] In one embodiment, the engineering machinery boom control device provided in this application can be implemented as a computer program, and the computer program can be implemented as follows: Figure 7 The computer device shown runs on this system. The computer device's memory can store the various program modules that make up the control device for the engineering machinery boom, for example... Figure 6 The diagram shows an acquisition module 410, a modeling module 420, a tracking module 430, and a control module 440. The computer program comprised of these modules causes the processor to execute the steps of the engineering machinery boom control methods described in the various embodiments of this application.

[0137] Figure 7 The computer device shown can be used as follows Figure 6 The acquisition module 410 in the control device for the boom of the engineering machinery shown executes step 210. The computer device can execute step 220 via the modeling module 420. The computer device can execute step 230 via the tracking module 430. The computer device can execute step 240 via the control module 440.

[0138] This application provides an electronic device, comprising: at least one processor; and a memory connected to the at least one processor; wherein the memory stores instructions executable by the at least one processor, and the at least one processor implements the above-described engineering machinery boom control method by executing the instructions stored in the memory. When the processor executes the instructions, it performs the following steps:

[0139] Real-time acquisition of multiple joint angles;

[0140] Based on the joint parameters of the engineering machinery boom and the multiple joint angles, a dynamic model is obtained by using dynamic modeling.

[0141] Based on the dynamic model, a sliding mode control algorithm is used to perform trajectory tracking control on the boom of the engineering machinery to obtain the sliding mode control law;

[0142] Based on the sliding mode control law, each joint of the engineering machinery boom is controlled.

[0143] In one embodiment, the step of using a sliding mode control algorithm to perform trajectory tracking control on the boom of the engineering machinery based on the dynamic model to obtain the sliding mode control law includes:

[0144] Based on the desired trajectory and the joint angle matrix composed of the multiple joint angles, a sliding surface is constructed;

[0145] Based on the sliding surface, the Lyapunov function is constructed;

[0146] Based on the aforementioned dynamic model and Lyapunov function, a sliding mode controller is constructed.

[0147] The stability analysis of the sliding mode controller is performed using the Lyapunov function, and the sliding mode control law is obtained after the stability analysis is completed.

[0148] In one embodiment, the construction of the sliding mode controller based on the dynamic model and the Lyapunov function includes:

[0149] The dynamic model is linearized to obtain a linearized expression;

[0150] Based on the Lyapunov function, the maximum value of the linearized expression is taken to construct the sliding mode controller.

[0151] In one embodiment, the sliding mode controller is:

[0152]

[0153] Where τ is the sliding mode control law, n is the number of joints in the boom of the engineering machinery, s is the sliding surface, and s1, s n Let sgn be the element in the matrix corresponding to the sliding mode surface, k be the sign function, and k1 and k2 be the coefficients. n These are the elements in the matrix corresponding to the coefficients.

[0154] In one embodiment, the sliding mode controller is used to implement quasi-sliding mode control.

[0155] In one embodiment, the sliding mode controller is:

[0156]

[0157] Where τ is the sliding mode control law, n is the number of joints in the boom of the engineering machinery, s is the sliding surface, and s1, s n Let be the elements in the matrix corresponding to the sliding mode surface, sat be the saturation function, k be the coefficients, and k1, k2, k3, k4, k5, k6, k7, k8, k9, k1, k9, k1, k2 ... n These are the elements in the matrix corresponding to the coefficients.

[0158] Those skilled in the art will understand that embodiments of this application can be provided as methods, systems, or computer program products. Therefore, this application can take the form of a completely hardware embodiment, a completely software embodiment, or an embodiment combining software and hardware aspects. Furthermore, this application can take the form of a computer program product embodied on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.

[0159] This application is described with reference to flowchart illustrations and / or block diagrams of methods, apparatus (systems), and computer program products according to embodiments of this application. It will be understood that each block of the flowchart illustrations and / or block diagrams, and combinations of blocks in the flowchart illustrations and / or block diagrams, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, special-purpose computer, embedded processor, or other programmable data processing apparatus to produce a machine, such that the instructions, which execute via the processor of the computer or other programmable data processing apparatus, generate instructions for implementing the flowchart... Figure 1 One or more processes and / or boxes Figure 1 A device that provides the functions specified in one or more boxes.

[0160] These computer program instructions may also be stored in a computer-readable storage medium that can direct a computer or other programmable data processing device to function in a particular manner, such that the instructions stored in the computer-readable storage medium produce an article of manufacture including instruction means, which are implemented in a process Figure 1 One or more processes and / or boxes Figure 1The function specified in one or more boxes.

[0161] These computer program instructions may also be loaded onto a computer or other programmable data processing equipment to cause a series of operational steps to be performed on the computer or other programmable equipment to produce a computer-implemented process, thereby providing instructions that execute on the computer or other programmable equipment for implementing the process. Figure 1 One or more processes and / or boxes Figure 1 The steps of the function specified in one or more boxes.

[0162] In a typical configuration, a computing device includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.

[0163] Memory may include non-persistent memory in computer-readable media, such as random access memory (RAM) and / or non-volatile memory, such as read-only memory (ROM) or flash RAM. Memory is an example of computer-readable media.

[0164] Computer-readable media includes both permanent and non-permanent, removable and non-removable media that can store information using any method or technology. Information can be computer-readable instructions, data structures, modules of programs, or other data. Examples of computer storage media include, but are not limited to, phase-change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technologies, CD-ROM, digital versatile optical disc (DVD) or other optical storage, magnetic tape, magnetic disk storage or other magnetic storage devices, or any other non-transferable medium that can be used to store information accessible by a computing device. As defined herein, computer-readable media does not include transient computer-readable media, such as modulated data signals and carrier waves.

[0165] It should also be noted that the terms "comprising," "including," or any other variations thereof are intended to cover non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements includes not only those elements but also other elements not expressly listed, or elements inherent to such process, method, article, or apparatus. Unless otherwise specified, an element defined by the phrase "comprising one..." does not exclude the presence of other identical elements in the process, method, article, or apparatus that includes that element.

[0166] The above are merely embodiments of this application and are not intended to limit the scope of this application. Various modifications and variations can be made to this application by those skilled in the art. Any modifications, equivalent substitutions, improvements, etc., made within the spirit and principles of this application should be included within the scope of the claims of this application.

Claims

1. A control method for an engineering machinery boom, characterized in that, include: Real-time acquisition of multiple joint angles; Based on the joint parameters of the engineering machinery boom and the multiple joint angles, a dynamic model is obtained by using dynamic modeling. Based on the dynamic model, a sliding mode control algorithm is used to perform trajectory tracking control on the boom of the engineering machinery to obtain the sliding mode control law; Based on the sliding mode control law, each joint of the engineering machinery boom is controlled; The step of using a sliding mode control algorithm to perform trajectory tracking control on the boom of the engineering machinery based on the dynamic model to obtain the sliding mode control law includes: Based on the desired trajectory and the joint angle matrix composed of the multiple joint angles, a sliding surface is constructed; Based on the sliding surface, the Lyapunov function is constructed; Based on the aforementioned dynamic model and Lyapunov function, a sliding mode controller is constructed. The stability analysis of the sliding mode controller is performed using the Lyapunov function, and the sliding mode control law is obtained after the stability analysis is completed. The sliding mode controller is: , in, For sliding mode control law, The number of joints in the boom of an engineering machine. For sliding surface, , Let be the element in the matrix corresponding to the sliding mode surface, and sgn be the sign function. For coefficients, , These are the elements in the matrix corresponding to the coefficients.

2. The method for controlling the boom of engineering machinery according to claim 1, characterized in that, The sliding mode controller constructed based on the dynamic model and the Lyapunov function includes: The dynamic model is linearized to obtain a linearized expression; Based on the Lyapunov function, the maximum value of the linearized expression is taken to construct the sliding mode controller.

3. The method for controlling the boom of engineering machinery according to claim 1, characterized in that, When the sliding mode controller is used to implement quasi-sliding mode control, the sliding mode controller is: , in, For sliding mode control law, The number of joints in the boom of an engineering machine. For sliding surface, , Let be the element in the matrix corresponding to the sliding mode surface, and let 'sat' be the saturation function. For coefficients, , These are the elements in the matrix corresponding to the coefficients.

4. A control device for an engineering machinery boom, characterized in that, include: The acquisition module is used to acquire multiple joint angles in real time; The modeling module is used to obtain a dynamic model based on the joint parameters of the engineering machinery boom and the multiple joint angles using dynamic modeling. The tracking module is used to perform trajectory tracking control of the engineering machinery boom based on the dynamic model and employing a sliding mode control algorithm to obtain the sliding mode control law. The process of performing trajectory tracking control of the engineering machinery boom based on the dynamic model and employing a sliding mode control algorithm to obtain the sliding mode control law includes: constructing a sliding surface based on the desired trajectory and a joint angle matrix composed of the multiple joint angles; constructing a Lyapunov function based on the sliding surface; constructing a sliding mode controller based on the dynamic model and the Lyapunov function; performing stability analysis on the sliding mode controller using the Lyapunov function; and obtaining the sliding mode control law after the stability analysis is completed. The sliding mode controller is: , in, For sliding mode control law, The number of joints in the boom of an engineering machine. For sliding surface, , Let be the element in the matrix corresponding to the sliding mode surface, and sgn be the sign function. For coefficients, , The coefficients are elements in the matrix; The control module is used to control each joint of the engineering machinery boom based on the sliding mode control rate.

5. An engineering machinery, characterized in that, It includes a mechanical boom, which is controlled by the engineering mechanical boom control method according to any one of claims 1-3.

6. An electronic device, characterized in that, The electronic device includes: At least one processor; A memory connected to the at least one processor; The memory stores instructions that can be executed by the at least one processor, and the at least one processor implements the engineering machinery boom control method according to any one of claims 1 to 3 by executing the instructions stored in the memory.

7. A machine-readable storage medium storing instructions thereon, characterized in that, When executed by a processor, the instruction causes the processor to be configured to perform the engineering machinery boom control method according to any one of claims 1 to 3.

Citation Information

Patent Citations

  • Mechanical arm system saturation compensation control method based on neural network dynamic surface sliding mode control

    CN105223808A

  • Mechanical arm trajectory tracking control method based on high-order sliding-mode observer

    CN109927032A

  • Mechanical arm control method and device and operation machine

    CN115625710A