标题: 求助：一个舵机控制小程序的编写 [打印本页]
作者: slh0721    时间: 2015-7-9 15:21
标题: 求助：一个舵机控制小程序的编写
我有个小项目上需要做一个用来控制舵机左右摆动且持续一分钟后停止的小程序。单片机用的是STC89C52RC，哪位大侠给练练手，帮忙写个C语言的。不胜感激。
作者: xtitxjg    时间: 2015-7-9 19:24
PWM20MS周期，高电平1—2SM 来回变，变一分钟
作者: jiakuo25    时间: 2015-7-10 07:06
这有个我发的舵机控制程序：http://www.51hei.com/bbs/dpj-37116-1.html
作者: slh0721    时间: 2015-7-11 17:27
你这个程序我有点看不太懂啊。
作者: slh0721    时间: 2015-7-15 00:46
有没有人劳驾写个程序啊？我试了好几次，舵机总是不动。
作者: stewart_leung    时间: 2015-8-19 12:27
同求！！！！
作者: 腾飞的龙    时间: 2015-8-23 22:27
你试试这个程序，适当改改。
  1. /****************************************************
  2. 功能：正确的3路舵机控制左，右，归中，程序
  3.         单片机：STC89C52
  4.         晶振：11.0592M
  5.         作者：苏义江
  6.         时间：2014-3-5
  7.         可以通过按键和传感器控制
  8. *****************************************************/
  9. //#include<12c5a.h>
  10. #include<reg52.h>
  11. #define uchar unsigned char
  12. #define uint unsigned int


  15. sbit moto_pwm=P1^0;//PWM输出脚控制舵机
  16. sbit moto_pwm1=P1^1;//PWM输出脚控制舵机
  17. sbit moto_pwm2=P1^2;//PWM输出脚控制舵机

  19. sbit xiaocheting=P1^3;//按键控制
  20. sbit xiaochehouti=P1^4;
  21. sbit xiaocheqianjin=P1^5;

  23. uchar pwm_lefr=0;//定义 定时器自加1变量
  24. uchar pwm_lefr1=0;//定义 定时器自加1变量
  25. uchar pwm_lefr2=0;//定义 定时器自加1变量
  26. uchar duojiguizhong=12;//舵机归中1.5ms
  27. uchar duojiguizhong1=12;//舵机归中1.5ms
  28. uchar duojiguizhong2=12;//舵机归中1.5ms


  31. void pwmmaic()//产生PWM
  32. {
  33.         if(pwm_lefr<=duojiguizhong)
  34.        
  35.                 moto_pwm=1;
  36.                 else
  37.                 moto_pwm=0;
  38.                 if(pwm_lefr>=200)
  39.                 pwm_lefr=0;       
  40. if(pwm_lefr1<=duojiguizhong1)
  41.        
  42.                 moto_pwm1=1;
  43.                 else
  44.                 moto_pwm1=0;
  45.                 if(pwm_lefr1>=200)
  46.                 pwm_lefr1=0;       
  47. if(pwm_lefr2<=duojiguizhong2)
  48.        
  49.                 moto_pwm2=1;
  50.                 else
  51.                 moto_pwm2=0;
  52.                 if(pwm_lefr2>=200)
  53.                 pwm_lefr2=0;       
  54. }
  55. void time1() interrupt 3
  56. {
  57. //        TH1=0XFf;//100us的赋值11.0592M
  58. //        TL1=0XAE;
  59.         TH1=(65536-60)/256;//100us的赋值
  60.         TL1=(65536-60)%256;
  61.         pwm_lefr++;
  62.         pwm_lefr1++;
  63.         pwm_lefr2++;
  64.         pwmmaic();
  65. }
  66. void inttime()
  67. {
  68. //        TMOD=0X10;
  69.         TMOD=0X11;
  70.         TH1=(65536-60)/256;//100us的赋值12M
  71.         TL1=(65536-60)%256;
  72. //        TH1=0XFf;//100us的赋值11.0592M
  73. //        TL1=0XAE;
  74.         ET1=1;
  75.         TR1=1;
  76.         EA=1;
  77. }
  78. void delay(uint z)
  79. {
  80.         uint x,y;
  81.         for(x=z;x>0;x--)
  82.         for(y=240;y>0;y--);
  83. }
  84. void main()
  85. {
  86.         duojiguizhong=12;//舵机归中
  87.         duojiguizhong1=12;//舵机归中
  88.         duojiguizhong2=12;//舵机归中
  89.         inttime();
  90.         while(1)
  91.         {
  92.                 if(xiaocheting==0)       
  93.                 {
  94.                         delay(10);
  95.                         if(xiaocheting==0)       
  96.                         {
  97.                                 duojiguizhong=4;
  98.                                 delay(2000);

  100.                                 duojiguizhong1=6;
  101.                                 delay(1000);

  103.                                 duojiguizhong=14;
  104.                                 delay(2000);

  106.                                 duojiguizhong1=14;
  107.                                 delay(2000);

  109.                                 while(xiaocheting==0);
  110.                                 duojiguizhong=12;//归中
  111.                                 delay(2000);
  112.                          }
  113.                          
  114.                 }
  115.        

  117.         }
  118. }
复制代码
作者: 51code    时间: 2015-9-15 21:38
有点看不懂



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