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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2048|回復(fù): 0
收起左側(cè)

舵機控制程序

[復(fù)制鏈接]
ID:275069 發(fā)表于 2018-1-12 08:33 | 顯示全部樓層 |閱讀模式
  1. //
  2. //  dji.c
  3. //  
  4. //
  5. //  Created by 倪剛 on 2018/1/12.
  6. //

  8. #include <reg52.h>
  9. #define Stop 0    //宏定義，停止
  10. #define Left 1   //宏定義，左轉(zhuǎn)
  11. #define Right 2   //宏定義，右轉(zhuǎn)

  13. sbit ControlPort = P2^0;  //舵機信號端口
  14. sbit KeyLeft = P1^0;   //左轉(zhuǎn)按鍵端口
  15. sbit KeyRight = P1^1;   //右轉(zhuǎn)按鍵端口
  16. sbit KeyStop = P1^2;   //歸位按鍵端口

  18. unsigned char TimeOutCounter = 0,LeftOrRight = 0;  //TimeOutCounter：定時器溢出計數(shù)   LeftOrRight：舵機左右旋轉(zhuǎn)標(biāo)志
  19. void InitialTimer (void)
  20. {
  21.     TMOD=0x10;   //定時/計數(shù)器1工作于方式1
  22.     TH1 = ( 65535 - 500 ) / 256;   //0.25ms
  23.     TL1 = ( 65535 - 500 ) % 256;
  24.     EA=1;        //開總中斷
  25.     ET1=1;       //允許定時/計數(shù)器1 中斷
  26.     TR1=1;       //啟動定時/計數(shù)器1 中斷
  27.    
  28. }

  30. void ControlLeftOrRight ( void )   //控制舵機函數(shù)
  31. {
  32.     if( KeyStop == 0 )
  33.     {
  34.         //while ( !KeyStop );    //使標(biāo)志等于Stop（0），在中斷函數(shù)中將用到
  35.         LeftOrRight = Stop;
  36.     }
  37.     if( KeyLeft == 0 )
  38.     {
  39.         //while ( !KeyLeft );    //使標(biāo)志等于Left（1），在中斷函數(shù)中將用到
  40.         LeftOrRight = Left;
  41.     }
  42.     if( KeyRight == 0 )
  43.     {
  44.         //while ( !KeyRight );   //使標(biāo)志等于Right（2），在中斷函數(shù)中將用到
  45.         LeftOrRight = Right;
  46.     }

  48. }

  50. void main ( void )  //主函數(shù)
  51. {
  52.     InitialTimer();
  53.     for(;;)
  54.     {
  55.         ControlLeftOrRight();
  56.         
  57.     }
  58. }

  60. void Timer1 ( void ) interrupt 3  //定時器中斷函數(shù)
  61. {
  62.     TH1 = ( 65535 - 500 ) / 256;
  63.     TL1 = ( 65535 - 500 ) % 256;
  64.     TimeOutCounter ++;
  65.     switch ( LeftOrRight )
  66.     {
  67.         case 0 :   //為0時，舵機歸位，脈寬1.5ms
  68.         {
  69.             if( TimeOutCounter <= 6 )
  70.             {
  71.                 ControlPort = 1;
  72.                
  73.             } else {
  74.                 ControlPort = 0;
  75.             }
  76.             break;
  77.             
  78.         }   case 1 :     //為1時，舵機左轉(zhuǎn)，脈寬1ms（理論值），實際可以調(diào)試得出
  79.         {
  80.             if( TimeOutCounter <= 2 )
  81.             {
  82.                 ControlPort = 1;
  83.                
  84.             } else {
  85.                 ControlPort = 0;
  86.             }
  87.             break;
  88.             
  89.         }   case 2 :   //為2時，舵機右轉(zhuǎn)，脈寬2ms（理論值），實際可以調(diào)試得出
  90.         {
  91.             if( TimeOutCounter <= 10 )
  92.                  {
  93.                     ControlPort = 1;
  94.                     
  95.                 }    else     {
  96.                     ControlPort = 0;
  97.                     
  98.                      }    break;
  99.         }
  100.          default : break;
  101.     }
  102.      if( TimeOutCounter == 80 )  //周期20ms（理論值），比較可靠，最好不要修改
  103.     {
  104.         TimeOutCounter = 0;
  105.     }
  106.    
  107. }}
復(fù)制代碼


回復(fù)

使用道具 舉報

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

本版積分規(guī)則

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

Powered by 單片機教程網(wǎng)

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 色综合九九| 中文在线一区二区 | 亚洲精品国产电影 | 国产一区不卡 | 国产人免费人成免费视频 | 国产高清视频一区 | 91精品在线播放 | 成人国产网站 | 久久鲁视频| 亚洲免费精品一区 | 九九热精品在线视频 | 最近中文字幕第一页 | 日本三级电影在线观看视频 | 亚洲精品成人 | 久久久久久久国产精品 | 热99在线 | a成人| 国产在线视频在线观看 | 成人免费一区二区三区视频网站 | 亚洲人精品 | 免费av在线网站 | 国产一区二区精品在线 | 精品国产一二三区 | 久久精品欧美一区二区三区不卡 | 亚洲人在线| 97国产精品| 呦呦在线视频 | 国产精品久久久久久久久久久久久 | 日韩国产在线 | 亚洲一区中文字幕 | 精品国产欧美一区二区三区成人 | 91 久久| 久久精品二区 | 国产精品一区二区三 | 九九久久国产 | 日韩精品一区二区三区在线观看 | 中文字幕欧美日韩一区 | 日韩视频免费 | 成人精品一区二区三区中文字幕 | 日韩在线精品视频 | 国产精品久久久久久高潮 |