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

^{<li id="cmkem"></li>}

<kbd id="cmkem"><abbr id="cmkem"></abbr></kbd>

標題: 單發單收超聲波主動跟隨小車的arduino程序 [打印本頁]

作者: misterchen 時間: 2018-11-8 12:14
標題: 單發單收超聲波主動跟隨小車的arduino程序
單發單收超聲波跟隨小車程序

單片機源程序如下:

const int IN1 = 20;//定義控制IO口“D20”
const int IN2 = 21;//定義控制IO口“D21”
const int IN3 = 22;//定義控制IO口“D22”
const int IN4 = 23;//定義控制IO口“D23”
const int ENA = 3; //定義控制PWM輸出口“3”
const int ENB = 4; //定義控制PWM輸出口“4”
const int Bled = 13; //背光燈控制腳定義D13
const int buzzer= 12; //蜂鳴器控制腳定義D9
const int voltPin = A3; //定義電壓檢測接口A5模擬口。
const int LSPPin = A7; //定義電壓檢測接口A5模擬口。
const int RSPPin = A6; //定義電壓檢測接口A5模擬口。
const int FSPPin = A5; //定義電壓檢測接口A5模擬口。
int LSP=0,RSP=0,LRSP=0,FSP=0;
int chazhi=300;
void setup() {
pinMode(IN1, OUTPUT);//定義控制IO口為輸出“D2”
pinMode(IN2, OUTPUT);//定義控制IO口為輸出“D3”
pinMode(IN3, OUTPUT);//定義控制IO口為輸出“D4”
pinMode(IN4, OUTPUT);//定義控制IO口為輸出“D5”
pinMode(ENA, OUTPUT);//定義控制IO口為輸出“D4”
pinMode(ENB, OUTPUT);//定義控制IO口為輸出“D5”
pinMode(Bled, OUTPUT); //LCD背光燈控制口設置為輸出
pinMode(buzzer, OUTPUT); // 將蜂鳴器引腳9設置為輸出
Serial.begin(9600);
}
void loop() {
FSP = analogRead(FSPPin);
delay(1);
LSP = analogRead(LSPPin);
delay(1);
RSP = analogRead(RSPPin);
delay(1);
LRSP = abs(LSP - RSP);
Serial.print("robot=");
Serial.print(FSP);
Serial.print(",");
Serial.print(LSP);
Serial.print(",");
Serial.print(RSP);
Serial.print(",");
Serial.println(LRSP);
if (LSP > RSP && LRSP > chazhi) {
zuo(255);
}
if (LSP < RSP && LRSP > chazhi) {
you(255);
}
if(FSP > 20 && LRSP < 200){
qian(255);
} else
if(FSP <20){
ting();
}
}
void qian(int xo)//定義前進帶參數函數
{
digitalWrite(IN1,HIGH); //定義D2輸出高電平
digitalWrite(IN2,LOW); //定義D3輸出低電平
digitalWrite(IN3,HIGH); //定義D4輸出高電平
digitalWrite(IN4,LOW); //定義D5輸出低電平
analogWrite(ENA,xo);//定義D6輸出PWM
analogWrite(ENB,xo);//定義D7輸出PWM
}
void hou(int xo)//定義后退帶參數函數
{
digitalWrite(IN1,LOW); //定義D2輸出低電平
digitalWrite(IN2,HIGH); //定義D3輸出高電平
digitalWrite(IN3,LOW); //定義D4輸出低電平
digitalWrite(IN4,HIGH); //定義D5輸出高電平
analogWrite(ENA,xo);//定義D6輸出PWM
analogWrite(ENB,xo);//定義D7輸出PWM
}
void zuo(int xo)//定義左轉帶參數函數
{
digitalWrite(IN1,LOW); //定義D2輸出低電平
digitalWrite(IN2,HIGH); //定義D3輸出高電平
digitalWrite(IN3,HIGH); //定義D4輸出高電平
digitalWrite(IN4,LOW); //定義D5輸出低電平
analogWrite(ENA,xo);//定義D6輸出PWM
analogWrite(ENB,xo);//定義D7輸出PWM
}
void you(int xo)//定義右轉帶參數函數
{
digitalWrite(IN1,HIGH); //定義D2輸出高電平
digitalWrite(IN2,LOW); //定義D3輸出低電平
digitalWrite(IN3,LOW); //定義D4輸出低電平
digitalWrite(IN4,HIGH); //定義D5輸出高電平
analogWrite(ENA,xo);//定義D6輸出PWM
analogWrite(ENB,xo);//定義D7輸出PWM
}
void ting()//定義停止帶參數函數
{
digitalWrite(IN1,LOW); //定義D2輸出低電平
digitalWrite(IN2,LOW); //定義D3輸出低電平
digitalWrite(IN3,LOW); //定義D4輸出低電平
digitalWrite(IN4,LOW); //定義D5輸出低電平
digitalWrite(ENA,LOW);//定義D6輸出PWM
digitalWrite(ENB,LOW);//定義D7輸出PWM
}

復制代碼

所有資料51hei提供下載:

超聲波追蹤代碼.rar (1.13 KB, 下載次數: 43)

作者: admin 時間: 2018-11-8 16:01
補全原理圖或者詳細說明一下電路連接即可獲得100+黑幣

作者: xuegod 時間: 2019-9-3 23:12
謝謝，樓主

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

Powered by Discuz! X3.1

主站蜘蛛池模板：成人av电影在线 | 久热精品免费 | 羞羞视频免费在线 | 久久久国产一区 | 东京久久 | 黄色免费在线观看网址 | 中文字幕韩在线第一页 | 亚洲精品乱码久久久久久9色 | 亚洲欧美一区二区三区国产精品 | 国产精品久久a | 精品一区二区三区视频在线观看 | 中文字幕乱码一区二区三区 | 午夜私人影院 | 玖玖视频网 | 久久精品国产久精国产 | 国产精品一区二区久久 | 一级毛片视频在线 | 一区二区三区国产精品 | 欧美黄色小视频 | 欧美一区二区二区 | 观看av| 日本视频在线播放 | 亚洲欧美精品国产一级在线 | 9久9久| 欧美日韩精品中文字幕 | 日韩精品一区二区三区 | av官网在线| 亚洲一区在线日韩在线深爱 | www.久草.com| 另类在线 | 欧美日韩国产中文字幕 | 色综合久久天天综合网 | 成人在线视频一区 | 狠狠av | 91亚洲精华国产 | 国产午夜精品久久久 | 欧美一级片在线观看 | 亚洲精品视频在线看 | 久久福利网站 | 国产激情一区二区三区 | 亚洲精品一区二区三区中文字幕 |

<td id="ismww"><strong id="ismww"></strong></td>

<bdo id="ismww"></bdo>