标题: 新人第一次共享模拟舵机控制代码 改变angle即可控制转向 [打印本页]
作者: GPPyeye    时间: 2016-4-23 16:45
标题: 新人第一次共享模拟舵机控制代码 改变angle即可控制转向
新人第一次共享模拟舵机控制代码，自己测试没问题，只要改变angle即可控制转向

源程序：

  1. #include <reg52.h>
  2. #define uint unsigned int
  3. #define uchar unsigned char
  4. //变量与引脚定义
  5. sbit dj=P1^7;        //与舵机信号线接的IO
  6. uchar pwm;                //pwm计数变量
  7. uchar angle=4;        //舵机摆臂默认转到45度，这是一个控制摆臂角度的变量，改变这个量就可以改变舵机摆臂的转角位置，范围是2~10，对应0~180度


  10. //***********************************************************************************//
  11. //软件延时，约为z毫秒
  12. void delay(uint z)
  13. {
  14.         uint x,y;
  15.         for(x=z;x>0;x--)
  16.                 for(y=110;y>0;y--);
  17. }


  20. //定时器初始化，用以模拟驱动舵机的PWM波
  21. void Timer_Init(void)
  22. {
  23.         TMOD=0x02;
  24.         TH0=6;        //设为0.25ms触发一次定时器中断
  25.         TL0=6;
  26.         ET0=1;
  27.         EA=1;
  28.         TR0=1;
  29. }
  30. //***********************************************************************************//       
  31. //主函数
  32. void main()
  33. {
  34.         Timer_Init();        //定时器初始化
  35.         angle=6;
  36. }
  37. //***********************************************************************************//
  38. //定时器中断服务程序
  39. void Time0_Isr() interrupt 1  
  40. {
  41.         pwm++;        //判断值自加一
  42.         if(pwm==angle)        //与角度变量比较
  43.         {
  44.                 dj=0;        //接舵机的IO置0
  45.         }
  46.         if(pwm==80)        //0.25*80=20ms的周期
  47.         {
  48.                 pwm=0;        //周期到，清零
  49.                 dj=1;        //接舵机的IO置1
  50.         }
  51. }
复制代码


舵机参考程序.zip

806 Bytes, 下载次数: 24, 下载积分: 黑币 -5

可以控制舵机转向需要的拿去



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