水陸兩用車 LVT (arduino car)

-

































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

long  a;
long  e;

Servo servo_6;
Servo servo_7;


SoftwareSerial CAR_BT(8,9); //定義 tX 及rX 腳位

void setup()  
{
servo_6.attach(6);
servo_7.attach(7);

 
a = 90;
e = 90;
  Serial.begin(9600); //Arduino起始鮑率：9600
  CAR_BT.begin(9600); //藍牙鮑率：9600 注意！每個藍牙晶片的鮑率都不太一樣，請務必確認
}




void f() {
  servo_6.write(40);
  servo_7.write(140);
  }
void s() {
  servo_6.write(90);
  servo_7.write(90);
}
void b() {
  servo_6.write(140);
  servo_7.write(40);
  }

void r() {
  servo_6.write(140);
  servo_7.write(140);
  }

void w() {
  servo_6.write(40);
  servo_7.write(90);
  }

void l() {
  servo_6.write(40);
  servo_7.write(40);
 }

void o() {
  servo_6.write(90);
  servo_7.write(140);
 }
 void m() {
  servo_6.write(90);
  servo_7.write(40);
 }

void z() {
  servo_6.write(140);
  servo_7.write(90);
}


void loop()
{
  int inSize;
  char input;
  if( (inSize = (CAR_BT.available())) > 0) { //讀取藍牙訊息
      Serial.print("size = ");
      Serial.println(inSize);
      Serial.print("Input = ");
      Serial.println(input=(char)CAR_BT.read());
      
      if( input == 'f' ) {
        f();
      }
      if( input == 'l' ) {
       l();  
      }
     if( input == 'w' ) {
       w();  
      }
      if( input == 'r' ) {
        r();
      }
      if( input == 'o' ) {
       o();  
      }
      
       if( input == 'b' ) {
        b();
      }  
     
     if( input == 's' ) {
        s();
      }
     
      if( input == 'z' ) {
        z();
      }
      if( input == 'm' ) {
        m();
      }   
   }      
 }