A Servo Loop Decoupling Method for a Four-Axis Inertially Stabilized Platform System
A technology for stabilizing the platform and servo loop, applied in the field of inertial measurement, can solve the problem of incomplete controllability of the servo loop, and achieve the effects of avoiding the gain tending to infinity, accurate decoupling method, and wide applicability
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Embodiment 1
[0067] In this embodiment, the decoupling calculation is performed using the calculation formula of the present invention, wherein the setting conditions are as follows: X p2 Angle of shaft rotation β xk =0; the outer frame revolves around the coordinate system Y of the inner frame p1 Angle of shaft rotation β yk =0; the inner frame revolves around the body coordinate system Z p Angle of shaft rotation β zk =0; that is, the three rotation axes are perpendicular to each other.
[0068] Calculation formula is provided according to the present invention:
[0069]
[0070]
[0071]
[0072]
[0073] From the above calculation results, it can be seen that the input of the three-axis controller of the table body is consistent with the measured values of the respective gyroscopes, and the control input of the following frame is related to the angular velocity of the inner frame.
Embodiment 2
[0075] In this embodiment, the decoupling calculation is performed using the calculation formula of the present invention, wherein the setting conditions are as follows: X p2 Angle of shaft rotation β xk =90°; the outer frame revolves around the coordinate system Y of the inner frame p1 Angle of shaft rotation β yk =0; the inner frame revolves around the body coordinate system Z p Angle of shaft rotation β zk =0.
[0076] Calculation formula is provided according to the present invention:
[0077]
[0078]
[0079]
[0080]
[0081] From the above calculation results, it can be seen that the input of the three-axis controller of the platform is consistent with the measured values of the respective gyroscopes, and the control input of the follower frame is related to the angular velocity of the platform.
Embodiment 3
[0083] In this embodiment, the decoupling calculation is performed using the calculation formula of the present invention, wherein the setting conditions are as follows: X p2 Angle of shaft rotation β xk =90°; the outer frame revolves around the coordinate system Y of the inner frame p1 Angle of shaft rotation β yk =90°; the inner frame revolves around the body coordinate system Z pAngle of shaft rotation β zk =0.
[0084] Calculation formula is provided according to the present invention:
[0085]
[0086]
[0087]
[0088]
[0089] From the above calculation results, it can be seen that, except that the Y and Z axis control quantities of the table body are consistent with the measured values of their respective gyroscopes, the input amount of the servo frame controller is related to the X gyroscope, and the input amount of the outer frame is related to the axis angle of the table body. related to speed.
[0090] The above three embodiments can verify that...
PUM
Abstract
Description
Claims
Application Information
- R&D Engineer
- R&D Manager
- IP Professional
- Industry Leading Data Capabilities
- Powerful AI technology
- Patent DNA Extraction
Browse by: Latest US Patents, China's latest patents, Technical Efficacy Thesaurus, Application Domain, Technology Topic, Popular Technical Reports.
© 2024 PatSnap. All rights reserved.Legal|Privacy policy|Modern Slavery Act Transparency Statement|Sitemap|About US| Contact US: help@patsnap.com