HƯỚNG DẪN SỬ DỤNG APP ĐIỀU KHIỂN ROBOT MEGA

Đăng bởi KLT vào 28/10/2023
App Điều khiển Robot Mega được mình phát triển trên nền tảng Android. App được dùng để kết nối điện thoại và Arduino thông qua Modul bluetooth HC-05

            Download app: Điền khiển Robot Mega 

I- Phần cứng
1 x Arduino Uno
2 x Động cơ 5-12V
1 x bluetooth HC 05
Sơ đồ điều khiển Robot mega dùng HC 05

II- Bộ mã

Ứng dụng giúp kết nối Ardunio và điện thoại thông qua bộ modul bluetool
Tiến - "1"
Lùi - "2"
Trái - "3"
Phải- "4"
Stop -"5"
Qtrai - "6"
QPhai -"7"
Gấp - " 8"
Nhả- " 9"
A- "A"
B -"B"
C-"C"
D-"D"
Lên-"L"
Xuống-"X"
V1- "E"
V2-"F"
V3- "G"
Giao diện app Điều khiển Robot

III- Code điều khiển
#define   MT1_T    3
#define   MT1_N    5
#define   MT2_T    6
#define   MT2_N    9

unsigned char tocdo = 255;
unsigned int GIATRI=0;
void setup()
{
  Serial.begin(9600);     // giao tiếp Serial với baudrate 9600

  pinMode(MT1_T, OUTPUT);
  pinMode(MT1_N, OUTPUT);
  pinMode(MT2_T, OUTPUT);
  pinMode(MT2_N, OUTPUT);
  //

}

void loop()
{

  if (Serial.available() > 0)
  {
    GIATRI = Serial.read();
    Serial.println(GIATRI);
  }
  //sieuam();
  switch (GIATRI)
  {
    case '1':
      {
        TIEN(tocdo);
        GIATRI = 0;
        delay(100);
        break;
      }
    case '2':
      {
        LUI(tocdo);
        GIATRI = 0;

        delay(100);
        break;
      }
    case '3':
      {
        TRAI(tocdo);
        GIATRI = 0;

        delay(100);
        break;
      }
    case '4':
      {
        PHAI(tocdo);
        delay(100);
        break;
      }
    case '5':
      {
        DUNG();
        GIATRI = 0;
        break;
      }
    case '6':
      {
        TRAI(tocdo);
        break;
      }
    case '7':
      {
        PHAI(tocdo);
        break;
      }
    case 'E': // V1
      {
        tocdo = 100;
        break;
      }
    case 'F': // V2
      {
        tocdo = 200;
        break;
      }
    case 'G': // V3
      {
        tocdo = 255;
        break;
      }
  }
}

// Chuong trinh con
void TIEN(int TC)
{
  DC2T(TC);
  DC1T(TC);
}
void LUI(int TC)
{
  DC1N(TC);
  DC2N(TC);
}
void TRAI(int TC)
{
  DC1T(TC);
  DC2N(TC);
}
void PHAI(int TC)
{
  DC1N(TC);
  DC2T(TC);
}
//
void DC1T( int Tdo)
{

  digitalWrite (MT1_N, 0);
  analogWrite (MT1_T, Tdo);
}
void DC1N(int Tdo)
{
  digitalWrite (MT1_T, 0);
  analogWrite (MT1_N, Tdo);

}
void DC2T( int Tdo)
{

  digitalWrite (MT2_N, 0);
  analogWrite (MT2_T, Tdo);
}
void DC2N(int Tdo)
{
  digitalWrite (MT2_T, 0);
  analogWrite (MT2_N, Tdo);

}
void DUNG()
{
  digitalWrite (MT1_T, 0);
  digitalWrite (MT1_N, 0);
  digitalWrite (MT2_T, 0);
  digitalWrite (MT2_N, 0);

}
 Xem thêm: http://www.ductaimec.com/2018/10/arduino-can-ban-phan-5-ieu-khien-ong-co.html
IV- Hướng dẫn

 

Danh mục