标题: STM32控制两路舵机程序 可直接输入角度较方便 [打印本页]
作者: 末影花椒    时间: 2022-4-6 16:05
标题: STM32控制两路舵机程序 可直接输入角度较方便
void SG90_Init1(float angle)     //angle是要转的角度
{   angle=(u16)(50.0*angle/9.0+249.0);
    TIM_SetCompare1(TIM5,angle);
}


void SG90_Init2(float angle)
{   angle=(u16)(50.0*angle/9.0+249.0);
    TIM_SetCompare2(TIM5,angle);
}


  1. #include "led.h"
  2. #include "delay.h"
  3. #include "key.h"
  4. #include "sys.h"
  5. #include "usart.h"
  6. #include "timer.h"

  8. void SG90_Init1(float angle)     //angle是要转的角度
  9. {   angle=(u16)(50.0*angle/9.0+249.0);
  10.     TIM_SetCompare1(TIM5,angle);
  11. }

  13. void SG90_Init2(float angle)
  14. {   angle=(u16)(50.0*angle/9.0+249.0);
  15.     TIM_SetCompare2(TIM5,angle);
  16. }


  19. int main(void)
  20. {   int i;
  21.     delay_init();
  22.     PWM5_Init(9999,143);//不分频。PWM频率=72*10^6/(9999+1)/(143+1)=50Hz 即 20ms一个周期
  23.     SG90_Init1(0);     //舵机转到零度
  24.         while(1)
  25.         {
  26.         for(i=0;i<=180;i=i+10)//舵机每次转10度，转到180回零
  27.                 {
  28.                 SG90_Init1(i);//信号线1  A0
  29.                 SG90_Init2(i);//信号线2  A1
  30.                 delay_ms(1000);
  31.                        
  32.                 }
  33.         if(i>=180)
  34.                 {
  35.         i=0;
  36.         }

  38.         }



  42. }

复制代码

Keil代码下载: 两路舵机.7z (188.11 KB, 下载次数: 30)




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