A Position Loop Coordinate System Transformation Method for Photoelectric Stabilized Platform
A photoelectric stable platform and coordinate system conversion technology, applied in the field of servo control, can solve problems such as unguaranteed accuracy, unsuitable integration, low efficiency, etc., to improve convenience and efficiency, simplify mechanical assembly steps, and high consistency and the effect of precision
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Embodiment 1
[0054] Implementation example 1: Inner pitch (ie)
[0055] Step 1: Initialize variables: set counter I counter =0, position sensor polarity P=0, speed command Cmd=0, full motion time variable I time = 0;
[0056] Step 2: Open the speed loop, and calculate the speed command Cmd of the speed loop of the inner pitch by the following formula:
[0057]
[0058] In the formula, ΔR is the mechanical rotation angle of the load; t is the expected movement time of the load, V max is the maximum speed of the speed loop, C max is the speed command corresponding to the maximum speed, ΔR, V max 、C max Both are known quantities, the value of t makes Cmdmax , here is set to 4 seconds; then the speed command of the inner pitch speed loop is:
[0059]
[0060] Step 3: According to the value of Cmd to the speed threshold V d Make an estimate:
[0061] V d = K i *Cmd / C max *V max
[0062] In the formula, K i Is the proportional factor, the value range is 0.1 to 0.4; here take ...
Embodiment 2
[0080] Implementation Example 2: Inner Orientation (ia)
[0081] Step 1: Initialize variables: set counter I counter =0, position sensor polarity P=0, speed command Cmd=0, full motion time variable I time = 0;
[0082] Step 2: Open the speed loop, and calculate the speed command Cmd of the speed loop in the inner direction by the following formula:
[0083]
[0084] In the formula, ΔR is the mechanical rotation angle of the load; t is the expected movement time of the load, V max is the maximum speed of the speed loop, C max is the speed command corresponding to the maximum speed, ΔR, V max 、C max Both are known quantities, the value of t makes Cmdmax , here is set to 4 seconds; then the speed command of the inner azimuth speed loop is:
[0085]
[0086] Step 3: According to the value of Cmd to the speed threshold V d Make an estimate:
[0087] V d = K i *Cmd / C max *V max
[0088] In the formula, K i Is the proportional factor, the value range is 0.1 to 0.4...
Embodiment 3
[0106] Implementation example three: outer pitch (oe)
[0107] Step 1: Initialize variables: set counter I counter =0, position sensor polarity P=0, speed command Cmd=0, full motion time variable I time = 0;
[0108] Step 2: Open the speed loop, and calculate the speed loop speed command Cmd of the outer pitch by the following formula:
[0109]
[0110] In the formula, ΔR is the mechanical rotation angle of the load; t is the expected movement time of the load, V max is the maximum speed of the speed loop, C max is the speed command corresponding to the maximum speed, ΔR, V max 、C max Both are known quantities, the value of t makes Cmdmax , here is set to 20 seconds; then the speed command of the outer pitch speed loop is:
[0111]
[0112] Step 3: According to the value of Cmd to the speed threshold V d Make an estimate:
[0113] V d = K i *Cmd / C max *V max
[0114] In the formula, K i Is the proportional factor, the value range is 0.1 to 0.4; here take K ...
PUM
Login to View More Abstract
Description
Claims
Application Information
Login to View More 


