欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

搜索
查看: 3427|回復: 1
收起左側

51單片機控制舵機左右轉源碼

[復制鏈接]
ID:167579 發表于 2017-3-2 09:27 | 顯示全部樓層 |閱讀模式
控制舵機左右轉
下載:
舵機控制.rar (25.92 KB, 下載次數: 30)

  1. /***********************************************************
  2. 版權所有 :河池學院創新實訓中心(2/3),劉歡(1/3)
  3. 程序功能 :舵機控制
  4. 生成日期 :2009年10月30日 星期五
  5. 作  者 :劉歡
  6. 聯系方式  :(QQ)281638360  (MSN)sundayboy@live.cn
  7. 說  明 :51單片機控制舵機,按鍵實現左轉、右轉及歸位
  8.             占用定時/計數器1
  9. ************************************************************/

  10. #include <reg52.h>
  11. #define Stop 0    //宏定義,停止
  12. #define Left 1          //宏定義,左轉
  13. #define Right 2          //宏定義,右轉


  14. sbit ControlPort = P1^0;  //舵機信號端口
  15. sbit KeyLeft = P1^1;          //左轉按鍵端口
  16. sbit KeyRight = P1^2;          //右轉按鍵端口
  17. sbit KeyStop = P1^3;          //歸位按鍵端口

  18. unsigned char TimeOutCounter = 0,LeftOrRight = 0;  //TimeOutCounter:定時器溢出計數          LeftOrRight:舵機左右旋轉標志

  19. void InitialTimer ( void )         
  20. {
  21.     TMOD=0x10;   //定時/計數器1工作于方式1
  22.     TH1 = ( 65535 - 500 ) / 256;          //0.25ms
  23.         TL1 = ( 65535 - 500 ) % 256;
  24.     EA=1;        //開總中斷
  25.     ET1=1;       //允許定時/計數器1 中斷
  26.     TR1=1;       //啟動定時/計數器1 中斷
  27. }

  28. void ControlLeftOrRight ( void )   //控制舵機函數
  29. {
  30.         if( KeyStop == 0 )
  31.         {
  32.                 while ( !KeyStop );           //使標志等于Stop(0),在中斷函數中將用到
  33.                 LeftOrRight = Stop;
  34.         }

  35.         if( KeyLeft == 0 )
  36.         {
  37.                 while ( !KeyLeft );           //使標志等于Left(1),在中斷函數中將用到
  38.                 LeftOrRight = Left;
  39.         }

  40.         if( KeyRight == 0 )
  41.         {
  42.                 while ( !KeyRight );   //使標志等于Right(2),在中斷函數中將用到
  43.                 LeftOrRight = Right;
  44.         }

  45. }

  46. void main ( void )         //主函數
  47. {
  48.     InitialTimer();
  49.         for(;;)
  50.         {
  51.                 ControlLeftOrRight();
  52.         }
  53. }

  54. void Timer1 ( void ) interrupt 3  //定時器中斷函數
  55. {
  56.     TH1 = ( 65535 - 500 ) / 256;
  57.         TL1 = ( 65535 - 500 ) % 256;
  58.         TimeOutCounter ++;

  59.         switch ( LeftOrRight )
  60.         {
  61.                 case 0 :          //為0時,舵機歸位,脈寬1.5ms
  62.                 {
  63.                         if( TimeOutCounter <= 6 )
  64.                         {
  65.                                 ControlPort = 1;
  66.                         }
  67.                         else
  68.                         {
  69.                                 ControlPort = 0;
  70.                         }
  71.                         break;
  72.                 }
  73.                 case 1 :     //為1時,舵機左轉,脈寬1ms(理論值),實際可以調試得出
  74.                 {
  75.                         if( TimeOutCounter <= 2 )
  76.                         {
  77.                                 ControlPort = 1;
  78.                         }
  79.                         else
  80.                         {
  81.                                 ControlPort = 0;
  82.                         }
  83.                         break;
  84.                 }
  85.                 case 2 :   //為2時,舵機右轉,脈寬2ms(理論值),實際可以調試得出
  86.                 {
  87.                         if( TimeOutCounter <= 10 )
  88.                         {
  89.                                 ControlPort = 1;
  90.                         }
  91.                         else
  92.                         {
  93.                                 ControlPort = 0;
  94.                         }
  95.                         break;
  96.                 }
  97.                 default : break;
  98.         }
  99.        
  100.         if( TimeOutCounter == 80 )         //周期20ms(理論值),比較可靠,最好不要修改
  101.         {
  102.                 TimeOutCounter = 0;
  103.         }
  104. }
復制代碼


回復

使用道具 舉報

ID:130231 發表于 2017-3-18 13:32 | 顯示全部樓層
不錯!感謝你的分享。
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規則

小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術交流QQ群281945664

Powered by 單片機教程網

快速回復 返回頂部 返回列表