|
|
My first Blogs:基于arduino uno的四輪(前后超聲波，兩側(cè)紅外)智能避障小車
/*所需材料：
1#arduino uno板子
2#L293D電極驅(qū)動(dòng)擴(kuò)展版
3#4個(gè)減速電機(jī)TT馬達(dá)
4#兩個(gè)超聲波HC-SR04
5#兩個(gè)紅外循跡避障模塊
6#一部分母對(duì)母杜邦線
7#18650電池兩節(jié)和一個(gè)電池盒
代碼部分
插入代碼：
#include<NewPing.h>
#include<Servo.h>
#include<AFMotor.h>
#define SONAR_NUM 2
#define RIGHT A4
#define LEFT A5
#define TRIGGER1_PIN A0
#define ECHO1_PIN A1
#define TRIGGER2_PIN A3
#define ECHO2_PIN A2
#define MAX1_DISTANCE 100
#define MAX2_DISTANCE 100
NewPing sonar[2] = {
NewPing(TRIGGER1_PIN, ECHO1_PIN, MAX1_DISTANCE),
NewPing(TRIGGER2_PIN, ECHO2_PIN, MAX2_DISTANCE)};
AF_DCMotor Motor1(1,MOTOR12_1KHZ);
AF_DCMotor Motor2(2,MOTOR12_1KHZ);
AF_DCMotor Motor3(3,MOTOR34_1KHZ);
AF_DCMotor Motor4(4,MOTOR34_1KHZ);
int pos =0;
int i;
void setup() {
Serial.begin(9600);
pinMode(RIGHT, INPUT);
pinMode(LEFT, INPUT);
}
void loop() {
delay(50);
unsigned int head=sonar[0].ping_cm();
Serial.print(“head”);
Serial.println(head);
delay(50);
unsigned int rear=sonar[1].ping_cm();
Serial.print(“rear”);
Serial.println(rear); //序列譜
int Right_Value = digitalRead(RIGHT);
int Left_Value = digitalRead(LEFT);
Serial.print(“RIGHT”);
Serial.println(Right_Value);
Serial.print(“LEFT”);
Serial.println(Left_Value);
if((Right_Value1)&&(Left_Value1)&&(head>15 && head<100)){
Motor1.setSpeed(150);
Motor1.run(FORWARD);
Motor2.setSpeed(150);
Motor2.run(FORWARD);
Motor3.setSpeed(150);
Motor3.run(FORWARD);
Motor4.setSpeed(150);
Motor4.run(FORWARD);}
else if((Right_Value0)&&(Left_Value1)&&(head>15 && head<100)){
for(i=1000;i>0;i–){
Motor1.setSpeed(0);
Motor1.run(FORWARD);
Motor2.setSpeed(150);
Motor2.run(FORWARD);
Motor3.setSpeed(150);
Motor3.run(FORWARD);
Motor4.setSpeed(0);
Motor4.run(FORWARD);}}
else if((Right_Value1)&&(Left_Value0)&&(head>15 && head<100)){
for(i=1000;i>0;i–){
Motor1.setSpeed(150);
Motor1.run(FORWARD);
Motor2.setSpeed(0);
Motor2.run(FORWARD);
Motor3.setSpeed(0);
Motor3.run(FORWARD);
Motor4.setSpeed(150);
Motor4.run(FORWARD);}}
else if(((Right_Value0)&&(Left_Value0))&&(head>15 && head<100)){
Motor1.setSpeed(150);
Motor1.run(FORWARD);
Motor2.setSpeed(150);
Motor2.run(FORWARD);
Motor3.setSpeed(150);
Motor3.run(FORWARD);
Motor4.setSpeed(150);
Motor4.run(FORWARD);}
else if((head>1 && head<15)&&((Right_Value0)&&(Left_Value0))){
Motor1.setSpeed(120);
Motor1.run(BACKWARD);
Motor2.setSpeed(120);
Motor2.run(BACKWARD);
Motor3.setSpeed(120);
Motor3.run(BACKWARD);
Motor4.setSpeed(120);
Motor4.run(BACKWARD);}
else if((head>1 && head<15)&&((Right_Value0)&&(Left_Value1))){
for(i=3000;i>0;i–){
Motor1.setSpeed(120);
Motor1.run(BACKWARD);
Motor2.setSpeed(0);
Motor2.run(BACKWARD);
Motor3.setSpeed(0);
Motor3.run(BACKWARD);
Motor4.setSpeed(120);
Motor4.run(BACKWARD);}}
else if((head>1 && head<15)&&((Right_Value1)&&(Left_Value0))){
for(i=3000;i>0;i–){
Motor1.setSpeed(0);
Motor1.run(BACKWARD);
Motor2.setSpeed(120);
Motor2.run(BACKWARD);
Motor3.setSpeed(120);
Motor3.run(BACKWARD);
Motor4.setSpeed(0);
Motor4.run(BACKWARD);}}
else if((head>1 && head<15)&&((Right_Value1)&&(Left_Value1))){
for(i=3000;i>0;i–){
Motor1.setSpeed(0);
Motor1.run(BACKWARD);
Motor2.setSpeed(120);
Motor2.run(BACKWARD);
Motor3.setSpeed(120);
Motor3.run(BACKWARD);
Motor4.setSpeed(0);
Motor4.run(BACKWARD);}}
else if((rear>1 && rear<15)&&((Right_Value0)&&(Left_Value0))){
Motor1.setSpeed(150);
Motor1.run(FORWARD);
Motor2.setSpeed(150);
Motor2.run(FORWARD);
Motor3.setSpeed(150);
Motor3.run(FORWARD);
Motor4.setSpeed(150);
Motor4.run(FORWARD);}
else if((rear>1 && rear<15)&&((Right_Value0)&&(Left_Value1))){
for(i=3000;i>0;i–){
Motor1.setSpeed(0);
Motor1.run(FORWARD);
Motor2.setSpeed(150);
Motor2.run(FORWARD);
Motor3.setSpeed(150);
Motor3.run(FORWARD);
Motor4.setSpeed(0);
Motor4.run(FORWARD);}}
else if((rear>1 && rear<15)&&((Right_Value1)&&(Left_Value0))){
for(i=3000;i>0;i–){
Motor1.setSpeed(150);
Motor1.run(FORWARD);
Motor2.setSpeed(0);
Motor2.run(FORWARD);
Motor3.setSpeed(0);
Motor3.run(FORWARD);
Motor4.setSpeed(150);
Motor4.run(FORWARD);}}
else if((rear>1 && rear<15)&&((Right_Value1)&&(Left_Value1))){
Motor1.setSpeed(150);
Motor1.run(FORWARD);
Motor2.setSpeed(150);
Motor2.run(FORWARD);
Motor3.setSpeed(150);
Motor3.run(FORWARD);
Motor4.setSpeed(150);
Motor4.run(FORWARD);}
else if((rear>1 && rear<15)&&(head>1 && head<15)){
Motor1.setSpeed(0);
Motor1.run(RELEASE);
Motor2.setSpeed(0);
Motor2.run(RELEASE);
Motor3.setSpeed(0);
Motor3.run(RELEASE);
Motor4.setSpeed(0);
Motor4.run(RELEASE);}
}
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
