這是藍牙遙控車想加進一段可以把超音波的資料傳給手機
程式是參考網路的 不知道為什麼沒有成功
手機沒有反應 監視視窗沒問題
想請問大家
#include <AFMotor.h>
#include <SoftwareSerial.h>
AF_DCMotor m1(1),m2(2),m3(3),m4(4);//馬達
SoftwareSerial BT(3,4);
char val;
const byte trig = 10;
const int echo = 9;
unsigned long d;
int counter=0;
void setup() {
pinMode(trig, OUTPUT);
pinMode(echo, INPUT);
Serial.begin(9600);
BT.begin(9600);
}
void loop() {
float duration; //持續時間
float distance; //距離
digitalWrite(trig, HIGH);
delayMicroseconds(1000);
digitalWrite(trig, LOW);
duration = pulseIn(echo, HIGH);
distance = (duration / 2) * 0.034;
Serial.print(distance);
Serial.println("cm");
delay(500);
int sendData = (int) (distance*100);
byte packet[3];
packet[0] = 97;
packet[1] = sendData / 256;
packet[2] = sendData % 256;
if(BT.read() == 97)
{
for(int i = 0; i < 3; i++)
BT.write(packet);
}
}
|