Part1.1 藍芽遙控車
#include <SoftwareSerial.h>
#include <Wire.h>
SoftwareSerial BT(2,3); //HC-05 (TX,RX)
void go(){
analogWrite(5,0);
analogWrite(6,255);
analogWrite(10,255);
analogWrite(11,0);
}
void back(){
analogWrite(5,255);
analogWrite(6,0);
analogWrite(10,0);
analogWrite(11,255);
}
void right(){
analogWrite(5,0);
analogWrite(6,0);
analogWrite(10,255);
analogWrite(11,0);
}
void left(){
analogWrite(5,0);
analogWrite(6,255);
analogWrite(10,0);
analogWrite(11,0);
}
void stand(){
analogWrite(5,0);
analogWrite(6,0);
analogWrite(10,0);
analogWrite(11,0);
}
void setup() {
Serial.begin(9600);
BT.begin(9600);
pinMode(5,OUTPUT);
pinMode(6,OUTPUT);
pinMode(10,OUTPUT);
pinMode(11,OUTPUT);
}
void loop() {
if(BT.available()>0){
char cmd = BT.read();
Serial.println(cmd);
switch (cmd){
case 'w':
go();
break;
case 'x':
back();
break;
case 'd':
right();
break;
case 'a':
left();
break;
case 's':
stand();
break;
}
}
}