A Method for Stabilizing the Line of Sight of an Optoelectronic Servo Turntable Based on an Adaptive Sliding Mode Controller
By establishing a multibody dynamics model and designing an adaptive sliding mode controller with a non-singular terminal sliding surface and an adaptive fast approach law, the problems of coupling effect and carrier disturbance in the line-of-sight stabilization control of the photoelectric servo turntable were solved, and high-precision and fast line-of-sight stabilization control was achieved.
Patent Information
- Application Number
- CN202411306657.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-19
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2044-09-19
AI Technical Summary
Existing photoelectric servo turntable line-of-sight stabilization control methods fail to effectively consider the coupling effect between different frames of the servo system and the carrier disturbance factors, resulting in poor robustness of the control results. Furthermore, classical sliding mode control suffers from steady-state error and chattering problems.
A multibody dynamics model considering the coupling effect of different frames of the servo system and the disturbance factors of the carrier is established. A non-singular terminal sliding surface and an adaptive fast approach law are designed. An adaptive sliding mode controller is used to stabilize the line of sight of the photoelectric servo turntable.
It improves the stability of the photoelectric servo turntable's line of sight, reduces the approach time of sliding mode control, weakens chattering, enhances robustness to external disturbances, and improves control accuracy and response time.
Smart Images

Figure CN119310843B_ABST
Abstract
Description
Technical Field
[0001] This invention belongs to the field of optoelectronic servo control technology, specifically relating to a method for stabilizing the line-of-sight control of an optoelectronic servo turntable based on an adaptive sliding mode controller. Background Technology
[0002] As the application scenarios of optoelectronic equipment become increasingly complex and diversified, higher demands are placed on its line-of-sight stabilization control under complex disturbance conditions. Currently, the main line-of-sight stabilization control algorithms for optoelectronic turntables are conventional classical control algorithms, such as PID control. However, due to the lack of a reasonable system dynamics model, when the carrier of the optoelectronic equipment experiences severe disturbances, the disturbances can significantly impact the stability of the optical axis pointing in the servo control system. Traditional classical control algorithms struggle to achieve high-precision optical axis stabilization control. Current research on the dynamics modeling of optoelectronic servo control turntables mainly focuses on kinematic modeling of the system or single-axis subsystem modeling, without fully considering the influence of multi-axis coupling and carrier disturbances on the system.
[0003] Sliding mode control is a variable structure control algorithm with good robustness to system parameters and external disturbances, making it a suitable application for the optical axis stabilization control of optoelectronic servo turntables. Once the system enters sliding mode motion, its motion depends only on the selection of control parameters, and is independent of the system's own parameters and external disturbances. However, the classic linear sliding surface suffers from the problem that the system's steady-state error is difficult to converge to zero within a finite time. When applied to the line-of-sight stabilization control of optoelectronic servo turntables, this leads to significant control errors and response times. Since line-of-sight stabilization control of optoelectronic servo turntables requires high control accuracy and response time, and chattering can occur during sliding mode control, the classic linear sliding surface negatively impacts the line-of-sight stabilization performance of optoelectronic servo turntables. Summary of the Invention
[0004] The purpose of this invention is to address the problems of poor robustness of existing servo photoelectric turntable optical axis stabilization control methods, which fail to consider the coupling effects between different frames of the servo system and the influence of carrier disturbance factors on the photoelectric turntable. This invention provides a photoelectric servo turntable line-of-sight stabilization control method based on an adaptive sliding mode controller. This method establishes a multibody dynamics model that considers the coupling effects between different frames of the servo system and carrier disturbance factors. It is applicable to various multi-axis photoelectric turntables where the center of gravity is collinear or non-collinear with the rotation axis. Based on this multibody dynamics model, a non-singular terminal sliding mode surface is designed for the speed control loop of the optical TV axis stabilization, realizing an adaptive fast approach law. This provides good robustness against external disturbances, reduces the approach time of the sliding mode control, weakens chattering, and improves the stability performance of the optical TV axis.
[0005] To achieve the above objectives, the technical solution provided by this invention is:
[0006] The photoelectric servo turntable line-of-sight stabilization control method based on adaptive sliding mode controller includes the following steps:
[0007] Step 1: Establish a multibody dynamics model that considers the coupling effects of different frames in the servo system and the disturbance factors of the carrier.
[0008]
[0009] In the formula, A(x1) and C(x1) are the correlation functions of variable x1, B(x1,x2) are the correlation functions of variables x1 and x2; u(t) is the external control input;
[0010] Step 2: To address the line-of-sight stabilization control problem of the optoelectronic system, an integral-shaped non-singular terminal sliding surface is designed; the non-singular terminal sliding surface is as follows: in, Let α be the independent variable parameter of the sliding surface, α > 0, β > 0, 1 < γ < 2;
[0011] Step 3: Design an adaptive fast approach law to enable the photoelectric servo system to quickly approach the sliding surface; the form of the sliding mode control adaptive fast approach law is as follows:
[0012]
[0013] Where k, ε, and δ are all control parameters, and k > 0, ε > 0, 0 < δ < 1; σ is a preset threshold, 0 < σ < 1; tanh(s) represents the hyperbolic tangent function, and e is the base of the natural logarithm;
[0014] Step 4: Based on the multibody dynamics model established in Step 1, and according to the non-singular terminal sliding surface designed in Step 2 and the adaptive fast approach law designed in Step 3, design an adaptive non-singular terminal sliding controller.
[0015] The designed sliding mode controller is as follows:
[0016]
[0017] Step 5: Using the adaptive non-singular Terminal sliding mode controller designed in Step 4, perform line-of-sight stabilization speed loop control on the multi-axis turntable photoelectric servo control system to enable the servo system to quickly reach a stable state.
[0018] Further, step 1 includes the following steps:
[0019] Step 1.1: Using the principle of virtual power, describe the ordinary dynamic equations of the multi-axis photoelectric turntable servo system as follows:
[0020] Among them, matrix
[0021] coefficient vector matrix
[0022] In the formula, f and h This is the intermediate vector matrix. m It is a diagonal matrix composed of the quality of different frameworks of the system. F For the external force matrix, M * The external moment matrix, J The inertial tensor matrix, T The path matrix, C and C 0 represents the weighted volume hinge vector matrix. It is the angular velocity of the carrier in the system. p It is the pivot basis vector;
[0023] Step 1.2: Draw the directed graph of the multi-axis photoelectric turntable servo system, and establish the association matrix of the multi-axis photoelectric turntable servo system based on the directed graph. S and pathway matrix T ;
[0024] Step 1.3: Establish a weighted body hinge vector matrix based on the distances from different hinges to the center of mass of the rigid body associated with each hinge, where the matrix element c ia This represents the product of the vector from the centroid of the i-th rigid frame to the a-th hinge and the corresponding element of the incidence matrix;
[0025] Step 1.4: Combine the pivot vectors of each hinge in the system to form a matrix. p T Then the relative angular velocity matrix of each rigid body in the system is obtained. Ω and absolute angular velocity matrix ω and intermediate vector matrix f and h ;
[0026] Relative angular velocity matrix Absolute angular velocity matrix ω = ω 01- T T Ω , ω 0 represents the angular velocity of the carrier in the system;
[0027] intermediate vector matrix f for:
[0028]
[0029] Wherein, matrix parameters i + (a) and i - (a) are two rigid bodies connected by directed arc a, i + (a) represents the rigid body at the starting point of the directed arc a, i - (a) represents the rigid body at the endpoint of the directed arc a, i.e., i.e. + (a) From directed arc a to i - (a), where n is the total number of system frameworks;
[0030] intermediate vector matrix h for:
[0031]
[0032] Among them, matrix elements
[0033]
[0034] Step 1.5: Determine the external force matrix of the photoelectric system. F and external moment matrix M * :
[0035]
[0036] Where: n is the number of turntable frames, and matrix element F i M is the resultant force acting on the center of mass of the i-th rotating frame of the photoelectric system. i J represents the total torque acting on the i-th rotating frame of the rigid body. This total torque includes the control torque, friction torque, and winding torque, etc. i Let be the inertia tensor of the i-th frame rotation;
[0037] Step 1.6: Substitute the formulas obtained in steps 1.2 to 1.5 into the formula in step 1.1 to obtain the multibody dynamics model of the photoelectric system.
[0038] Furthermore, the specific process of step 1.2 is as follows:
[0039] Step 1.2.1: Draw multiple vertices, with each vertex representing a rigid body in the multi-axis photoelectric turntable servo system. The directed connections between points represent the hinges connecting the rigid bodies, thus forming a directed graph of the multi-axis photoelectric turntable servo system.
[0040] Step 1.2.2: Establish the association matrix of the multi-axis photoelectric turntable servo system based on the directed graph. S and pathway matrix T Among them, the correlation matrix S and pathway matrix T The matrix elements are as follows:
[0041]
[0042] The advantages of this invention are:
[0043] 1. In establishing the multi-axis coupled dynamic model of the photoelectric servo turntable, the control method of this invention considers the coupling effect between different frames of the servo system and the influence of carrier disturbance factors on the stability performance of the photoelectric servo turntable's line of sight. Based on the established dynamic model, a non-singular terminal sliding surface is designed for the speed control loop of the photoelectric servo turntable's line of sight. An adaptive non-singular terminal sliding controller designed with the non-singular terminal sliding surface is used, combined with an adaptive fast approach law, to enable the photoelectric servo system to quickly reach a stable state, reduce the approach time of the sliding control, weaken chattering, and have good robustness to external disturbances, thereby improving the stability performance of the photoelectric turntable's line of sight.
[0044] 2. The modeling process in this invention is clear, simple, and standardized, and can be easily implemented through computer programming. The model is also highly versatile and applicable to various multi-axis photoelectric servo turntables where the center of gravity and the rotation axis are collinear or not.
[0045] 3. The non-singular nonlinear terminal sliding surface designed in this invention enables the system to converge rapidly within a finite time and effectively avoids singularity problems, thereby improving the control accuracy and response time of the photoelectric servo turntable's line-of-sight stability.
[0046] Additional aspects and advantages of the invention will be set forth in part in the description which follows, and in part will be obvious from the description, or may be learned by practice of the invention. Attached Figure Description
[0047] The above and / or additional aspects and advantages of the present invention will become apparent and readily understood from the description of the embodiments taken in conjunction with the following drawings, in which:
[0048] Figure 1 This is a flowchart of the method of the present invention;
[0049] Figure 2 This is a schematic diagram of the process for establishing system dynamics modeling in this invention;
[0050] Figure 3 It is a schematic diagram of the directed graph of the system.
[0051] Figure 4 The simulation effect diagram is controlled using the method of this invention. Detailed Implementation
[0052] The embodiments of the present invention are described in detail below. These embodiments are exemplary and intended to explain the present invention, and should not be construed as limiting the present invention.
[0053] Reference Figure 1 A line-of-sight stabilization control method for an optoelectronic servo turntable based on an adaptive sliding mode controller includes the following steps:
[0054] Step 1: Establish a multibody dynamics model that considers the coupling effects of different frames in the servo system and the disturbance factors of the carrier, such as Figure 2 As shown, the specific steps are as follows:
[0055] Step 1.1: For a multi-axis turntable optoelectronic system, the general dynamic equations of a multi-body system expressed using the principle of virtual power are described as follows:
[0056]
[0057] Where q represents the generalized degree-of-freedom vector, which uses relative coordinates and can be transformed using the direction cosine matrix. The two coefficients in the equation are given below using the concept of an augmented body:
[0058]
[0059] In the formula, the underlined element represents a matrix whose elements are vectors or tensors.
[0060] The expression for the coefficient vector matrix is as follows:
[0061]
[0062] In the formula, f and h This is the intermediate vector matrix. m It is a diagonal matrix composed of the quality of different frameworks of the system. F For the external force matrix, M * The external moment matrix, J The inertial tensor matrix, T The path matrix, C and C 0 represents the weighted volume hinge vector matrix. It is the angular velocity of the carrier in the system. p It is the pivot basis vector;
[0063] Step 1.2: First, draw the directed graph of the system. For example... Figure 3 As shown in the diagram, each vertex represents a rigid body, and the connections between points represent the relationships between rigid bodies. Then, the system's incidence matrix is established based on the directed graph. S and pathway matrix T The matrix elements are defined as follows:
[0064]
[0065] Step 1.3: Establish a weighted body hinge vector matrix based on the distances from different hinges to their associated rigid body centroids. C and C 0. Its matrix element c ia This represents the result of multiplying the vector from the centroid of the i-th rigid frame to the a-th hinge with the corresponding elements of the correlation matrix.
[0066] Step 1.4: Derive the system's kinematic parameter matrix. This involves combining the pivot vectors of each hinge into a matrix representation. p T Then the system's relative angular velocity matrix Ω With absolute angular velocity matrix ω They are respectively:
[0067]
[0068] ω = ω 01- T T Ω (6)
[0069] in ω 0 represents the angular velocity of the rigid body (i.e., the carrier in this invention).
[0070] In equation (3) the matrix f The expression is:
[0071]
[0072] Wherein, matrix parameters i + (a) and i - (a) represents two vertices (rigid bodies) connected by directed arc a, i + (a) is a rigid body at the starting point of directed arc a, i - (a) is the rigid body at the endpoint of the directed arc a, i.e., i + (a) pointing to i via directed arc a - (a).
[0073] In equation (3) the matrix h The expression is:
[0074]
[0075] Among them, matrix elements
[0076]
[0077] Step 1.5: Derive the system's external force matrix F and external moment matrix M* ,but
[0078]
[0079] in, J Let F represent the inertia tensor matrix, n=3, and the matrix parameter F. i M is the resultant force acting on the center of mass of the i-th rotating frame of the photoelectric system. i J represents the total torque acting on the i-th rotating frame of the rigid body, which includes the control torque, friction torque, and winding torque, etc. i Let be the inertia tensor of the i-th frame rotation. For any rigid body, its inertia tensor is defined as follows:
[0080]
[0081] In the formula, J x J y J z Let be the principal moment of inertia of the rigid body.
[0082] Step 1.6: Substitute equations (4)-(10) into equations (1)-(3) to obtain the multibody dynamics equations of the photoelectric servo system.
[0083] Step 2: To address the line-of-sight stabilization control problem of the photoelectric system, an integral-shaped non-singular terminal sliding surface is designed. The non-singular terminal sliding surface is as follows:
[0084]
[0085] in: Let α be the independent variable parameter of the sliding surface, α > 0, β > 0, 1 < γ < 2.
[0086] Step 3: To ensure the system can quickly approach the sliding surface, a novel adaptive fast approach law for sliding mode control is designed, with the following form:
[0087]
[0088] Where k, ε and δ are control parameters, and k > 0, ε > 0 > 0, 0 < σ < 1, 0 < δ < 1, tanh(s) represents the hyperbolic tangent function, and e is the base of the natural logarithm.
[0089] Equation (12) can adaptively adjust the speed approaching the sliding surface, where the exponential approach term When the error is large, it can significantly accelerate the approach speed; when the error is small, it approaches the conventional exponential approach term -ks; power-law approach. This can reduce chattering, where σ is a preset threshold. When the error exceeds the threshold σ, due to... Therefore, the power-law approaching term can also accelerate the approach speed, while minimizing the phenomenon that the power-law approaching term might actually increase the approach time during error convergence. After the error is less than the threshold σ, because... Therefore, it can reduce flutter.
[0090] Step 4: Design the sliding mode controller.
[0091] Consider a second-order dynamic equation in the following form:
[0092]
[0093] In the formula, A(x1) and C(x1) are the correlation functions of variable x1, B(x1,x2) are the correlation functions of variables x1 and x2, and u(t) is the external control input.
[0094] The non-singular terminal sliding surface shown in equation (11) can be specifically written as:
[0095]
[0096] exist Nearby, taking its derivative, we get:
[0097]
[0098] Therefore, the non-singular terminal sliding surface shown in equation (11) is continuous, and its derivative can be obtained as follows:
[0099]
[0100] Substituting equation (13) into equation (16), we get:
[0101]
[0102] Using the sliding surface shown in equation (11) and the adaptive fast approach law shown in equation (12), the form of the sliding controller can be obtained as follows:
[0103]
[0104] The adaptive nonsingular Terminal sliding controller (Equation 18), designed using the sliding surface shown in Equation (11) and the adaptive fast reaching law shown in Equation (12), can perform closed-loop feedback control on second-order nonlinear systems. It can enable the system state to converge quickly to the sliding surface and is robust to external carrier disturbances.
[0105] Step 5: Using the adaptive non-singular Terminal sliding mode controller designed in Step 4, the line-of-sight stabilization speed loop control of the multi-axis turntable photoelectric servo control system is performed to enable the servo system to quickly reach a stable state.
[0106] Stability proof: Define the Lyapunov function related to the sliding surface (11) as follows:
[0107]
[0108] We can obtain:
[0109]
[0110] because and s 2 =2V, equation (20) can also be written as:
[0111]
[0112] make Then we can get: Since 1 < γ < 2, λ1 > 0 and λ2 > 0.
[0113] Therefore, when x2≠0, according to the extended Lyapunov stability theory, the system will reach s=0 in a finite time, and the convergence time meets the requirements.
[0114] When x2 = 0, replacing the control input u(t) in equation (13) with equation (18) yields:
[0115]
[0116] It can be seen from equation (22) that when s > 0, When s < 0 This means that x2 = 0 is not stable. Therefore, the system can converge to the sliding surface from any position in the state space. The adaptive non-singular Terminal sliding controller given by Equation (16) can make the state shown in Equation (11) converge to 0, thus achieving stable control.
[0117] The following uses a three-axis photoelectric turntable as an example to illustrate the specific process of the method of the present invention. In this method, the outer ring frame of the three-axis photoelectric turntable controls the roll angle of the photoelectric sensor, the middle ring frame controls the pitch angle, and the inner ring frame controls the azimuth angle. Figure 1 As shown, an adaptive nonsingular terminal sliding mode controller is designed for this system. The specific steps are as follows:
[0118] Step 1: Establish the multibody dynamics equations of the system. The specific steps can be divided into:
[0119] Step 1.1: Let B0, B1, B2, and B3 represent the carrier, outer roll frame, mid-pitch frame, and inner orientation frame, respectively. In this example, the three-axis photoelectric turntable has three rotational degrees of freedom: outer roll frame angle q1, mid-pitch frame angle q2, and inner orientation frame angle q3, i.e., q = [q1, q2, q3]. Using T... ij B j To B i The coordinate transformation matrix between them is:
[0120]
[0121] Step 1.2: Draw the directed graph of the drawing system, such as... Figure 2 As shown; then, based on the directed graph, the correlation matrix and path matrix of the photoelectric turntable system in this invention example are as follows:
[0122]
[0123] Step 1.3: Obtain the weighted body hinge vector matrix based on the system kinematic parameters:
[0124]
[0125] In this context, the vector subscripts represent the connected coordinate system of the corresponding rigid frame, and ρ1, ρ2, ρ3, ρ4 and ρ5 are the distance parameters from the centroid of each frame to the corresponding rotation axis.
[0126] Step 1.4: Combine the pivot basis vectors of each hinge into a matrix, as shown in the following expression:
[0127]
[0128] The angular velocity of the system is:
[0129]
[0130] intermediate vector matrix f and h :
[0131]
[0132] Step 1.5: Let F1, F2, and F3 represent the resultant forces acting on the centers of mass of the three rigid rotating frames B1, B2, and B3, respectively; M1, M2, and M3 represent the torques applied to the centers of mass of the three rigid bodies, respectively; J1, J2, and J3 represent the inertia tensors of the rotation of the three frames, respectively; and m1, m2, and m3 represent the masses of the three frames, respectively. Then the coefficients in equation (3) can be written as:
[0133]
[0134] Step 1.6: Substituting the above equations into equations (1), (2), and (3) and decoupling the left side of the equations, we can obtain the system dynamics equations in the form of equation (1) as follows:
[0135]
[0136] The coefficients on the left side of the equation contain trigonometric function coupling terms for three directional angles, while the coefficients on the right side contain coupling terms related to three directional angles, angular velocity, and carrier angular velocity. It is clear from the dynamic model that this three-axis optoelectronic servo system is a multi-input-output nonlinear system with coupling effects. In particular, due to the relatively small moment of inertia of the azimuth frame, the influence of the roll and pitch frames is not negligible.
[0137] Step 2: Design the non-singular terminal sliding surface. Define the tracking error as:
[0138]
[0139] Where i = 1, 2, 3, Represents the frame angle q i The target velocity. The non-singular terminal sliding surface is designed as follows:
[0140]
[0141] Step 3: Design an adaptive non-singular terminal sliding mode controller. Based on the dynamic equation established by equation (31), using the non-singular terminal sliding surface shown in equation (30) and the adaptive fast approach law shown in equation (12), the control input can be obtained as follows:
[0142]
[0143] Step 4: Using the sliding mode controller designed by formula (31), the three-axis photoelectric system in the example of this invention is subjected to line-of-sight stabilization speed loop control, which can enable the system to quickly reach a stable state and has good robustness to disturbances from external carriers.
[0144] Figure 4 Simulation results of sliding mode control for an example of this invention are presented. The angular velocities of the carrier in all three directions are subjected to significant white noise disturbances. The control targets are set as follows: outer roll frame velocity 20° / s, pitch frame 30° / s, and azimuth frame 40° / s. It can be seen that the angular velocities of the three frames of the photoelectric turntable quickly reach the steady-state control target, demonstrating high accuracy and minimal chattering.
[0145] This invention, based on the modeling principles of the Roberson-Wittenburg method, employs graph theory to describe the structure and pathway relationships of multi-rigid-body systems. Using the relative displacements between adjacent rigid bodies as generalized coordinates, and employing a standardized modeling and solution process, a multi-body dynamics model is established that considers the coupling effects between different frames of the servo system and carrier disturbance factors. This model is applicable to the general form of dynamic equations for any multi-rigid-body system. Based on this dynamics model, this invention designs a non-singular terminal sliding mode surface and a novel adaptive fast approach law for the speed control loop of the optical television axis. This law exhibits good robustness to external disturbances, reduces the approach time of sliding mode control, and weakens chattering.
[0146] The above description is only a preferred embodiment of the present invention. It should be noted that for those skilled in the art, several improvements and modifications can be made without departing from the technical principles of the present invention, and these improvements and modifications should also be considered within the scope of protection of the present invention.
Claims
1. A method for stabilizing the line-of-sight of an opto-electronic servo-gimbal based on an adaptive sliding mode controller, characterized in that, Includes the following steps: Step 1: Establish a multibody dynamics model that considers the coupling effects of different frames in the servo system and the disturbance factors of the carrier. , In the formula, and For variables Related functions, For variables and Related functions; For external control input; Step 2: To address the line-of-sight stabilization control problem of the optoelectronic system, an integral-shaped non-singular terminal sliding surface is designed; the non-singular terminal sliding surface is as follows: ,in, The sliding surface is the independent variable. , and The parameters of the sliding surface are: , , ; Step 3: Design an adaptive fast approach law to enable the photoelectric servo system to quickly approach the sliding surface; the form of the sliding mode control adaptive fast approach law is as follows: ; in, , and All are control parameters, and satisfy the following: , , ; For the preset threshold, ; tanh(s) represents the hyperbolic tangent function, and e is the base of the natural logarithm; Step 4: Based on the multibody dynamics model established in Step 1, and according to the non-singular terminal sliding surface designed in Step 2 and the adaptive fast approach law designed in Step 3, design an adaptive non-singular terminal sliding controller. The designed sliding mode controller is as follows: ; Step 5: Using the adaptive non-singular Terminal sliding mode controller designed in Step 4, perform line-of-sight stabilization speed loop control on the multi-axis turntable photoelectric servo control system to enable the servo system to quickly reach a stable state.
2. The photoelectric servo turntable line-of-sight stabilization control method based on an adaptive sliding mode controller according to claim 1, characterized in that, Step 1 includes the following steps: Step 1.1: Using the principle of virtual power, describe the ordinary dynamic equations of the multi-axis photoelectric turntable servo system as follows: ; Among them, matrix ; coefficient vector matrix ; In the formula, and This is the intermediate vector matrix. It is a diagonal matrix composed of the quality of different frameworks of the system. For the external force matrix, The external moment matrix, The inertial tensor matrix, The path matrix, and Represents the weighted body hinge vector matrix. It is the angular velocity of the carrier in the system. The pivot basis vector matrix; Step 1.2: Draw the directed graph of the multi-axis photoelectric turntable servo system, and establish the association matrix of the multi-axis photoelectric turntable servo system based on the directed graph. and pathway matrix ; Step 1.3: Establish a weighted body hinge vector matrix based on the distances from different hinges to the center of mass of the rigid body associated with each hinge, where the matrix elements... This represents the product of the vector from the centroid of the i-th rigid frame to the a-th hinge and the corresponding element of the incidence matrix; Step 1.4: Combine the pivot vectors of each hinge in the system to form a matrix. Then we can obtain the stiffness of each component in the system. The relative angular velocity matrix of the body and absolute angular velocity matrix and intermediate vector matrix and ; Relative angular velocity matrix Absolute angular velocity matrix , Let be the angular velocity of the carrier in the system; intermediate vector matrix for: Wherein, matrix parameters , and These are two rigid bodies connected by a directed arc a. The rigid body representing the starting point of the directed arc a. The rigid body representing the endpoint of the directed arc a, i.e. Pointed via directed arc a n is the number of turntable frames; intermediate vector matrix for: Among them, matrix elements ; Step 1.5: Determine the external force matrix of the photoelectric system. and external moment matrix : ; Where: matrix elements The resultant force acting on the center of mass of the i-th rotating frame of the photoelectric system is... Let be the total torque acting on the i-th rotating frame of the rigid body. Let be the inertia tensor of the i-th frame rotation; Step 1.6: Substitute the formulas obtained in steps 1.2 to 1.5 into the formula in step 1.1 to obtain the multibody dynamics model of the photoelectric system.
3. The photoelectric servo turntable line-of-sight stabilization control method based on an adaptive sliding mode controller according to claim 2, characterized in that, The specific process of step 1.2 is as follows: Step 1.2.1: Draw multiple vertices, with each vertex representing a rigid body in the multi-axis photoelectric turntable servo system. The directed connections between points represent the hinges connecting the rigid bodies, thus forming a directed graph of the multi-axis photoelectric turntable servo system. Step 1.2.2: Establish the association matrix of the multi-axis photoelectric turntable servo system based on the directed graph. and pathway matrix Among them, the correlation matrix and pathway matrix The matrix elements are as follows: 。
Citation Information
Patent Citations
Rapid tracking control system and method for permanent magnet brushless direct current motor servo system
CN113193794A
Finite time speed control method for permanent magnet synchronous motor based on fast integral terminal sliding mode and disturbance estimation
US20230246578A1
