|
|
基于STM32F103C8T6單片機(jī)做的控制舵機(jī)的程序,用PWM精準(zhǔn)驅(qū)動
程序如下：
- /***************STM32F103C8T6**********************
- * 文件名 ：main.c
- * 描述 : 舵機(jī)測試
- * 實(shí)驗(yàn)平臺：STM32F103C8T6
- * 備注 ：使用定時(shí)器來產(chǎn)生pwm波，控制舵機(jī)動作
- * 接口 ：TIM1, CH1-PB13, CH2-PB14, CH3-PB15
- ****************STM32F103C8T6**********************/
- #include "pwm_output.h"
- /* 配置TIM1復(fù)用輸出PWM時(shí)用到的I/O */
- static void TIM1_GPIO_Config(void)
- {
- GPIO_InitTypeDef GPIO_InitStructure;
- RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE);//定時(shí)器1時(shí)鐘使能
- RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);//GPIOB時(shí)鐘使能
- GPIO_InitStructure.GPIO_Pin = GPIO_Pin_13 | GPIO_Pin_14 | GPIO_Pin_15;
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;//復(fù)用推挽輸出
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
- GPIO_Init(GPIOB, &GPIO_InitStructure);
- }
- /*配置TIM1輸出的PWM信號的模式，如周期、極性、占空比 */
- static void TIM1_Mode_Config(void)
- {
- TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
- TIM_OCInitTypeDef TIM_OCInitStructure;
- /* PWM信號電平跳變值 */
- u16 CCR1_Val = 0;
- u16 CCR2_Val = 0;
- //u16 CCR3_Val = 50000;
- /* Time base configuration */
- TIM_TimeBaseStructure.TIM_Period = 20000 - 1;//定時(shí)器周期,20ms
- TIM_TimeBaseStructure.TIM_Prescaler = 72 - 1;//時(shí)鐘預(yù)分頻
- TIM_TimeBaseStructure.TIM_ClockDivision = 0;
- TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;//計(jì)數(shù)方式：向上計(jì)數(shù)
- TIM_TimeBaseInit(TIM1, &TIM_TimeBaseStructure);
- /* PWM1 Mode configuration: Channel1 */
- TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2;//選擇定時(shí)器模式：tim脈寬調(diào)制2
- TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;//比較輸出使能
- TIM_OCInitStructure.TIM_OutputNState = TIM_OutputNState_Enable;
- TIM_OCInitStructure.TIM_Pulse = CCR1_Val;
- TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_Low;//極性
- TIM_OCInitStructure.TIM_OCNPolarity = TIM_OCNPolarity_High;//開反向通道
- TIM_OCInitStructure.TIM_OCIdleState = TIM_OCIdleState_Set;
- TIM_OCInitStructure.TIM_OCNIdleState = TIM_OCIdleState_Reset;
- TIM_OC1Init(TIM1, &TIM_OCInitStructure);
- TIM_OC1PreloadConfig(TIM1, TIM_OCPreload_Enable);
- /* PWM1 Mode configuration: Channel2 */
- TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2;
- TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
- TIM_OCInitStructure.TIM_OutputNState = TIM_OutputNState_Enable;
- TIM_OCInitStructure.TIM_Pulse = CCR2_Val;
- TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_Low;
- TIM_OCInitStructure.TIM_OCNPolarity = TIM_OCNPolarity_High;//開反向通道
- TIM_OCInitStructure.TIM_OCIdleState = TIM_OCIdleState_Set;
- TIM_OCInitStructure.TIM_OCNIdleState = TIM_OCIdleState_Reset;
- TIM_OC2Init(TIM1, &TIM_OCInitStructure);
- TIM_OC2PreloadConfig(TIM1, TIM_OCPreload_Enable);
- /* PWM1 Mode configuration: Channel3 */
- /*
- TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2;
- TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
- TIM_OCInitStructure.TIM_OutputNState = TIM_OutputNState_Enable;
- TIM_OCInitStructure.TIM_Pulse = CCR3_Val;
- TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_Low;
- TIM_OCInitStructure.TIM_OCNPolarity = TIM_OCNPolarity_Low;//開反向通道
- TIM_OCInitStructure.TIM_OCIdleState = TIM_OCIdleState_Set;
- TIM_OCInitStructure.TIM_OCNIdleState = TIM_OCIdleState_Reset;
- TIM_OC3Init(TIM1, &TIM_OCInitStructure);
- TIM_OC3PreloadConfig(TIM1, TIM_OCPreload_Enable); */
- TIM_ARRPreloadConfig(TIM1, ENABLE);
- /* TIM1 enable counter */
- TIM_Cmd(TIM1, ENABLE);
- TIM_CtrlPWMOutputs(TIM1, ENABLE);
- }
- /*配置和初始化TIM1 */
- void TIM1_PWM_Init(void)
- {
- TIM1_GPIO_Config();
- TIM1_Mode_Config();
- }
- //粗略延時(shí) 不精確！
- void Delay_us(unsigned int i)
- {
- unsigned char t = 0;
- for(;i>0;i--)
- {
- for(t=0;t<10;t++)
- {
- }
- }
- }
- void Delay_ms(unsigned int i)
- {
- for(;i>0;i--)
- {
- Delay_us(1000);
- }
- }
- //舵機(jī)擺動
- void Servo_out (void)
- {
- TIM1->CCR1 = 2000;//pwm波高電平持續(xù)時(shí)間，2ms
- Delay_ms(2000);
- while(1)
- {
- TIM1->CCR1 = 1500;
- Delay_ms(1000);
- TIM1->CCR1 = 2500;
- Delay_ms(1000);
- }
- }
|
|
[復(fù)制鏈接]
