标题: 51单片机控制舵机源程序 [打印本页]
作者: 西瓜太狼    时间: 2017-10-12 11:10
标题: 51单片机控制舵机源程序
所有资料51hei提供下载:
51单片机控制舵机程序.doc (31.5 KB, 下载次数: 16)


51单片机控制舵机源程序如下:
  1. #include <reg52.h>
  2. #define Stop 0    //宏定义，停止
  3. #define Left 1          //宏定义，左转
  4. #define Right 2          //宏定义，右转


  7. sbit ControlPort = P2^0;  //舵机信号端口
  8. sbit KeyLeft = P1^0;          //左转按键端口
  9. sbit KeyRight = P1^1;          //右转按键端口
  10. sbit KeyStop = P1^2;          //归位按键端口

  12. unsigned char TimeOutCounter = 0,LeftOrRight = 0;  //TimeOutCounter：定时器溢出计数          LeftOrRight：舵机左右旋转标志

  14. void InitialTimer ( void )         
  15. {
  16.     TMOD=0x10;   //定时/计数器1工作于方式1
  17.     TH1 = ( 65535 - 500 ) / 256;          //0.25ms
  18.         TL1 = ( 65535 - 500 ) % 256;
  19.     EA=1;        //开总中断
  20.     ET1=1;       //允许定时/计数器1 中断
  21.     TR1=1;       //启动定时/计数器1 中断
  22. }

  24. void ControlLeftOrRight ( void )   //控制舵机函数
  25. {
  26.         if( KeyStop == 0 )
  27.         {
  28.                 //while ( !KeyStop );           //使标志等于Stop（0），在中断函数中将用到
  29.                 LeftOrRight = Stop;
  30.         }

  32.         if( KeyLeft == 0 )
  33.         {
  34.                 //while ( !KeyLeft );           //使标志等于Left（1），在中断函数中将用到
  35.                 LeftOrRight = Left;
  36.         }

  38.         if( KeyRight == 0 )
  39.         {
  40.                 //while ( !KeyRight );   //使标志等于Right（2），在中断函数中将用到
  41.                 LeftOrRight = Right;
  42.         }

  44. }

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

  55. void Timer1 ( void ) interrupt 3  //定时器中断函数
  56. {
  57.     TH1 = ( 65535 - 500 ) / 256;
  58.         TL1 = ( 65535 - 500 ) % 256;
  59.         TimeOutCounter ++;

  61.         switch ( LeftOrRight )
  62.         {
  63.                 case 0 :          //为0时，舵机归位，脉宽1.5ms
  64.                 {
  65.                         if( TimeOutCounter <= 6 )
  66.                         {
  67.                                 ControlPort = 1;
  68.                         }
  69.                         else
  70.                         {
  71.                                 ControlPort = 0;
  72.                         }
  73.                         break;
  74.                 }
  75.                 case 1 :     //为1时，舵机左转，脉宽1ms（理论值），实际可以调试得出
  76.                 {
  77.                         if( TimeOutCounter <= 2 )
  78.                         {
  79.                                 ControlPort = 1;
  80.                         }
  81.                         else
  82.                         {
  83.                                 ControlPort = 0;
  84.                         }
  85.                         break;
  86.                 }
  87.                 case 2 :   //为2时，舵机右转，脉宽2ms（理论值），实际可以调试得出
  88.                 {
  89.                         if( TimeOutCounter <= 10 )
  90.                         {
  91.                                 ControlPort = 1;
  92.                         }
  93.                         else
  94.                         {
  95.                                 ControlPort = 0;
  96.                         }
  97.                         break;
  98.                 }
  99.                 default : break;
  100.         }
  101.         
  102.         if( TimeOutCounter == 80 )         //周期20ms（理论值），比较可靠，最好不要修改
  103.         {
  104.                 TimeOutCounter = 0;
  105.         }
  106. }
复制代码







欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1