HMR3000電子羅盤(pán)與DSP的接口設(shè)計(jì)及編程
2.4 獲取平臺(tái)相對(duì)地理正北夾角計(jì)算
為了獲得羅盤(pán)正向與地理北的夾角值,存在一定的換算關(guān)系。機(jī)械安裝保證羅盤(pán)正向與光軸指向一致,如存在偏向角,則還需疊加偏向角。我國(guó)除烏魯木齊、南沙群島、曾母暗沙群島磁偏角位于磁北偏東以外,其他地區(qū)均處于磁北偏西。系統(tǒng)歸零時(shí),假定磁北(圖4指示磁北在地理北以西,也可能在地理北以東)、地理北、光軸指向如圖4所示。同時(shí)假定磁偏角為ζ,羅盤(pán)正向與磁北夾角為ψ(角度以磁北順時(shí)針命名,即磁航向),獲取的羅盤(pán)正向與地理正北夾角為θ(相對(duì)地理北順時(shí)針命名,即真航向)。根據(jù)每個(gè)地區(qū)ζ值的不同采用上位軟件命令輸入方式。磁北偏在地理北以西時(shí),ζ為正值,磁北偏在地理北以東時(shí),ζ為負(fù)值。設(shè)計(jì)時(shí)ζ始終取為正,但以標(biāo)志作為正、負(fù)判斷,則存在以下判據(jù):
3 結(jié)論
HMR3000與外界通信若采用通常的匯編語(yǔ)言,其控制處理的靈活性差,而且語(yǔ)言本身的可移植性差。采用DSP高級(jí)語(yǔ)言處理克服了以上的缺點(diǎn)。以上利用高級(jí)語(yǔ)言處理的HMR3000部分接口程序在CCS 2.21環(huán)境下編譯通過(guò),其獲取平臺(tái)相對(duì)地理正北重復(fù)精度達(dá)±0.1°,且速度快,并在開(kāi)發(fā)的項(xiàng)目中穩(wěn)定運(yùn)行。系統(tǒng)穩(wěn)定運(yùn)行需要注意磁場(chǎng)對(duì)電子羅盤(pán)的干擾。
評(píng)論