当前位置:   article > 正文

STM32F103C8T6———180度舵机(来回转)_stm32驱动180°舵机

stm32驱动180°舵机

注意:

1、供电:舵机需要至少 5.0V 供电;

2、使用TIM2,舵机A1。

直接上代码:

Timer.c:

  1. #include "stm32f10x.h" // Device header
  2. #include "Timer.h"
  3. void Timer_Init(void)
  4. {
  5. TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure;
  6. NVIC_InitTypeDef NVIC_InitStructure;
  7. RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
  8. TIM_TimeBaseInitStructure.TIM_Period = 50000+1;
  9. TIM_TimeBaseInitStructure.TIM_Prescaler = 7199+1;
  10. TIM_TimeBaseInitStructure.TIM_CounterMode = TIM_CounterMode_Up;
  11. TIM_TimeBaseInitStructure.TIM_ClockDivision = TIM_CKD_DIV1;
  12. TIM_TimeBaseInit(TIM2, &TIM_TimeBaseInitStructure);
  13. TIM_ITConfig(TIM2, TIM_IT_Update, ENABLE);
  14. TIM_Cmd(TIM2, ENABLE);
  15. NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn;
  16. NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority =15;
  17. NVIC_InitStructure.NVIC_IRQChannelSubPriority = 15;
  18. NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
  19. NVIC_Init(&NVIC_InitStructure);
  20. }

Timer.h:

  1. #ifndef __TIMER_H
  2. #define __TIMER_H
  3. void Timer_Init(void);
  4. #endif

PWM.c:

  1. #include "stm32f10x.h" // Device header
  2. void PWM_Init(void)
  3. {
  4. RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
  5. RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);
  6. GPIO_InitTypeDef GPIO_InitStructure;
  7. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
  8. GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;
  9. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  10. GPIO_Init(GPIOA, &GPIO_InitStructure);
  11. TIM_InternalClockConfig(TIM2);
  12. TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure;
  13. TIM_TimeBaseInitStructure.TIM_ClockDivision = TIM_CKD_DIV1;
  14. TIM_TimeBaseInitStructure.TIM_CounterMode = TIM_CounterMode_Up;
  15. TIM_TimeBaseInitStructure.TIM_Period = 20000 - 1; //ARR
  16. TIM_TimeBaseInitStructure.TIM_Prescaler = 72 - 1; //PSC
  17. TIM_TimeBaseInitStructure.TIM_RepetitionCounter = 0;
  18. TIM_TimeBaseInit(TIM2, &TIM_TimeBaseInitStructure);
  19. TIM_OCInitTypeDef TIM_OCInitStructure;
  20. TIM_OCStructInit(&TIM_OCInitStructure);
  21. TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;
  22. TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
  23. TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
  24. TIM_OCInitStructure.TIM_Pulse = 0; //CCR
  25. TIM_OC2Init(TIM2, &TIM_OCInitStructure);
  26. TIM_Cmd(TIM2, ENABLE);
  27. }
  28. void PWM_SetCompare2(uint16_t Compare)
  29. {
  30. TIM_SetCompare2(TIM2, Compare);
  31. }
  32. void Servo_SetAngle(float Angle)
  33. {
  34. PWM_SetCompare2(Angle / 180 * 2000 + 500);
  35. }

PWM.h:

  1. #ifndef __PWM_H
  2. #define __PWM_H
  3. #include "stm32f10x.h" // Device header
  4. void PWM_Init(void);
  5. void PWM_SetCompare2(uint16_t Compare);
  6. void Servo_SetAngle(float Angle);
  7. #endif

main.c:

  1. #include "stm32f10x.h" // Device header
  2. #include "Delay.h"
  3. #include "PWM.h"
  4. #include "Timer.h"
  5. float Angle;//控制角度
  6. int main(void)
  7. {
  8. Timer_Init();
  9. PWM_Init();
  10. Angle=-16; //Angle的值可以修改
  11. while (1)
  12. {
  13. Servo_SetAngle(Angle);
  14. }
  15. }

中断服务程序:

  1. extern float Angle;
  2. unsigned char num=0;
  3. void TIM2_IRQHandler(void)
  4. {
  5. if (TIM_GetITStatus(TIM2, TIM_IT_Update) == SET)
  6. {
  7. TIM_ClearITPendingBit(TIM2, TIM_IT_Update);
  8. if(num == 0)
  9. {
  10. if(Angle < 195)
  11. {
  12. Angle=Angle+2;
  13. }
  14. else num=num+1;
  15. }
  16. if(num == 1)
  17. {
  18. if(Angle > -16)
  19. {
  20. Angle=Angle-2;
  21. }
  22. else num=num-1;
  23. }
  24. }
  25. }

  能用的支持一波!!!

声明:本文内容由网友自发贡献,转载请注明出处:【wpsshop】
推荐阅读
相关标签
  

闽ICP备14008679号