描述

“Segbot”是 UIUC 的 SE 423 級平衡 segway 機器人。segbot 由 Dan Block (d-block@illinois.edu) 教授設計的電路板和 F28379D 微控制器組成，該微控制器是德州儀器 C2000 系列的一部分。該項目的目標是通過藍牙向 segbot 無線發送轉向命令。

藍牙通訊

藍牙 LE UART Friend 與 Bluefruit Connect 應用程序兼容。字符通過UART傳輸到segbot，可以在計算機終端上查看。從 segbot 傳輸的字符可以在應用程序中查看或繪制。在我的演示中，我從手機發送了加速度計數據，并用它來引導 segbot 通過障礙物。

傳入的加速度計數據由前綴“！A”標識，后跟三個浮點值。由于數據是通過 UART 傳輸的，因此無法立即解釋原始值。實現了一個聯合，將六個 16 位整數與三個 32 位浮點數存儲在內存中的同一位置。

typedef union phonedata_s{
    uint16_t rawdata[6];
    float fltdata[3];

}phonedata_t;
phonedata_t phoneaccel; //use new data type defined in union

下面的代碼在串行接收函數中。首先，傳入的 8 位值保存在過去狀態的數組中。然后通過查找前綴“！A”來篩選這些值以確定它是否是加速度計數據。然后，與加速度計數據對應的值組合成 16 位整數并保存為上面定義的新數據類型。然后，這些值存儲為浮點數。

        if((past[0] == '!')&&(past[1] == 'A')){
            //incoming accelerometer data 
            //X
            phoneaccel.rawdata[0] = (past[3]<<8)|past[2];
            phoneaccel.rawdata[1] = (past[5]<<8)|past[4];
            //Y
            phoneaccel.rawdata[2] = (past[7]<<8)|past[6];
            phoneaccel.rawdata[3] = (past[9]<<8)|past[8];
            //Z
            phoneaccel.rawdata[4] = (past[11]<<8)|past[10];
            phoneaccel.rawdata[5] = (past[13]<<8)|past[12];

            ble_x = phoneaccel.fltdata[0];
            ble_y = phoneaccel.fltdata[1];
            ble_z = phoneaccel.fltdata[2];

操舵

在加速度計數據被標記后，仍然在串行接收功能中，對應于 x、y 和 z 方向上的加速度的三個浮點數被解釋為 segbot 的轉向指令。segbot 通過更改“turnrate”和“FwdBackOffset”值來驅動。假設手機將被側向操縱，y 加速度的變化對應于轉向指令，z 加速度的變化對應于向前和向后的運動。

?

iPhone 加速度計軸

?

當加速度在指定方向達到某個閾值時，發出轉向指令。閾值是這樣的，即故意改變手機位置將引導 segbot，但方向的小幅波動不會。轉向速度已調整為我認為最容易轉向的速度，但可以調整為更快或更慢。

            //Interpret phone accel data as steering instructions
            if(ble_y >= 0.3){
                //turn left
                turnrate = -4.0;
            }else if(ble_y <= -0.3){
                //turn right
                turnrate = 4.0;
            }else if(fabs(ble_y) < 0.3){
                //don't turn
                turnrate = 0;
            }

            if(ble_z <= -0.3){
                //go forward
                FwdBackOffset = -1.0;
            }else if(ble_z >= 0.3){
                //go backward
                FwdBackOffset = 1.0;
            }else if(fabs(ble_z) < 0.3){
                //don't go forward or backward
                FwdBackOffset = 0;
            }

接線

?

上圖顯示了 UART Friend 到 segbot 的接線圖。藍牙傳感器連接到 5 V 電源。芯片的接收線連接到segbot的發送線，發送線連接到segbot的接收線，對應F28739D處理器的Serial C。為了在數據模式下工作，藍牙芯片的 CTS 引腳必須接地。它連接到 GPIO 引腳并設置為低電平，從而可以通過編輯代碼輕松更改模式。

分段機器人組件

慶典

當 segbot 完成障礙賽時，它會通過蜂鳴器播放 Kool & The Gang 的“Celebration”并跳一段小舞。當麥克風聽到我的歡呼聲時會觸發此響應。這是由大約 625 Hz 的頻率識別的，我使用頻率分析儀應用程序發現了這個頻率。麥克風以 10 kHz 的速率進行采樣，并通過 Goertzel 算法傳遞數據，該算法搜索 625 Hz 的目標頻率。在我的另一個項目中有更多關于音符檢測以及歌曲和舞蹈的信息，鏈接在這里。