激光雷達中掃描振鏡控制研究

任福漢,余紅英,劉 琛

(1.中北大學，太原 030051； 2.中國電子信息產(chǎn)業(yè)集團第六研究所，北京 100083)

0 引 言

激光雷達是探測目標、遠程測距、面陣成像常用系統(tǒng)之一，在軍事、航天、民用等多領域發(fā)揮著巨大作用。在激光雷達系統(tǒng)中，掃描振鏡至關重要[1]。掃描振鏡(GS)，也稱電流計掃描儀，是一種性能優(yōu)良的矢量掃描器件，是高頻驅動下的一種特殊的擺動伺服電機。掃描振鏡將激光雷達發(fā)射的激光源，通過電機上兩個反射鏡的擺動，形成激光面陣，達到激光掃描成像效果[2]。

對于掃描振鏡的周期性運動控制，傳統(tǒng)PID參數(shù)整定更多依靠經(jīng)驗，抗干擾能力不足，控制性能無法滿足掃描振鏡需求。模糊控制是先進控制理論之一，在非線性和時變系統(tǒng)中有較好控制性能，但是模糊控制缺少積分環(huán)節(jié)，無法消除穩(wěn)態(tài)誤差[3]。模糊控制更多是與其他先進控制理論結合，提高控制性能?；Ｗ兘Y構控制有良好的抗干擾能力、動靜態(tài)特性，但是存在抖振現(xiàn)象，限制了滑模變結構控制在實際中的應用[4]?；诖?，本文提出模糊滑模變結構控制，利用模糊算法抑制滑模變結構控制的抖振現(xiàn)象，提高掃描振鏡抗干擾能力。

1 振鏡數(shù)學模型

掃描振鏡在相對較大的角度范圍內(nèi)具有高線性、低慣性的特點，這使得它們可以在高達幾千赫茲的掃描頻率下使用。為了通過幀掃描獲得均勻的光場，幀掃描的頻率應該是幾十赫茲。激光雷達掃描振鏡系統(tǒng)框圖如圖1所示。

圖1 激光雷達掃描振鏡系統(tǒng)框圖

掃描振鏡由電氣系統(tǒng)和機械系統(tǒng)組成，掃描振鏡電氣機械系統(tǒng)組合如圖2所示[5]。

圖2 掃描振鏡電氣機械系統(tǒng)組合

電樞回路微分方程如下：

(1)

掃描振鏡動力學方程如下：

(2)

式中：Ω為機械角速度，Ω=2πn/60。

設系統(tǒng)初始狀態(tài)為零，對式(1)、式(2)進行拉普拉斯變換，結果如下：

(3)

(4)

(5)

(6)

由式(5)、式(6)掃描振鏡傳遞函數(shù)框圖如圖3所示。

圖3 掃描振鏡傳遞函數(shù)框圖

2 掃描振鏡控制算法

2.1 模糊PID控制

完整的模糊控制器包括模糊化接口、推理機(包括數(shù)據(jù)庫和規(guī)則庫)以及解模糊接口[6]。模糊化接口負責將輸入?yún)?shù)模糊化處理，并移交推理機進行規(guī)則運算，推理機輸出參數(shù)通過解模糊接口，計算出系統(tǒng)整定所需參數(shù)。

模糊PID控制原理圖如圖4所示。模糊PID與傳統(tǒng)PID相比，在動態(tài)響應、靜態(tài)響應以及魯棒性方面都有一定的提高[7]，是現(xiàn)代先進控制理論使用較為廣泛的控制算法之一。在本文中，模糊PID通過對掃描振鏡位置反饋誤差e以及誤差變化率ec進行模糊化，根據(jù)模糊規(guī)則實時整定系統(tǒng)控制所需參數(shù)KP，KI，KD，以達到期望的控制性能。

圖4 模糊PID控制原理圖

輸入?yún)?shù)e，ec和輸出參數(shù)ΔKP，ΔKI，ΔKD模糊子集{NB,NM,NS,NZ,Z,PS,PM,PB}。

設定e，ec是高斯型隸屬函數(shù)，ΔKP，ΔKI，ΔKD的隸屬函數(shù)為三角，論域為[-3,3]，得到如表1、表2、表3中對應的ΔKP，ΔKI，ΔKD模糊控制規(guī)則表。

表1 ΔKP模糊規(guī)則表

表2 ΔKI模糊規(guī)則表

表3 ΔKD模糊規(guī)則表

2.2 滑模變結構控制

滑模變結構控制也是先進控制技術之一，是一種變結構控制策略?；Ｗ兘Y構控制與其他先進控制技術的本質區(qū)別在于其非連續(xù)控制?；Ｗ兘Y構控制具有優(yōu)良的抗干擾能力，但由于存在抖振現(xiàn)象，滑模變結構控制并不能單獨應用于實際工程[8]。現(xiàn)對滑模變結構控制進行簡要說明。

在欠驅動的滑模變控制系統(tǒng)中，狀態(tài)表達式：

(7)

存在翻轉方程s(x)=s(x1,x2,…,xn)=0，狀態(tài)空間被s(x)劃分為s>0及s<0兩部分。圖5為系統(tǒng)狀態(tài)空間示意圖，圖中點A，B，C為狀態(tài)空間中三種類型，即：通常點A、起始點B以及結束點C。

圖5 系統(tǒng)狀態(tài)空間示意圖

狀態(tài)空間中運動點在s(x)=0處是結束點條件：

(8)

式(8)也可以表示：

(9)

式(9)對系統(tǒng)提出了一個形如：

v(x1,x2,…,xn)=[s(x1,x2,…,xn)]2

(10)

的Lyapunov約束函數(shù)的條件方程。由于在翻轉面數(shù)值域內(nèi)，式(10)是正定的，并根據(jù)式(9)，s2導數(shù)為半負定，在s=0附近v是一個非增函數(shù)。所以在式(9)成立的基礎上，式(10)為系統(tǒng)條件Lyapunov函數(shù)，即系統(tǒng)穩(wěn)定于s=0。

設控制系統(tǒng)：

(11)

需要確定其切換函數(shù)s(x)，且s∈R″。

求解控制函數(shù)：

(12)

在本文中，設激光雷達掃描振鏡PSD(光位置傳感器)位置狀態(tài)方程：

(13)

(14)

則切換函數(shù)：

(15)

所以，控制律：

(16)

2.3 模糊滑模變結構控制

建立掃描振鏡數(shù)學模型時，實際應用環(huán)境中諸多影響因素是不可估計的，在應用中會受到較大干擾，但滑模變結構控制需要較大的切換增益，不可避免地產(chǎn)生抖振現(xiàn)象，限制了其在掃描振鏡中的應用。根據(jù)常規(guī)趨近律調(diào)節(jié)系統(tǒng)參數(shù)的方法，能夠抑制抖振現(xiàn)象。被調(diào)參數(shù)需要根據(jù)系統(tǒng)條件而定，常規(guī)調(diào)節(jié)方法將被調(diào)參數(shù)設為恒定值，導致其不能在線調(diào)整。為了改進此缺點，更好抑制抖振現(xiàn)象，本文將模糊控制與滑模變結構控制相結合，在滑模變結構控制基礎上，引入對切換函數(shù)幅值的模糊控制。在模糊控制中，輸入為切換函數(shù)目前幅值，并根據(jù)切換函數(shù)幅值計算出模糊控制器輸出量，保證系統(tǒng)良好的魯棒性、抗干擾性，并且最大限度抑制抖振現(xiàn)象。模糊滑模變結構控制原理圖如圖6所示[9]。

圖6 滑模變結構控制原理圖

(17)

表與ΔK(t)之間模糊規(guī)則表

(18)

式中：G是由經(jīng)驗確定的比例系數(shù)。則控制率：

(19)

3 掃描振鏡仿真

3.1 模糊PID仿真

在MATLAB中運行Fuzzy Logic Designer，將表1、表2、表3模糊控制規(guī)則輸入到Ruler Editor，得到ΔKP，ΔKI，ΔKD模糊規(guī)則曲面圖，如圖7所示。

(a) ΔKP

(b) ΔKI

(c) ΔKD圖7 ΔKP，ΔKI，ΔKD模糊規(guī)則曲面

在Simulink中對PSD數(shù)據(jù)進行模糊PID控制仿真，其單位階躍響應曲線、位置誤差e、速度ec曲線如圖8所示，系統(tǒng)調(diào)節(jié)時間為3 s，超調(diào)量為1%。

圖8 模糊PID仿真曲線

圖9是傳統(tǒng)PID控制與模糊PID控制脈沖擾動響應曲線。相同情況下加入擾動，模糊PID擾動超調(diào)量為18%，傳統(tǒng)PID為21%。

圖9 脈沖擾動響應曲線

3.2 滑模變結構仿真

在Simulink中對采用滑模變結構控制的掃描振鏡PSD位置環(huán)進行仿真，得到PSD數(shù)據(jù)階躍響應y、位置誤差e、速度誤差ec曲線，如圖10所示。系統(tǒng)調(diào)節(jié)時間為3 s，超調(diào)量為0.06%。但在y平穩(wěn)后，存在抖振現(xiàn)象，位置誤差e、速度誤差ec有明顯波動。

圖10 滑模變結構仿真曲線

圖11為滑模變結構擾動響應仿真曲線。增加擾動后，系統(tǒng)能夠快速恢復，擾動超調(diào)量為5.8%，其動態(tài)響應和抗干擾能力相比傳統(tǒng)PID控制和模糊PID控制有明顯提升。但是抖振現(xiàn)象始終存在，不利于系統(tǒng)穩(wěn)定，違背了激光雷達掃描成像的準確性原則。

圖11 滑模變結構擾動響應曲線

3.3 模糊滑模變結構仿真

圖12 模糊規(guī)則曲線

在Simulink中對掃描振鏡位置環(huán)進行仿真，響應曲線y、位置誤差e、速度誤差ec如圖13所示。與圖10相比，模糊滑模變結構控制算法有效抑制了滑?？刂葡到y(tǒng)帶來的抖振現(xiàn)象，且控制效果優(yōu)異，證明本文的模糊滑模變結構控制適用于激光雷達掃描振鏡系統(tǒng)。

圖13 模糊滑模變結構算法仿真曲線

系統(tǒng)運行第5 s時加入擾動，得到模糊滑模變結構擾動響應曲線,如圖14所示。由圖14曲線可知，當存在脈沖干擾時，系統(tǒng)有超調(diào)現(xiàn)象，超調(diào)量為7.2%，表明系統(tǒng)抗干擾性能優(yōu)越，且無抖振現(xiàn)象。

圖14 模糊滑模變擾動響應曲線

3.4 原理樣機結果

本文利用STM32F407、QT0707力矩電機、PSD傳感器，搭建激光雷達掃描振鏡硬件原理樣機測試平臺，如圖15所示。采用模糊滑模變結構控制算法得到的PSD數(shù)據(jù)曲線如圖16所示。

在實際系統(tǒng)中要求掃描振鏡掃描頻率50 Hz，掃描時間為16 ms，復位時間為4 ms。在實際測試中，掃描時間16.1 ms，復位時間3.9 ms，基本達到了期望性能。

圖15 掃描振鏡原理樣機

圖16 PSD信號波形

分析圖16可知，由于實驗條件限制，PSD傳感器會受到激光光斑大小以及實驗室燈光影響，導致正程仍存在一定的抖振現(xiàn)象，反程存在一定超調(diào)。

4 結 語

本文建立了激光雷達掃描振鏡數(shù)學模型，基于PSD位置環(huán)進行了模糊PID算法、滑模變結構算法研究并進行了對應的仿真實驗，根據(jù)模糊PID控制、滑模變結構控制的弊端，提出了新的模糊滑模變結構控制算法，并在Simulink中進行了仿真實驗。仿真結果表明，針對激光雷達中掃描振鏡控制系統(tǒng)，傳統(tǒng)PID可以實現(xiàn)對其控制，但傳統(tǒng)PID抗干擾能力不足，無法滿足掃描振鏡精確控制的需求。模糊PID相比于傳統(tǒng)PID算法，抗干擾性能提高，擁有良好的動態(tài)控制特性?；Ｗ兘Y構控制算法在抗干擾性能方面相比于傳統(tǒng)PID和模糊PID算法，有較大提升，但固有高頻抖振現(xiàn)象限制了其在掃描振鏡中的應用。為了解決滑模變結構控制算法這一缺陷，提出了模糊滑模變結構控制算法，將模糊規(guī)則融合到滑模變結構控制中，既保留了良好的抗干擾性能，又消除了抖振現(xiàn)象，適合應用于掃描振鏡控制。原理樣機實驗結果與期望結果相符。