查看(RB-13K056)AS-4WD移動偵測避障機器人的源代碼

[[文件:4wdzhencebizhang.png|400px|縮略圖|右]]
==產(chǎn)品概述==
超聲波作為智能車避障的一種重要手段，以其避障實現(xiàn)便，計算簡單，易于做時控制，測量精度也能達到實用的要求，在未來汽車智能化進程中必將得到廣泛。AS-4WD 超聲偵測自主避障機器人采用RB-URF02超聲波傳感器，可使機器人像蝙蝠一樣通過聲納來感知周圍的環(huán)境，傳感器下面安裝伺服舵機可以令其具有旋轉(zhuǎn)功從而可實現(xiàn)一個傳感器多方位測距與探測避障功能。產(chǎn)品為全鋁合金車體，結(jié)實耐用，四個馬達7.2V電壓獨立驅(qū)動，動力強勁，結(jié)構(gòu)合理，便于擴展；獨立散件包裝，讓您完全體驗DIY的樂趣。

==配件參數(shù)==
===直流減速電機（1：48）===
# 驅(qū)動電機齒輪箱減速比：1:48
# 無負載轉(zhuǎn)速（3V）：168RPM
# 無負載轉(zhuǎn)速（6V）：300RPM
# 無負載時電流（3V）：90mA
# 無負載時電流（6V）：100mA
# 扭矩大小 (3V):   0.04N.m
# 扭矩大小 (6V):   0.08N.m
# 尺寸大?。?0.50 mm×27.00 mm×23.00 mm（長×寬×高）
# 重量大小:  約30g
===電控部分資料===
====Carduino UNO控制器====
[http://www.alsrobot.com.cn/wiki/index.php?title=(SKU:RB-01C076)CarDuino_UNO_R3%EF%BC%88%E7%9B%B4%E6%8F%92%E8%8A%AF%E7%89%87%EF%BC%89 Carduino UNO相關(guān)資料及使用方法]<br/>
====雙H橋電機驅(qū)動板====
[http://www.alsrobot.com.cn/wiki/index.php?title=(SKU:RB-01C025)%E5%8F%8CH%E6%A1%A5%E7%9B%B4%E6%B5%81%E7%94%B5%E6%9C%BA%E9%A9%B1%E5%8A%A8%E6%9D%BF 雙H橋電機驅(qū)動板相關(guān)資料及使用方法]<br/>
====超聲波傳感器====
[http://m.gharee.com/wiki/index.php?title=(SKU:RB-02S001)RB_URF02%E8%B6%85%E5%A3%B0%E6%B3%A2%E4%BC%A0%E6%84%9F%E5%99%A8 超聲波傳感器相關(guān)資料及使用方法]<br/>
====傳感器擴展板====
[http://www.alsrobot.com.cn/wiki/index.php?title=(SKU:RB-01C015)Arduino_%E4%BC%A0%E6%84%9F%E5%99%A8%E6%89%A9%E5%B1%95%E6%9D%BFv5.0#.E8.B4.AD.E4.B9.B0.E5.9C.B0.E5.9D.80 V5.0傳感器擴展板相關(guān)資料及使用方法]<br/>
====RB-421舵機====
[http://m.gharee.com/wiki/index.php?title=(SKU:RB-04M008)RB-421%E8%88%B5%E6%9C%BA RB-421舵機相關(guān)資料及使用方法]<br/>
==零件清單==
[[文件:4wdchaoshengboqingdan.png|600px|縮略圖|居中]]

==安裝步驟==
===充電接口撥動開關(guān)連接線制作===
[http://m.gharee.com/wiki/index.php?title=(SKU:RB-06L012)%E7%94%B5%E6%BA%90%E5%85%85%E7%94%B5%E6%8E%A5%E5%8F%A3%E8%BF%9E%E6%8E%A5%E7%BA%BF 充電接口撥動開關(guān)連接線制作步驟詳解]<br/>
===機械部分安裝步驟===
====直流電機安裝====
4WD平臺兩側(cè)電機安裝方法相同，需要注意的是在安裝電機之前需要將電機連接線使用電烙鐵焊接好，并使用熱縮過加熱塑封。<br/>
[[文件:jiansudianjianzhuang.png|700px|縮略圖|居中]]
====平臺側(cè)板安裝====
[[文件:cebanxiabananzhuang.png|700px|縮略圖|居中]]
====平臺端板安裝====
[[文件:duanbananzhuang.png|700px|縮略圖|居中]]

===電控部分安裝步驟===
[[文件:4wddiankonganzhuang00.jpg|700px|縮略圖|居中|雙H橋電機驅(qū)動板安裝示意圖]]
[[文件:4wddiankonganzhuang01.jpg|700px|縮略圖|居中|充電接口和撥動開關(guān)安裝示意圖]]
[[文件:4wddiankonganzhuang02.jpg|700px|縮略圖|居中|主控制器安裝示意圖]]
[[文件:4wddiankonganzhuang03.jpg|700px|縮略圖|居中|舵機安裝示意圖]]
[[文件:4wddiankonganzhuang04.jpg|700px|縮略圖|居中|超聲波傳感器安裝示意圖]]
[[文件:4wddiankonganzhuang05.jpg|700px|縮略圖|居中|上下兩部分安裝示意圖]]
[[文件:4wddiankonganzhuang06.jpg|700px|縮略圖|居中|4WD輪子安裝示意圖]]
[[文件:4wddiankonganzhuang07.jpg|700px|縮略圖|居中|4WD偵測避障平臺安裝完成效果圖]]

==整機實驗==
===實驗接線圖===
注意：1.超聲波傳感器在實驗中使用的是單線模式。<br/>
2.主控板采用分離供電方式，這種供電方式需要將傳感器擴展板端子旁邊的一個黃色跳線帽拔掉。<br/>
{|border="1" cellspacing="0" align="center" cellpadding="5" width="400px"
|-
|align="center"|控制器引腳
|align="center"|連接引腳
|-
|align="center"|數(shù)字口 D15（A1）
|align="center"|超聲波傳感器 input
|-
|align="center"|數(shù)字口 D8
|align="center"|RB-421舵機
|-
|align="center"|數(shù)字口 D5
|align="center"|雙H橋驅(qū)動板 EA
|-
|align="center"|數(shù)字口 D6
|align="center"|雙H橋驅(qū)動板 I2
|-
|align="center"|數(shù)字口 D7
|align="center"|雙H橋驅(qū)動板 I1
|-
|align="center"|數(shù)字口 D9
|align="center"|雙H橋驅(qū)動板 I3
|-
|align="center"|數(shù)字口 D10
|align="center"|雙H橋驅(qū)動板 I4
|-
|align="center"|數(shù)字口 D11
|align="center"|雙H橋驅(qū)動板 EB
|-
|align="center"|雙H橋驅(qū)動板 VMS
|align="center"|7.4V鋰電池 + 極
|-
|align="center"|雙H橋驅(qū)動板 VMS
|align="center"|傳感器擴展板 VIN
|-
|align="center"|雙H橋驅(qū)動板 5V
|align="center"|傳感器擴展板端子 + 極
|-
|align="center"|雙H橋驅(qū)動板 GND
|align="center"|傳感器擴展板端子 - 極
|}
<br>

===應用例程===
<pre style='color:blue'>
#include <Servo.h> 
Servo myservo;
int duration; //定義變量duration用來存儲脈沖 
int distance; //定義變量distance用來存儲距離值 
int srfPin = 15; //定義srfPin為數(shù)字口15 
int z; //定義變量Z int val; 
int val;//定義變量val 
int val1; //定義變量val1 
int val2; //定義變量val2 
void setup() 
{ 
  myservo.attach(8); //8號引腳輸出舵機控制信號 
  Serial.begin(9600); //僅能使用9、10號引腳 
  pinMode(9,OUTPUT); //定義I3接口 
  pinMode(10,OUTPUT); //定義I4接口 
  pinMode(11,OUTPUT); //定義EB(PWM調(diào)速)接口 
  pinMode(5,OUTPUT); //定義EA(PWM調(diào)速)接口 
  pinMode(6,OUTPUT); //定義I2接口 
  pinMode(7,OUTPUT); //定義I1接口 
  myservo.write(90); //使舵機轉(zhuǎn)到90度
}
void loop() 
{ 
  delay(20); //延時20毫秒 
  Goahead(); //調(diào)用前進子程序 
  val=Ultrasonic(z); //將超聲波讀取的距離值賦值給val 
  if(val<25) //判斷如果val小于25則繼續(xù)執(zhí)行 
{ 
  Stop(); //調(diào)用停止子程序 
  myservo.write(0); //讓舵機轉(zhuǎn)0度 
  delay(1000); //延時1秒等待舵機到達指定位置
  val1=Ultrasonic(z); //將超聲波讀取的距離值賦值給
  delay(1000); //延時1秒等待舵機到達指定位置 
  myservo.write(179); //讓舵機轉(zhuǎn)180度 
  delay(1000); //延時1秒等待舵機到達指定位置 
  val2=Ultrasonic(z); //將超聲波讀取的距離值賦值給val2 
  delay(1000); //延時1秒等待舵機到達指定位置 
  myservo.write(83); //讓舵機轉(zhuǎn)90度 
  delay(1000); //延時1秒 
  if(val1<val2) 
{ 
  Turn_left(); //調(diào)用左轉(zhuǎn)子程序 
  delay(200); //延時200毫秒
 } 
  else 
{ 
  Turn_right(); //調(diào)用右轉(zhuǎn)子程序 
  delay(200); //延時200毫秒 
} 
  delay(500); //延時500毫秒
  }
}
int Ultrasonic(int distance) 
{ 
  pinMode(srfPin,OUTPUT); //定義srfPin為輸出接口 
  digitalWrite(srfPin, LOW); //高電平觸發(fā)前發(fā)送2微秒的低電平 
  delayMicroseconds(2); 
  digitalWrite(srfPin, HIGH); //發(fā)送10微秒的高電平開始檢測 
  delayMicroseconds(10); 
  digitalWrite(srfPin, LOW); //等待脈沖返回前發(fā)送一個低電平 
  pinMode(srfPin, INPUT); //定義srfPin為輸入接口 
  duration = pulseIn(srfPin, HIGH); //從URF02讀取脈沖 
  distance = duration/58; //除以58得到距離值 
  return distance; 
}
void Goahead()//前進 
{ 
  analogWrite(5,165); //輸入模擬值進行設定速度 
  digitalWrite(7,LOW); //使直流電機（右）順時針轉(zhuǎn) 
  digitalWrite(6,HIGH); 
  analogWrite(11,160); //輸入模擬值進行設定速度 
  digitalWrite(9,HIGH); //使直流電機（左）逆時針轉(zhuǎn) 
  digitalWrite(10,LOW);
 } 
void Stop()//停止 
{ 
digitalWrite(6,HIGH); //使直流電機（右）制動 
digitalWrite(7,HIGH); 
digitalWrite(9,HIGH); //使直流電機（左）制動 
digitalWrite(10,HIGH); 
} 
void Turn_right()//右轉(zhuǎn) 
{ 
  analogWrite(5,170); //輸入模擬值進行設定速度 
  digitalWrite(6,LOW); //使直流電機（右）順時針轉(zhuǎn) 
  digitalWrite(7,HIGH); 
  analogWrite(11,150); //輸入模擬值進行設定速度 
  digitalWrite(9,HIGH); //使直流電機（左）逆時針轉(zhuǎn) 
  digitalWrite(10,LOW); 
} 
void Turn_left()//左轉(zhuǎn) 
{ 
  analogWrite(5,150); //輸入模擬值進行設定速度 
  digitalWrite(7,LOW); //使直流電機（右）順時針轉(zhuǎn) 
  digitalWrite(6,HIGH); 
  analogWrite(11,170); //輸入模擬值進行設定速度 
  digitalWrite(10,HIGH); //使直流電機（左）逆時針轉(zhuǎn) 
  digitalWrite(9,LOW); 
}
</pre>

==視頻演示==
[[File:4wd ding ju 01.png|400px|左|link=http://v.youku.com/v_show/id_XMzQyNzkwNzQw.html?from=y1.7-2]]
[[File:4wd zhen ce.png|400px|居中|link=http://v.youku.com/v_show/id_XMzQyNzk2MzM2.html?from=y1.7-2]]
<br/>
==產(chǎn)品相關(guān)推薦==
[[文件:erweima.png|230px|無框|右]]
===產(chǎn)品購買地址===
[http://m.gharee.com/goods-424.html AS-4WD鋁合金超聲波自主偵測避障機器人套件]<br/>
===周邊產(chǎn)品推薦===
[http://m.gharee.com/goods-407.html Arduino 4WD鋁合金移動平臺車燈套件]<br/>
[http://m.gharee.com/goods-185.html Arduino 光電碼盤 光電測速傳感器]<br/>
===相關(guān)問題解答===
[http://www.makerspace.cn/forum.php?mod=viewthread&tid=4875&highlight=4WD AS-4WD 碰撞機器人如何安裝]<br/>
[http://www.makerspace.cn/forum.php?mod=viewthread&tid=5473&fromuid=10780 4wd 紅外線巡線壁障車調(diào)試助手沒有反應]<br/>
===相關(guān)學習資料===
[http://www.makerspace.cn/forum.php?mod=viewthread&tid=3953&fromuid=10780 視頻：機器人調(diào)試助手無線操控AS-4WD輪式機器人]<br/>
[http://v.youku.com/v_show/id_XMjgwMjk0NDE2.html 視頻：Arduino-4WD移動機器人尋線功能演示]<br/>
[http://v.youku.com/v_show/id_XMjgwMjkyNDM2.html 視頻：Arduino-4WD移動機器人碰撞功能演示]<br/>
[http://v.youku.com/v_show/id_XMjgwMjk4MjU2.html 視頻：Arduino-4WD移動機器人追光功能演示]<br/>
[http://v.youku.com/v_show/id_XMjgwNTg5NTI4.html 視頻：Arduino-4WD移動機器人尋線與避障功能演示]<br/>
[http://v.youku.com/v_show/id_XMzQyNzk2MzM2.html 視頻：Arduino-4WD移動機器人偵測避障功能演示]<br/>
[http://v.youku.com/v_show/id_XNjQ2MDY0MDg=.html?from=y1.7-2 視頻：直流減速電機驅(qū)動實例]<br/>
[http://www.makerspace.cn/portal.php 奧松機器人技術(shù)論壇]<br/>