A wide-range angular position tracking control method and system for an optoelectronic pod

By setting the switching speed and position control of angular position error levels and optimizing control parameters, the contradiction in the dynamic performance of the optoelectronic pod during full-range angular position tracking was resolved, achieving fast, overshoot-free tracking at large angles and stable tracking at low speeds at small angles, thus improving the tracking performance of the optoelectronic pod.

CN116860014BActive Publication Date: 2026-11-17CHANGCHUN INST OF OPTICS FINE MECHANICS & PHYSICS CHINESE ACAD OF SCI
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202310962728.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-08-02
Publication Date
2026-11-17
Estimated Expiration
2043-08-02

AI Technical Summary

Technical Problem

Existing optoelectronic pods cannot simultaneously meet the dynamic performance requirements of fast, overshoot-free large-angle movement and slow, low-speed small-angle movement when tracking angular position across the entire range. PID control algorithms struggle to reconcile the contradiction between speed and overshoot.

Method used

By setting the magnitude level of angular position error, speed control and position control can be switched respectively, and the control parameters of each level can be tuned, including adjusting the proportional gain and integral gain, to achieve error level switching and parameter optimization.

Benefits of technology

It achieves fast, overshoot-free tracking of the optoelectronic pod for large-angle commands and stable, low-speed tracking of small-angle commands, while also meeting the dynamic performance requirements of a rotating electromechanical servo system. The design and parameter tuning process is simple.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN116860014B_ABST
    Figure CN116860014B_ABST
Patent Text Reader

Abstract

This invention discloses a wide-range angular position tracking control method and system for an optoelectronic pod, applicable to the field of electromechanical servo control technology. The method includes: setting an angular position error level according to the target tracking requirements of the optoelectronic pod; switching speed control and position control respectively based on the angular position error level; and tuning the parameters of the speed control and position control. The design and parameter tuning process of this application are simple, and only one set of control parameters can ensure both low-speed tracking performance for small-angle commands and fast, overshoot-free tracking characteristics for large-angle commands.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of electromechanical servo control technology, and in particular to a wide-range angular position tracking control method and system for an optoelectronic pod. Background Technology

[0002] The optoelectronic pod, represented by the moving base, is an optoelectronic sensor imaging support device that integrates optomechanical structure, electronic imaging, servo control, and image processing. It is known as the "eyes" of unmanned systems because it can effectively isolate or compensate for uncertain disturbances and maintain the relative stability of the line of sight in inertial space. It also has advantages such as good concealment, high timeliness, high accuracy, wide reconnaissance range, and flexible use. It can be widely used in electronic reconnaissance, information warfare, target positioning, geographic mapping, disaster monitoring, traffic surveillance, etc. It not only plays a pivotal role in civilian construction, but also occupies an extremely important strategic position in national defense and military affairs, making it a vital national asset.

[0003] To achieve the two main functions of wide-area target search and target tracking for the optoelectronic pod, the frame axis should possess the following characteristics: mechanically, the frame's rotation range is typically designed to be large; in terms of motion characteristics, the frame axis should exhibit high speed and no overshoot throughout the entire range of angular position command tracking. However, in rotary electromechanical servo systems such as optoelectronic pods, when the frame axis performs angular position tracking across its entire range of motion, target search requires high speed and no overshoot for large-angle movements, while target tracking requires low-speed movements at small angles, along with rapid follow-up characteristics to target maneuvers. Currently, taking the easily implemented PID control algorithm as an example, if only a closed-loop position control method is used, a single set of control parameters cannot reconcile the contradiction between speed and overshoot across the entire range of angular movements, meaning it cannot simultaneously meet the dynamic performance requirements for tracking commands of different angle sizes.

[0004] Therefore, it is essential to improve the dynamic process of full-range angular position tracking of the optoelectronic pod frame axis through practical control algorithms or measures, so as to achieve fast, overshoot-free and stable tracking performance throughout the entire range of angular position command tracking of the frame axis. Summary of the Invention

[0005] The purpose of this application is to provide a wide-range angular position tracking control method and system for an optoelectronic pod, which aims to solve the problem of not being able to simultaneously meet the dynamic performance requirements of tracking commands of different angular sizes.

[0006] To achieve the above objectives, this application provides the following technical solution:

[0007] This application provides a wide-range angular position tracking and control method for an optoelectronic pod, including:

[0008] Based on the target tracking requirements of the optoelectronic pod, the magnitude level of angular position error is set;

[0009] Speed ​​control and position control are switched according to the magnitude level of the angular position error;

[0010] The parameters for the speed control and position control are tuned respectively.

[0011] Furthermore, the step of setting the angular position error level according to the target tracking requirements of the photoelectric pod includes the following steps:

[0012] A constant δ greater than zero is set to determine the magnitude level of the angular position error. When the absolute value of the angular position error e is less than or equal to δ, it is a small error, that is, |e|≤δ is defined as a small error; when the absolute value of the angular position error e is greater than δ, it is a large error, that is, |e|>δ is defined as a large error. The value range of the constant δ is 3°≤δ≤5°.

[0013] Furthermore, the step of switching between speed control and position control based on the magnitude of the angular position error includes the following steps:

[0014] The magnitude of the angular position error is detected in real time. When the angular position error is at a large error level, a speed closed-loop control method is adopted; when the angular position error is at a small error level, a position closed-loop control method is adopted.

[0015] Furthermore, the step of tuning the parameters of the speed control and position control respectively includes the following steps:

[0016] Tuning of speed control parameters with large error levels;

[0017] Tuning of position control parameters with small error levels;

[0018] The parameters for switching from the large error speed control mode to the small error position control mode are tuned.

[0019] Furthermore, the step of tuning the speed control parameters with large error levels includes the following steps:

[0020] An experiment using angular velocity step closed-loop control was conducted, and tuning was performed based on the angular velocity error curve, with the angular velocity command ω... r Let there be an initial angular velocity value ω0, i.e., ω r =ω0;

[0021] Adjust the proportional gain Speed.Kp and integral gain Speed.Ki in the speed closed-loop PID control parameters;

[0022] During the step angular velocity process, determine whether the angular velocity achieves zero overshoot and accurate and stable tracking. If so, determine whether the rapid performance meets the requirements. If overshoot occurs, readjust the speed closed-loop control parameters.

[0023] If the rapid performance meets the requirements, the position control parameters with small error levels are tuned.

[0024] Furthermore, the step of tuning the position control parameters at the small error level includes the following steps:

[0025] An experiment using angular position step closed-loop control was conducted. Tuning was performed based on the angular velocity curve and the angular position error curve, and the angular position command θ was... r Set as the critical value δ for the magnitude error, i.e., θ r =δ;

[0026] Adjust the proportional gain Speed.Kp and integral gain Speed.Ki in the position closed-loop PID control parameters;

[0027] During the angular position step change, determine whether the angular position achieves overshoot-free and accurate stable tracking. If so, determine the peak value ω of the angular velocity curve. f If the maximum value is reached, and overshoot occurs, the position closed-loop control parameters should be readjusted.

[0028] If the peak value of the angular velocity curve is ω f If the maximum value is found, then check if ω is satisfied. f If ω < 0, then the parameters for switching from the large error speed control mode to the small error position control mode are tuned.

[0029] If ω f If ≥ω0, then it is necessary to return to the step of tuning the speed control parameters at the large error level, continue to increase ω0, perform speed closed-loop control gain parameter adjustment, and then iterate again in the step of tuning the position control parameters at the small error level until ω is satisfied. f <ω0.

[0030] Furthermore, the step of tuning the parameters for switching from the large error speed control mode to the small error position control mode includes the following steps:

[0031] An experiment using angular position step closed-loop control was conducted. Tuning was performed based on the angular velocity curve and the angular position error curve, and the angular position command θ was... r Initially set to a value greater than the critical value δ but not exceeding the maximum limit angle θ of the photoelectric pod frame. max The constant value θ0, i.e. θ r =θ0, where δ < θ0 < θ max ;

[0032] Adjust the position closed-loop control gain parameters. When the absolute value of the angular position error is greater than δ, i.e., |e|>δ, speed closed-loop control is adopted. An initial speed command value ω1 is set to satisfy ω f ≤ω1<ω0;

[0033] When the absolute value of the angular position error is less than or equal to δ, i.e., |e|≤δ, the pre-set Pos.Kp and Pos.Ki are used for position closed-loop control;

[0034] When switching from speed closed-loop control to position closed-loop control, it is determined whether the angular position achieves zero overshoot and accurate stable tracking. If overshoot occurs, it should be ensured that ω... f Under the premise that ≤ω1<ω0, continue to increase the speed command value ω1 until no overshoot occurs during the angular position tracking process;

[0035] After achieving overshoot-free and accurate stable tracking in angular position, continue adjusting the angular position command θ0 to the maximum limit rotation angle value θ of the optoelectronic pod frame. max That is, θ0 = θ max Detect the full range of motion performance of the optoelectronic pod frame;

[0036] When switching from speed closed-loop control to position closed-loop control, it is determined whether the angular position achieves zero overshoot and accurate stable tracking. If overshoot occurs, it should be ensured that ω... f Under the premise that ≤ω1<ω0, continue to increase the speed command value ω1 until the angular position error curve does not show overshoot.

[0037] A wide-range angular position tracking control system for an optoelectronic pod is also provided, characterized in that it includes:

[0038] Classification module: Based on the target tracking requirements of the optoelectronic pod, set the angular position error level;

[0039] Control module: Switches between speed control and position control based on the magnitude of the angular position error;

[0040] Tuning module: Tunes the parameters of the speed control and position control respectively.

[0041] This application provides a wide-range angular position tracking and control method and system for an optoelectronic pod, which has the following advantages:

[0042] This application reconciles the contradiction between the wide-range angular position of the optoelectronic pod and the large-angle, fast, overshoot-free tracking and the small-angle, low-speed motion. First, the angular position error is divided into two levels: large and small. Then, based on the level of position error, a switching mechanism for position control and speed control is incorporated. Finally, the key parameters for switching between position and speed control modes are tuned. The method design and parameter tuning process are simple. With only one set of control parameters, both the low-speed tracking performance of small-angle commands and the fast, overshoot-free tracking characteristics of large-angle commands can be guaranteed. Attached Figure Description

[0043] Figure 1 This is a flowchart illustrating a wide-range angular position tracking control method for an optoelectronic pod according to Embodiment 1 of this application.

[0044] Figure 2 This is a schematic diagram illustrating the principle of a wide-range angular position tracking and control method for an optoelectronic pod according to Embodiment 1 of this application;

[0045] Figure 3 This is a schematic diagram of the speed closed-loop control structure of Embodiment 1 of this application;

[0046] Figure 4 This is a schematic diagram of the position closed-loop control structure of Embodiment 1 of this application;

[0047] Figure 5 This is a schematic flowchart illustrating the steps for tuning speed control parameters with large error levels in Embodiment 1 of this application.

[0048] Figure 6 This is a schematic flowchart illustrating the steps for tuning position control parameters with small error levels in Embodiment 1 of this application.

[0049] Figure 7 This is a flowchart illustrating the steps of adjusting parameters for switching from a large-error speed control mode to a small-error position control mode in Embodiment 1 of this application.

[0050] Figure 8 This is a schematic diagram of the structure of a wide-range angular position tracking control system for an optoelectronic pod according to Embodiment 2 of this application. Detailed Implementation

[0051] It should be understood that the specific embodiments described herein are merely illustrative of this application and are not intended to limit this application.

[0052] The technical solutions of the embodiments of this application will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only a part of the embodiments of this application, and not all of the embodiments. Based on the embodiments of this application, all other embodiments obtained by those of ordinary skill in the art without creative effort are within the scope of protection of this application.

[0053] Example 1

[0054] Please see Figure 1 and Figure 2 The figures are a flowchart and a schematic diagram of the principle of a wide-range angular position tracking and control method for an optoelectronic pod proposed in this application; the specific steps include:

[0055] Step S1: Set the angular position error level according to the target tracking requirements of the photoelectric pod.

[0056] In this embodiment, based on the target tracking requirements of the optoelectronic pod, a constant δ greater than zero is set to determine the magnitude level of the angular position error. The value range of the constant δ is 3°≤δ≤5°. If δ is too large, it will reduce the fast performance of small-angle tracking; if δ is too small, it will reduce the fast performance of large-angle tracking. If the target tracking requirements of the optoelectronic pod emphasize large-angle tracking performance, δ can be appropriately increased; if the emphasis is on small-angle tracking performance, δ can be appropriately decreased.

[0057] When the absolute value of the angular position error e is less than or equal to δ, it is considered a small error, i.e., |e|≤δ is defined as a small error; when the absolute value of the angular position error e is greater than δ, it is considered a large error, i.e., |e|>δ is defined as a large error.

[0058] Step S2: Switch between speed control and position control according to the magnitude level of the angular position error.

[0059] In this embodiment, the magnitude of the angular position error is detected in real time. When the angular position error is at a large error level, a speed closed-loop control method is adopted, as detailed below:

[0060] like Figure 3 As shown; using the given angular velocity command ω r The actual angular velocity ω is detected and fed back in real time by the angular velocity sensor. act By comparison, the resulting angular velocity error ω e =ω r -ω act As the input to the speed correction PID controller, the angular velocity error, after being corrected by the PID controller, is amplified and further input to the actuator (motor). The actuator then drives the controlled object (frame) to perform the corresponding movement. When the speed correction PID controller uses appropriate proportional gain Speed.Kp and integral gain Speed.Ki, the angular velocity error ω... e It will rapidly decrease and remain within a near-zero error band.

[0061] When the angular position error is at a small error level, a position closed-loop control method is adopted, as detailed below:

[0062] like Figure 4 As shown; the position closed-loop control consists of an outer position loop and an inner velocity loop, using a given angular position command θ. r The actual angular position θ is detected and fed back in real time by the angular position sensor. act By comparison, the obtained angular position error e = θ r -θ act As the input to the position correction PID controller, the angular position error, after being corrected by the position correction PID controller, is used as the angular velocity command ω for the inner velocity loop. r The subsequent speed closed-loop control is consistent with the above description. When the position correction PID controller is properly selected with appropriate proportional gain Pos.Kp and integral gain Pos.Ki, and when it is used in conjunction with the proportional gain Speed.Kp and integral gain Speed.Ki tuned by the aforementioned speed correction PID controller, the angular velocity ω act It will first accelerate and then decelerate, and then remain in a state approaching zero. The angular position error e will decrease rapidly and remain within the error band approaching zero.

[0063] Step S3: Tuning the parameters of the speed control and position control. In this embodiment, the tuning of the parameters of the speed control and position control specifically includes the following steps S31 to S33, and the implementation of each step is described in detail below.

[0064] Step S31: Tune the speed control parameters with large error levels.

[0065] Please see Figure 5 The steps for tuning speed control parameters with large error levels include the following steps: S311 to S314. The implementation of each step is explained in detail below.

[0066] S311: An experiment using angular velocity step closed-loop control was conducted, and tuning was performed based on the angular velocity error curve, with the angular velocity command ω... r Let there be an initial angular velocity value ω0, i.e., ω r =ω0;

[0067] S312: Adjust the proportional gain Speed.Kp and integral gain Speed.Ki in the speed closed-loop PID control parameters;

[0068] S313: During the step angular velocity process, determine whether the angular velocity achieves zero overshoot and accurate and stable tracking. If so, determine whether the rapid performance meets the requirements. If overshoot occurs, readjust the speed closed-loop control parameters.

[0069] S314: If the rapid performance meets the requirements, the position control parameters with small error levels shall be tuned.

[0070] Please refer to the following: Figure 3 This embodiment takes the classic PID control algorithm as an example. In practice, the magnitude of the angular position error can be detected in real time. When the angular position error is at a large error level, a speed closed-loop control method is adopted. The proportional gain Speed.Kp and integral gain Speed.Ki in the speed loop PID control parameters can be adjusted so that during the step angular velocity process, the angular velocity error curve is observed to determine the speed requirement as much as possible under the premise of no speed overshoot and accurate and stable tracking.

[0071] Step S32: Tune the position control parameters with small error levels.

[0072] See also Figure 6 The step of tuning the position control parameters with small error levels specifically includes the following steps S321 to S325. The implementation of each step is explained in detail below.

[0073] Step S321: Using the angular position step closed-loop control experiment, the angular position command θ is tuned based on the angular velocity curve and the angular position error curve. r Set as the critical value δ for the magnitude error, i.e., θ r =δ;

[0074] Step S322: Adjust the proportional gain Speed.Kp and integral gain Speed.Ki in the position closed-loop PID control parameters;

[0075] Step S323: During the angular position step process, determine whether the angular position achieves overshoot-free and accurate stable tracking. If so, determine the peak value ω of the angular velocity curve. f If the maximum value is reached, and overshoot occurs, the position closed-loop control parameters should be readjusted.

[0076] Step S324: If the peak value of the angular velocity curve ω f If the maximum value is found, then check if ω is satisfied. f If ω < 0, then the parameters for switching from large error speed control mode to small error position control mode are tuned.

[0077] Step S325: If ω f If ≥ω0, then it is necessary to return to the step of tuning the speed control parameters at the large error level, continue to increase ω0, perform speed closed-loop control gain parameter adjustment, and then iterate again in the step of tuning the position control parameters at the small error level until ω is satisfied. f <ω0.

[0078] Please refer to the following: Figure 4 This embodiment uses the classic PID control algorithm as an example. In practice, the magnitude of the angular position error can be detected in real time. When the angular position error is at a small error level, a position closed-loop control method is adopted to adjust the proportional control gain Pos.Kp and integral gain Pos.Ki of the position loop control gain. During the angular position step process, the angular position error curve is observed to determine the speed requirement while ensuring no overshoot and accurate and stable tracking of the angular position. The angular velocity curve is observed to ensure that the peak angular velocity ω is within the acceptable range. f maximum.

[0079] Step S33: Adjust the parameters for switching from large error speed control mode to small error position control mode.

[0080] Please see Figure 7 The step of tuning the parameters for switching from a large error speed control mode to a small error position control mode specifically includes the following steps S331 to S335. The implementation of each step is explained in detail below.

[0081] Step S331: Using an angular position step closed-loop control experiment, tuning is performed based on the angular velocity curve and angular position error curve, and the angular position command θ is set. r Initially set to a value greater than the critical value δ but not exceeding the maximum limit angle θ of the photoelectric pod frame. max The constant value θ0, i.e. θ r =θ0, where δ < θ0 < θ max ;

[0082] Step S332: Adjust the position closed-loop control gain parameter. When the absolute value of the angular position error is greater than δ, i.e., |e|>δ, adopt speed closed-loop control. Initially set a speed command value ω1, satisfying ω f ≤ω1<ω0;

[0083] When the absolute value of the angular position error is less than or equal to δ, i.e., |e|≤δ, the pre-set Pos.Kp and Pos.Ki are used for position closed-loop control;

[0084] Step S333: When switching from speed closed-loop control to position closed-loop control, determine whether the angular position achieves zero overshoot and accurate stable tracking. If overshoot occurs, then ω should be satisfied. f Under the premise that ≤ω1<ω0, continue to increase the speed command value ω1 until no overshoot occurs during the angular position tracking process;

[0085] Step S334: After achieving overshoot-free and accurate stable tracking of the angular position, continue to adjust the angular position command θ0 to the maximum limit rotation angle value θ of the optoelectronic pod frame. max That is, θ0 = θ maxDetect the full range of motion performance of the optoelectronic pod frame;

[0086] Step S335: When switching from speed closed-loop control to position closed-loop control, determine whether the angular position achieves zero overshoot and accurate stable tracking. If overshoot occurs, then ω should be satisfied. f Under the premise that ≤ω1<ω0, continue to increase the speed command value ω1 until the angular position error curve does not show overshoot.

[0087] It is understandable that during the entire control parameter tuning process, ω0 and ω1 can be appropriately increased by referring to the operating status of the optoelectronic pod frame and the specific requirements of the large-angle target search application, so as to improve the response speed of large-angle command tracking. The control key parameter tuning process is carried out in the order of S31, S32, and S33, and repeated iterations are required based on the judgment of key parameters.

[0088] In summary, this application, through Embodiment 1, first divides the angular position error into two levels, large and small. Then, based on the level of position error, it incorporates a switching mechanism between position control and speed control. Finally, it tunes the key parameters for switching between position and speed control modes. This method has a simple design and parameter tuning process. With only one set of control parameters, it can ensure low-speed tracking performance for small-angle commands and achieve fast, overshoot-free tracking characteristics for large-angle commands. It can simultaneously meet the performance requirements of fast, overshoot-free tracking of large and small-angle positions in rotary electromechanical servo systems, and is especially suitable for wide-range angular position tracking control of optoelectronic pods.

[0089] Example 2

[0090] Please see Figure 8 This is a schematic diagram of the structure of a wide-range angular position tracking control system for an optoelectronic pod according to Embodiment 2 of this application. Its specific contents include:

[0091] Classification module 100: Sets the angular position error level according to the target tracking requirements of the photoelectric pod;

[0092] Control module 200: Switches between speed control and position control based on the magnitude of the angular position error;

[0093] Tuning module 300: Tunes the parameters of the speed control and position control.

[0094] The detailed working method of the photoelectric pod wide-range angular position tracking control system provided in this embodiment 2 can be found in embodiment 1, and will not be repeated here.

[0095] In summary, Embodiment 2 of this application first classifies the angular position error into two levels, large and small, through a classification module. Then, the control module switches between speed control and position control according to the size level of the classification module. Finally, the tuning module tunes the key parameters for switching between position and speed control modes. This improves the dynamic process of full-range angular position tracking of the photoelectric pod frame axis, achieving fast, overshoot-free, and stable tracking performance throughout the full range of angular position command tracking of the frame axis.

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

[0097] The above description is only a preferred embodiment of this application and does not limit the patent scope of this application. Any equivalent structural or procedural changes made based on the content of this application's specification and drawings, or direct or indirect applications in other related technical fields, are similarly included within the patent protection scope of this application.

[0098] Although embodiments of this application have been shown and described, it will be understood by those skilled in the art that various changes, modifications, substitutions and variations can be made to these embodiments without departing from the principles and spirit of this application, the scope of which is defined by the appended claims and their equivalents.

[0099] Of course, the present invention may have many other embodiments. Based on this embodiment, other embodiments obtained by those skilled in the art without any creative effort are all within the scope of protection of the present invention.

Claims

1. A method for wide-range angular position tracking and control of an optoelectronic pod, characterized in that, include: Based on the target tracking requirements of the optoelectronic pod, the magnitude level of angular position error is set; Speed ​​control and position control are switched according to the magnitude level of the angular position error; The parameters for the speed control and position control are tuned respectively; The step of setting the angular position error level according to the target tracking requirements of the optoelectronic pod includes the following steps: Set a constant greater than zero. Determine the magnitude level of the angular position error; when the angular position error... The absolute value is less than or equal to This is a small error, i.e., defined as For small errors; when angular position error The absolute value is greater than This is a large error, i.e., defined as For large errors, the constant The range of values ​​is ; The step of switching between speed control and position control based on the magnitude of the angular position error includes the following steps: The magnitude of the angular position error is detected in real time. When the angular position error is at a large error level, a speed closed-loop control method is adopted; when the angular position error is at a small error level, a position closed-loop control method is adopted. The step of tuning the parameters of the speed control and position control respectively includes the following steps: Tuning of speed control parameters with large error levels; Tuning of position control parameters with small error levels; The parameters for switching from large error speed control mode to small error position control mode are tuned; The step of tuning the speed control parameters with large error levels includes the following steps: An experiment using angular velocity step closed-loop control was conducted, and tuning was performed based on the angular velocity error curve. The angular velocity command was then... Initially set an angular velocity value ,Right now ; Adjust the proportional gain Speed.Kp and integral gain Speed.Ki in the speed closed-loop PID control parameters; During the step angular velocity process, determine whether the angular velocity achieves zero overshoot and accurate and stable tracking. If so, determine whether the rapid performance meets the requirements. If overshoot occurs, readjust the speed closed-loop control parameters. If the rapid performance meets the requirements, the position control parameters with small error levels should be tuned. The step of tuning the position control parameters with small error levels includes the following steps: An experiment was conducted using angular position step closed-loop control. Tuning was performed based on the angular velocity curve and the angular position error curve, and the angular position command was... Set as the critical value of the magnitude error ,Right now ; Adjust the proportional gain Pos.Kp and integral gain Pos.Ki in the position closed-loop PID control parameters; During the angular position step process, determine whether the angular position achieves overshoot-free and accurate stable tracking; if so, determine the peak value of the angular velocity curve. If the maximum value is reached, and overshoot occurs, the position closed-loop control parameters should be readjusted. If the peak value of the angular velocity curve If the maximum value is found, then check if the condition is met. If the conditions are met, the parameters for switching from the large error speed control mode to the small error position control mode will be tuned. like If this happens, it is necessary to return to the step of tuning the speed control parameters with large error levels and continue to increase them. Then, the speed closed-loop control gain parameter is adjusted, and the step of tuning the position control parameter with small error level is iterated again until the condition is met. ; The step of tuning the parameters for switching from a large-error speed control mode to a small-error position control mode includes the following steps: An experiment was conducted using angular position step closed-loop control. Tuning was performed based on the angular velocity curve and the angular position error curve, and the angular position command was... Initially set to a value greater than the critical value But not exceeding the maximum limit angle of rotation of the optoelectronic pod frame. constant value ,Right now ,in ; Adjust the position closed-loop control gain parameter until the absolute value of the angular position error is greater than... ,Right now At that time, speed closed-loop control is adopted, and an initial speed command value is set. ,satisfy ; When the absolute value of the angular position error is less than or equal to ,Right now At that time, the pre-set Pos.Kp and Pos.Ki are used for position closed-loop control; When switching from speed closed-loop control to position closed-loop control, it is determined whether the angular position achieves zero overshoot and accurate and stable tracking. If overshoot occurs, it should meet the following requirements: Under the premise of increasing the speed command value Continue until no overshoot occurs during the angular position tracking process; After achieving overshoot-free and accurate stable tracking in angular position, continue adjusting the angular position command. To the maximum limit angle of rotation of the optoelectronic pod frame ,Right now Detect the full range of motion performance of the optoelectronic pod frame; When switching from speed closed-loop control to position closed-loop control, it is determined whether the angular position achieves zero overshoot and accurate and stable tracking. If overshoot occurs, it should be determined that the following conditions are met: Under the premise of increasing the speed command value Continue until the angular position error curve does not show overshoot.

2. A control system for a wide-range angular position tracking control method for an optoelectronic pod according to claim 1, characterized in that the content... include: Classification module: Based on the target tracking requirements of the optoelectronic pod, set the angular position error level; Control module: Switches between speed control and position control based on the magnitude of the angular position error; Tuning module: Tunes the parameters of the speed control and position control respectively.

Citation Information

Patent Citations

  • Hovering control method of deep sea underwater robot

    CN111208840A

  • Photoelectric servo turntable target tracking method and device, electronic equipment and storage medium

    CN115601399A