設(shè)計(jì)制作一個(gè)運(yùn)動(dòng)目標(biāo)控制與自動(dòng)追蹤系統(tǒng)

一、任務(wù)

設(shè)計(jì)制作一個(gè)運(yùn)動(dòng)目標(biāo)控制與自動(dòng)追蹤系統(tǒng)。系統(tǒng)包括：

01

模擬目標(biāo)運(yùn)動(dòng)的紅色光斑位置控制系統(tǒng)。

02

指示自動(dòng)追蹤的綠色光斑位置控制系統(tǒng)。

系統(tǒng)結(jié)構(gòu)示意及擺放位置見圖 1（a）。

圖中兩個(gè)激光筆固定在各自獨(dú)立的二維電控云臺(tái)上。

紅色激光筆發(fā)射的光斑用來(lái)模擬運(yùn)動(dòng)目標(biāo)。光斑落在正前方距離 1m 處的白色屏幕上，光斑直徑≤1cm。紅色光斑位置控制系統(tǒng)控制光斑能在屏幕范圍內(nèi)任意移動(dòng)。

綠色激光筆發(fā)射的光斑由綠色光斑位置系統(tǒng)控制，用于自動(dòng)追蹤屏幕上的紅色光斑，指示目標(biāo)的自動(dòng)追蹤效果，光斑直徑≤1cm。

綠色激光筆放置線段如圖 1（b）所示。

該線段與屏幕平行，位于紅色激光筆兩側(cè)，距紅色激光筆距離大于 0.4m、小于 1m。

綠色激光筆在兩個(gè)放置線段上任意放置。

屏幕為白色，有效面積大于 0.6╳0.6m2。

用鉛筆在屏幕中心畫出一個(gè)邊長(zhǎng)0.5m的正方形，標(biāo)識(shí)屏幕的邊線；所畫的正方形的中心為原點(diǎn)，用鉛筆畫出原點(diǎn)位置，所用鉛筆痕跡寬≤1mm。

二、要求

01

設(shè)置運(yùn)動(dòng)目標(biāo)位置復(fù)位功能。

執(zhí)行此功能，紅色光斑能從屏幕任意位置回到原點(diǎn)。

光斑中心距原點(diǎn)誤差≤2cm。

02

啟動(dòng)運(yùn)動(dòng)目標(biāo)控制系統(tǒng)。

紅色光斑能在 30 秒內(nèi)沿屏幕四周邊線順時(shí)針移動(dòng)一周，移動(dòng)時(shí)光斑中心距邊線距離≤2cm。

03

用約1.8cm寬的黑色電工膠帶沿A4紙四邊貼一個(gè)長(zhǎng)方形，構(gòu)成A4靶紙。

將此A4靶紙貼在屏幕自定的位置。

啟動(dòng)運(yùn)動(dòng)目標(biāo)控制系統(tǒng)，紅色光斑能在30秒內(nèi)沿膠帶順時(shí)針移動(dòng)一周。

超時(shí)不得分，光斑完全脫離膠帶一次扣2分，連續(xù)脫離膠帶移動(dòng)5cm以上記為0分。

04

將上述 A4 靶紙以任意旋轉(zhuǎn)角度貼在屏幕任意位置。啟動(dòng)運(yùn)動(dòng)目標(biāo)控制系統(tǒng)，要求同（3）。

設(shè)計(jì)要求

一、運(yùn)動(dòng)目標(biāo)控制理論

在運(yùn)動(dòng)控制系統(tǒng)中，基于OpenMV識(shí)別目標(biāo)點(diǎn)及軌跡并傳送坐標(biāo)數(shù)據(jù)給MCU，由主控MCU調(diào)整PWM輸出占空比實(shí)現(xiàn)對(duì)舵機(jī)運(yùn)動(dòng)參數(shù)的調(diào)整，從而控制云臺(tái)轉(zhuǎn)動(dòng)實(shí)現(xiàn)對(duì)運(yùn)動(dòng)目標(biāo)的復(fù)位、軌跡移動(dòng)、循跡等功能。首先，將OpenMV固定在合適位置以觀測(cè)到完整的目標(biāo)屏幕，利用OpenMV識(shí)別紅色激光返回的坐標(biāo)點(diǎn)（以下簡(jiǎn)稱紅斑），將激光筆依次在屏幕上移動(dòng)。基于基礎(chǔ)題2要求，用激光筆在屏幕鉛筆畫的邊線上標(biāo)記8個(gè)坐標(biāo)點(diǎn)（擁有四個(gè)頂點(diǎn)，每?jī)蓚€(gè)頂點(diǎn)之間各取一個(gè)中點(diǎn)），分別按下按鍵記錄坐標(biāo)在MCU中，最后控制二維云臺(tái)依次將記錄的每一個(gè)點(diǎn)都走一遍。（運(yùn)動(dòng)目標(biāo)控制皆使用記錄坐標(biāo)構(gòu)建坐標(biāo)系的方法）

對(duì)于運(yùn)動(dòng)控制系統(tǒng)的循跡功能（基礎(chǔ)題目3，4），需要通過(guò)OpenMV完成對(duì)黑色A4紙邊框的識(shí)別以確定矩形頂點(diǎn)坐標(biāo)，利用頂點(diǎn)坐標(biāo)分別計(jì)算出矩形四條邊框斜率，基于頂點(diǎn)及邊框斜率計(jì)算得到每條邊框上的20個(gè)標(biāo)記點(diǎn)（經(jīng)過(guò)測(cè)試，20個(gè)標(biāo)記點(diǎn)效果較為理想）。最后識(shí)別紅斑坐標(biāo)，控制二維云臺(tái)依次沿標(biāo)記點(diǎn)完成移動(dòng)，即可實(shí)現(xiàn)對(duì)黑色矩形的循跡功能。

二、自動(dòng)追蹤系統(tǒng)方法

在自動(dòng)追蹤系統(tǒng)中，OpenMV需要完成對(duì)紅斑以及綠色激光筆的識(shí)別（以下簡(jiǎn)稱綠斑），因此需要單獨(dú)將OpenMV固定在二維云臺(tái)旁邊，不隨云臺(tái)移動(dòng)。OpenMV將識(shí)別d的坐標(biāo)數(shù)據(jù)通過(guò)串口返回到主控端，系統(tǒng)中對(duì)紅斑和綠斑設(shè)定有不同的幀頭幀尾防止誤判，主控接收到坐標(biāo)數(shù)據(jù)之后再分別對(duì)它們的橫縱坐標(biāo)值相減以獲取兩運(yùn)動(dòng)目標(biāo)的相對(duì)距離。根據(jù)兩坐標(biāo)差值的正負(fù)，可獲知兩光斑的相對(duì)坐標(biāo)位置。這時(shí)只需要利用紅色和綠色Ｘ、Ｙ軸的差值，最后控制二維云臺(tái)的x，y軸增加或者減小角度即可。

在測(cè)試過(guò)程中，發(fā)現(xiàn)PWM舵機(jī)偶爾莫名抖動(dòng)，分析這是由于坐標(biāo)數(shù)據(jù)存在噪聲導(dǎo)致。因此，本項(xiàng)目中采用采用卡爾曼濾波對(duì)OpenMV傳送的坐標(biāo)數(shù)據(jù)進(jìn)行對(duì)其濾波，具體公式如下：

從而讓OpenMV反饋回來(lái)的坐標(biāo)與驅(qū)動(dòng)MG995舵機(jī)變得更加穩(wěn)定，能夠完成設(shè)計(jì)要求。

A:狀態(tài)轉(zhuǎn)移矩陣

X(k-1):k-1時(shí)刻 狀態(tài)最優(yōu)估計(jì)值 B:控制輸入矩陣

U(k)：k時(shí)刻 狀態(tài)輸入控制量

W(k)：k時(shí)刻 卡爾曼增益

設(shè)計(jì)圖

運(yùn)動(dòng)控制系統(tǒng)硬件原理圖

自動(dòng)追蹤系統(tǒng)硬件原理圖

控制程序流程圖

自動(dòng)跟蹤系統(tǒng)主流程圖

自動(dòng)跟蹤系統(tǒng)串口流程

自動(dòng)跟蹤系統(tǒng)OpenMV流程圖

審核編輯：劉清