標(biāo)題: DIY 循跡小車（加入步進(jìn)電機(jī)、超聲波） [打印本頁]
作者: admin    時(shí)間: 2013-6-2 01:26
標(biāo)題: DIY 循跡小車（加入步進(jìn)電機(jī)、超聲波）
  1. 小車程序 采用C8051f020芯片
  2. #include
  3. #include

  5. #define uchar unsigned char
  6. #define uint unsigned int
  7. #define SYSCLK 22118400
  8. sfr PH0=0xFA;
  9. sfr PH1=0xFB;
  10. sbit IN1=P3^0;
  11. sbit IN2=P3^1;
  12. sbit IN3=P3^2;
  13. sbit IN4=P3^3;
  14. sbit S1=P2^0;
  15. sbit S2=P2^1;
  16. sbit S3=P2^2;
  17. sbit S4=P2^3;
  18. sbit S5=P2^4;
  19. sbit S6=P2^5;

  21. uchar code table[]={0xC0,0xF9,0xA4,0xB0,0x99,0x92,0x82,0xF8,0x80,0x90};
  22. uint num,temp,left,right,t,r,ge,shi,bai,qian;


  25. void SYSCLK_init() //時(shí)鐘初始化
  26. {
  27. int i;
  28. OSCXCN=0x67;
  29. for(i=0;i<256;i++);
  30. while(!(OSCXCN&0x80));
  31. OSCICN=0x88;
  32. }

  34. void IO_init() //IO口初始化
  35. {
  36. XBR0=0x10;
  37. XBR1=0x00;
  38. XBR2=0x40;
  39. P0MDOUT=0xff;
  40. P3MDOUT=0xff;
  41. }

  43. void PCA_int_init() //PCA0初始化
  44. {
  45. PCA0MD=0x08; //使用系統(tǒng)時(shí)鐘 禁止中斷
  46. PCA0CPM0=0xc2;
  47. PCA0CPM1=0xc2;
  48. PCA0CN=0x40;
  49. PCA0L=0x00;
  50. PCA0H=0x00;
  51. PCA0CPL0=0x00; //設(shè)置PCA0CP0脈沖寬度
  52. PCA0CPH0=240;
  53. PCA0CPL1=0x00; //設(shè)置PCA0CP1脈沖寬度
  54. PCA0CPH1=240;
  55. }

  57. void T_init() //定時(shí)器初始化
  58. {
  59. IE=0x82;
  60. TMOD=0x01;
  61. TH0=(65536-18432)/256;
  62. TL0=(65536-18432)%256;
  63. TR0=0;
  64. }

  66. void delay1ms(uint z) //延時(shí)函數(shù)
  67. {
  68. uint x,y,i;
  69. for(y=z;y>0;y--)
  70. {
  71. for(x=0;x<10;x++)
  72. for(i=0;i<221;i++);
  73. }
  74. }

  76. void control() //方向控制
  77. {
  78. num=P2;
  79. num=num&0x3f;
  80. switch(num)
  81. {
  82. case 0x0c: //001100 011110 111111
  83. case 0x1e:
  84. case 0x3f:
  85. {
  86. PH0=0xa0; //左路電機(jī)
  87. PH1=0xa0; //右路電機(jī)
  88. } break;
  89. case 0x0e: //001110 001111 011111
  90. case 0x0f:
  91. case 0x1f:
  92. {
  93. PH0=0xa0;
  94. PH1=0x00;
  95. } break;
  96. case 0x06: //000110 000111
  97. case 0x07:
  98. {
  99. PH0=0xa0;
  100. PH1=0x00;
  101. } break;
  102. case 0x01: //000011 000001
  103. case 0x03:
  104. {
  105. PH0=0xb8;
  106. PH1=0x00;
  107. } break;
  108. case 0x1c: //011100 111100 111110
  109. case 0x3c:
  110. case 0x3e:
  111. {
  112. PH0=0x90;
  113. PH1=0xa0;
  114. } break;
  115. case 0x18: //011000 111000
  116. case 0x38:
  117. {
  118. PH0=0x80;
  119. PH1=0xa0;
  120. } break;
  121. case 0x30: //110000 100000
  122. case 0x20:
  123. {
  124. PH0=0x60;
  125. PH1=0xb8;
  126. } break;
  127. case 0x00: //000000
  128. {
  129. if(PH0<H1)
  130. {
  131. PH0=0x00;
  132. PH1=0x70;
  133. }
  134. if(PH0>H1)
  135. {
  136. PH0=0x70;
  137. PH1=0x00;
  138. }
  139. } break;
  140. }

  142. }

  144. void display(uchar qian,uchar bai,uchar shi,uchar ge) //數(shù)碼管顯示函數(shù)
  145. {
  146. if(qian!=0)
  147. {
  148. P4=0xef;
  149. P7=table[qian];
  150. delay1ms(2);
  151. }
  152. if(qian!=0||bai!=0)
  153. {
  154. P4=0xdf;
  155. P7=table[bai];
  156. delay1ms(2);
  157. }
  158. if(qian!=0||bai!=0||shi!=0)
  159. {
  160. P4=0xbf;
  161. P7=table[shi];
  162. delay1ms(2);
  163. }
  164. P4=0x7f;
  165. P7=table[ge];
  166. delay1ms(2);
  167. }

  169. void main() //主函數(shù)
  170. {
  171. WDTCN=0xde; //關(guān)閉看門狗
  172. WDTCN=0xad;
  173. SYSCLK_init();
  174. IO_init();
  175. PCA_int_init();
  176. T_init();
  177. IN1=0;
  178. IN2=1;
  179. IN3=0;
  180. IN4=1;
  181. TR0=1; //打開定時(shí)器
  182. while(1)
  183. {
  184. control();
  185. display(qian,bai,shi,ge);
  186. if(temp==1)
  187. {
  188. temp=0;
  189. ge=shi=bai=qian=0;
  190. display(qian,bai,shi,ge);
  191. for(r=0;r<5;r++)
  192. {
  193. P6=0x00;
  194. delay1ms(1000);
  195. P6=0xff;
  196. delay1ms(1000);

  198. }
  199. IN2=1;
  200. IN4=1;
  201. TR0=1;
  202. }
  203. }
  204. }

  206. void timer0() interrupt 1
  207. {
  208. TH0=(65536-18432)/256;
  209. TL0=(65536-18432)%256;
  210. t++;
  211. if(t==100)
  212. {
  213. t=0;
  214. ge++;
  215. if(ge==10) //秒計(jì)數(shù)
  216. {
  217. ge=0;
  218. shi++;
  219. }
  220. if(shi==10)
  221. {
  222. shi=0;
  223. bai++;
  224. }
  225. if(bai==10)
  226. {
  227. bai=0;
  228. qian++;
  229. }
  230. if(qian==10)
  231. ge=shi=bai=qian=0;
  232. }
  233. if(shi==5)
  234. {
  235. IN2=0;
  236. IN4=0;
  237. TR0=0;
  238. temp=1;
  239. }
  240. }
復(fù)制代碼
飛奔中


跑道


小車全景


安裝后內(nèi)部

等待下線


電源、驅(qū)動(dòng)、傳感器電路

車底傳感器


電源驅(qū)動(dòng)PCB

超聲波蔽障

超聲波蔽障

步進(jìn)電機(jī)驅(qū)動(dòng)小車


步進(jìn)電機(jī)驅(qū)動(dòng)板+電源



作者: 鮮の水晶葡萄    時(shí)間: 2013-7-31 20:26
高手在這里
作者: 申家坤    時(shí)間: 2013-8-20 10:58
高手很不錯(cuò)的制作，謝謝分享。
作者: xi_chang    時(shí)間: 2014-5-4 13:35
謝謝分享
作者: LEAVING    時(shí)間: 2014-5-5 14:21
學(xué)習(xí)了~~~~~
作者: 許你晴天柱    時(shí)間: 2014-6-2 17:35
厲害，大神！
作者: 終無畏    時(shí)間: 2014-7-31 21:05
聽說可以得金幣哇
作者: 終無畏    時(shí)間: 2014-8-1 00:37
M幣到手。。。
作者: HADES_YZ    時(shí)間: 2014-10-23 21:50
大神，真是不錯(cuò)啊
作者: xyz2014sxl    時(shí)間: 2014-10-25 10:21
很不錯(cuò)的設(shè)計(jì)
作者: blj178    時(shí)間: 2014-10-27 08:49
學(xué)習(xí)下
作者: zyqwyh    時(shí)間: 2014-11-9 11:01
不錯(cuò)學(xué) 習(xí)了
作者: zyqwyh    時(shí)間: 2014-11-9 11:05
不錯(cuò)學(xué)習(xí)了呀
作者: szzheng    時(shí)間: 2014-11-20 11:38
高手�。。。。。。。�！
作者: 日日日    時(shí)間: 2015-1-6 09:11
大神，有電路圖不
作者: whrui5033    時(shí)間: 2015-1-12 13:08
研究研究
作者: heros    時(shí)間: 2015-1-20 10:07
學(xué)習(xí)了
作者: 一把刀    時(shí)間: 2015-1-21 21:38
不錯(cuò)啊,學(xué)習(xí)了
作者: delay    時(shí)間: 2015-1-23 15:20
厲害，高手呀
作者: 蒲公英lhl    時(shí)間: 2015-1-31 12:13
好厲害啊
作者: nry928    時(shí)間: 2015-4-1 11:08
好像買這些配件來學(xué)習(xí)學(xué)習(xí)，給下配件資料別，還有196的學(xué)習(xí)版什么時(shí)候有貨
作者: lb688    時(shí)間: 2015-4-3 14:39
學(xué)習(xí)了。
作者: dzdalong    時(shí)間: 2015-4-8 00:01
樓主能分享下電路就更好了   
作者: dzdalong    時(shí)間: 2015-4-8 00:02
代碼標(biāo)注在詳細(xì)點(diǎn)就更完美了，
作者: 老大好    時(shí)間: 2015-4-8 08:03
樓主，程序和原理圖分享一下謝謝1419214137@qq.com
作者: H全新    時(shí)間: 2015-4-8 09:00
值得學(xué)習(xí)學(xué)習(xí)  .非常感謝
作者: 單片菜菜機(jī)    時(shí)間: 2015-4-8 22:04
吊的很！大神啊
作者: 6ningning    時(shí)間: 2015-4-12 14:36
做的不錯(cuò)。
作者: san    時(shí)間: 2015-4-13 20:38
我能問一下，超聲模塊可以循跡嗎？要怎么循跡，還有徹底的傳感器是什么？
作者: yyxtj    時(shí)間: 2015-4-16 20:37

好東西，學(xué)習(xí)一下，謝謝！
作者: e介草民    時(shí)間: 2017-9-27 11:06
厲害啊樓主



歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1