IRU-based dynamic broadband disturbance suppression method, system and device
By setting the light vector and rotation matrix, and combining them with the reflection matrix of the optical components, a dynamic mathematical model was established, which solved the problem of misalignment between the detector and actuator in the IRU line-of-sight stabilization system, and achieved high-precision line-of-sight stabilization and disturbance suppression.
Patent Information
- Application Number
- CN202411186200.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-28
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-08-28
AI Technical Summary
Space constraints can cause the detector and actuator of the IRU-based line-of-sight stabilization system to be out of sync, increasing the difficulty of high-precision control of the system and potentially leading to system malfunction.
A dynamic broadband disturbance suppression method based on IRU is provided. By setting the light vector and rotation matrix and combining them with the reflection matrix of the optical components, a dynamic mathematical model is established to realize closed-loop control of the moving parts in the system.
Despite space constraints, the system achieves miniaturization and high-precision line-of-sight stabilization, suppressing wideband disturbances on the moving base platform and ensuring line-of-sight stability and accuracy.
Smart Images

Figure CN118689121B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of optoelectronic load servo control, and in particular to dynamic broadband disturbance suppression based on IRU. Background Art
[0002] The vibration of dynamic base platforms such as satellites, aircraft, vehicles, and ships can cause the line of sight jitter of optoelectronic payloads. In the fields of laser communication, directional energy, and other high-precision tracking and aiming, IRU is usually introduced on the basis of composite axis tracking to achieve inertial stabilization of the system line of sight. The inertial reference light provided by IRU passes through the main antenna and assists the fine tracking FSM to complete the stabilization and tracking of the line of sight to the target.
[0003] At present, the IRU-based line of sight stabilization method is applied in many payloads at home and abroad. The basic working principle is as follows: Figure 1 As shown. When the IRU base receives a disturbance, the inertial elements (such as MHD, gyroscope, accelerometer, etc.) installed on the platform can measure the vibration state in real time. By fusing the data of the inertial elements, the wide-band disturbance information can be measured, and the IRU motor can be controlled to generate a reaction force, thereby achieving the inertial stability of the platform. The laser installed on the platform serves as the inertial reference light of the system. The reference light and the target light pass through the same optical path and are reflected by the precision FSM before being split. The inertial reference light enters the collimation detector, and the target light enters the precision tracking camera.
[0004] Since the frame rate of the collimation detector is much higher than that of the precision tracking camera, adjusting the position of the precision FSM using the output of the collimation detector can avoid the influence of the detector frame rate on the control bandwidth and achieve system line of sight stability. Furthermore, the target miss distance measured by the precision camera is used to adjust the IRU position to achieve high-precision tracking of the target by the system line of sight. Ideally, in the IRU-based stabilization system, the motion coordinate axes of the IRU and FSM are parallel, and the target surfaces of the collimation detector and the precision tracking camera are parallel, making it easier to respond to the information detected by the detector. However, in satellite-based and airborne applications, there are usually high constraints on the volume and weight of the payload. It is difficult to achieve the parallel motion coordinate axes of the IRU and FSM through optimized design within a limited space, and it is also difficult to ensure the parallelism of the target surfaces of the collimation detector and the precision tracking camera. The resulting non-parallel coordinate axis phenomenon greatly increases the difficulty of high-precision control of the system, and may seriously cause the system to be unable to be controlled or even out of control. For example Figure 1 As shown, the principle of the IRU-based stabilization system does not take into account the space limitations in the actual design process. Summary of the invention
[0005] The purpose of the present invention is to solve the problem of misalignment of detectors and actuators in an IRU-based line of sight stabilization system due to space limitations, and to provide an IRU-based dynamic broadband disturbance suppression method, system and device.
[0006] The present invention is implemented by the following technical solutions. On one hand, the present invention provides a dynamic broadband disturbance suppression method based on IRU, the method comprising:
[0007] Step 1: Set the light vector A of the target light tar and the light vector A of the IRU outgoing reference light p , and normalize the light vector of the reference light to obtain the normalized result A of the light vector of the reference light sta and the normal vector of IRU ;
[0008] Step 2: According to the rotation angles θ1 and θ2 of IRU along the x-axis and y-axis, the rotation matrix S along the x-axis is obtained respectively. 1_sta , the rotation matrix S along the y axis 2_sta ;
[0009] Step 3: Obtain the normal vector N1 and reflection matrix R after IRU rotation sta ;
[0010] Step 4: Obtain the reflection matrix R of the primary mirror according to the installation position of the optical components pri and the reflection matrix R of the secondary mirror sec ;
[0011] Step 5: Get the light vector A1 incident on the refined FSM;
[0012] Step 6: Normalize the normal vector of the refined FSM to obtain the normalized normal vector N FSM ;
[0013] Step 7: According to the rotation angles α1 and α2 of the refined FSM along the x-axis and y-axis, the rotation matrix S along the x-axis is obtained respectively. 1_FSM , the rotation matrix S along the y-axis 2_FSM ;
[0014] Step 8: Get the normal vector N4 and reflection matrix R after the fine FSM rotation FSM ;
[0015] Step 9: According to the calibration of the optical component, obtain the reflection matrix of each lens, reflector and beam splitter of the optical component;
[0016] Step 10: According to the reflection matrix and reflection matrix R of each lens, reflector and beam splitter of the optical component FSM , the reflection matrix R of the secondary mirror sec , the reflection matrix R of the primary mirror pri , the reflection matrix R after IRU rotation sta 、Light vector A of the incident target light tarand the normalized result of the reference light vector A sta , get the light A incident on the precision tracking camera CCD and the coordinates in the camera coordinate system and the light A incident on the collimated detector PSD and the coordinates in the collimated detector coordinate system;
[0017] Step 11: Decouple the coordinates in the camera coordinate system and the coordinates in the collimation detector coordinate system respectively to obtain the dynamic mathematical model of the precise FSM and IRU position, the miss amount of the collimation detector, the two-dimensional adjustment angle of the IRU and the precise FSM position, and the miss amount of the precise tracking camera. The dynamic mathematical model is solidified in the system hardware to realize the corresponding dynamic closed-loop control to suppress the disturbance applied to the platform.
[0018] Further, the optical assembly is composed of a first lens, a first reflector, a second reflector, a second lens, a third reflector, a beam splitter and a third lens;
[0019] After being reflected by the primary mirror and the secondary mirror, the target light is incident on the fine FSM mirror surface. After being reflected by the fine FSM mirror surface, it passes through the first lens, the first reflector, the second reflector, the second lens, and the third reflector in sequence and then is incident on the beam splitter. The beam splitter reflects the target light, so that the target light enters the fine tracking camera through the third lens after being reflected by the beam splitter.
[0020] The reference light is generated by IRU. After being reflected by the primary mirror and the secondary mirror, the reference light is incident on the precision FSM mirror. After being reflected by the precision FSM mirror, it passes through the first lens, the first reflector, the second reflector, the second lens, and the third reflector in sequence and is incident on the beam splitter. The beam splitter transmits the reference light, and the reference light enters the collimation detector through the beam splitter.
[0021] Further, in step 10, the light A incident on the precision tracking camera is obtained. CCD And the coordinates in the camera coordinate system, including:
[0022] The light A incident on the precision tracking camera CCD for:
[0023]
[0024] Among them, T 透镜1 , , , T 透镜2 , 、F 分光镜 and T 透镜3They are the reflection matrices of the first lens, the first reflector, the second reflector, the second lens, the third reflector, the beam splitter, and the third lens respectively; according to the x, y, z coordinates in the precise tracking camera coordinate system, the rotation matrix M of the camera coordinate system converted to the global coordinate system is obtained through orthogonalization and unitization. CCD , then the rotation matrix from the global coordinate system to the precise tracking camera coordinate system is N CCD =M CCD -1 ; Precision tracking camera incident light A CCD In the global coordinate system it is expressed as: , and obtain the normalized incident light Q CCD ; The coordinates in the camera coordinate system are: .
[0025] Furthermore, in step 10, the light A incident on the collimating detector is obtained. PSD and the coordinates in the collimated detector coordinate system, specifically including:
[0026] The light A incident on the collimated detector PSD for:
[0027] ;
[0028] According to the x, y, z coordinates in the collimated detector coordinate system, the rotation matrix M of the collimated detector coordinate system to the global coordinate system can be obtained through orthogonalization and unitization. PSD , then the rotation matrix from the global coordinate system to the collimated detector coordinate system is N PSD =M PSD -1 ; Collimate the incident light A on the detector PSD In the global coordinate system it is expressed as: , and obtain the normalized incident light ; The coordinates in the collimated detector coordinate system are: .
[0029] Furthermore, the rotation matrix S in step 2 1_sta and S 2_sta The formula is:
[0030]
[0031]
[0032] in, ; The rotation vector of IRU along the x-axis is , the result after normalizing the rotation vector along the x-axis is , the rotation vector of IRU along the y-axis is , the result after normalizing the rotation vector along the y-axis is .
[0033] Furthermore, the normal vector N1 and reflection matrix R in step 3 sta The formula is:
[0034]
[0035] .
[0036] Furthermore, the rotation matrix S in step 7 1_FSM and S 2_FSM The formula is:
[0037]
[0038]
[0039] in, ; The rotation vector of FSM along the x-axis is , the result after normalizing the rotation vector along the x-axis is ; The rotation vector of FSM along the y-axis is , the result after normalizing the rotation vector along the y-axis is .
[0040] In a second aspect, the present invention provides a dynamic broadband disturbance suppression system based on an IRU, the system comprising an IRU, a primary mirror, a secondary mirror, a precision FSM, an optical assembly, a collimation detector, a precision tracking camera, and a control unit;
[0041] The optical assembly is composed of a first lens, a first reflector, a second reflector, a second lens, a third reflector, a beam splitter and a third lens;
[0042] After being reflected by the primary mirror and the secondary mirror, the target light is incident on the fine FSM mirror surface. After being reflected by the fine FSM mirror surface, it passes through the first lens, the first reflector, the second reflector, the second lens, and the third reflector in sequence before being incident on the beam splitter. The beam splitter reflects the target light, so that the target light passes through the third lens after being reflected by the beam splitter and enters the fine tracking camera. The two-dimensional adjustment angle of IRU is obtained by the current position of the fine FSM and the miss amount of the fine tracking camera.
[0043] The reference light is generated by the IRU. After being reflected by the primary mirror and the secondary mirror, the reference light is incident on the fine FSM mirror. After being reflected by the fine FSM mirror, it passes through the first lens, the first reflector, the second reflector, the second lens, and the third reflector in sequence before being incident on the beam splitter. The beam splitter transmits the reference light. The reference light passes through the beam splitter and enters the collimation detector. The two-dimensional adjustment angle of the fine FSM is obtained by the current position of the IRU and the miss amount of the collimation detector.
[0044] The control unit suppresses the disturbance applied to the platform according to an IRU-based dynamic broadband disturbance suppression method as described above.
[0045] In a third aspect, the present invention provides a computer device, comprising a memory and a processor, wherein the memory stores a computer program, and when the processor runs the computer program stored in the memory, the steps of a dynamic broadband disturbance suppression method based on IRU as described above are executed.
[0046] In a fourth aspect, the present invention provides a computer-readable storage medium, wherein a plurality of computer instructions are stored in the computer-readable storage medium, and the plurality of computer instructions are used to enable a computer to execute a dynamic broadband disturbance suppression method based on IRU as described above.
[0047] Beneficial effects of the present invention:
[0048] The present invention takes into account the space limitation of the system, and the technical route is as follows Figure 2 As shown in Figure 1, the system mainly consists of IRU, primary mirror, secondary mirror, precision FSM, precision tracking camera, collimation detector and optical components. Figure 1 , a series of optical components are designed to be added to realize the deflection of the laser path inside the system, so as to realize the miniaturization design of the system to the maximum extent. The optical components mainly include three types: lenses, reflectors and beam splitters, which are specifically composed of a first lens, a first reflector, a second reflector, a second lens, a third reflector, a beam splitter and a third lens. There are certain differences in the propagation paths of light in different systems during the optical design process. The present invention provides a solution to the non-parallel coordinate axes caused by the light path deflection design. Combined with the optical design layout in the actual system, such as Figure 3 As shown, the two-dimensional adjustment angle of the IRU is jointly constrained by the current position of the precise FSM and the miss amount of the precise tracking camera. The two-dimensional adjustment angle of the precise FSM is jointly constrained by the current position of the IRU and the miss amount of the collimation detector.
[0049] In order to solve the problem of misalignment of detectors and actuators in an IRU-based line of sight stabilization system caused by limited space, the present invention constructs a kinematic model of the line of sight stabilization system based on a coordinate transformation method and an optical installation model, thereby realizing closed-loop control of movable parts in the line of sight stabilization system and providing technical support for a dynamic base optoelectronic platform to achieve high-precision line of sight stabilization.
[0050] 1. The present invention introduces an IRU system for collecting broadband disturbances under a moving base platform, thereby suppressing broadband disturbances applied to the moving base platform and achieving micro-arc-level line of sight stabilization accuracy of the moving base platform.
[0051] 2. The present invention combines the optical design and installation model of the actual dynamic base platform and constructs a kinematic model of the line of sight stabilization system based on the coordinate transformation method. It solves the problem of different axes of motion coordinate systems of the detector and actuator caused by optical design due to limited system space in actual application, realizes closed-loop control of moving parts in the line of sight stabilization system, and solves the problem of non-parallel motion coordinate axes caused by optical design, which makes it impossible to achieve closed-loop control.
[0052] The present invention is applicable to the detection, tracking and communication of targets in the fields of space laser communication, directional energy and other high-precision tracking and aiming technologies, and solves the technical problems of insufficient laser link stability, poor accuracy and inability to achieve high-precision tracking and aiming caused by the visual axis jitter due to platform vibration. BRIEF DESCRIPTION OF THE DRAWINGS
[0053] In order to more clearly illustrate the technical solution of the present application, the drawings required for use in the embodiments are briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without any creative work.
[0054] Figure 1 It is an IRU-based boresight stabilization system;
[0055] Figure 2 This is the technical route of the dynamic broadband disturbance suppression method of the present invention;
[0056] Figure 3 Design the optical layout of the system of the present invention. DETAILED DESCRIPTION
[0057] Embodiments of the present invention are described in detail below, examples of which are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are intended to be used to explain the present invention, and should not be construed as limiting the present invention.
[0058] Implementation method 1: a dynamic broadband disturbance suppression method based on IRU. The method includes:
[0059] Step 1: Set the light vector A of the target light tar and the light vector A of the IRU outgoing reference light p , and normalize the light vector of the reference light to obtain the normalized result A of the light vector of the reference light sta and the normal vector of IRU ;
[0060] Step 2: According to the rotation angles θ1 and θ2 of IRU along the x-axis and y-axis, the rotation matrix S along the x-axis is obtained respectively.1_sta , the rotation matrix S along the y-axis 2_sta ;
[0061] Step 3: Obtain the normal vector N1 and reflection matrix R after IRU rotation sta ;
[0062] Step 4: Obtain the reflection matrix R of the primary mirror according to the installation position of the optical components pri and the reflection matrix R of the secondary mirror sec ;
[0063] Step 5: Get the light vector A1 incident on the refined FSM;
[0064] Step 6: Normalize the normal vector of the refined FSM to obtain the normalized normal vector N FSM ;
[0065] Step 7: According to the rotation angles α1 and α2 of the refined FSM along the x-axis and y-axis, the rotation matrix S along the x-axis is obtained respectively. 1_FSM , the rotation matrix S along the y-axis 2_FSM ;
[0066] Step 8: Get the normal vector N4 and reflection matrix R after the fine FSM rotation FSM ;
[0067] Step 9: According to the calibration of the optical component, obtain the reflection matrix of each lens, reflector and beam splitter of the optical component;
[0068] Step 10: According to the reflection matrix and reflection matrix R of each lens, reflector and beam splitter of the optical component FSM , the reflection matrix R of the secondary mirror sec , the reflection matrix R of the primary mirror pri , the reflection matrix R after IRU rotation sta 、Light vector A of the incident target light tar and the normalized result of the reference light vector A sta , get the light A incident on the precision tracking camera CCD and the coordinates in the camera coordinate system and the light A incident on the collimated detector PSD and the coordinates in the collimated detector coordinate system;
[0069] Step 11: Decouple the coordinates in the camera coordinate system and the coordinates in the collimation detector coordinate system respectively to obtain the dynamic mathematical model of the precise FSM and IRU position, the miss amount of the collimation detector, the two-dimensional adjustment angle of the IRU and the precise FSM position, and the miss amount of the precise tracking camera. The dynamic mathematical model is solidified in the system hardware to realize the corresponding dynamic closed-loop control to suppress the disturbance applied to the platform, such as controlling the rotation of the FSM or IRU through the miss amount on the detector.
[0070] In this embodiment, first, according to the coordinate transformation methods such as coordinate rotation and reflection, combined with the actual optical design of the system, the ray tracing model of IRU, precision FSM, collimation detector, precision tracking camera and optical components is established. Secondly, the installation position of the optical component is calibrated to obtain the fixed component coordinate transformation matrix in the model, and the simplified model is corrected. Finally, the kinematic inverse solution is completed with the help of the intermediate transition matrix, and the dynamic mathematical model of the precision FSM and IRU position, the collimation detector miss amount, and the two-dimensional adjustment angle of IRU and the precision FSM position, and the precision tracking camera miss amount are obtained respectively, and the model is solidified on the actual tracking system hardware platform to achieve dynamic broadband disturbance suppression.
[0071] This implementation aims to solve the problem of misalignment of the detector and actuator in the IRU-based line of sight stabilization system due to space limitation. Based on the coordinate transformation method and combined with the optical installation model, a kinematic model of the line of sight stabilization system is constructed to achieve closed-loop control of the moving parts in the line of sight stabilization system, providing technical support for the dynamic base optoelectronic platform to achieve high-precision line of sight stabilization.
[0072] Embodiment 2: This embodiment further defines the IRU-based dynamic broadband disturbance suppression method described in Embodiment 1. In this embodiment, the optical component is further defined, specifically including:
[0073] The optical assembly is composed of a first lens, a first reflector, a second reflector, a second lens, a third reflector, a beam splitter and a third lens;
[0074] Combined with the actual system optical design layout such as Figure 3 As shown, the laser beam transmission path is: after the target light is reflected by the primary mirror 2 and the secondary mirror 3, it is incident on the precision FSM4 mirror surface. After being reflected by the precision FSM4 mirror surface, it passes through the first lens 5, the first reflector 6, the second reflector 7, the second lens 8, and the third reflector 9 in sequence and then is incident on the beam splitter 10. The beam splitter reflects the target light, so that the target light passes through the third lens 11 and enters the precision tracking camera 12 after being reflected by the beam splitter 10. Therefore, the two-dimensional adjustment angle of IRU1 is generated by the joint constraints of the current position of the precision FSM4 and the miss-target amount of the precision tracking camera 12.
[0075] The reference light is generated by IRU1. Similar to the optical path of the target light, the reference light is reflected by the primary mirror 2 and the secondary mirror 3, and then incident on the mirror surface of the precision FSM4. After being reflected by the mirror surface of the precision FSM4, it passes through the first lens 5, the first reflector 6, the second reflector 7, the second lens 8, and the third reflector 9 in sequence, and then is incident on the beam splitter 10. The beam splitter transmits the reference light, so the reference light passes through the beam splitter 10 and enters the collimation detector 13. Therefore, the two-dimensional adjustment angle of the precision FSM4 is jointly constrained by the current position of IRU1 and the off-target amount of the collimation detector 13.
[0076] This embodiment designs the transmission path of the target light and the transmission path of the reference light within the system based on the existing space size limitations and weight constraints and in combination with the actual optical system solution. The purpose of this embodiment is to shorten the space required for laser link transmission through the design of optical path transmission while ensuring that the target light and the reference light are detected by the precision tracking camera and the collimation detector respectively after passing through the optical components in the system.
[0077] Implementation method 3: This implementation method further defines the IRU-based dynamic broadband disturbance suppression method described in implementation method 2. In this implementation method, step 10 is further defined, specifically including:
[0078] In step 10, the light A incident on the precision tracking camera is obtained. CCD And the coordinates in the camera coordinate system, including:
[0079] The light A incident on the precision tracking camera CCD for:
[0080]
[0081] Among them, T 透镜1 , , , T 透镜2 , 、F 分光镜 and T 透镜3 They are the reflection matrices of the first lens, the first reflector, the second reflector, the second lens, the third reflector, the beam splitter, and the third lens respectively; according to the x, y, z coordinates in the precise tracking camera coordinate system, the rotation matrix M of the camera coordinate system converted to the global coordinate system is obtained through orthogonalization and unitization. CCD , then the rotation matrix from the global coordinate system to the precise tracking camera coordinate system is N CCD =M CCD -1 ; Precision tracking camera incident light A CCD In the global coordinate system it is expressed as: , and obtain the normalized incident light Q CCD; The coordinates in the camera coordinate system are: .
[0082] This implementation establishes a ray tracing model of the target light based on the position design distribution of the optical components in the system optical design, combined with the optical transmission path of the target light in the system, and based on coordinate transformation methods such as coordinate rotation and reflection. The purpose is to obtain the dynamic mathematical model of the two-dimensional adjustment angle of the IRU and the precise FSM position and the precise tracking camera miss amount through the inverse solution of the optical link model, and solve the problem of non-parallel motion coordinate system and difficult control caused by optical design.
[0083] Embodiment 4: This embodiment further defines the IRU-based dynamic broadband disturbance suppression method described in Embodiment 3. In this embodiment, step 10 is further defined, specifically including:
[0084] In step 10, the light A incident on the collimating detector is obtained. PSD and the coordinates in the collimated detector coordinate system, specifically including:
[0085] The light A incident on the collimated detector PSD for:
[0086] ;
[0087] According to the x, y, z coordinates in the collimated detector coordinate system, the rotation matrix M of the collimated detector coordinate system to the global coordinate system can be obtained through orthogonalization and unitization. PSD , then the rotation matrix from the global coordinate system to the collimated detector coordinate system is N PSD =M PSD -1 ; Collimate the incident light A on the detector PSD In the global coordinate system it is expressed as: , and obtain the normalized incident light ; The coordinates in the collimated detector coordinate system are: .
[0088] This implementation establishes a ray tracing model of the reference light based on the position design distribution of the optical components in the system optical design, combined with the optical transmission path of the reference light in the system, and based on coordinate transformation methods such as coordinate rotation and reflection. The purpose is to obtain the dynamic mathematical model of the precise FSM and IRU position and the miss amount of the collimated detector through the inverse solution of the optical link model, and solve the problem of non-parallel motion coordinate system and difficult control caused by optical design.
[0089] Embodiment 5: This embodiment further defines the IRU-based dynamic broadband disturbance suppression method described in Embodiment 1. In this embodiment, step 2 is further defined, specifically including:
[0090] The rotation matrix S in step 2 1_sta and S 2_sta The formula is:
[0091]
[0092]
[0093] in, ; The rotation vector of IRU along the x-axis is , the result after normalizing the rotation vector along the x-axis is , the rotation vector of IRU along the y-axis is , the result after normalizing the rotation vector along the y-axis is .
[0094] This implementation method analyzes the position offset of the reference light caused by the rotation of the IRU around the azimuth axis (x-axis) and the pitch axis (y-axis) according to the motion deflection mode of the IRU, and provides the rotation matrix of the two axes of the IRU. The purpose is to more accurately establish a dynamic mathematical model of the reference light transmission link and achieve high-precision closed-loop control.
[0095] Embodiment 6: This embodiment further defines the IRU-based dynamic broadband disturbance suppression method described in Embodiment 1. In this embodiment, step 3 is further defined, specifically including:
[0096] The normal vector N1 and reflection matrix R in step 3 sta The formula is:
[0097]
[0098] .
[0099] In this implementation, the reference light is generated by the IRU and the IRU reflection matrix is constructed in combination with the rotation matrix of the two axes of the IRU. The purpose is to more accurately establish a dynamic mathematical model of the reference light transmission link and achieve high-precision closed-loop control.
[0100] Embodiment 7: This embodiment further defines the IRU-based dynamic broadband disturbance suppression method described in Embodiment 1. In this embodiment, step 7 is further defined, specifically including:
[0101] The rotation matrix S in step 71_FSM and S 2_FSM The formula is:
[0102]
[0103]
[0104] in, ; The rotation vector of FSM along the x-axis is , the result after normalizing the rotation vector along the x-axis is ; The rotation vector of FSM along the y-axis is , the result after normalizing the rotation vector along the y-axis is .
[0105] This embodiment analyzes the position offset of the target light and the reference light incident on the mirror of the precision FSM caused by the rotation of the precision FSM around the azimuth axis (x-axis) and the pitch axis (y-axis) according to the motion deflection mode of the precision FSM, and provides the rotation matrix of the two axes of the precision FSM. Its function is to more accurately establish a dynamic mathematical model of the target light and reference light transmission link, and realize high-precision closed-loop control.
[0106] Embodiment 8: This embodiment is an example of a dynamic broadband disturbance suppression method based on IRU as described above. Figure 2 As shown, specifically including:
[0107] The optical components designed in this embodiment mainly include three types of lenses, reflectors and beam splitters, and are specifically composed of a first lens, a first reflector, a second reflector, a second lens, a third reflector, a beam splitter and a third lens. There are certain differences in the propagation paths of light in different systems during the optical design process, but the core idea is to seek a solution and method for the non-parallel coordinate axes caused by the light path deflection design.
[0108] Combined with the actual system optical design layout such as Figure 3 As shown, the laser beam transmission path is: after the target light is reflected by the primary mirror 2 and the secondary mirror 3, it is incident on the precision FSM4 mirror surface. After being reflected by the precision FSM4 mirror surface, it passes through the first lens 5, the first reflector 6, the second reflector 7, the second lens 8, and the third reflector 9 in sequence and then is incident on the beam splitter 10. The beam splitter reflects the target light, so that the target light passes through the third lens 11 and enters the precision tracking camera 12 after being reflected by the beam splitter 10. Therefore, the two-dimensional adjustment angle of IRU1 is generated by the joint constraints of the current position of the precision FSM4 and the miss-target amount of the precision tracking camera 12.
[0109] The reference light is generated by IRU1. Similar to the optical path of the target light, the reference light is reflected by the primary mirror 2 and the secondary mirror 3, and then incident on the mirror surface of the precision FSM4. After being reflected by the mirror surface of the precision FSM4, it passes through the first lens 5, the first reflector 6, the second reflector 7, the second lens 8, and the third reflector 9 in sequence, and then is incident on the beam splitter 10. The beam splitter transmits the reference light, so the reference light passes through the beam splitter 10 and enters the collimation detector 13. Therefore, the two-dimensional adjustment angle of the precision FSM4 is jointly constrained by the current position of IRU1 and the off-target amount of the collimation detector 13.
[0110] A dynamic mathematical model is constructed based on the optical path transmission relationship designed above. The specific construction process is as follows:
[0111] 1) Set the light vector of the target light to ; Set the light vector of the IRU outgoing reference light to , in Matlab, by the formula The normalized result of the light vector can be obtained and the normal vector of the IRU ;
[0112] 2) Let the rotation vector of IRU along the x-axis be , in Matlab, by the formula The normalized result of the rotation vector along the x-axis is , let the rotation vector of IRU along the y-axis be , in Matlab, by the formula The normalized result of the rotation vector along the y-axis is: , combined with the rotation angles θ1 and θ2 of IRU along the x-axis and y-axis, the rotation matrix S along the x-axis is obtained respectively 1_sta , the rotation matrix S along the y-axis 2_sta .
[0113]
[0114]
[0115] in:
[0116]
[0117] 3) From this, we can get the normal vector N1 and the reflection matrix R after IRU rotation sta .
[0118]
[0119]
[0120] 4) According to the installation position of the optical components, the normal vector of the primary mirror is , the normalized normal vector is , the normal vector of the secondary mirror is , the normalized normal vector is , we can get the primary mirror reflection matrix R pri and the reflection matrix R of the secondary mirror sec They are:
[0121]
[0122]
[0123] 5) From this, we can get the light vector A1 incident on the precise FSM:
[0124]
[0125] 6) According to the normal vector of the refined FSM , in Matlab, by the formula The normalized normal vector can be obtained ;
[0126] 7) Let the rotation vector of FSM along the x-axis be , in Matlab, by the formula The normalized result of the rotation vector along the x-axis is , let the rotation vector of FSM along the y-axis be , in Matlab, by the formula The normalized result of the rotation vector along the y-axis is: , and combined with the rotation angles α1 and α2 of the refined FSM along the x-axis and y-axis, the rotation matrix S along the x-axis is obtained respectively. 1_FSM , the rotation matrix S along the y-axis 2_FSM .
[0127]
[0128]
[0129] in:
[0130]
[0131] 8) From this, we can get the normal vector N4 and the reflection matrix R after the fine FSM rotation FSM .
[0132]
[0133]
[0134] 9) Similarly, according to the position design of each part included in the optical component, the reflection matrices of the first lens, the first reflector, the second reflector, the second lens, the third reflector, the beam splitter and the third lens are T 透镜1 , , , T 透镜2 , 、F 分光镜 and T 透镜3 .
[0135] 10) Light A incident on the precision tracking camera (CCD camera) CCD for:
[0136]
[0137] 11) According to the x, y, z coordinates in the CCD camera coordinate system, the rotation matrix M of the camera coordinate system to the global coordinate system can be obtained through orthogonalization and normalization. CCD , then the rotation matrix from the global coordinate system to the CCD coordinate system is N CCD =M CCD -1 According to step 10, the incident light A of the CCD camera CCD In the global coordinate system it is expressed as: , in Matlab, by the formula The normalized incident light Q can be obtained CCD ; From this, the coordinates in the camera coordinate system are: .
[0138] 12) According to the optical design, the light A incident on the collimated detector PSD for:
[0139]
[0140] 13) Similarly, according to the x, y, z coordinates in the collimated detector coordinate system, after orthogonalization and normalization, the rotation matrix M of the collimated detector coordinate system to the global coordinate system can be obtained: PSD , then the rotation matrix from the global coordinate system to the collimated detector coordinate system is N PSD =M PSD -1 According to step 12, the incident light A on the collimated detector PSD In the global coordinate system it is expressed as: , in Matlab, by the formula The normalized incident light can be obtained ; From this, the coordinates in the collimated detector coordinate system are: .
[0141] 14) Decoupling the coordinates in the camera coordinate system and the coordinates in the collimation detector coordinate system respectively can obtain the dynamic mathematical relationship between the precise FSM and IRU position, the collimation detector miss amount, and the two-dimensional adjustment angle of the IRU and the precise FSM position, and the precise tracking camera miss amount;
[0142] 15) The dynamic mathematical model constructed above is solidified in the system hardware to realize the corresponding dynamic closed-loop control, and finally the dynamic and broadband disturbances applied to the platform can be suppressed (closed-loop control).
Claims
1. A dynamic broadband disturbance suppression method based on IRU, characterized in that: The method comprises: Step 1: Set the light vector A of the target light tar and the light vector A of the IRU outgoing reference light p , and normalize the light vector of the reference light to obtain the normalized result A of the light vector of the reference light sta and the normal vector N of IRU a ; Step 2: According to the rotation angles θ1 and θ2 of IRU along the x-axis and y-axis, the rotation matrix S along the x-axis is obtained respectively. 1_sta , the rotation matrix S along the y-axis 2_sta ; Step 3: Obtain the normal vector N1 and reflection matrix R after IRU rotation sta ; Step 4: Obtain the reflection matrix R of the primary mirror according to the installation position of the optical components pri and the reflection matrix R of the secondary mirror sec ; Step 5: Get the light vector A1 incident on the refined FSM; Step 6: Normalize the normal vector of the refined FSM to obtain the normalized normal vector N FSM ; Step 7: According to the rotation angles α1 and α2 of the refined FSM along the x-axis and y-axis, the rotation matrix S along the x-axis is obtained respectively. 1_FSM , the rotation matrix S along the y-axis 2_FSM ; Step 8: Get the normal vector N4 and reflection matrix R after the fine FSM rotation FSM ; Step 9: According to the calibration of the optical component, obtain the reflection matrix of each lens, reflector and beam splitter of the optical component; Step 10: According to the reflection matrix and reflection matrix R of each lens, reflector and beam splitter of the optical component FSM , the reflection matrix R of the secondary mirror sec , the reflection matrix R of the primary mirror pri , the reflection matrix R after IRU rotation sta 、Light vector A of the incident target light tar and the normalized result of the reference light vector A sta , get the light A incident on the precision tracking camera CCD and the coordinates in the camera coordinate system and the light A incident on the collimated detector PSD and the coordinates in the collimated detector coordinate system; Step 11: Decouple the coordinates in the camera coordinate system and the coordinates in the collimation detector coordinate system respectively to obtain the dynamic mathematical model of the precise FSM and IRU position, the miss amount of the collimation detector, the two-dimensional adjustment angle of the IRU and the precise FSM position, and the miss amount of the precise tracking camera. The dynamic mathematical model is solidified in the system hardware to realize the corresponding dynamic closed-loop control to suppress the disturbance applied to the platform; In step 10, the light A incident on the precision tracking camera is obtained. CCD And the coordinates in the camera coordinate system, including: The light A incident on the precision tracking camera CCD for: Among them, T 透镜1 , R 反射镜1 , R 反射镜2 、T 透镜2 , R 反射镜3 、F 分光镜 and T 透镜3 They are the reflection matrices of the first lens, the first reflector, the second reflector, the second lens, the third reflector, the beam splitter, and the third lens respectively; according to the x, y, and z coordinates in the precise tracking camera coordinate system, the rotation matrix M of the camera coordinate system converted to the global coordinate system is obtained through orthogonalization and unitization. CCD , then the rotation matrix from the global coordinate system to the precise tracking camera coordinate system is N CCD =M CCD -1 ; Precision tracking camera incident light A CCD In the global coordinate system, it is expressed as: Q1 = [A CCDx ; A CCDy ; A CCDz ], and obtain the normalized incident light Q CCD ; The coordinates in the camera coordinate system are: R CCD =N CCD Q CCD ; In step 10, the light A incident on the collimating detector is obtained. PSD and the coordinates in the collimated detector coordinate system, specifically including: The light A incident on the collimated detector PSD for: According to the x, y, and z coordinates in the collimated detector coordinate system, the rotation matrix M of the collimated detector coordinate system to the global coordinate system can be obtained through orthogonalization and unitization. PSD , then the rotation matrix from the global coordinate system to the collimated detector coordinate system is N PSD =M PSD -1 ; Collimate the incident light A on the detector PSD In the global coordinate system, it is expressed as: Q2 = [A PSDx ; A PSDy ; A PSDz ], and obtain the normalized incident light Q PSD ; The coordinates in the collimated detector coordinate system are: R PSD =N PSD Q PSD .
2. According to claim 1, a dynamic broadband disturbance suppression method based on IRU is characterized in that: The optical assembly is composed of a first lens, a first reflector, a second reflector, a second lens, a third reflector, a beam splitter and a third lens; After being reflected by the primary mirror and the secondary mirror, the target light is incident on the fine FSM mirror surface. After being reflected by the fine FSM mirror surface, it passes through the first lens, the first reflector, the second reflector, the second lens, and the third reflector in sequence and then is incident on the beam splitter. The beam splitter reflects the target light, so that the target light enters the fine tracking camera through the third lens after being reflected by the beam splitter. The reference light is generated by IRU. After being reflected by the primary mirror and the secondary mirror, the reference light is incident on the precision FSM mirror. After being reflected by the precision FSM mirror, it passes through the first lens, the first reflector, the second reflector, the second lens, and the third reflector in sequence and is incident on the beam splitter. The beam splitter transmits the reference light, and the reference light enters the collimation detector through the beam splitter.
3. The IRU-based dynamic broadband disturbance suppression method according to claim 1, characterized in that: The rotation matrix S in step 2 1_sta and S 2_sta The formula is: Among them, P xx =P stax ,P xy =P stay ,P xz =P staz ;P yx =Q stax ,P yy =Q stay ,P yz =Q staz ; The rotation vector of IRU along the x-axis is P x =[P xx ;P xy ;P xz ], the result after normalization of the rotation vector along the x-axis is P sta =[P stax ;P stay ;P staz ], the rotation vector of IRU along the y-axis is Q x =[Q xx ;Q xy ;Q xz ], the result after normalization of the rotation vector along the y-axis is Q sta =[Q stax ;Q stay ;Q staz ].
4. The IRU-based dynamic broadband disturbance suppression method according to claim 1, characterized in that: The normal vector N1 and reflection matrix R in step 3 sta The formula is:
5. The IRU-based dynamic broadband disturbance suppression method according to claim 1, characterized in that: The rotation matrix S in step 7 1_FSM and S 2_FSM The formula is: Among them, P xx =B FSMx ,P xy =B FSMy ,P xz =B FSMz ;P yx =D FSMx ,P yy =D FSMy ,P yz =D FSMz ; The rotation vector of FSM along the x-axis is B x =[B xx ; B xy ; B xz ], the result after normalization of the rotation vector along the x-axis is B FSM =[B FSMx ; B FSMy ; B FSMz ]; The rotation vector of FSM along the y-axis is D x =[D xx ;D xy ;D xz ], the result after normalization of the rotation vector along the y-axis is D FSM =[D FSMx ;D FSMy ;D FSMz ].
6. A dynamic broadband disturbance suppression system based on IRU, characterized in that: The system includes an IRU, a primary mirror, a secondary mirror, a fine FSM, an optical assembly, a collimation detector, a fine tracking camera, and a control unit; The optical assembly is composed of a first lens, a first reflector, a second reflector, a second lens, a third reflector, a beam splitter and a third lens; After being reflected by the primary mirror and the secondary mirror, the target light is incident on the fine FSM mirror surface. After being reflected by the fine FSM mirror surface, it passes through the first lens, the first reflector, the second reflector, the second lens, and the third reflector in sequence before being incident on the beam splitter. The beam splitter reflects the target light, so that the target light passes through the third lens after being reflected by the beam splitter and enters the fine tracking camera. The two-dimensional adjustment angle of IRU is obtained by the current position of the fine FSM and the miss amount of the fine tracking camera. The reference light is generated by the IRU. After being reflected by the primary mirror and the secondary mirror, the reference light is incident on the fine FSM mirror. After being reflected by the fine FSM mirror, it passes through the first lens, the first reflector, the second reflector, the second lens, and the third reflector in sequence before being incident on the beam splitter. The beam splitter transmits the reference light. The reference light passes through the beam splitter and enters the collimation detector. The two-dimensional adjustment angle of the fine FSM is obtained by the current position of the IRU and the miss amount of the collimation detector. The control unit suppresses the disturbance applied to the platform according to the method of any one of claims 1-5.
7. A computer device comprising a memory and a processor, wherein a computer program is stored in the memory, wherein: When the processor runs the computer program stored in the memory, the steps of the method according to any one of claims 1 to 5 are performed.
8. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a plurality of computer instructions, and the plurality of computer instructions are used to enable a computer to execute the method according to any one of claims 1 to 5.
