Position loop coordinate system conversion method of photoelectricity stable platform
A photoelectric stabilization platform, coordinate system conversion technology, applied in the field of servo control, can solve the problems of inability to guarantee accuracy, unsuitable integration, low efficiency, etc., and achieve the effect of increasing hardware circuits and costs
- 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] Cmd = ΔR t * V max * C max
[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: Acco...
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] Cmd = ΔR t * V max * C max
[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] ...
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] Cmd = ΔR t * V max * C max
[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: Accord...
PUM
Login to View More Abstract
Description
Claims
Application Information
Login to View More 