Scribd Logo
Upload

Welcome to Scribd!

  • New Text Document

    Uploaded by

    Chien Nguyen Van Khanh
    4 views2 pages
    This code defines pin assignments and functions to control the direction of a Bluetooth controlled robot. It initializes Bluetooth and pin modes in setup. The loop continuously checks for Bluetooth input and calls the appropriate direction function - forward(), backward(), leftward(), rightward(), or Stop() - to set the pin states and move the robot. Digital pin 13 is used to indicate motion. Serial printing provides debugging output.

    Original Description:

    Copyright

    © © All Rights Reserved

    Available Formats

    TXT, PDF, TXT or read online from Scribd

    Did you find this document useful?

    Is this content inappropriate?

    Report this Document
    This code defines pin assignments and functions to control the direction of a Bluetooth controlled robot. It initializes Bluetooth and pin modes in setup. The loop continuously checks for Bluetooth input and calls the appropriate direction function - forward(), backward(), leftward(), rightward(), or Stop() - to set the pin states and move the robot. Digital pin 13 is used to indicate motion. Serial printing provides debugging output.

    Copyright:

    © All Rights Reserved
    Download as TXT, PDF, TXT or read online from Scribd
    Flag for inappropriate content
    Download as txt, pdf, or txt
    4 views2 pages

    New Text Document

    Uploaded by

    Chien Nguyen Van Khanh
    This code defines pin assignments and functions to control the direction of a Bluetooth controlled robot. It initializes Bluetooth and pin modes in setup. The loop continuously checks for Bluetooth input and calls the appropriate direction function - forward(), backward(), leftward(), rightward(), or Stop() - to set the pin states and move the robot. Digital pin 13 is used to indicate motion. Serial printing provides debugging output.

    Copyright:

    © All Rights Reserved
    Download as TXT, PDF, TXT or read online from Scribd
    Flag for inappropriate content
    Download as txt, pdf, or txt
    of 2

    #include <SoftwareSerial.

    h>
    #define in1 5
    #define in2 6
    #define in3 7
    #define in4 8

    int bluetoothTx = 3; // truyen


    int bluetoothRx = 2;// nhan
    SoftwareSerial bluetooth(bluetoothRx, bluetoothTx);
    char input;
    char spd;

    void setup(){
    bluetooth.begin(9600);
    Serial.begin(11520);
    pinMode(in1, OUTPUT);
    pinMode(in2, OUTPUT);
    pinMode(in3, OUTPUT);
    pinMode(in4, OUTPUT);
    }
    void forward()// di thang
    {
    digitalWrite(in1,0);
    digitalWrite(in2,1);

    digitalWrite(in3,0);
    digitalWrite(in4,1);
    digitalWrite(13,1);
    Serial.println("di thang");

    }
    void backward()//lui
    {
    digitalWrite(in1,1);
    digitalWrite(in2,0);

    digitalWrite(in3,1);
    digitalWrite(in4,0);
    Serial.println("di lui");
    digitalWrite(13,1);
    }
    void leftward()//sang trai
    {
    digitalWrite(in1,1);
    digitalWrite(in2,0);

    digitalWrite(in3,0);
    digitalWrite(in4,1);
    Serial.println("sang trai");
    digitalWrite(13,1);

    }
    void rightward()//sang phai
    {
    digitalWrite(in1,0);
    digitalWrite(in2,1);
    digitalWrite(in3,1);
    digitalWrite(in4,0);
    Serial.println("sang phai");
    digitalWrite(13,1);

    }
    void Stop()//dung
    {
    digitalWrite(in1,0);
    digitalWrite(in2,0);

    digitalWrite(in3,0);
    digitalWrite(in4,0);
    Serial.println("dung");
    digitalWrite(13,0);

    void loop() {
    if (bluetooth.available())
    {
    input = bluetooth.read();
    Serial.print("gia tri cua input la ");
    Serial.println(input);
    }
    switch (input ){
    case('F'):
    forward();
    break;

    case('B'):
    backward();
    break;

    case('L'):
    leftward();
    break;

    case('R'):
    rightward();
    break;

    case('S'):
    Stop();
    break;

    }
    }

    You might also like