#include <SoftwareSerial.h>
SoftwareSerial BT(12,13); // 接收腳(RX) pin 11 接藍芽Tx, 傳送腳(TX) pin 10 接藍芽Rx
int vel = 80;
int lpwr=3,lpin1=4,lpin2=5,rpin2=7,rpin1=8,rpwr=9;
char ch;
void setup(){
pinMode(lpwr,OUTPUT);
pinMode(lpin1,OUTPUT);
pinMode(lpin2,OUTPUT);
pinMode(rpin2,OUTPUT);
pinMode(rpin1,OUTPUT);
pinMode(rpwr,OUTPUT);
BT.begin(9600);
}
void loop(){
if (BT.available()) {
ch = BT.read();
switch(ch){
case 'F': goF(); break;
case 'B': goB(); break;
case 'L': goL(); break;
case 'R': goR(); break;
case 'S': goS(); break;
}
}
}
void goB(){
digitalWrite(lpin1, HIGH);
digitalWrite(lpin2, LOW);
analogWrite(lpwr, vel);
digitalWrite(rpin1, HIGH);
digitalWrite(rpin2, LOW);
analogWrite(rpwr, vel);
}
void goF(){
digitalWrite(lpin1, LOW);
digitalWrite(lpin2, HIGH);
analogWrite(lpwr, vel);
digitalWrite(rpin1, LOW);
digitalWrite(rpin2, HIGH);
analogWrite(rpwr, vel);
}
void goR(){
digitalWrite(lpin1, LOW);
digitalWrite(lpin2, HIGH);
analogWrite(lpwr, vel);
analogWrite(rpwr, 0);
}
void goL(){
analogWrite(lpwr, 0);
digitalWrite(rpin1, LOW);
digitalWrite(rpin2, HIGH);
analogWrite(rpwr, vel);
}
void goS(){
analogWrite(lpwr, 0);
analogWrite(rpwr, 0);
}