描述

概述

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

部分

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

?

?

?

?

?

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

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

• 機器人的大腦：RosBot 底板

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

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

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

第 1 步：組裝

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

?

?

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

?

?

將 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ù)項的值。

?

PID控制器

?

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;

操縱值以找到最適合您的機器人的值。