标题: 关于数字舵机和模拟舵机单片机驱动程序区别 [打印本页]
作者: 茂名叻仔    时间: 2022-5-18 20:25
标题: 关于数字舵机和模拟舵机单片机驱动程序区别
求大神解答，我用51单片机驱动SG90模拟舵机，功能正常可以从0°转到180°自由控制，但是用同样的代码驱动，驱动数字舵机MG90s，数字舵机会乱转，上网百度后发现是不同类型的舵机，但是驱动参考程序，众说纷纭，有些说数字舵机和模拟舵机驱动代码是一样的，但烧写代码进去，SG90可以正常转动，MG90s用一样的代码会乱转角度。

机械臂旋转单片机源程序如下:
  1. #include <reg52.h>
  2. #include <intrins.h>
  3. #include "Delay.h"
  4. #include "Timer0.h"
  5. #include "LCD1602.h"
  6. #include "MatrixKey.h"


  9. //extern MatrixKey();

  11. sbit SG0_PWM=P2^0;
  12. sbit SG1_PWM=P2^1;

  14. unsigned char PWM0_Count=0,PWM1_Count=0;
  15. unsigned char Keynum;
  16. unsigned char Displaynum,Displaynum2;

  18. /*       
  19.                 PWM0_Count=1;          //舵机转动0度

  21.                 PWM0_Count=2;          //舵机转动45度

  23.                 PWM0_Count=3;          //舵机转动90度

  25.                 PWM0_Count=4;          //舵机转动135度

  27.                 PWM0_Count=5;          //舵机转动180度
  28. */
  29. void Keyscan()
  30. {
  31.         if(Keynum==1)
  32.         {
  33.                 PWM0_Count=1;
  34.                 Displaynum=0;
  35.         }
  36.         if(Keynum==2)
  37.         {
  38.                 PWM0_Count=2;
  39.                 Displaynum=45;
  40.         }
  41.         if(Keynum==3)
  42.         {
  43.                 PWM0_Count=3;
  44.                 Displaynum=90;
  45.         }
  46.         if(Keynum==4)
  47.         {
  48.                 PWM0_Count=4;
  49.                 Displaynum=180;
  50.         }
  51. }

  53. void Keyscan2()
  54. {
  55.         if(Keynum==5)
  56.         {
  57.                 PWM1_Count=1;
  58.         }
  59.         if(Keynum==6)
  60.         {
  61.                 PWM1_Count=2;
  62.         }
  63.         if(Keynum==7)
  64.         {
  65.                 PWM1_Count=3;
  66.         }
  67.         if(Keynum==8)
  68.         {
  69.                 PWM1_Count=4;
  70.         }       
  71. }

  73. void main()
  74. {
  75.   Timer0_Init();
  76.         LCD_Init();
  77.         while(1)
  78.         {
  79.                 Keynum=MatrixKey();
  80.                 Keyscan();
  81.                 Keyscan2();
  82.                 LCD_ShowString(1,1,"angle");
  83.                 LCD_ShowString(1,6,":");
  84.                 LCD_ShowString(1,8,"upper");
  85.                 LCD_ShowString(1,13,":");
  86.                 LCD_ShowString(2,1,"lower");
  87.                 LCD_ShowString(2,6,":");
  88.                 LCD_ShowNum(1,14,Displaynum,3);
  89.                 LCD_ShowNum(2,7,Displaynum2,3);
  90.         }
  91. }

  93. void Timer0_Routine() interrupt 1 //500us重装一次初值0.5ms
  94. {
  95.         static unsigned int T0Count;
  96.         TH0 = 0xFE;       
  97.         TL0 = 0x33;
  98.         T0Count++;//自增到20
  99.         T0Count%=40;//产生20ms的方波
  100.         if(T0Count<PWM0_Count)
  101.         {
  102.                 SG0_PWM=1;
  103.         }
  104.         else
  105.         {
  106.                 SG0_PWM=0;
  107.         }
  108.        
  109.         if(T0Count<PWM1_Count)
  110.         {
  111.                 SG1_PWM=1;
  112.         }
  113.         else
  114.         {
  115.                 SG1_PWM=0;
  116.         }       
  117. }
复制代码

Keil代码下载: 机械臂旋转.rar (42.61 KB, 下载次数: 10)
作者: yzwzfyz    时间: 2022-5-19 11:20
先弄清楚：数字舵机、模拟舵机的驱动原理。
作者: 啤酒瓶子老大    时间: 2022-5-19 12:30
模拟舵机一般是用一个持续不断的波长20ms的PWM信号控制的。
数字舵机就是一个设备，比如串口舵机，用的是串口的通讯协议，发送是类似是先发送舵机地址，后面是指令。（这个具体我也没研究过）
驱动程序根本就不一样。
要多用百度的同时更要擦亮双眼，有时搜到的结果是错的。百度只负责搜索，内容是什么是对是错他不负责。



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