标题: STM32两台舵机控制程序 [打印本页]

作者: 枫麟胤    时间: 2021-7-25 09:34
标题: STM32两台舵机控制程序
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "key.h"
  4. #include "sys.h"
  5. #include "usart.h"
  6. #include "timer.h"


  7.        
  8. int main(void)
  9. {
  10.         u16 i=0,j=0;
  11.         delay_init(); //延时函数初始化
  12.         LED_Init();        //LED端口初始化
  13.         TIM3_PWM_Init(1999,719);
  14.         TIM1_PWM_Init(1999,719); //不分频,PWM频率=72000000/720/2000=50hz       
  15.         while(1)
  16.         {       
  17.                 for(i=1950;i>1749;i--){
  18.                         TIM_SetCompare1(TIM1,i); //对应0度                2.5%
  19.                     delay_ms(10);       
  20.                 }
  21.                 for(i=1750;i<1951;i++){
  22.                         TIM_SetCompare1(TIM1,i); //对应0度                2.5%
  23.                     delay_ms(10);
  24.                 }
  25.                 for(i=1750;j<1951;j++){
  26.                         LED0_PWM_VAL=j;
  27.                         delay_ms(10);
  28.                 }
  29.                 for(i=1951;j>1749;j--){
  30.                         LED0_PWM_VAL=j;
  31.                         delay_ms(10);
  32.                 }  
  33.         }
  34. }


复制代码
  1. #include "timer.h"
  2. #include "led.h"
  3. #include "usart.h"


  4. void TIM3_PWM_Init(u16 arr,u16 psc)
  5. {                                                          
  6.         //此部分需手动修改IO口设置
  7.         RCC->APB1ENR|=1<<1;         //TIM3时钟使能   
  8.         RCC->APB2ENR|=1<<3;            //使能PORTB时钟       
  9.         GPIOB->CRL&=0XFF0FFFFF;        //PB5输出
  10.         GPIOB->CRL|=0X00B00000;        //复用功能输出                    
  11.           
  12.         RCC->APB2ENR|=1<<0;     //开启辅助时钟          
  13.         AFIO->MAPR&=0XFFFFF3FF; //清除MAPR的[11:10]
  14.         AFIO->MAPR|=1<<11;      //部分重映像,TIM3_CH2->PB5

  15.         TIM3->ARR=arr;                        //设定计数器自动重装值
  16.         TIM3->PSC=psc;                        //预分频器不分频
  17.        
  18.         TIM3->CCMR1|=7<<12;          //CH2 PWM2模式                 
  19.         TIM3->CCMR1|=1<<11;         //CH2预装载使能          
  20.         TIM3->CCER|=1<<4;           //OC2 输出使能          
  21.         TIM3->CR1=0x0080;           //ARPE使能
  22.         TIM3->CR1|=0x01;            //使能定时器3                                                                                           
  23. }           


  24. void TIM1_PWM_Init(u16 arr,u16 psc)
  25. {
  26.     GPIO_InitTypeDef GPIO_InitStructure;
  27.     TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
  28.     TIM_OCInitTypeDef  TIM_OCInitStructure;
  29.        
  30.     RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE);//
  31.     RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA , ENABLE);  //使能GPIO外设时钟使能
  32.    //设置该引脚为复用输出功能,输出TIM1 CH1的PWM脉冲波形
  33.     GPIO_InitStructure.GPIO_Pin = GPIO_Pin_8; //TIM_CH1
  34.     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;  //复用推挽输出
  35.     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  36.     GPIO_Init(GPIOA, &GPIO_InitStructure);
  37.        
  38.   TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值  80K
  39.   TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值  不分频
  40.   TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim
  41.   TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式
  42.   TIM_TimeBaseInit(TIM1, &TIM_TimeBaseStructure); //根据     TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
  43.   
  44.         TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2; //选择定时器模式:TIM脉冲宽度调制模式2
  45.   TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能
  46.   TIM_OCInitStructure.TIM_Pulse = 0; //设置待装入捕获比较寄存器的脉冲值
  47.   TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //输出极性:TIM输出比较极性高
  48.   TIM_OC1Init(TIM1, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx

  49.   TIM_CtrlPWMOutputs(TIM1,ENABLE);  //MOE 主输出使能
  50.   TIM_OC1PreloadConfig(TIM1, TIM_OCPreload_Enable);  //CH1预装载使能     
  51.   TIM_ARRPreloadConfig(TIM1, ENABLE); //使能TIMx在ARR上的预装载寄存器
  52.   TIM_Cmd(TIM1, ENABLE);  //使能TIM1
  53. }
复制代码

Keil代码工程放51hei附件里面了: 两台舵机.7z (185.19 KB, 下载次数: 25)





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