[發明專利]一種光電穩定平臺控制的方法和電子設備

在審

• 申請號: 202210902100.8
• 申請日: 2022-07-29
• 公開（公告）號: CN115313949A
• 公開（公告）日: 2022-11-08
• 發明（設計）人: 黃立;吳云軍;黃國鵬;張煜文
• 申請（專利權）人: 武漢高德紅外股份有限公司
• 主分類號: H02P21/22
• 分類號: H02P21/22;H02P21/05
• 代理公司: 北京匯澤知識產權代理有限公司 11228
• 代理人: 吳靜

1.一種光電穩定平臺控制的方法，其特征在于，包括：

S100.通過運動敏感元件檢測光電穩定平臺中的電機角速度反饋值ω_Fdb，并將其變換得到擾動頻率ω_L；

S200.將得到的擾動頻率ω_L和電流環反饋電流I_qFdb送入光電穩定平臺中的諧振擾動鎖相環，通過諧振擾動鎖相環算法得到補償電流I_comp；

S300.將補償電流I_comp送入光電穩定平臺中的電流環后進行負反饋控制，減小外界擾動對穩定平臺的影響，增強穩定平臺的抗擾動能力。

2.如權利要求1所述的一種光電穩定平臺控制的方法，其特征在于，S100中，運動敏感元件至少包括：陀螺儀和組合導航。

3.如權利要求1所述的一種光電穩定平臺控制的方法，其特征在于，角速度反饋值ω_Fdb通過快速傅里葉變換得到擾動頻率ω_L。

4.如權利要求1所述的一種光電穩定平臺控制的方法，其特征在于，S200中，通過諧振擾動鎖相環算法得到補償電流I_comp的具體方法包括：

S201.實時計算擾動頻率ω_L和實時采集電流環反饋電流I_qFdb；

S202.計算與電流環反饋電流I_qFdb同相位信號I’_qFdb及其正交信號qI’_qFdb；

S203.計算與電流環反饋電流I_qFdb同相信號的角頻率ω_PLL；

S204.通過對S203角頻率進行積分，得到擾動電流相位θ_PLL；

S205.通過擾動電流相位，計算補償電流I_comp。

5.如權利要求4所述的一種光電穩定平臺控制的方法，其特征在于，計算與電流環反饋電流I_qFdb同相位信號I’_qFdb的公式為：

I’_qFdb＝(I’_qFdb)^-1+(K·(I_qFdb-(I’_qFdb)^-1)-(qI’_qFdb)^-1)·ω_L·T_s

其中，(I’_qFdb)^-1為I’_qFdb上一時刻的輸出值，(qI’_qFdb)^-1為qI’_qFdb上一時刻的輸出值，T_s為電流環的計算周期，K為諧振擾動鎖相環算法的增益，ω_L為擾動頻率。

6.如權利要求4所述的一種光電穩定平臺控制的方法，其特征在于，計算與電流環反饋電流I_qFdb正交信號qI’_qFdb的公式為：

qI’_qFdb＝(qI’_qFdb)^-1+I’_qFdb·ω_L·T_s

其中，(I’_qFdb)^-1為I’_qFdb上一時刻的輸出值，(qI’_qFdb)^-1為qI’_qFdb上一時刻的輸出值，T_s為電流環的計算周期，ω_L為擾動頻率。