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

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