標題: 基于LDC1314的循跡程序源碼 [打印本頁]
作者: yuguoyu123456    時間: 2018-7-19 19:25
標題: 基于LDC1314的循跡程序源碼
基于LDC1314的循跡
  1. void main（ void ）

  3. 　　{

  5. 　　P2SEL &=~ BIT7; //蜂鳴器

  7. 　　P2DIR |= BIT7;

  9. 　　P2OUT &=~ BIT7;

  11. 　　InitSys（）;

  13. 　　InitLDC1314（）;

  15. 　　Ini_Lcd（）;

  17. 　　P6SEL=0;P6DIR|=BIT0+BIT1;P6OUT&=~（BIT0+BIT1）; //電機旋轉(zhuǎn)方向

  19. 　　_EINT（）;

  21. 　　int i;

  23. 　　InitPWM（0x03E8）; //PWM初始化，采用TB輸出2路PWM波

  25. 　　TBCCR1=TBCCR2=0;

  27. 　　for（i=0;i《1500;i++） // 電感傳感器自校準

  29. 　　{

  31. 　　D1=LDC1314_Result（1）;

  33. 　　D2=LDC1314_Result（2）;

  35. 　　D3=LDC1314_Result（3）;

  37. 　　}

  39. 　　initTA（）; // 定時器A初始化，用于計時

  41. 　　go（）; //直行

  43. 　　TIme=mc=sx=0; //開始執(zhí)行 時間路程清零

  45. 　　while（1）

  47. 　　{

  49. 　　Component_Display（4，0，TIme）;//時間

  51. 　　sl=（int）（（float）sx*3.0）;

  53. 　　Component_Display（4，4，sl）; //路程

  55. 　　if（sl》800）{while（1）;_DINT（）;TBCCR1=TBCCR2=0;} //到達終點 結(jié)束

  57. 　　value1 = LDC1314_Result（1）; Component_Display（1，1，value1）;//顯示通道1

  59. 　　value2 = LDC1314_Result（2）; Component_Display（2，1，value2）;

  61. 　　value3 = LDC1314_Result（3）; Component_Display（3，1，value3）;//顯示

  63. 　　// 硬幣的檢測

  65. 　　if （（value1》（2+D1））|| （value2》（2+D2））|| （value3》（2+D3）） || （abs（value2-D2）》20）|| （abs（value1-D1）》20）|| （abs（value3-D3）》20））

  67. 　　P2OUT |=BIT7;

  69. 　　else

  71. 　　P2OUT &=~BIT7;

  73. 　　//循跡

  75. 　　if（（abs（value3-D3）《20）&&（D3》value3）） { turn_r（）; }

  77. 　　else if（（abs（value1-D1）《20）&&（D1》value1）） { turn_l（）; }

  79. 　　else go（）;

  81. 　　}

  83. 　　}


復制代碼


基于LDC1314的循跡 單片機程序源碼.docx

11.92 KB, 下載次數(shù): 12, 下載積分: 黑幣 -5





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