设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › 24小时必答区 › 求直流伺服电机怎么控制输出脉冲个数转动一度角度，哪位 ...
返回列表 发新帖
查看: 3575|回复: 2
打印 上一主题 下一主题
收起左侧

求直流伺服电机怎么控制输出脉冲个数转动一度角度，哪位大佬能改下我这程序

[复制链接]
跳转到指定楼层
楼主
ID:541229 发表于 2019-5-30 21:30 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
哪位大佬能看看我这程序，为啥我按键输入一度角度值，电机不能转转动对应角度，是脉冲函数部分错了吗，会的大佬能不能改一下，有感谢


单片机源程序如下:
  1. #include <reg52.h>
  2. #include<string.h>
  3. #include <intrins.h>
  4. #define uchar unsigned char
  5. #define uint unsigned int
  6.      
  7. sbit lcdrs=P2^0;       //寄存器选择，0：数据寄存器。1：为状态/命令寄存器
  8. sbit lcden=P2^1;         //--LCD控制引脚

  10. sbit angle=P3^3;                                        //测转角端口
  11. sbit ENA=P2^2;                                        //电机使能控制端
  12. sbit Zheng=P2^5;                                                //正反转电平设置端口
  13. sbit Fan=P2^6;                                               



  17. uchar Timer0_flag=0;
  18. uchar Timer0_BiaoZhi=0;//初始化占空比为1：3（高：低）
  19. uchar  da;
  20. uchar gewei;
  21. uchar shiwei;
  22. uchar baiwei;
  23. uchar n;
  24. uchar angel;
  25. int aa[3];
  26. /******标志位设置*****/
  27. uchar KEY1=0;//优先级标志
  28. uchar KEY2=0;//加速标志

  30. uchar INT1_FLAG=0;
  31. uchar COUNTER_high=0;
  32. uchar COUNTER_low=0;
  33. uchar SUM=0;
  34. uint TIMER1_COUNTER=0;
  35. uint INT1_tingzhi=0;                //在要测速时置0

  37. /****面板显示****/
  38. uchar code lcd_desktop11[]="stop";//停止
  39. uchar code lcd_desktop12[]="ford";//正转
  40. uchar code lcd_desktop13[]=" fanzhuang";//反转
  41. uchar code lcd_desktop21[]=" speedup";//加速
  42. uchar code lcd_desktop22[]=" speeddn";//减速
  43. uchar code num[]={'0','1','2','3','4','5','6','7','8','9'};//要显示的转速数字。

  45. //-----lcd液晶屏头文件-----//
  46. /**延时函数**/
  47. void delayms(uchar xms)   
  48. {
  49.         uchar i,j;
  50.         for(i=xms;i>0;i--)
  51.         for(j=110;j>0;j--);
  52. }

  54. /****LCD写命令******/
  55. void write_command(uchar com)//com写入命令
  56. {
  57.         lcdrs=0;
  58.         P0=com;
  59.         delayms(2);
  60.         lcden=1;
  61.         delayms(2);
  62.         lcden=0;
  63. }

  65. /**************LCD写数据*********/
  66. void write_data(uchar date)//数据为DATA
  67. {
  68.         lcdrs=1;
  69.         P0=date;
  70.         delayms(2);
  71.         lcden=1;
  72.         delayms(2);
  73.         lcden=0;
  74. }

  76. /********LCD初始化****************/
  77. void lcd_init()//显示模式设置
  78. {
  79.         lcden=0;
  80.         write_command(0x38);
  81.         write_command(0x0c);
  82.         write_command(0x06);
  83.         write_command(0x01);
  84. }

  86. /**电机初始化函数**/
  87. void motor_init(void)
  88. {
  89.         ENA=0;                                //        停止
  90. }

  92. void ZhongDuanKaiQi(void)
  93. {
  94.         EA=1;               
  95.         ET0=1;        //计时器0允许中断。产生脉冲。
  96.         ET1=1;        //计时器1允许中断。对低电平进行计时。
  97.         //EX1=1;        //INT0允许中断。测速。由外部来启动。
  98.         IT1=1;        //低电平触发。
  99.         PX1=0;        //低级中断。
  100.         PT0=1;
  101.         PT1=0;
  102.         TMOD=0x12;//定时器工作方式控制
  103. }
  104. /***定时器T1初始化！！！等待外部脉冲的到来***/
  105. void Timer1_init(void)
  106. {
  107.         TH1=0;
  108.         TL1=0;                //等待外部脉的到来。INT1
  109. }
  110. /*****定时T0初始化*****/
  111. void Timer0_init(void)
  112. {
  113.         TH0=0;
  114.         TL0=0;
  115.         TR0=1;
  116. }
  117. /********测速模块,显示速度*******/
  118. /*void speed_test(void)
  119. {
  120. //        TIMER1_COUNTER;
  121.         COUNTER_high=TH1;
  122.         COUNTER_low=TL1;
  123.         SUM=COUNTER_high*256+COUNTER_low+TIMER1_COUNTER*65536;//得到的是多少us。
  124.         SUM=SUM/1000;                                //化为毫秒。
  125.         SUM=1000/SUM;                                //圈每秒。
  126.         SUM=SUM*60;                                        //圈每分钟；三位数。
  127.         gewei=SUM%10;
  128.         shiwei=SUM/10%10;
  129.         baiwei=SUM/100;
  130.         write_command(0xc0);
  131.         write_data(baiwei);
  132.         write_command(0xc1);
  133.         write_data(shiwei);
  134.         write_command(0xc2);
  135.         write_data(gewei);
  136.         SUM=0;
  137.         TIMER1_COUNTER=0;               
  138. }


  141. /********外中断1函数**********/
  142. void INT1_QIDONG() interrupt 2
  143. {
  144.         INT1_tingzhi++;
  145.         if(INT1_tingzhi==5)
  146.         {
  147.                 INT1_tingzhi=5;EX1=0;//关闭中断。
  148.         }
  149.         if(INT1_tingzhi<=4)
  150.         {
  151.                 INT1_FLAG++;
  152.           if(INT1_FLAG==2)
  153.                         {
  154.                                 INT1_FLAG=0;TR1=0;speed_test();
  155.                         }
  156.                 else
  157.                         {
  158.                                 Timer1_init();
  159.                                 TR1=1;
  160.                         }
  161.         }
  162. }
  163. /******定时器T1计数*******/
  164. void Timer1_QIDONG() interrupt 3
  165. {
  166.         TIMER1_COUNTER++;
  167. }


  170. /**相位测量并输出!!!!!出现问题？？？**/
  171. /*void xiangwei_test(void)
  172. {
  173.         uchar i=0,j=0;
  174.         //while((P2^3==0)&&(P2^4==0));
  175.         //if((P2^3==0)&&(P2^4==0))
  176.         {
  177.                 //delayms(5);
  178.                 if(P2^3==1)
  179.                 {
  180.                         write_command(0x01);
  181.                         write_command(0x80);for(i=0;i<=3;i++) write_data(lcd_desktop13[i]);//反转。
  182.                         j++;//反转
  183.                 }
  184.                
  185.                 if(P2^4==1)
  186.                 {
  187.                         write_command(0x01);
  188.                         write_command(0x80);for(i=0;i<=3;i++) write_data(lcd_desktop12[i]);//正转。
  189.                         j++;
  190.                 }
  191.         }
  192. }

  194. /****T0中断发出信号并进行通道选择****/
  195. void Timer0() interrupt 1
  196. {       
  197.         Timer0_flag--;
  198.         if((Timer0_BiaoZhi)>=(Timer0_flag))
  199.         {
  200.                 if(KEY2==0)
  201.                 {
  202.                         Zheng=1;Fan=0;
  203.                 }
  204.                 else
  205.                 {
  206.                         Zheng=0;Fan=1;
  207.                 }
  208.         }
  209.         else
  210.         {
  211.                 Zheng=0;Fan=0;                               
  212.         }       
  213.         if(Timer0_flag==0) Timer0_flag=5;
  214. }


  217. void Guan(void)
  218. {
  219.         ET0=0;
  220.         EX1=0;
  221.         ET1=0;       
  222. }

  224. /*********/
  225. void pulsegenerate(){
  226.           int g,N;
  227.           N=angel*40;
  228.           for(g=0;g<N;g++)
  229.             {
  230.                                 ENA=0;
  231.                                 delayms(10);
  232.                                 ENA=1;
  233.                                 delayms(10);
  234.                                 ENA=0;
  235.                                 delayms(10);
  236.        }
  237. }

  239. void keyscan()                         //按键扫描函数
  240. {
  241.         uint i=0;
  242.                         KEY1=5;
  243.                         Fan=0;
  244.                         Zheng=0;
  245.                         //ENA=1;
  246.                         KEY2=0;//初始化为正转。
  247.                   Timer0_BiaoZhi=0;
  248.                         Timer0_flag=4;
  249.                        
  250.                         ZhongDuanKaiQi();//开启中断       
  251.                         Timer0_init();//                初始化并开始发出脉场外中断已经开启。
  252.                         EX1=1;                                        //外中断开启；测速，显示速度。五次后结束关闭外中断1。出现问题！！！
  253.                        
  254.                         write_command(0x80);
  255.                         for(i=0;i<strlen(lcd_desktop11);i++)//显示正转。
  256.                         write_data(lcd_desktop12[i]);
  257.        
  258. }
  259. /******键盘0-9输入模块*******/

  261. uchar keyin(){      //键盘
  262. uchar temp;
  263.         uchar com,com1,com2;
  264.         P1=0xf0;
  265.         if(P1!=0xf0){
  266.                 com1=P1;
  267.                 P1=0x0f;
  268.                 com2=P1;
  269.         }
  270.         P1=0xf0;
  271.         while(P1!=0xf0);
  272.                 temp=com1|com2;
  273.                 if(temp==0xee)com=0x01;
  274.                 if(temp==0xed)com=0x02;
  275.                 if(temp==0xeb)com=0x03;
  276.                 if(temp==0xde)com=0x04;
  277.                 if(temp==0xdd)com=0x05;
  278.                 if(temp==0xdb)com=0x06;
  279.                 if(temp==0xbe)com=0x07;
  280.                 if(temp==0xbd)com=0x08;
  281.                 if(temp==0xbb)com=0x09;
  282.                 if(temp==0x7e)com=0x0a;
  283.                 if(temp==0x7d)com=0x00;
  284.                 if(temp==0x7b)com=0x0b;
  285.                 return com;
  286. }
  287. void xianshi(){
  288.         uchar a;
  289.         uchar d=1;
  290.         uchar da;
  291.         P1=0xf0;
  292.         for(a=0;a<d;a++){
  293.                 int i1=0;
  294.                 while(P1==0xf0);
  295.                 da=keyin();  //调用keyin函数
  296.                
  297.                 if(da>=0x00&&da<=0x09){
  298.                                 aa[i1]=da;
  299.                                 i1++;
  300.                                 if(i1==3){
  301.                                         angel=aa[0]*100+aa[1]*10+aa[2];
  302.                                         i1=0;
  303.                                 }
  304.                         }
  305.                         Timer0_flag = angel;
  306.                 //if(da>=0x00&&da<=0x09){aa[i1]=da;i1++;if(i1==3){angel1=aa[0]*100+aa[1]*10+aa[2];i1=0;}}
  307.                 if(4==d) {
  308.                         while(1){
  309.                                 da=keyin();  //调用keyin函
  310.                                 if(da==0x0a){
  311.                                                 lcd_init();
  312.                                                 //xianshi();
  313.                                 }else if(da==0x0b){
  314.                                                 keyscan();
  315.                                 }
  316.                         }
  317.                 }
  318.                        
  319.                 if(da==0x01){
  320.                                         write_data('1');
  321.                         d++;
  322.                 }else if(da==0x02){
  323.                                         write_data('2');
  324.                         d++;
  325.                 }else if(da==0x03){
  326.                                         write_data('3');
  327.                         d++;
  328.                 }else if(da==0x04){
  329.                                         write_data('4');
  330.                         d++;
  331.                 }else if(da==0x05){
  332.                                         write_data('5');
  333.                         d++;
  334.                 }else if(da==0x06){
  335.                                         write_data('6');
  336.                         d++;
  337.                 }else if(da==0x07){
  338.                                         write_data('7');
  339.                                         d++;
  340.                 }else if(da==0x08){
  341.                                         write_data('8');
  342.                         d++;
  343.                 }else if(da==0x09){
  344.                                         write_data('9');
  345.                         d++;
  346.                 }else if(da==0x00){
  347.                                         write_data('0');
  348.                         d++;
  349.                 }/*else if(da==0x0a){
  350.                         lcd_init();
  351.                         //xianshi();
  352.                 }else if(da==0x0b){
  353.                         pulsegenerate();
  354.                                 break;
  355.                 }*/
  356.        
  357.         }
  358. }       

  360. /***************/


  363. /*****************/

  365.        
  366. /* if((key2==0)&&(KEY1=5)) //按键K2按下，（正转）只改变转向（标志位改变输出端口）
  367.         {
  368.                 delayms(10);
  369.                 if(key2==0)
  370.                 {
  371.                         while(!key1);
  372.                         KEY1=5;
  373.                         Fan=0;
  374.                         Zheng=0;
  375.                         ENA=1;
  376.                         KEY2=0;//初始化为正转。
  377.                   Timer0_BiaoZhi=0;
  378.                         Timer0_flag=4;
  379.                        
  380.                         ZhongDuanKaiQi();//开启中断       
  381.                         Timer0_init();//                初始化并开始发出脉场外中断已经开启。
  382.                         EX1=1;                                        //外中断开启；测速，显示速度。五次后结束关闭外中断1。出现问题！！！
  383.                        
  384.                         write_command(0x80);
  385.                         for(i=0;i<strlen(lcd_desktop11);i++)//显示正转。
  386.                         write_data(lcd_desktop12[i]);
  387.                 }
  388.         }
  389.        
  390.         if((key3==0)&&(KEY1=5)) //按键K3按下，（反转）只改变转向
  391.         {
  392.                 delayms(10);
  393.                 if(key3==0)
  394.                 {
  395.                         while(!key3);
  396.                         KEY2=~0;                        //反转标志。
  397.                         //KEY2=(~0);
  398.                         xiangwei_test();
  399.                         KEY1=5;
  400.                         lcd_init();
  401.                          for(n=0;n<10;n++){
  402.                                 write_data(lcd_desktop13[n]);}
  403.                 }
  404.         }
  405.    if((key4==0)&&(KEY1==5))        //按键K4按下，（加速）改变装入的数值？循环次数？执行if里面的语句，通过size++来改变幅值的频率
  406.          {
  407.                  delayms(10);
  408.                  if(key4==0)
  409.                  {
  410.                          while(!key4);
  411.                          if(Timer0_BiaoZhi<4)
  412.                          {
  413.                                  Timer0_BiaoZhi++;
  414.                          }
  415.                          else
  416.                          {
  417.                                  Timer0_BiaoZhi=4;
  418.                          }
  419.                           EX1=1;
  420.                           KEY1=5;
  421.                          lcd_init();
  422.                          for(n=0;n<8;n++){
  423.                                 write_data(lcd_desktop21[n]);}
  424.                  }
  425.                
  426.          }
  427.          
  428.          if((key5==0)&&(KEY1==5))         //按键K5按下，（减速）对其它标志位没有影响。
  429.          {
  430.                  delayms(5);
  431.                  if(key5==0)
  432.                  {
  433.                          while(!key5);
  434.                          if(Timer0_BiaoZhi==0)
  435.                          {
  436.                                  Timer0_BiaoZhi=0;
  437.                          }
  438.                          else
  439.                          {
  440.                                  Timer0_BiaoZhi--;
  441.                          }
  442.                           EX1=1;
  443.                           KEY1=5;
  444.                          lcd_init();
  445.                          for(n=0;n<8;n++){
  446.                                 write_data(lcd_desktop22[n]);}
  447.                  }
  448.          }
  449.          if((key6==0)&&(KEY1==5))//按键K6按下，电机停止转动使能端和计数启动关闭，计数器工作否？设立标志位。此按键按下后除K1外无法启动
  450.          {
  451.                  delayms(5);
  452.                  if(key6==0)
  453.                  {
  454.                          while(!key6);
  455.                          //置位，保证后续操作正常。
  456.                          
  457.                          
  458.                          
  459.                          EA=0;                                //总中断关
  460.                          motor_init();                //电机关
  461.                          lcd_init();
  462.                          Guan();
  463.                                                            
  464.                  }
  465.          }
  466. }

  468. /*主函数*/
  469. void main()
  470. {

  472.         ZhongDuanKaiQi();//初始化
  473.         motor_init();                        //电机停止
  474.         lcd_init();
  475.         while(1)
  476.         {
  477.                 xianshi();
  478.                
  479.         }
  480. }
复制代码

所有资料51hei提供下载:
lyp22.zip (84.34 KB, 下载次数: 23)


分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶顶 踩踩
回复

使用道具 举报

沙发
ID:750208 发表于 2020-5-15 12:47 来自触屏版 | 只看该作者
你的D4连在哪里啊，图中没有
回复

使用道具 举报

板凳
ID:800205 发表于 2020-7-9 10:13 | 只看该作者
你是用51做的啊
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表