CAVEDU教育團隊技術部落格 / Arduino開發板與實作

【雙A計劃】Part4:App Inventor 藍牙遙控 Arduino 雙輪機器人

✍ CAVEDU 阿吉 - 雜工📅 2014-05-22👁 3,271

雙A計畫來到第五篇了,您都 follow 了嗎?在手機上製作多個按鈕,分別發送不同的字元來控制 Arduino 機器人。

雙A計畫文章總覽:

 

作者/攝影   曾吉弘
難度

★★★☆☆

材料表
  • Android系統智慧型手機
  • Arduino相容開發板(機器人王國購物連結,請點我)本文使用 Arduino MEGA2560
  • 藍牙收發接收器,本系列使用JY-MCU04 或 JY-MCU05
  • 麵包板
  • 具備2個連續型伺服馬達的車身,右側馬達的訊號線接在 D12 腳位,左側則是13。並分別接電與接地。
  • 9V電池,為機器人供電。如果用 USB 的話,馬達可能轉得非常慢或根本不會轉。

【推薦套件】自學者的天堂|Arduino 入門到雲端基本套件包

下載 範例程式請點我下載(App Inventor中文學習網檔案庫)  App Inventor 2檔名:BTRobot.aia

範例影片如下:

 

先根據下圖,將藍牙與兩個 servo motor 接上Arduino。

*請注意如果您要用直流馬達的話,就要使用 TA7279p 或 L293D  等馬達驅動電路。或是國產的 motoduino 控制板(已整合 L293D 晶片)

App Inventor 編寫藍牙訊息接收程式

畫面元件很簡單,點選 BT List 之後,會顯示藍牙配對裝置清單,點選您已經配對好的藍牙裝置之後,就會顯示一個包含有五個按鈕的操作介面。

a001

以下是安裝到實體手機上的截圖

 

 

程式說明:

本段程式重點在於按下不同的按鈕就會藉由 BluetoothClient元件發送不同的字元。例如 f 是前進,s 是停止等等。到了Arduino 端的程式就是藉由 switch 架構去判斷所收到字元的 ASCII碼,並執行對應的動作。所以機器人的接收端程式不太需要修改。

其他程式例如點選 ListPicker 去連接藍牙裝置或是斷線等,與先前的範例完全相同。在此就不再介紹囉。

BT_U:送出 ' f ' 讓機器人前進

BT_S:送出 ' s ' 讓機器人停止

BT_R:送出 ' r ' 讓機器人右轉

BT_L:送出 ' l ' 讓機器人左轉

BT_Dwn:送出 ' d ' 讓機器人後退

a002

Arduino 端程式

請注意Arduino 端程式會因為您使用連續型伺服馬達或是透過直流馬達控制晶片而有所不同,但基本上的架構都是一樣的。手機端程式則完全不變,都是滿足某個條件(例如按按鈕)發送字元。

連續型伺服馬達的機器人如下圖 (請忽略學生手上拿的 Wii 手把)

 

請先看伺服馬達的版本

#include <SoftwareSerial.h>
#include <Servo.h>

Servo servoRight;
Servo servoLeft;

SoftwareSerial BTSerial(10, 11); // RX, TX

byte dis[6];  //distance package
int t,i,pp;   //temp value


void setup(){
  Serial.begin(9600);
  BTSerial.begin(57600);    //BTSerial 9600,19200,38400,57600
  servoRight.attach(12);
  servoLeft.attach(13);
  dis[0] = 65;              //check value
}

void loop(){
  if (BTSerial.available()>0){
    pp=BTSerial.read();
    Serial.println(pp);
    switch(pp){
    case 'f':  //Forward
      Up();
    break;
    case 'x':  //Back
      Down();
    break;
    case 'a':  //Turn Left
      Left();
    break;
    case 'd':  //Turn Right
      Right();
    break;
    case 's':  //Stop
      stop();
    break;
    case 65:  //Return distance value
      for(i=5;i>0;i--){
        dis[i] = t%10;
        t/=10;
      }
      //Pack value
      for(i=0;i<=5;i++)
        BTSerial.write(dis[i]);
        //Return value
    break;
    default:
    break;
    }
  }
}
int Up(){
  servoRight.writeMicroseconds(1300);
  servoLeft.writeMicroseconds(1700);
  //delay(1000);
}
int Down(){
  servoRight.writeMicroseconds(1700);
  servoLeft.writeMicroseconds(1300);
  //delay(1000);  //視情況調整
}
int Right(){
  servoRight.writeMicroseconds(1700);
  servoLeft.writeMicroseconds(1700);
}
int Left(){
  servoRight.writeMicroseconds(1300);
  servoLeft.writeMicroseconds(1300);
}
int stop(){
  servoRight.writeMicroseconds(1500);
  servoLeft.writeMicroseconds(1500);
}

 

 

為了回饋各位朋友,也一併附上 motoduino 的版本。

const int Motor_E2 = 5; // digital pin 5 of Arduino (PWM)    
const int Motor_E1 = 6;  // digital pin 6 of Arduino (PWM)  
const int Motor_M1 = 7;     // digital pin 7 of Arduino
const int Motor_M2 = 8;    // digital pin 8 of Arduino
char val;  // variable to receive data from the serial port(bluetooth)

void setup()  
{
  // Start serial communication at 9600
  Serial.begin(9600); 
  pinMode(Motor_M1, OUTPUT);
  pinMode(Motor_M2, OUTPUT);
}

void loop()
{
  if(Serial.available()>0)
  {
    val = Serial.read();
    switch(val)
    {
      case 'f':   // car forward
                forward(0, 255);
                break;
      case 'd':   // car backward
                backward(0, 255);
                break;
      case 'l':   // car turn left
                left(0, 255);
                break;
      case 'r':   // car turn right
                right(0, 255);
                break;
      case 's':   // car stop
                motorstop(0, 0);
                break;
    }     
  }
}

void motorstop(byte flag, byte motorspeed)
{
  Serial.println("Stop!");
  digitalWrite( Motor_E1, motorspeed);
  digitalWrite( Motor_E2, motorspeed);
}

void forward(byte flag, byte motorspeed)
{
  Serial.println("Forward!");

  digitalWrite( Motor_M1, HIGH);
  digitalWrite( Motor_M2, HIGH);

  analogWrite( Motor_E1, motorspeed);
  analogWrite( Motor_E2, motorspeed);
}

void backward(byte flag, byte motorspeed)
{
  Serial.println("Backward!");

  digitalWrite( Motor_M1, LOW);
  digitalWrite( Motor_M2, LOW);

  analogWrite( Motor_E1, motorspeed);
  analogWrite( Motor_E2, motorspeed);
}

void right(byte flag, byte motorspeed)
{
  Serial.println("Turn Right! ");

  digitalWrite( Motor_M1, HIGH);
  digitalWrite( Motor_M2, HIGH);

  analogWrite( Motor_E1, motorspeed);
  analogWrite( Motor_E2, 0);
}

void left(byte flag, byte motorspeed)
{
  Serial.println("Turn Left!");

  digitalWrite( Motor_M1, HIGH);
  digitalWrite( Motor_M2, HIGH);

  analogWrite( Motor_E1, 0);
  analogWrite( Motor_E2, motorspeed); 
}

 

本文發表於Arduino開發板與實作、MIT App Inventor,並標記arduino、MIT App Inventor、程式教學、雙A計畫。

相關文章 📎

打造虛擬鍵盤手勢控制音樂播放器--- 使用Arduino 首次接觸就上手

2024-11-06

《Arduino首次接觸就上手》的進階教學 追憶鳥山明:OLED螢幕上的經典重現

2024-04-23

使用DF燈光/馬達控制板,透過電腦來控制馬達轉速

2022-04-01

【Arduino首次接觸就上手】快速執行AI圖像辨識

2021-11-23

留言 💬 (0)

還沒有留言,來當第一個。