如果你想要制作一個遵循黑線行動的酷機器人。大概只需要在 2 小時內(nèi)學習并制作就能夠完成帶有 PID 控制器的線跟隨器機器人。

大多數(shù)漫游車自主機器人需要的一項功能是線路跟蹤。該項目的目的是構(gòu)建一個線跟隨機器人，并以一種有趣的方式開始學習 PID 控制器。

構(gòu)建

機器人與兩個電機、Rosbot 底板和一個 5 通道傳感器一起正常工作。與其他產(chǎn)品不同，您無需購買額外的 H 橋電機驅(qū)動器或各種組件，因為 Rosbot 基板具有內(nèi)置的 2x H 橋雙驅(qū)動器。只需將電機連接到 Rosbot 基板，它將提供比 Arduino Uno 更多的電力。

機器人框架： KittenBot 陽極氧化鋁底盤

酷酷且堅固的底盤，帶有大量安裝孔（4.8 毫米樂高機械組），您絕對可以將此底盤重復用于其他有趣的項目。

機器人的大腦：RosBot 底板

一個基于 Arduino UNO 的主板，帶有 2 個板載雙 H 橋電機驅(qū)動器。

機器人的眼睛： 5 通道 IR 線跟隨跟蹤器傳感器

5通道紅外探測器，更準確、更穩(wěn)定。

第 1 步：組裝

這個機器人很容易組裝，按照說明操作，大約需要 15 分鐘。

首先，將電機連接到底盤的側(cè)面，只需插入橡膠輪即可。

將 5 通道紅外傳感器安裝到機箱前部。

將您的 Rosbot 底板連接到底盤上，然后機器人就可以開始接線了。

第2步：連接

以下是 5 通道紅外傳感器的連接：

VCC 至 5V

GND 到 RosBot 的 GND

T1-T4 到引腳 A0-A3

T5 到 SDA 引腳

直流電機只需連接到引腳 A+A- 和引腳 B+B-。

編碼

在代碼中，我們有一個狀態(tài)機來指示每個可能的傳感器陣列輸出。機器人根據(jù)傳感器陣列輸出向某個方向移動。

void stateMachine(int a) {

switch (a) {
? ?case B00000:
? ? ?outlineCnt++;
? ? ?break;
? ?case B11111:
? ? ?outlineCnt++;
? ? ?break;
? ?case B00010:
? ?case B00110:
? ? ?outlineCnt = 0;
? ? ?pixels.setPixelColor(2, pixels.Color(0, 50, 0));
? ? ?bias = 1;
? ? ?break;
? ?case B00001:
? ?case B00011:
? ? ?outlineCnt = 0;
? ? ?pixels.setPixelColor(2, pixels.Color(0, 200, 0));
? ? ?bias = 2;
? ? ?break;
? ?case B00100:
? ? ?outlineCnt = 0;
? ? ?pixels.setPixelColor(2, pixels.Color(0, 0, 20));
? ? ?bias = 0;
? ? ?break;
? ?case B01000:
? ?case B01100:
? ? ?outlineCnt = 0;
? ? ?pixels.setPixelColor(2, pixels.Color(50, 0, 0));
? ? ?bias = -1;
? ? ?break;
? ?case B10000:
? ?case B11000:
? ? ?outlineCnt = 0;
? ? ?pixels.setPixelColor(2, pixels.Color(200, 0, 0));
? ? ?bias = -2;
? ? ?break;
? ?default:
? ? ?Serial.println(a,BIN);
? ? ?outlineCnt++;
? ? ?break;
?}

到此我們已經(jīng)設(shè)置了誤差、比例項、積分項和導數(shù)項的值。

float Kp = 25;

float Ki = 0.15;
float Kd = 1200;
float error, errorLast, erroInte;
float calcPid(float input) {
?float errorDiff;
?float output;
?error = error * 0.7 + input * 0.3; // filter
?//error = input;
?errorDiff = error - errorLast;
?erroInte = constrain(erroInte + error, -50, 50);
?output = Kp * error + Ki * erroInte + Kd * errorDiff;
?Serial.print(error); Serial.print(' ');
?Serial.print(erroInte); Serial.print(' ');
?Serial.print(errorDiff); Serial.print(' ');
?Serial.println(output);
?errorLast = error;
?return output;