描述

該項目是 ME 461（機械系統(tǒng)的計算機控制）的最終作業(yè)的結(jié)果，這是伊利諾伊大學(xué)提供的一門課程。

介紹

Noot Shoot是一款云臺上的橡皮筋射擊游戲，使用計算機視覺瞄準(zhǔn)特定顏色。云臺使用 HiTec HS-311 伺服系統(tǒng)移動，安裝在從 servocity 獲得的塊中。攝像頭被擰在前面。另一個伺服器用作射手的觸發(fā)器。

?

伺服系統(tǒng)使用德州儀器 (TI) 的微控制器 MSP430 進行定向，而 Orange Pi Zero 則用于與相機接口。舞臺和腿是 3D 打印的。

系統(tǒng)輸入

系統(tǒng)的輸入是來自攝像機的實時饋送。在 Pi 中連續(xù)運行的 C++ 程序逐幀讀取此提要并計算我們感興趣的對象的中心坐標(biāo)。在我們的例子中，我們將顏色范圍定位在一系列 HSV 值之間：(239*, 103 , 103) 和 (15*, 255, 255)。這對應(yīng)于 HSV 光譜中的亮粉色。該程序計算幀中的所有粉紅色像素，如果有超過 60 個活動像素，則計算對象的質(zhì)心（這是必要的，因此環(huán)境中的噪聲不會被視為對象）。這些坐標(biāo)使用 I2C 通信協(xié)議發(fā)送到 MSP430。

其他輸入是兩個按鈕。一個用于手動拍攝，另一個用于改變狀態(tài)。下一節(jié)將詳細(xì)介紹更多信息。

比例控制器

一旦 MSP430 接收到物體的中心坐標(biāo)，x 軸和 y 軸的誤差就會計算為相機框架中心與物體中心之間的差值。誤差的大小表明需要多少轉(zhuǎn)彎。因此，我們將轉(zhuǎn)率計算為誤差和我們調(diào)整的比例增益的乘積。然后從先前發(fā)送的伺服命令中減去該轉(zhuǎn)速，并將該新值設(shè)置為伺服的新目的地。我們需要減去，因為誤差和舵機的正角運動方向相反。

errorX = 160 - rxlong1; // rxlong1 is the x-coordinate of the object in frame.
errorY = 120 - rxlong2; // rxlong2 is the y-coordinate of the object in frame.
turnrateX = kpx*errorX; // kpx and kpy are gain values that need to be tuned.
turnrateY = kpy*errorY; 
currX = prevX - (turnrateX * 20)/1000; //We multiply with 0.02 based on the loop time
currY = prevY - (turnrateY * 20)/1000;

狀態(tài)機

我們將控制程序包裝在狀態(tài)機中。射手可以分為兩種狀態(tài)。它要么正在主動識別要射擊的目標(biāo)，要么處于重新加載模式，此時載物臺停止移動，以便用戶可以加載下一個橡皮筋。射手以主動觀察模式開始。以下是導(dǎo)致狀態(tài)改變的條件：

從主動尋找到重裝模式：

按狀態(tài)更改按鈕。

• 按狀態(tài)更改按鈕。

按下手動拍攝按鈕。這會啟動橡皮筋，并且射手會在很短的延遲后進入重新加載模式。

• 按下手動拍攝按鈕。這會啟動橡皮筋，并且射手會在很短的延遲后進入重新加載模式。

x 軸和 y 軸的誤差小于定義的閾值超過 3 秒。這意味著目標(biāo)要么移動非常緩慢，要么根本不動。在這種情況下，射擊者會自動射擊橡皮筋，然后在很短的延遲后進入裝彈模式。

• x 軸和 y 軸的誤差小于定義的閾值超過 3 秒。這意味著目標(biāo)要么移動非常緩慢，要么根本不動。在這種情況下，射擊者會自動射擊橡皮筋，然后在很短的延遲后進入裝彈模式。

從重新加載模式到積極尋找：

按狀態(tài)更改按鈕（這是唯一的方法）。

• 按狀態(tài)更改按鈕（這是唯一的方法）。

更多 MSP430 實施細(xì)節(jié)

結(jié)合三個伺服系統(tǒng)：我們使用定時器 B 來實現(xiàn)平移和傾斜伺服系統(tǒng)。載波頻率設(shè)置為 20 ms。定時器設(shè)置為向上模式，輸出模式設(shè)置為重置/設(shè)置。計時器 A 也進行了類似的調(diào)整，以控制射手伺服系統(tǒng)。

按鈕連接：如上所述，我們使用了 2 個按鈕。為此，我們將引腳 2.4 和 2.5 定義為啟用和下拉電阻器的輸入引腳。這些按鈕還連接到電容器以防止彈跳。

?

?