[發(fā)明專利]瞄準(zhǔn)控制器及其自動(dòng)解算慣組棱鏡初始方位角的方法

有效

• 申請(qǐng)?zhí)枺?/td>: 201410225092.3
• 申請(qǐng)日: 2014-05-26
• 公開（公告）號(hào): CN104049642B
• 公開（公告）日: 2017-09-08
• 發(fā)明（設(shè)計(jì)）人: 狄世超;高明杰;董彥維;宋小艷;范毅
• 申請(qǐng)（專利權(quán)）人: 北京航天發(fā)射技術(shù)研究所;中國(guó)運(yùn)載火箭技術(shù)研究院
• 主分類號(hào): G05D3/12
• 分類號(hào): G05D3/12
• 代理公司: 北京雙收知識(shí)產(chǎn)權(quán)代理有限公司11241
• 代理人: 左明坤,萊

1.一種瞄準(zhǔn)控制器自動(dòng)解算慣組棱鏡初始方位角的方法，

包括瞄準(zhǔn)控制器，瞄準(zhǔn)控制器包括處理器模塊(1)、通訊模塊(3)、電源管理模塊(2)、顯示模塊(4)、存儲(chǔ)模塊(5)；所述處理器模塊(1)為CPU處理器；

所述電源管理模塊(2)、通訊模塊(3)、顯示模塊(4)和存儲(chǔ)模塊(5)分別連接在所述CPU處理器的相應(yīng)管腳上；

所述處理器模塊(1)包括依次相連的輸入單元(11)、處理單元(12)和輸出單元(13)，且所述輸入單元(11)、處理單元(12)和輸出單元(13)集成在所述CPU處理器中；

所述通訊模塊(3)、所述顯示模塊(4)、所述存儲(chǔ)模塊(5)與所述輸出單元(13)相連；

所述顯示模塊(4)包括參數(shù)設(shè)置單元(41)、流程控制單元(42)、顯示數(shù)據(jù)單元(43)；

所述參數(shù)設(shè)置單元(41)、所述流程控制單元(42)與所述處理器模塊(1)的輸入單元(11)相連；

所述顯示數(shù)據(jù)單元(43)與所述處理器模塊(1)的輸出單元(13)相連；

所述電源管理模塊(2)輸入端與220V市電電源母線相連，輸出端分別與所述處理器模塊(1)、顯示模塊(4)和存儲(chǔ)模塊(5)相連；

所述處理器模塊(1)的輸入單元(11)通過(guò)所述通訊模塊(3)與激光瞄準(zhǔn)儀的數(shù)據(jù)輸出端相連；

所述通訊模塊(3)為串口通信接口或無(wú)線傳輸設(shè)備；

所述電源管理模塊(2)輸出端還與激光瞄準(zhǔn)儀激光器相連；

所述參數(shù)設(shè)置單元(41)和所述流程控制單元(42)分別與鍵盤輸入裝置相連；

還包括光源旋鈕，所述光源旋鈕連接所述電源管理模塊(2)的輸出端，并與激光瞄準(zhǔn)儀激光器相連，用于控制激光器的激光亮度；

所述CPU處理器通過(guò)所述通訊模塊(3)與上位機(jī)相連；

所述存儲(chǔ)模塊(5)采用鐵電存儲(chǔ)器；

所述通訊模塊(3)包括RS232串口通信接口、RS422串口通信接口；

所述上位機(jī)通過(guò)RS422串口通信接口連接在所述CPU處理器上；

所述激光瞄準(zhǔn)儀通過(guò)RS232串口通信接口連接在所述CPU處理器上；

所述電源管理模塊(2)與所述CPU處理器輸出端之間設(shè)置有電源開關(guān)；

所述電源開關(guān)的輸入端設(shè)置在所述顯示模塊(4)上；

所述CPU處理器采用SAK-XC164CS-32F型號(hào)；

所述鐵電存儲(chǔ)器采用FM25640型號(hào)；

所述顯示模塊(4)為可觸控LCD顯示屏；

其特征在于，包括以下步驟：

通過(guò)鍵盤在所述顯示模塊(4)的參數(shù)設(shè)置單元(41)相應(yīng)的界面輸入各瞄準(zhǔn)點(diǎn)號(hào)及對(duì)應(yīng)的大地方位角，輸入的數(shù)據(jù)存儲(chǔ)在所述存儲(chǔ)模塊(5)中；

將標(biāo)桿架設(shè)在基準(zhǔn)點(diǎn)上，并用激光瞄準(zhǔn)儀瞄準(zhǔn)該標(biāo)桿；

通過(guò)鍵盤在所述顯示模塊(4)的流程控制單元(42)相應(yīng)的界面選擇瞄標(biāo)桿；

所述CPU處理器讀取所述存儲(chǔ)模塊(5)中存儲(chǔ)的對(duì)應(yīng)的大地方位角；

所述CPU處理器通過(guò)所述通訊模塊(3)讀取瞄準(zhǔn)標(biāo)桿時(shí)激光瞄準(zhǔn)儀的方位角和俯仰角，并將結(jié)果存儲(chǔ)在所述存儲(chǔ)模塊(5)中；

按下所述顯示模塊(4)上的電源開關(guān)輸入端，使所述電源管理模塊(2)為激光瞄準(zhǔn)儀激光器供電；通過(guò)“光源”旋鈕調(diào)整瞄準(zhǔn)儀激光器光照度至合適值；

依據(jù)激光器瞄準(zhǔn)儀激光器，調(diào)整激光瞄準(zhǔn)儀方位角、俯仰角使之與慣組棱鏡準(zhǔn)直；

通過(guò)鍵盤在所述顯示模塊(4)的流程控制單元(41)相應(yīng)的界面選擇瞄慣組；

所述CPU處理器的輸入單元(11)獲取激光瞄準(zhǔn)儀方位角、俯仰角與慣組棱鏡準(zhǔn)直時(shí)，激光瞄準(zhǔn)儀的方位角、俯仰角，并將其儲(chǔ)存在所述存儲(chǔ)模塊(5)中；

所述CPU處理器的處理單元(12)計(jì)算慣組棱鏡的初始方位角度和俯仰角度，其中，慣組棱鏡初始方位角Φ計(jì)算見公式(1)，

Φ＝Φ_i+ρ₃-ρ₁ (1)，

ρ₃-瞄慣組結(jié)果，

ρ₁-瞄標(biāo)桿結(jié)果，

Φ_i-基準(zhǔn)大地方位角，

若Φ_i+ρ₃-ρ₁<0，則需要加360°；

所述輸出單元(13)將慣組棱鏡初始方位角Φ輸出至所述顯示模塊(4)的顯示數(shù)據(jù)單元(43)。

2.根據(jù)權(quán)利要求1所述的一種瞄準(zhǔn)控制器自動(dòng)解算慣組棱鏡初始方位角的方法，其特征在于，包括以下步驟：

將上位機(jī)與所述處理器模塊(1)通過(guò)所述通訊模塊(3)相連；

上位機(jī)通過(guò)所述通訊模塊(3)向所述處理器模塊(1)發(fā)出瞄準(zhǔn)指令；

所述處理器模塊(1)分別進(jìn)行瞄標(biāo)桿、瞄慣組、解算慣組棱鏡初始方位角流程，并存儲(chǔ)相應(yīng)數(shù)據(jù)；

所述上位機(jī)通過(guò)所述通訊模塊(3)向所述處理器模塊(1)發(fā)出請(qǐng)求瞄準(zhǔn)數(shù)據(jù)命令；

所述處理器模塊(1)將解算出的瞄準(zhǔn)數(shù)據(jù)方位角度、俯仰角度通過(guò)所述通訊模塊(3)上傳至上位機(jī)。