本帖最後由 odom 於 2015-5-1 09:15 編輯
請問大大要怎麼分兩個陣列 小的不會寫想請教@@
#include <Ultrasonic.h>
#include <Servo.h>
#define TRIGGER_PIN A2
#define ECHO_PIN A3
#define M1_in1 12
#define M1_in2 11
#define M2_in3 10
#define M2_in4 9
int speed;
Ultrasonic ultrasonic(TRIGGER_PIN, ECHO_PIN);
int incomingByte; //讀取進來的資料存放位置。
const byte ENB = 5;
const byte ENA = 6;
unsigned long Time; //time
void setup() {
Serial.begin(57600); //設定傳輸速度
// 設定LED 燈的接腳
pinMode(M1_in1,OUTPUT);
pinMode(M1_in2,OUTPUT);
pinMode(M2_in3,OUTPUT);
pinMode(M2_in4,OUTPUT);
speed = 100;
}
void Go_Ahead() {
digitalWrite(M1_in1, HIGH);
digitalWrite(M1_in2, LOW);
digitalWrite(M2_in3, HIGH);
digitalWrite(M2_in4, LOW);
delay(1000);
}
void Stop(){
digitalWrite(M1_in1, LOW);
digitalWrite(M1_in2, LOW);
digitalWrite(M2_in3, LOW);
digitalWrite(M2_in4, LOW);
delay(1000);
}
void Go_Back(){
digitalWrite(M1_in1, LOW);
digitalWrite(M1_in2, HIGH);
digitalWrite(M2_in3, LOW);
digitalWrite(M2_in4, HIGH);
delay(1000);
}
void Left(){
digitalWrite(M1_in1, LOW);
digitalWrite(M1_in2, LOW);
digitalWrite(M2_in3, HIGH);
digitalWrite(M2_in4, LOW);
delay(1000);
}
void Right(){
digitalWrite(M1_in1, HIGH);
digitalWrite(M1_in2, LOW);
digitalWrite(M2_in3, LOW);
digitalWrite(M2_in4, LOW);
delay(1000);
}
void a(){
float cmMsec;
long microsec = ultrasonic.timing();
cmMsec = ultrasonic.convert(microsec, Ultrasonic::CM);
Serial.print("CM: ");
Serial.print(cmMsec);
Serial.print("
");
}
void b(){
int sV;
sV = analogRead(A0);
Serial.print("Flame:");
Serial.println(sV);
Serial.print("
");
}
void c(){
int va; // 煙霧
va=analogRead(A1);
Serial.print("Smoke:");
Serial.println(va,DEC);
Serial.print("
");
delay(1000);
}
void loop() { //超音波
analogWrite(ENA, speed); //輸出 PWM 脈衝到 ENA
analogWrite(ENB, speed); //輸出 PWM 脈衝到 ENB
a();
b();
c();
// 看看是否有資料進來?
if (Serial.available() > 0) { //馬達
// 讀取資料
incomingByte = Serial.read();
if (incomingByte == "A")
Go_Ahead();
else if (incomingByte == "B")
Stop();
else if (incomingByte == "C")
Go_Back();
else if (incomingByte == "D")
Left();
else if (incomingByte == "E")
Right();
}
{
}
} |