基于PID算法的船舶航跡自動(dòng)控制

1 引言
當船舶在大海中航行時(shí),通常利用自動(dòng)舵系統改變舵角從而使船舶沿著(zhù)期望的航跡自動(dòng)航行[1]。自動(dòng)舵系統是根據航跡偏差信息自動(dòng)完成操縱舵機的裝置,是在隨動(dòng)操舵基礎上發(fā)展起來(lái)的一種自動(dòng)控制操舵方式。它可以代替人工操舵,保持船舶在設定航向或預定航跡上航行,實(shí)現航向保持、航向改變以及航跡保持的功能。自動(dòng)舵不僅可以減輕舵手的勞動(dòng)強度,而且在遠航時(shí),在相同的航行條件下,可以減少偏航次數,減小航向偏差,從而提高航速,縮短航行時(shí)間,節省燃料,提高航行的經(jīng)濟效益[2,3]。

2 視線(xiàn)掃描導航系統設計
2.1 航跡控制方案設計
航跡控制分為直接航跡控制和間接航跡控制。直接航跡控制是依據航跡偏差直接改變舵角,從而使船舶的實(shí)際航跡能夠跟蹤期望航跡。間接航跡控制是通過(guò)航跡偏差計算期望的航向信息,再利用期望的航向與實(shí)際船舶航向的偏差改變舵角,從而實(shí)現航跡控制。

本文采用間接航跡控制方式,如圖1所示,內環(huán)為船的舵角控制,用于操縱舵機使實(shí)際舵角與規劃舵角一致,從而使船舶航向發(fā)生改變,中環(huán)為船的航向控制,是將GPS測量的當前船舶航向與航向規劃器產(chǎn)生的期望航向相比較,航向誤差送入航向PID控制器,從而產(chǎn)生期望的舵角變化值,外環(huán)為船舶的航跡控制,通過(guò)航跡跟蹤算法計算可以消除航跡偏差的規劃航向。
2.2 航跡跟蹤方式

船舶在航行過(guò)程中受到風(fēng)、浪及海流等因素的影響,出現航跡偏差問(wèn)題。本文通過(guò)GPS系統獲取的船舶實(shí)際位置信息對航跡偏差進(jìn)行解算,以獲取可消除航跡偏差的航向修正角度。圖2所示為航跡跟蹤方式原理圖。人工駕駛時(shí),船舶駕駛人員會(huì )在一定的視線(xiàn)區域實(shí)時(shí)觀(guān)察船舶前方有無(wú)障礙物和是否偏離期望的航跡。因此在船舶航跡自動(dòng)控制時(shí),模擬人工駕駛設定視線(xiàn)掃描區域,當航跡偏差在一定范圍時(shí),視線(xiàn)掃描區域與預定航跡相交于航跡瞄準點(diǎn)P。當前船位與航跡瞄準點(diǎn)P形成的航跡瞄準方向即為經(jīng)視線(xiàn)導航策略導出的規劃航向角度。利用GPS系統反饋的船舶位置、航向信息以及設定的航跡信息可計算出當前的規劃航向角度從而解算出可消除航跡偏差的規劃航向角度。解算具體過(guò)程如下所示。
計劃航跡向角度可通過(guò)計劃航跡點(diǎn)坐標解算獲得:

其中為從赤道到緯度的緯線(xiàn)之間的距離,即

將A、B點(diǎn)的緯度坐標代入到式(3)計算出數值,再利用(2)式可解算出計劃航跡向角度由于航跡瞄準點(diǎn)P在計劃航向AB上,所以用AP點(diǎn)、PB點(diǎn)計算出的航向角度與計劃航向相同。
利用式(1)、(2)即可計算出航跡瞄準點(diǎn)P位置坐標。由此可利用式(1)得到當前船位點(diǎn)與瞄準點(diǎn)形成的規劃航向角度值。
經(jīng)視線(xiàn)導引策略解算出的規劃航向角將傳遞到航向控制系統中。通過(guò)對船舶的航向控制使船舶按規劃航向角度方向行駛,從而使船舶相對于預定航線(xiàn)的偏差逐漸趨向零。該跟蹤規律可以使船舶在逼近預定航線(xiàn)縮短航跡偏差的同時(shí),使得船舶航向角度趨近于預定航線(xiàn)的航向角。