一種捷聯(lián)慣性導(dǎo)航系統(tǒng)的旋轉(zhuǎn)控制機構(gòu)設(shè)計技術(shù)

董 旭，董建樹，王 惠，嚴宗睿

(1.北京機電工程研究所，北京 100074；2.北京振興計量測試研究所，北京 100074; 3.海軍指揮學(xué)院，南京 210016)

0 引言

當(dāng)前，國外高精度光纖陀螺旋轉(zhuǎn)調(diào)制慣導(dǎo)系統(tǒng)正在逐漸替代價格昂貴的靜電陀螺慣導(dǎo)系統(tǒng)，為艦船提供高精度、低成本、長航時的慣性導(dǎo)航系統(tǒng)。為了在現(xiàn)有光纖陀螺精度基礎(chǔ)上進一步提高捷聯(lián)慣性導(dǎo)航系統(tǒng)的導(dǎo)航精度，采用誤差自補償?shù)男D(zhuǎn)調(diào)制技術(shù)勢在必行[1-2]。

旋轉(zhuǎn)調(diào)制型捷聯(lián)慣性導(dǎo)航系統(tǒng)的旋轉(zhuǎn)方式可以分為兩類：一是慣性元器件所在的殼體旋轉(zhuǎn)，二是整個慣性測量組件所在的臺體旋轉(zhuǎn)。旋轉(zhuǎn)調(diào)制型捷聯(lián)慣性導(dǎo)航系統(tǒng)的旋轉(zhuǎn)方式眾多，旋轉(zhuǎn)調(diào)制型慣導(dǎo)系統(tǒng)根據(jù)轉(zhuǎn)軸數(shù)目可分為單軸系統(tǒng)、雙軸系統(tǒng)、三軸系統(tǒng)，每種類型有不同的轉(zhuǎn)動方案，可分為連續(xù)往復(fù)轉(zhuǎn)動、間斷型多位置轉(zhuǎn)停等轉(zhuǎn)動方案[3-4]。

當(dāng)前, 連續(xù)旋轉(zhuǎn)對準方式成為光纖陀螺慣導(dǎo)系統(tǒng)實現(xiàn)高精度對準的一種有效技術(shù)手段。采用單軸旋轉(zhuǎn)光纖陀螺捷聯(lián)慣性導(dǎo)航系統(tǒng)的連續(xù)旋轉(zhuǎn)方案，研究單軸連續(xù)旋轉(zhuǎn)控制機構(gòu)的設(shè)計技術(shù)，通過光纖陀螺慣性測量組件(IMU)繞旋轉(zhuǎn)軸作有規(guī)律的運動，對慣性器件的誤差在旋轉(zhuǎn)周期內(nèi)進行調(diào)制, 補償慣性器件的漂移誤差，控制導(dǎo)航誤差隨時間延長的增長，從而大幅提升系統(tǒng)對準精度和對準收斂速度, 成為工程應(yīng)用研究的熱點之一。

1 工作原理和設(shè)計方案

慣導(dǎo)系統(tǒng)單軸旋轉(zhuǎn)調(diào)制技術(shù)的實現(xiàn)方法是將慣性測量單元(IMU)安裝在單軸旋轉(zhuǎn)機構(gòu)上，旋轉(zhuǎn)機構(gòu)帶動 IMU 按照事先設(shè)定的轉(zhuǎn)動規(guī)律繞旋轉(zhuǎn)軸相對載體轉(zhuǎn)動。為了實現(xiàn)方便，轉(zhuǎn)臺的旋轉(zhuǎn)軸與載體水平面垂直。在普通的往復(fù)旋轉(zhuǎn)控制方式下，旋轉(zhuǎn)機構(gòu)以單軸測角裝置的360°范圍值為依據(jù)，帶動慣性測量單元以設(shè)定的速率進行從光碼盤的0°運動到360°，然后從360°運動到0°的往復(fù)旋轉(zhuǎn)。往復(fù)旋轉(zhuǎn)運動的理想效果是：旋轉(zhuǎn)機構(gòu)圍繞載體坐標(biāo)系的基準角，作勻速的往復(fù)旋轉(zhuǎn)。

航向解藕往復(fù)旋轉(zhuǎn)模式是航向追蹤運動與往復(fù)旋轉(zhuǎn)運動的兩種矢量疊加。假設(shè)載體靜止，IMU 會相對導(dǎo)航系按照設(shè)定的規(guī)律轉(zhuǎn)動。但是在工程實際中，載體總是進行各種各樣的運動，載體的角運動與 IMU 的轉(zhuǎn)動耦合。在載體航向運動的影響下，IMU 再按原來設(shè)定的方案旋轉(zhuǎn)時，相對導(dǎo)航系并不是按照理想設(shè)定的規(guī)律旋轉(zhuǎn)，影響到旋轉(zhuǎn)調(diào)制的效果。在導(dǎo)航系中，等效陀螺漂移與載體的航向角幅度、角頻率、載體航向的發(fā)生時刻、航向角運動時間長短和 IMU 相對載體的轉(zhuǎn)動時刻相關(guān)。由于載體的航向運動，IMU 在導(dǎo)航系中的運動沒有規(guī)律，在一個旋轉(zhuǎn)周期內(nèi)，器件誤差積分不為零，即載體航向運動抵消了 IMU 旋轉(zhuǎn)的調(diào)制效果。如果載體航向運動的角度始終與 IMU 相對載體旋轉(zhuǎn)的角度大小相等方向相反，那么在導(dǎo)航系中的器件測量誤差沒有發(fā)生變化，載體航向運動就完全抵消了旋轉(zhuǎn)調(diào)制的效果。理想情況下，利用計算的載體姿態(tài)數(shù)據(jù)和設(shè)定的旋轉(zhuǎn)調(diào)制規(guī)律驅(qū)動 IMU 轉(zhuǎn)臺相對載體轉(zhuǎn)動，可以有效消除載體航向運動的影響，使系統(tǒng)與載體的航向運動相隔離，以便 IMU 相對于導(dǎo)航系進行有規(guī)律地轉(zhuǎn)動。INS與IMU之間的位置慣性如圖1所示[5-6]。

圖1 INS與IMU之間的位置關(guān)系示意圖

航向解藕往復(fù)旋轉(zhuǎn)模式以地理坐標(biāo)系為基準坐標(biāo)系，以解調(diào)后的初始航向角為零位，根據(jù)解調(diào)后的航向角和角速度，能夠在0～360°之間以指令角速率恒速往復(fù)運動。航向解耦的理想效果是：無論載體(INS)航向如何變化，旋轉(zhuǎn)機構(gòu)都圍繞地理坐標(biāo)系的基準角，作勻速的往復(fù)旋轉(zhuǎn)[7-8]。

旋轉(zhuǎn)機構(gòu)的設(shè)計方案集電子、自控、軟件、機械于一體，工作原理如下：慣導(dǎo)中的慣性測量單元置于旋轉(zhuǎn)機構(gòu)上，直流電機通過變速箱軸承驅(qū)動旋轉(zhuǎn)機構(gòu)轉(zhuǎn)動，通過測角裝置上傳角位置，旋轉(zhuǎn)機構(gòu)返回零位置，等待導(dǎo)航計算機發(fā)送的指令，旋轉(zhuǎn)機構(gòu)帶動慣性測量單元以設(shè)定的速率和旋轉(zhuǎn)方式進行旋轉(zhuǎn)，或者接收導(dǎo)航計算機發(fā)送的位置指令，以固定的速率轉(zhuǎn)到要求位置，并在該位置穩(wěn)定。同時，通過串口將旋轉(zhuǎn)機構(gòu)實時信息傳遞至外部的導(dǎo)航計算機[9]。

旋轉(zhuǎn)機構(gòu)主要實現(xiàn)兩種功能，一是能夠接收導(dǎo)航計算機發(fā)送的速率指令，以設(shè)定的速率和旋轉(zhuǎn)方式進行旋轉(zhuǎn)；二是能夠接收導(dǎo)航計算機發(fā)送的位置指令，以固定的速率轉(zhuǎn)到要求位置，并在該位置穩(wěn)定。另外，旋轉(zhuǎn)機構(gòu)還必須具有上電自檢和工作過程中進行巡檢的功能，并將檢測結(jié)果通過狀態(tài)字發(fā)送給慣導(dǎo)。旋轉(zhuǎn)機構(gòu)工作過程中若發(fā)現(xiàn)“失速”等非硬件損壞性故障，在旋轉(zhuǎn)控制電路的處理器還能與慣導(dǎo)正常通訊的情況下，在慣導(dǎo)發(fā)送復(fù)位命令后，旋轉(zhuǎn)機構(gòu)應(yīng)能復(fù)位，控制程序重新開始執(zhí)行[10]。

為滿足功能和性能要求，旋轉(zhuǎn)機構(gòu)的設(shè)計方案綜合考慮系統(tǒng)級實際工作要求，將傳感器、處理器、控制器融合在一個機械結(jié)構(gòu)體內(nèi)。旋轉(zhuǎn)機構(gòu)主要由旋轉(zhuǎn)控制電路、旋轉(zhuǎn)控制軟件、單軸測角裝置、直流電機等分部件組成，旋轉(zhuǎn)機構(gòu)組成及配套關(guān)系如圖2所示。其中，旋轉(zhuǎn)控制電路及其控制軟件負責(zé)完成采集測角信息，實現(xiàn)對電機的速度驅(qū)動，并完成與慣導(dǎo)的通訊。外部的導(dǎo)航計算機向旋轉(zhuǎn)控制電路和測角裝置發(fā)送同一個同步信號，旋轉(zhuǎn)控制電路和導(dǎo)航計算機同時接收測角裝置發(fā)送的測角數(shù)據(jù)。小型直流電機負責(zé)執(zhí)行旋轉(zhuǎn)控制電路的旋轉(zhuǎn)功能。

圖2 旋轉(zhuǎn)機構(gòu)系統(tǒng)框圖

2 硬件設(shè)計

2.1 控制電路的設(shè)計

旋轉(zhuǎn)控制電路負責(zé)完成采集測角信息，實現(xiàn)對電機的速度驅(qū)動，并完成與慣導(dǎo)的通訊，接收指令和發(fā)送數(shù)據(jù)及狀態(tài)[11-12]。旋轉(zhuǎn)控制電路定時獲得準確的測角裝置角度，控制系統(tǒng)通過數(shù)模轉(zhuǎn)換器和運放驅(qū)動直流電機，利用它與處理器、電機和測角裝置構(gòu)成一個完整的運動控制系統(tǒng)。旋轉(zhuǎn)控制電路的原理如圖3所示。

圖3 旋轉(zhuǎn)控制電路的原理圖

旋轉(zhuǎn)控制電路的3D如圖4所示。

圖4 旋轉(zhuǎn)控制電路的3D圖

2.2 單軸測角裝置的選型

單軸測角裝置主要應(yīng)用于旋轉(zhuǎn)機構(gòu)角度測量系統(tǒng)。旋轉(zhuǎn)機構(gòu)根據(jù)單軸測角裝置輸出角度信號對IMU進行運動控制，包括角位置控制和角速度控制。旋轉(zhuǎn)機構(gòu)選用長春光機所的單軸測角裝置(光碼盤)，分辨率優(yōu)于2.5″；同步信號響應(yīng)延時不大于5 μs(單軸測角裝置在同步信號的下降沿后5 μs之內(nèi)進行角度采樣)；完成數(shù)據(jù)輸出(從接收同步信號開始)小于100 μs；功耗不大于1 W；允許最高機械轉(zhuǎn)速不小于20 rpm。

單軸測角裝置的工作方式如圖5所示，測角裝置以中斷方式響應(yīng)同步信號的下降沿，觸發(fā)角度采樣，然后輸出角度數(shù)據(jù)，從接收到同步信號開始到完成數(shù)據(jù)輸出小于100 μs[13]。

圖5 單軸測角裝置工作方式

單軸測角裝置通過導(dǎo)航計算機向旋轉(zhuǎn)控制電路和測角裝置發(fā)送同一個同步信號，旋轉(zhuǎn)控制電路和導(dǎo)航計算機同時接收測角裝置發(fā)送的測角數(shù)據(jù)，如圖6所示。具體實現(xiàn)為:導(dǎo)航軟件進入1 ms定時中斷程序，陀螺選通時將同步信號發(fā)出，測角裝置接收到同步信號后最大采樣延時為5 μs[14]。

圖6 旋轉(zhuǎn)機構(gòu)數(shù)據(jù)同步原理示意圖

單軸測角裝置的數(shù)字量與角秒之間的換算關(guān)系為：

(1)

反過來，1角分代表的單軸測角裝置數(shù)字量為：

(2)

在旋轉(zhuǎn)過程中，假設(shè)角速度為5(°/s)，則由于軟件延時5 ms形成的角誤差為：

(3)

該式表明調(diào)節(jié)精度為90″。

2.3 電機的選型

根據(jù)前期對4.5 kg旋轉(zhuǎn)體的需要的驅(qū)動轉(zhuǎn)矩的測量和計算，所需轉(zhuǎn)矩如下：

1)克服摩擦力矩所需轉(zhuǎn)矩：摩擦轉(zhuǎn)矩包括單軸測角裝置軸承、力矩電機軸承、力矩電機電刷的摩擦轉(zhuǎn)矩、潤滑脂對軸承摩擦轉(zhuǎn)矩的影響以及由于系統(tǒng)裝配不完全同軸所帶來的負載的增加部分等等。由于不易通過計算得到準確值，因此用掛砝碼的方法對單軸測角裝置的摩擦力矩進行測量，砝碼重量為0.104 kg，力臂約為12.5 mm，結(jié)果為：

0.104×9.8×0.0125=0.01225 Nm(P=mgL)

(4)

電機總的摩擦轉(zhuǎn)矩，根據(jù)0.6 V的起動電壓，估算為：

(0.7～0.8)×0.6/24=(0.0175～0.02)Nm

(5)

因此常溫條件下，旋轉(zhuǎn)機構(gòu)的摩擦轉(zhuǎn)矩約為0.03 Nm(疊加)?？紤]低溫摩擦力矩增大，取摩擦力矩0.1 Nm；

2)旋轉(zhuǎn)機構(gòu)加速運動所需轉(zhuǎn)矩：正常工作狀態(tài)下，由轉(zhuǎn)動慣量產(chǎn)生的負載最大值發(fā)生在換向加速結(jié)束時，此時按系統(tǒng)要求旋轉(zhuǎn)機構(gòu)的最大角速度達到100°/s(17 rpm)，因此所需轉(zhuǎn)矩為：

Tj1=Jdω1/dt=0.01969×100/57.3=0.034 Nm

(6)

3)跟蹤載體加速旋轉(zhuǎn)所需轉(zhuǎn)矩：根據(jù)某型慣導(dǎo)試驗數(shù)據(jù)，瞬間角加速度不大于 1500 °/s2，則為保證旋轉(zhuǎn)機構(gòu)平穩(wěn)旋轉(zhuǎn)的轉(zhuǎn)矩為：

Tj2=Jdω2/dt=0.01969×1500/57.3=0.515 Nm

(7)

4)旋轉(zhuǎn)部分偏心在沖擊條件(15 g/11 ms)下產(chǎn)生的轉(zhuǎn)矩：根據(jù)復(fù)算結(jié)果，旋轉(zhuǎn)部分偏心距為0.23 mm，旋轉(zhuǎn)體重量為4.6 kg，考慮機構(gòu)放大1.8倍(總體提供數(shù)據(jù))，實際加速度達到27 g,因此旋轉(zhuǎn)體偏心受沖擊影響，產(chǎn)生的轉(zhuǎn)矩為:

Tp=Mal=4.6×27× 9.8 ×0.23×10-3=0.28 Nm

(8)

綜上，在極端條件下電機所需要提供的轉(zhuǎn)矩為上述轉(zhuǎn)矩的合力，即:

T=0.1+0.034+0.515+0.28=0.929 Nm

(9)

考慮到極端條件(例如載體1 500°/s2)出現(xiàn)幾率較小，按極端條件的50%計，對旋轉(zhuǎn)體進行配重調(diào)平降低偏心距，降低沖擊產(chǎn)生的50%轉(zhuǎn)矩，因此電機所需提供的力矩為:

T=0.1+0.034+0.2575+0.15=0.54 Nm

(10)

按目前對系統(tǒng)的架構(gòu)設(shè)想，內(nèi)環(huán)旋轉(zhuǎn)體上僅有加速度計和陀螺組合，重量應(yīng)在3.5 kg左右，為了對慣性器件進行有效的磁屏蔽，設(shè)計還將要在旋轉(zhuǎn)體外部用磁屏蔽材料做一個外罩，因此旋轉(zhuǎn)負載體的重量應(yīng)在5 kg左右。所以以上述計算的力矩選擇電機。

5)單軸測角裝置與電機之間傳動的計算：單軸測角裝置的轉(zhuǎn)速與控制電機速度的電壓量之間的關(guān)系式為：

Vtarget=K·N

(11)

其中：Vtarget表示控制電機速度的電壓(V);K表示電機變速箱和齒輪等共同作用形成的轉(zhuǎn)速比例系數(shù);N表示光碼盤的轉(zhuǎn)速(rpm)。

單位rpm與單位(0.00001 °/s)之間的換算關(guān)系式為：

N·360°/60 s=ω/105(°)/s

(12)

其中：ω表示單軸測角裝置的角速度，單位：0.00001 °/s。1 rpm=6 °/s。

3 軟件設(shè)計

3.1 旋轉(zhuǎn)機構(gòu)的軟件功能

旋轉(zhuǎn)機構(gòu)采用以單片機為核心的數(shù)字控制系統(tǒng)，因此旋轉(zhuǎn)機構(gòu)的控制策略通過旋轉(zhuǎn)控制軟件設(shè)計來實現(xiàn)，其工作內(nèi)容包括：

1)單片機各寄存器和變量的初始化；

2)與導(dǎo)航計算機通信，接收導(dǎo)航計算機運動控制命令，并向?qū)Ш接嬎銠C反饋旋轉(zhuǎn)機構(gòu)狀態(tài)；

3)產(chǎn)生單軸測角裝置同步信號，并接收單軸測角裝置輸出角度信號；

4)對電機進行控制，實現(xiàn)導(dǎo)航計算機發(fā)送的運動控制命令；

5)旋轉(zhuǎn)機構(gòu)相應(yīng)的保護功能。旋轉(zhuǎn)控制軟件由主程序和中斷服務(wù)子程序兩大部分組成，按功能將軟件分為三部分：系統(tǒng)初始化、中斷服務(wù)和執(zhí)行導(dǎo)航計算機命令[15-16]。

主要軟件部件內(nèi)部接口控制流如圖7所示。

圖7 軟件內(nèi)部接口示意圖

旋轉(zhuǎn)控制軟件的流程主要包括如下步驟：

1)實現(xiàn)中央處理器的初始化功能。對旋轉(zhuǎn)機構(gòu)的中央處理器各寄存器和變量的初始化；

2)對旋轉(zhuǎn)機構(gòu)進行自檢活動尋零，確保旋轉(zhuǎn)機構(gòu)開機后的位置處于起始零位；

3)循環(huán)解讀導(dǎo)航命令，并執(zhí)行相應(yīng)動作；

4)隨時響應(yīng)CPU定時中斷和外部中斷申請，執(zhí)行相應(yīng)的中斷服務(wù)子程序。

導(dǎo)航計算機從外部向旋轉(zhuǎn)機構(gòu)下達各種導(dǎo)航命令，這些命令產(chǎn)生的條件分別為：

1)當(dāng)旋轉(zhuǎn)機構(gòu)工作異常需要糾正時，外部發(fā)出命令復(fù)位；

2)當(dāng)需要旋轉(zhuǎn)機構(gòu)正常工作時，外部發(fā)出命令往復(fù)旋轉(zhuǎn)控制；

3)當(dāng)需要旋轉(zhuǎn)機構(gòu)在某個角度靜止時，外部發(fā)出命令絕對位置控制；

4)當(dāng)需要旋轉(zhuǎn)機構(gòu)以指定的速度旋轉(zhuǎn)時，外部發(fā)出命令速度控制；

5)當(dāng)需要旋轉(zhuǎn)機構(gòu)相對于某個固定角度作旋轉(zhuǎn)并在另一個相關(guān)角度靜止時，外部發(fā)出命令相對位置控制；

6)當(dāng)需要旋轉(zhuǎn)機構(gòu)根據(jù)慣導(dǎo)的要求一次性連續(xù)單向旋轉(zhuǎn)多圈時，外部發(fā)出命令在線標(biāo)定控制；

7)當(dāng)需要旋轉(zhuǎn)機構(gòu)根據(jù)慣導(dǎo)的要求一次性旋轉(zhuǎn)到指定角度時，外部發(fā)出命令初始標(biāo)定控制；

8)當(dāng)需要旋轉(zhuǎn)機構(gòu)需要實時跟蹤載體外部的航向與航速變化，從而實現(xiàn)相對地理坐標(biāo)系的往復(fù)旋轉(zhuǎn)時，外部發(fā)出命令航向解耦往復(fù)旋轉(zhuǎn)控制。

在上述步驟的過程中任何時刻，響應(yīng)不同的中斷源并保存新命令。待前一個命令的動作完成后，再執(zhí)行最新命令的動作[17-18]。

各種中斷源如下所示：

1)中斷源(1 優(yōu)先級最高)REST：復(fù)位中斷；

2)中斷源(2 優(yōu)先級高)INT0：外部同步信號請求中斷；

3)中斷源(3 優(yōu)先級次高)TIMER0 OVF：定時器0中斷，允許中斷嵌套；

4)中斷源(4 優(yōu)先級中)USART1 RX：通訊串口1收結(jié)束的中斷；

5)中斷源(5 優(yōu)先級低)USART1 TX：通訊串口1發(fā)結(jié)束中斷；

中斷源(6 優(yōu)先級最低)USART2 RX：通訊串口2收結(jié)束的中斷。

3.2 旋轉(zhuǎn)裝置控制方法和工作模式

旋轉(zhuǎn)裝置控制方法的流程包括如下步驟：

1)實現(xiàn)中央處理器的初始化功能。對旋轉(zhuǎn)裝置的中央處理器各寄存器和變量的初始化。

2)對旋轉(zhuǎn)裝置進行自檢尋零，確保旋轉(zhuǎn)裝置開機后的位置在起始零位；

3)解讀導(dǎo)航命令，并執(zhí)行相應(yīng)動作；

外部計算機向雙軸旋轉(zhuǎn)裝置下達各種導(dǎo)航命令，這些命令產(chǎn)生的條件分別為：

當(dāng)旋轉(zhuǎn)裝置工作異常需要糾正時，外部發(fā)出命令復(fù)位；

當(dāng)需要旋轉(zhuǎn)裝置正常工作時，外部發(fā)出命令往復(fù)旋轉(zhuǎn)控制；

當(dāng)需要旋轉(zhuǎn)裝置在某個角度靜止時，外部發(fā)出命令絕對位置控制；

當(dāng)需要旋轉(zhuǎn)裝置需要實時跟蹤載體外部的航向與航速變化，從而實現(xiàn)相對地理坐標(biāo)系的往復(fù)旋轉(zhuǎn)時，外部發(fā)出命令航向解耦往復(fù)旋轉(zhuǎn)控制。

在上述步驟的過程中任何時刻，響應(yīng)不同的中斷源并執(zhí)行相應(yīng)命令。

旋轉(zhuǎn)機構(gòu)能夠提供8種工作模式：絕對位置控制模式、相對位置控制模式、速度控制模式、往復(fù)旋轉(zhuǎn)暫?？刂颇Ｊ?、普通往復(fù)旋轉(zhuǎn)控制模式、航向解耦往復(fù)旋轉(zhuǎn)控制模式、在線標(biāo)定控制模式、初始標(biāo)定控制模式[18-20]。

一般情況下，旋轉(zhuǎn)機構(gòu)工作在絕對位置控制、普通往復(fù)運動控制、航向解耦往復(fù)旋轉(zhuǎn)控制3種工作模式。各種工作模式的功能、有效參數(shù)見表2。

表2 旋轉(zhuǎn)機構(gòu)工作模式表

旋轉(zhuǎn)控制軟件在旋轉(zhuǎn)機構(gòu)通電復(fù)位后開始運行，是單獨運行的程序。每次通電后，旋轉(zhuǎn)控制軟件首先進行系統(tǒng)的初始化，包括了CPU相關(guān)寄存器的設(shè)置、變量賦初值和旋轉(zhuǎn)機構(gòu)的尋零操作[21]。

系統(tǒng)初始化完畢之后，旋轉(zhuǎn)機構(gòu)進入正常工作狀態(tài)。旋轉(zhuǎn)控制軟件將根據(jù)接收到的導(dǎo)航計算機控制指令進行相應(yīng)的運動控制，包括絕對位置控制、往復(fù)運動控制、航向解耦、在線標(biāo)定等8種控制模式。同時，旋轉(zhuǎn)控制軟件響應(yīng)同步信號中斷，向?qū)Ш接嬎銠C返回旋轉(zhuǎn)機構(gòu)的狀態(tài)信息，包括計算同步時刻旋轉(zhuǎn)機構(gòu)的角度和角速度信息、旋轉(zhuǎn)機構(gòu)控制狀態(tài)信息和故障巡檢結(jié)果[22]。

當(dāng)旋轉(zhuǎn)機構(gòu)在運動過程中出現(xiàn)直流電機停轉(zhuǎn)以及連續(xù)長時間未能正常接收到單軸測角裝置角位置信息時，旋轉(zhuǎn)機構(gòu)將進入故障保護模式，關(guān)閉直流電機驅(qū)動輸出，旋轉(zhuǎn)機構(gòu)處于自由狀態(tài)，直至故障消除。

3.3 程序設(shè)計

旋轉(zhuǎn)控制軟件的主程序工作流程如圖8所示。在主程序中，單片機各寄存器和變量的初始化，上電自檢和工作過程中進行巡檢，解讀導(dǎo)航計算機發(fā)送的運動控制命令，對電機進行控制。電路軟件能夠?qū)崿F(xiàn)的思路如下：

圖8 旋轉(zhuǎn)控制軟件主程序流程圖

1)能夠接收慣導(dǎo)發(fā)送的速率指令，以設(shè)定的速率和旋轉(zhuǎn)方式進行旋轉(zhuǎn)；

2)能夠接收慣導(dǎo)發(fā)送的位置指令，以固定的速率轉(zhuǎn)到要求位置，并在該位置穩(wěn)定；

3)能夠執(zhí)行上電自檢和工作過程中進行巡檢的功能，并將檢測結(jié)果通過狀態(tài)字發(fā)送給慣導(dǎo)。

在定時中斷子程序中，單片機定時產(chǎn)生單軸測角裝置同步信號，并接收單軸測角裝置輸出角度信號，解算角位置和角速度，向?qū)Ш接嬎銠C反饋旋轉(zhuǎn)機構(gòu)狀態(tài)。在外部串口通訊中斷子程序中，單片機與導(dǎo)航計算機通信，接受導(dǎo)航計算機運動控制命令。

3.4 PID算法

在增量式速度PID算法子程序中，通過參數(shù)整定獲得最佳效果，從小到大順序查；先是比例后積分，最后再把微分加。增量式PID控制結(jié)構(gòu)如圖9所示，仿真結(jié)果如圖10所示。

圖9 增量式PID控制結(jié)構(gòu)

圖10 PID控制響應(yīng)曲線

3.5 電機控制

典型的電機轉(zhuǎn)向切換過程包括：啟動加速、運動勻速和制動減速3個階段。

快速啟動時，轉(zhuǎn)速與轉(zhuǎn)距的動態(tài)響應(yīng)很重要，可以提供高于正常速度的模擬電壓來改善轉(zhuǎn)速的上升特性。無刷直流電機的啟動轉(zhuǎn)距與啟動電流、轉(zhuǎn)子相對于電樞繞組的位置有關(guān)。電機的電樞啟動電流計算公式如下：

(14)

其中:U為調(diào)試速度電壓(V),ΔU為功率管飽和壓降，racp為繞組平均電阻。

4 試驗與結(jié)果分析

4.1 角位置定位試驗

4.1.1 角位置試驗方法

旋轉(zhuǎn)機構(gòu)初始化完成后，采用絕對位置控制模式使旋轉(zhuǎn)機構(gòu)依次旋轉(zhuǎn)到要求驗證的定位位置(0°、90°、180°和270°)，并記錄旋轉(zhuǎn)機構(gòu)定位后的角度穩(wěn)定值，每個位置定位至少7次。

4.1.2 角位置精度、穩(wěn)定性評定標(biāo)準

按如下公式計算每個定位角度的精度eθ，旋轉(zhuǎn)機構(gòu)的定位精度由其中最大的eθ值來進行評定。

(15)

式中,θi為第i個角度樣本值(°/s)；θref為目標(biāo)角度(°/s)；n為角度樣本數(shù)，至少大于6。

角位置定位穩(wěn)定性按如下方法評定：旋轉(zhuǎn)機構(gòu)初始化完成后，采用絕對位置控制模式使旋轉(zhuǎn)機構(gòu)依次旋轉(zhuǎn)到要求驗證的定位位置(0°、90°、180°和270°)，定位時間不小于60秒，記錄旋轉(zhuǎn)機構(gòu)定位后的角度穩(wěn)定值。角位置定位穩(wěn)定性的計算公式如下所示，由其中最大的σθ值來進行評定：

(16)

式中,θi為第i次定位角度值(°)；θref為設(shè)定定位角度值(°)；n為角度樣本數(shù)，至少大于6。

4.2 角速率精度試驗

4.2.1 角速率精度試驗方法

表3 普通往復(fù)運動控制參數(shù)設(shè)定值

旋轉(zhuǎn)機構(gòu)初始化完成后，采用光碼盤普通往復(fù)旋轉(zhuǎn)模式，按照上表設(shè)定往復(fù)運動的角度幅值和角速率后啟動選擇旋轉(zhuǎn)機構(gòu)。如果缺乏導(dǎo)航計算機，可以用工控機代替導(dǎo)航計算機向旋轉(zhuǎn)機構(gòu)發(fā)送虛擬命令開展試驗。旋轉(zhuǎn)機構(gòu)運動過程中數(shù)據(jù)由旋轉(zhuǎn)機構(gòu)監(jiān)控軟件進行記錄。

4.2.2 角速率精度評定標(biāo)準

對每個給定速率條件下速率穩(wěn)定后的數(shù)據(jù)采用定時測角法進行處理，角速率等于相鄰采樣角度差值Δθ與采樣周期T的比值。角度值由旋轉(zhuǎn)控制電路定時反饋。角速率樣本數(shù)不少于10。

按下列公式計算每個設(shè)定角速率條件下的角速率精度eω，旋轉(zhuǎn)機構(gòu)的角速率精度由各個速率命令計算的最大誤差eω值來進行評定。

(17)

按照下列公式計算每個角速率命令條件下角速率平穩(wěn)性σω，旋轉(zhuǎn)機構(gòu)的角速率平穩(wěn)性由其中最大的σω來進行評定。

(18)

式中，ω0為角速率目標(biāo)值(°/s)；ωref為第i個角速率樣本值(°/s)；n為角速率樣本數(shù)，至少大于6。

角速率的計算處理公式為：

V1s計算b=V1s真+ΔVb=θTb-θTb-1s

(19)

式中，V1s真，ΔVb分別為間隔周期為1 s的理論角速率真值和實際測量誤差；θTb，θTb-1s分別為當(dāng)前與1 s之前的光碼盤角度值。當(dāng)V1s真為10°/s時，ΔVb一般不超過0.3°/s，數(shù)值很小。另外，周期為1 s的角速率統(tǒng)計平均值能夠很好地被控制調(diào)節(jié)。

4.3 結(jié)果分析

根據(jù)捷聯(lián)慣導(dǎo)的環(huán)境應(yīng)力篩選工作安排，旋轉(zhuǎn)機構(gòu)隨捷聯(lián)慣導(dǎo)依次完成靜態(tài)、振動、沖擊、高低溫試驗，試驗結(jié)果表明，產(chǎn)品功能和性能指標(biāo)滿足任務(wù)要求。某批次的旋轉(zhuǎn)機構(gòu)的角速率和角度曲線圖分別如圖11～13所示，技術(shù)指標(biāo)對照表見表4。

表4 旋轉(zhuǎn)機構(gòu)技術(shù)指標(biāo)對照表

圖12 角速率(5°/s)曲線圖

圖13 角度(0°，90°，180°，270°)曲線圖

5 結(jié)束語

連續(xù)旋轉(zhuǎn)對準方式成為光纖陀螺慣導(dǎo)系統(tǒng)實現(xiàn)高精度對準的一種有效技術(shù)手段。這里提出一種實現(xiàn)單軸旋轉(zhuǎn)導(dǎo)航系統(tǒng)的低功耗、低成本、中精度旋轉(zhuǎn)控制方案，試驗結(jié)果表明，旋轉(zhuǎn)機構(gòu)的功能和性能均滿足技術(shù)要求，為更好地發(fā)揮單軸旋轉(zhuǎn)調(diào)制光纖陀螺捷聯(lián)慣導(dǎo)產(chǎn)品的導(dǎo)航能力提供了有力的支持。