李載峰, 李俊霖
(中國(guó)科學(xué)院長(zhǎng)春光學(xué)精密機(jī)械與物理研究所,吉林 長(zhǎng)春 130033)
動(dòng)態(tài)地物仿真系統(tǒng)用于完成機(jī)載光電偵查平臺(tái)捕獲與動(dòng)態(tài)跟蹤精度室內(nèi)檢測(cè),其原理是利用目標(biāo)發(fā)生器模擬待捕獲目標(biāo),與仿真系統(tǒng)中的其它設(shè)備配合模擬出現(xiàn)實(shí)目標(biāo)的運(yùn)動(dòng)特性,機(jī)載光電偵查平臺(tái)對(duì)目標(biāo)發(fā)生器發(fā)出的模擬目標(biāo)完成捕獲和跟蹤,并給出實(shí)時(shí)的方位角α′與俯仰角β′,即通過方位角與俯仰角描繪出模擬目標(biāo)的空間位置,而目標(biāo)發(fā)生器則同時(shí)給出模擬目標(biāo)的方位角α與俯仰角β作為真值。通過公式計(jì)算就可以得到機(jī)載平臺(tái)的跟蹤精度[1]。
目標(biāo)發(fā)生器作為動(dòng)態(tài)地物仿真系統(tǒng)的關(guān)鍵設(shè)備,用于產(chǎn)生仿真背景下的待捕獲模擬目標(biāo),并驅(qū)動(dòng)目標(biāo)按設(shè)定的運(yùn)動(dòng)軌跡運(yùn)動(dòng),同時(shí),實(shí)時(shí)輸出模擬目標(biāo)的方位角α與俯仰角β作為理論真值,文中主要介紹目標(biāo)發(fā)生器電控系統(tǒng)設(shè)計(jì)方案。
目標(biāo)發(fā)生器的設(shè)計(jì)要求是模擬一個(gè)無窮遠(yuǎn)的待捕獲目標(biāo),目標(biāo)的運(yùn)動(dòng)特性是沿空間圓周做向心轉(zhuǎn)動(dòng)的兩維運(yùn)動(dòng),并保證光學(xué)系統(tǒng)的出射光線始終指向空間坐標(biāo)系的原點(diǎn),即被檢機(jī)載偵測(cè)平臺(tái)光學(xué)系統(tǒng)的主點(diǎn),其空間運(yùn)動(dòng)軌跡原理如圖1所示。
圖1 目標(biāo)運(yùn)動(dòng)特性原理圖
基于目標(biāo)運(yùn)動(dòng)特性的需求設(shè)計(jì)目標(biāo)發(fā)生器整體結(jié)構(gòu)如圖2所示。
圖2 目標(biāo)發(fā)生器組成原理示意圖
影像投射系統(tǒng)發(fā)射平行光,用于模擬無窮遠(yuǎn)處待捕獲的目標(biāo),根據(jù)設(shè)計(jì)要求的目標(biāo)運(yùn)動(dòng)特性,目標(biāo)發(fā)生器的機(jī)械結(jié)構(gòu)設(shè)計(jì)為兩自由度的回轉(zhuǎn)運(yùn)動(dòng)機(jī)構(gòu)。影像投射系統(tǒng)安裝在弧形回轉(zhuǎn)運(yùn)動(dòng)機(jī)構(gòu)上,可以沿著弧形導(dǎo)軌做勻速、勻變速圓周運(yùn)動(dòng),而弧形導(dǎo)軌整體圍繞水平回轉(zhuǎn)軸系機(jī)構(gòu)相對(duì)于地面做圓周運(yùn)動(dòng),兩個(gè)圓周運(yùn)動(dòng)合成的結(jié)果就是影像投射系統(tǒng)相對(duì)地面做圖1所示的運(yùn)動(dòng)。
根據(jù)目標(biāo)發(fā)生器使用要求,電控系統(tǒng)主要實(shí)現(xiàn)驅(qū)動(dòng)電機(jī)轉(zhuǎn)動(dòng)和反饋角度信息的功能,設(shè)計(jì)中影像投射系統(tǒng)和水平軸系回轉(zhuǎn)均由力矩電機(jī)驅(qū)動(dòng),電控系統(tǒng)通過伺服控制驅(qū)動(dòng)兩力矩電機(jī),保持影像投射系統(tǒng)按照設(shè)定的軌跡運(yùn)行,同時(shí),電控系統(tǒng)實(shí)時(shí)采集影像投射系統(tǒng)空間位置的方位角和俯仰角。
目標(biāo)發(fā)生器電控系統(tǒng)由中央控制器、接口電路、數(shù)字采集卡、電機(jī)驅(qū)動(dòng)器、圓形光柵角位置傳感器、力矩電機(jī)等單元組成,系統(tǒng)結(jié)構(gòu)框圖如圖3所示[2-3]。
圖3 電控系統(tǒng)結(jié)構(gòu)圖
電控系統(tǒng)中線性電源和隔離變壓器實(shí)現(xiàn)電壓變換,將220V交流電轉(zhuǎn)換成電控系統(tǒng)所需的各種電壓;兩個(gè)力矩電機(jī)驅(qū)動(dòng)器接收電機(jī)控制卡的控制信號(hào),并驅(qū)動(dòng)相應(yīng)的力矩電機(jī)帶動(dòng)設(shè)備運(yùn)轉(zhuǎn);位置傳感器采用圓形光柵角位置傳感器,傳感器采集影像投射系統(tǒng)的方位角和俯仰角,并將角位置信息通過數(shù)據(jù)采集卡傳輸至中央控制器;中央控制器是電控系統(tǒng)的關(guān)鍵部件,其組成包括工控機(jī)、數(shù)據(jù)采集卡和電機(jī)控制卡,電機(jī)控制卡是伺服控制的輸出端,輸出兩個(gè)力矩電機(jī)的PWM控制信號(hào),數(shù)據(jù)采集卡接收位置傳感器返回的角位置信息,將其傳輸至工控機(jī)完成數(shù)據(jù)處理,工控機(jī)結(jié)合系統(tǒng)軟件實(shí)現(xiàn)電控系統(tǒng)的綜合控制功能。
電控系統(tǒng)的設(shè)計(jì)關(guān)鍵是伺服系統(tǒng),本設(shè)計(jì)中伺服系統(tǒng)采用位置速度雙回路控制,系統(tǒng)初始狀態(tài)根據(jù)初始參數(shù)設(shè)置驅(qū)動(dòng)電機(jī),根據(jù)位置傳感器的返回值計(jì)算出位置和速度參數(shù),以位置和速度參數(shù)作為伺服系統(tǒng)的輸入,進(jìn)而推算出下一時(shí)刻系統(tǒng)輸出的PWM控制信號(hào),完成電機(jī)驅(qū)動(dòng)。伺服系統(tǒng)控制框圖如圖4所示[4-6]。
圖4 伺服系統(tǒng)控制框圖
目標(biāo)發(fā)生器電控系統(tǒng)軟件主要實(shí)現(xiàn)兩個(gè)功能:一是根據(jù)初始設(shè)定的參數(shù)驅(qū)動(dòng)兩個(gè)力矩電機(jī)實(shí)現(xiàn)機(jī)構(gòu)的運(yùn)動(dòng),并通過伺服系統(tǒng)連續(xù)驅(qū)動(dòng)力矩電機(jī),使模擬目標(biāo)最大程度擬合理論軌跡運(yùn)動(dòng);另一功能是采集角位置傳感器實(shí)時(shí)返回的影像投射系統(tǒng)方位角和俯仰角數(shù)據(jù),將其作為輸入反饋至伺服系統(tǒng),并將方位角和俯仰角數(shù)據(jù)存儲(chǔ)至數(shù)據(jù)庫,進(jìn)而在顯示器上完成顯示,電控系統(tǒng)軟件流程如圖5所示。
圖5 電控系統(tǒng)軟件流程圖
軟件啟動(dòng)后,伺服系統(tǒng)以初始參數(shù)設(shè)置作為原始輸入,結(jié)算出輸出值并驅(qū)動(dòng)力矩電機(jī)工作,機(jī)構(gòu)整體啟動(dòng)。軟件查詢采集卡是否采集到角位置傳感器返回值,沒有返回?cái)?shù)據(jù),則繼續(xù)查詢;有返回?cái)?shù)據(jù),則讀取方位角和俯仰角的當(dāng)前值,將其存儲(chǔ)至指定數(shù)據(jù)庫中,并更新顯示器的顯示值,以返回的位置數(shù)據(jù)和解算出的速度數(shù)據(jù)作為新的輸入啟動(dòng)伺服系統(tǒng)。伺服系統(tǒng)輸出驅(qū)動(dòng)力矩電機(jī)實(shí)現(xiàn)機(jī)構(gòu)的連續(xù)運(yùn)動(dòng),軟件繼續(xù)查詢數(shù)據(jù)采集卡狀態(tài),準(zhǔn)備接受新的返回?cái)?shù)據(jù)。
電控系統(tǒng)軟件結(jié)合高效的伺服驅(qū)動(dòng)系統(tǒng)很好地實(shí)現(xiàn)了目標(biāo)發(fā)生器電機(jī)控制和數(shù)據(jù)采集,使影像投射系統(tǒng)能夠按照理論運(yùn)動(dòng)軌跡完成運(yùn)動(dòng)。
動(dòng)態(tài)地物仿真系統(tǒng)目標(biāo)發(fā)生器現(xiàn)階段已經(jīng)投入正式使用,可靠、穩(wěn)定的電控系統(tǒng)有效地保證了影像投射系統(tǒng)的運(yùn)動(dòng)特性,從而成功實(shí)現(xiàn)了機(jī)載光電偵查平臺(tái)捕獲與動(dòng)態(tài)跟蹤精度室內(nèi)檢測(cè)。
[1]李興紅.基于TMS320F2812的跟蹤伺服系統(tǒng)[J].微計(jì)算機(jī)信息,2007,13:147-151.
[2]張翠哲.步進(jìn)電機(jī)在檢測(cè)系統(tǒng)中的控制與應(yīng)用[J].電機(jī)與控制應(yīng)用,2010,9(9):38-40.
[3]王建立.光電經(jīng)緯儀電視跟蹤、捕獲快速運(yùn)動(dòng)目標(biāo)技術(shù)的研究[D]:[碩士學(xué)位論文].長(zhǎng)春:中國(guó)科學(xué)院長(zhǎng)春光學(xué)精密機(jī)械與物理研究所,2002.
[4]趙希梅.交流伺服控制系統(tǒng)的發(fā)展現(xiàn)狀及研究熱點(diǎn)[J].伺服控制,2010,17:14-17.
[5]張勇.經(jīng)緯儀測(cè)試場(chǎng)景仿真系統(tǒng)研究[J].光電工程,2009,3(11):39-42.
[6]梁偉,馮楓,鮑學(xué)良,等.角加速度傳感器及其應(yīng)用[J].長(zhǎng)春工業(yè)大學(xué)學(xué)報(bào):自然科學(xué)版,2012,3(6):311-316.