久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標題: arduino無線小車 [打印本頁]

作者: 越來越明亮的你 時間: 2016-11-12 20:07
標題: arduino無線小車
#include <MsTimer2.h>
#include <SoftwareSerial.h>
#include <Servo.h>
Servo myservo;// 定義舵機對
int pos = 90;//定義舵機轉動位置
SoftwareSerial mySerial(8, 9); // RX, TX
const int TrigPin = 2;
const int EchoPin = 3;
const int L298nIn1 = 7;
const int L298nIn2 = 6;
const int L298nIn3 = 5;
const int L298nIn4 = 4;
float distance,a,b,a1=360.0,b1=360.0;
unsigned char flag=0;
void setup()
{ // 初始化串口通信及連接SR04的引腳
      mySerial.begin(9600);
      myservo.attach(10);  // 設置舵機控制針腳
      myservo.write(pos);
      pinMode(TrigPin, OUTPUT);// 要檢測引腳上輸入的脈沖寬度，需要先設置為輸入狀態
      pinMode(EchoPin, INPUT);
      pinMode(L298nIn1, OUTPUT);
      pinMode(L298nIn2, OUTPUT);
      pinMode(L298nIn3, OUTPUT);
      pinMode(L298nIn4, OUTPUT);
      pinMode(13, OUTPUT);
      digitalWrite(13, HIGH);
      goStop();
//    mySerial.println("Ultrasonic sensor:");
//    MsTimer2::set(500, flash);       // 中斷設置函數，每 500ms 進入一次中斷
//    MsTimer2::start();             //開始計時
}
void flash() //中斷處理函數，改變燈的狀態
{
  if(flag==1) {
mySerial.print(distance);
mySerial.print("cm");
mySerial.println("");}
}
void goForward() {//小車前進
  digitalWrite(L298nIn1, LOW);
  analogWrite(L298nIn2,  250);//右輪正轉
  analogWrite(L298nIn3,  0);
  digitalWrite(L298nIn4, HIGH);//左輪直走
}
void goBack() {//小車后退
  digitalWrite(L298nIn1, HIGH);
  analogWrite(L298nIn2,  0);
  analogWrite(L298nIn3,  255);
  digitalWrite(L298nIn4, LOW);
}
void goStop() {//小車停止
  digitalWrite(L298nIn1, LOW);
  digitalWrite(L298nIn2, LOW);
  digitalWrite(L298nIn3, LOW);
  digitalWrite(L298nIn4, LOW);
}
void turnRight() {//小車右轉
  digitalWrite(L298nIn1, HIGH);
  digitalWrite(L298nIn2, LOW);
  digitalWrite(L298nIn3, LOW);
  digitalWrite(L298nIn4, HIGH);
}
void turnLeft() {//小車左轉
  digitalWrite(L298nIn1, LOW);
  digitalWrite(L298nIn2, HIGH);
  digitalWrite(L298nIn3, HIGH);
  digitalWrite(L298nIn4, LOW);
}
void PWM_Right() {//小車右轉
  digitalWrite(L298nIn1, LOW);
  analogWrite(L298nIn2,  170);
  digitalWrite(L298nIn3, LOW);
  digitalWrite(L298nIn4, HIGH);
}
void PWM_Left() {//小車左轉
  digitalWrite(L298nIn1, LOW);
  digitalWrite(L298nIn2, HIGH);
  analogWrite(L298nIn3,  75);
  digitalWrite(L298nIn4, HIGH);
}
void PWM_back_L(){
  digitalWrite(L298nIn1, HIGH);
  digitalWrite(L298nIn2, LOW);
  analogWrite(L298nIn3, 200);
  digitalWrite(L298nIn4, LOW);
}
void PWM_back_R(){
  digitalWrite(L298nIn1, HIGH);
  analogWrite(L298nIn2, 60);
  digitalWrite(L298nIn3, HIGH);
  digitalWrite(L298nIn4, LOW);
}
void flag_1(){
  if(flag==1)
flag=0;
  else
flag=1;
}

void readTtl() {
  while (mySerial.available())
  {
char s=mySerial.read();
delay(2);
if (s == 'W')  goForward();//如果按GO鍵，小車前進，直到按STOP鍵停止
else if (s == 'A' ) PWM_Left();
else if (s == 'Q' ) {goStop();flag=0;}
else if (s == 'D' ) PWM_Right();
else if (s == 'S' ) goBack();
else if (s == 'L' ) turnLeft();
else if (s == 'R' ) turnRight();
else if (s == 'Z' ) PWM_back_L();
else if (s == 'Y' ) PWM_back_R();
else if (s == 'F' ) flag_1();
  }
}
void Ultr(){
  distance=0.0;
  digitalWrite(TrigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(TrigPin, HIGH);
  delayMicroseconds(10); // 產生一個10us的高脈沖去觸發TrigPin
  digitalWrite(TrigPin, LOW);
  distance = pulseIn(EchoPin, HIGH) / 58.00; // 檢測脈沖寬度，并計算出距離
  delay(2);
}
void Duoji(){
  for(pos = 90; pos <= 180; pos += 1){
myservo.write(pos);
delay(5);
readTtl();
  }
  for(pos = 180; pos >= 90; pos-= 1){
myservo.write(pos);
delay(5);
readTtl();
Ultr();
if(pos>120){
   if(distance<a1)a1=distance;}
a=a1;
  }
  for(pos = 90; pos >= 0; pos -= 1){
myservo.write(pos);
delay(5);
readTtl();
  }
  for(pos = 0; pos <= 90; pos += 1){
myservo.write(pos);
delay(5);
readTtl();
Ultr();
if(pos<60){
   if(distance<b1)b1=distance;}
b=b1;
  }
}
void loop()
{
  readTtl();
  if(flag==1)
  {
goForward();
Ultr();
if(distance<=20.0)
{
   goStop();
   Duoji();
   if(a>15.0 || b>15.0){
      if(a>b){turnLeft(); delay(300);}
      else if(a<b){turnRight();delay(300);}
      else if(a>20.0&&b>20.0){turnRight();delay(300);}
   }
   else
   {goBack();delay(300);turnLeft();delay(580);}
   goForward();
   a1=50.0;
   b1=50.0;
}
  }
}

歡迎光臨 (http://www.zg4o1577.cn/bbs/)