黄工无刷电机学习
登录
直播中
李丽华
7年用户
1412经验值
私信
关注
[问答]
如何利用伺服电机的指令脉冲加方向位置控制模式实现精确位置控制？
开启该帖子的消息推送
STM32
伺服电机
如何利用伺服电机的指令脉冲加方向位置控制模式实现精确位置控制？
回帖
（1）
余彦
2021-9-27 10:33:17
实验室有个项目涉及到多个步进电机以及伺服电机的控制，需要电机得到一个触发信号后精确移动一段距离。
下面以单个伺服电机控制为例，利用伺服电机的指令脉冲加方向位置控制模式实现精确位置控制。
关于伺服电机
所谓
指令脉冲+方向控制模式
就是由
一路PWM波控制电机转动，一个IO控制电机方向。PWM的占空比控制电机转速，PWM的脉冲数控制电机的转动距离。
计算方法如下：
电机转动一圈所需脉冲数=电机驱动内置编码器线数*4/电子齿轮数
4
为编码器对AB相计数模式 若仅对AB相上升沿或者下降沿计数则取2 若对AB相上升沿和下降沿都计数则取4
电子齿轮
即为电机驱动对脉冲的细分数，使控制更加精确。
例:
伺服电机编码器为2500线 驱动细分为4：1
则一圈脉冲数=2500*4/4=2500 指令脉冲频率=（需要电机运行的转速 r/min/60）*一圈的脉冲数 此次操作不涉及到电机速度控制 不做介绍
一圈所需脉冲数为2500 则一个脉冲转动1/2500圈 设电机转动一圈移动距离为C，则一个脉冲移动C/2500 所以通过对脉冲计数可以实现非常精确的位置控制。
关于PWM脉冲数精确控制
PWM脉冲数精确控制有以下三种方案：
利用延时
在开始发出脉冲的同时开始延时 时长=PWM周期*PWM脉冲数 这是非常土的方法 且弊端显而易见 一是延时使系统的实时性降低 二是精确度不高
两个定时器同步，一个发PWM波另外一个计数
即将两个定时器时基参数配置相同且同时开启 定时器在1个period中产生一个PWM脉冲 定时器2在一个period更新时产生一个中断，通过中断使计数变量加一，至设定脉冲数后关闭定时器1。 这个方法可以实现精确的脉冲数量控制，但是需要系统频繁的进入中断，如果需要20个PWM脉冲就要触发20次中断进行计数，如果需要20000个PWM脉冲则要触发20000次中断，太浪费系统资源，并且过于频繁的中断会让系统出现跑飞或者其他一些莫名其妙的错误，只有在数量比较小时才适合这种方法。
利用STM32自带的定时器主从模式进行计数
将主定时器的PWM输出脉冲作为从定时器的时钟，同时将从定时器的period设置为所需脉冲数，当从定时器产生溢出中断时则表示到达了所需脉冲数，即可在中断中关闭主定时器的PWM输出，达到精确的位移控制的目的。这种方法只需要触发一次中断，并且计数非常精确。
权衡利弊，本次使用了
方法三
，需要两个定时器资源，主控为STM32F103ZET6，选用TIM3的CH2作为PWM输出通道即主定时器为TIM3，从定时器选用TIM4。
关于STM32主从定时器
在stm32中文参考手册”定时器同步“那一小节中有详细介绍
选择使用模式1 使用一个定时器（主）作为另一个定时器（从）的预分频器
其实就是将stm32的72MHz的时钟由主定时器分为一个周期为主定时器period的新脉冲（可理解为从定时器的新时钟），在主定时器的每个period溢出的那一刻会产生更新事件，由更新事件作为从定时器的时钟。
由下表可以看到STM32 TIMX的内部连接，在程序中通过选择ITRX将主从定时器联系起来，如本程序从定时器为TIM4，主定时器选择TIM3，则应选择ITR2.
下面直接上代码：
下为伺服电机控制头文件代码
下为伺服电机控制头文件代码
#ifndef ms_counter_h
#define ms_counter_h
#include "sys.h"
#define PWM_CLK RCC_APB2Periph_GPIOC //定义PWM输出时钟
#define Motor_CCW GPIO_ResetBits(GPIOE,GPIO_Pin_5) //电机逆时针旋转
#define Motor_CW GPIO_SetBits(GPIOE,GPIO_Pin_5) //电机顺时针旋转
void Master_TIM(u16 period,u16 prescaler,u16 pulse); //主定时器配置函数
void Slave_TIM(u16 period); //从定时器配置函数
void DIR_Crl(void); //方向控制IO配置函数
#endif
下为主/从定时器配置函数代码：
#include"stm32f10x.h"
#include "MS_Counter.h"
/***************
主定时器配置函数
period:PWM周期
prescaler:预分频系数
pulse:占空比控制变量 也就是PWM有效电平的宽度
PWM输出IO为GPIOC_7
完全重映射至 TIM3_CH2
***************/
void Master_TIM(u16 period,u16 prescaler,u16 pulse)
{
TIM_OCInitTypeDef TIM_OCInitStructure; //OC2初始化结构体
TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure; //TIM3时基初始化结构体
GPIO_InitTypeDef GPIO_InitTypeStructure; //GPIO初始化结构体
RCC_APB2PeriphClockCmd(PWM_CLK|RCC_APB2Periph_GPIOB|RCC_APB2Periph_AFIO,ENABLE);
//使能PWM输出的时钟和复用IO时钟
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE); //使能主定时器时钟
GPIO_InitTypeStructure.GPIO_Mode=GPIO_Mode_Out_PP;
//沙雕核心板默认蜂鸣器开启状态，每次还要专门写代码关蜂鸣器...
GPIO_InitTypeStructure.GPIO_Pin=GPIO_Pin_8;
GPIO_InitTypeStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOB,&GPIO_InitTypeStructure);
GPIO_ResetBits(GPIOB,GPIO_Pin_8);
GPIO_InitTypeStructure.GPIO_Mode=GPIO_Mode_AF_PP; //PWM输出IO设为复用推挽
GPIO_InitTypeStructure.GPIO_Pin=GPIO_Pin_7;
GPIO_InitTypeStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOC,&GPIO_InitTypeStructure);
GPIO_PinRemapConfig(GPIO_FullRemap_TIM3,ENABLE); //完全重映射至TIM3_CH2
/*********
初始化TIM3的时基
设定PWM周期和预分频系数
*********/
TIM_TimeBaseInitStructure.TIM_ClockDivision=1; //时钟分频为1即为72MHz
TIM_TimeBaseInitStructure.TIM_CounterMode=TIM_CounterMode_Up;
TIM_TimeBaseInitStructure.TIM_Period=period;
TIM_TimeBaseInitStructure.TIM_Prescaler=prescaler;
TIM_TimeBaseInitStructure.TIM_RepetitionCounter=0;
TIM_TimeBaseInit(TIM3,&TIM_TimeBaseInitStructure);
/***********
初始化PWM输出通道OC2
设定PWM占空比
***********/
TIM_OCInitStructure.TIM_OCIdleState=ENABLE;
TIM_OCInitStructure.TIM_OCMode=TIM_OCMode_PWM1; //PWM模式1
TIM_OCInitStructure.TIM_OCPolarity=TIM_OCPolarity_High; //高电平为有效位
TIM_OCInitStructure.TIM_OutputState=ENABLE;
TIM_OCInitStructure.TIM_Pulse=pulse;
TIM_OC2Init(TIM3,&TIM_OCInitStructure);
TIM_OC2PreloadConfig(TIM3,TIM_OCPreload_Enable); //预装载TIM3的pulse值
TIM_Cmd(TIM3,DISABLE); //初始化过程中不开启TIM3
//中断响应后再开启，保证主从定时器同步工作
TIM_SelectMasterSlaveMode(TIM3,TIM_MasterSlaveMode_Enable); //TIM3选择使能主从模式主定时器
TIM_SelectOutputTrigger(TIM3,TIM_TRGOSource_Update); //TIM3选择更新事件作为
trgo触发源
}
/************
从定时器配置函数
period：TIM4的溢出值 即设定的PWM脉冲数
***********/
void Slave_TIM(u16 period)
{
NVIC_InitTypeDef NVIC_InitStructure; //中断初始化结构体
TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure; //TIM4时基初始化结构体
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4,ENABLE); //使能TIM4时钟
/********
初始化TIM4时基
设定所需PWM脉冲数
********/
TIM_TimeBaseInitStructure.TIM_ClockDivision=TIM_CKD_DIV1; //时钟不分频即直接使用
//TIM3脉冲
TIM_TimeBaseInitStructure.TIM_CounterMode=TIM_CounterMode_Up;
TIM_TimeBaseInitStructure.TIM_Period=period;
TIM_TimeBaseInitStructure.TIM_Prescaler=0; //PWM不分频
TIM_TimeBaseInitStructure.TIM_RepetitionCounter=0;
TIM_TimeBaseInit(TIM4,&TIM_TimeBaseInitStructure);
TIM_SelectSlaveMode(TIM4,TIM_SlaveMode_External1); //TIM4选择从定时器模式
TIM_SelectInputTrigger(TIM4,TIM_TS_ITR2); //TIM4选择内部触发来源为
//TIM3
TIM_Cmd(TIM4,DISABLE); //同样初始化中不使能TIM4
/***************
配置TIM4的中断
利用TIM4计数溢出作为中断事件关闭TIM3
可达到精确计数的目的
****************/
NVIC_InitStructure.NVIC_IRQChannel=TIM4_IRQn;
NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE;
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=2;
NVIC_InitStructure.NVIC_IRQChannelSubPriority=2;
NVIC_Init(&NVIC_InitStructure);
TIM_ITConfig(TIM4,TIM_IT_Update,ENABLE); //TIM4中断触发事件为update
}
/*************
方向控制IO配置函数
GPIOE_5
高电平顺时针
低电平逆时针
*************/
void DIR_Crl(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE,ENABLE);
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP;
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_5;
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOE,&GPIO_InitStructure);
}
使用按键信号来模拟外部触发信号，通过外部中断开启TIM3进行PWM输出，开启TIM4进行计数
下为按键配置代码：
#include"stm32f10x.h"
#include "key.h"
/**********
按键配置函数
通过外部按键触发中断
使主定时器发出设定数量的PWM脉冲
也可将按键改为其他触发信号接入
按键IO为 GPIOE_4
**********/
void KEY_Config(void)
{
NVIC_InitTypeDef NVIC_InitStructure; //中断初始化结构体
EXTI_InitTypeDef EXTI_InitStructure; //外部中断通道初始化结构体
GPIO_InitTypeDef GPIO_InitStructure; //按键IO初始化结构体
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE|RCC_APB2Periph_AFIO,ENABLE);
//使能按键IO时钟和复用时钟
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_IPU;
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_4;
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOE,&GPIO_InitStructure);
GPIO_EXTILineConfig(GPIO_PortSourceGPIOE,GPIO_PinSource4); //选择外部中断通道
EXTI_InitStructure.EXTI_Line=EXTI_Line4;
EXTI_InitStructure.EXTI_LineCmd=ENABLE;
EXTI_InitStructure.EXTI_Mode=EXTI_Mode_Interrupt;
EXTI_InitStructure.EXTI_Trigger=EXTI_Trigger_Falling;
EXTI_Init(&EXTI_InitStructure);
NVIC_InitStructure.NVIC_IRQChannel=EXTI4_IRQn;
NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE;
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=1;
NVIC_InitStructure.NVIC_IRQChannelSubPriority=2;
NVIC_Init(&NVIC_InitStructure);
}
下为中断服务函数：
外部按键按下后触发外部中断 在外部中断中将主从定时器同时开启 主定时器开始发出设定数量的PWM脉冲
void TIM4_IRQHandler (void) //TIM4中断服务函数
{
if (TIM_GetITStatus(TIM4,TIM_IT_Update)!=RESET)
{
TIM_Cmd(TIM3,DISABLE); //TIM4产生中断后关闭TIM3
TIM_ClearITPendingBit(TIM4,TIM_IT_Update);
}
}
void EXTI4_IRQHandler(void) //按键外部中断服务函数
{
if (EXTI_GetITStatus(EXTI_Line4)!=RESET) //按键按下后TIM3/4开启，电机动作
{
TIM_Cmd(TIM3,ENABLE);
TIM_Cmd(TIM4,ENABLE);
}
EXTI_ClearITPendingBit(EXTI_Line4);
}
下为主函数：
include "stm32f10x.h"
#include "MS_Counter.h"
#include "key.h"
#include "delay.h"
int main()
{
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //配置中断优先级
delay_init();
DIR_Crl(); //电机方向接口初始化
Motor_CCW; //控制电机逆时针旋转
Master_TIM(999,719,399); //主定时器预分频为720，周期为1000则PWM频率为100Hz
Slave_TIM(20); //设定脉冲数为20，小数量便于验证
KEY_Config();
delay_ms(10);
while(1);
}
不多不少 正好20个脉冲
实验室有个项目涉及到多个步进电机以及伺服电机的控制，需要电机得到一个触发信号后精确移动一段距离。
下面以单个伺服电机控制为例，利用伺服电机的指令脉冲加方向位置控制模式实现精确位置控制。
关于伺服电机
所谓
指令脉冲+方向控制模式
就是由
一路PWM波控制电机转动，一个IO控制电机方向。PWM的占空比控制电机转速，PWM的脉冲数控制电机的转动距离。
计算方法如下：
电机转动一圈所需脉冲数=电机驱动内置编码器线数*4/电子齿轮数
4
为编码器对AB相计数模式 若仅对AB相上升沿或者下降沿计数则取2 若对AB相上升沿和下降沿都计数则取4
电子齿轮
即为电机驱动对脉冲的细分数，使控制更加精确。
例:
伺服电机编码器为2500线 驱动细分为4：1
则一圈脉冲数=2500*4/4=2500 指令脉冲频率=（需要电机运行的转速 r/min/60）*一圈的脉冲数 此次操作不涉及到电机速度控制 不做介绍
一圈所需脉冲数为2500 则一个脉冲转动1/2500圈 设电机转动一圈移动距离为C，则一个脉冲移动C/2500 所以通过对脉冲计数可以实现非常精确的位置控制。
关于PWM脉冲数精确控制
PWM脉冲数精确控制有以下三种方案：
利用延时
在开始发出脉冲的同时开始延时 时长=PWM周期*PWM脉冲数 这是非常土的方法 且弊端显而易见 一是延时使系统的实时性降低 二是精确度不高
两个定时器同步，一个发PWM波另外一个计数
即将两个定时器时基参数配置相同且同时开启 定时器在1个period中产生一个PWM脉冲 定时器2在一个period更新时产生一个中断，通过中断使计数变量加一，至设定脉冲数后关闭定时器1。 这个方法可以实现精确的脉冲数量控制，但是需要系统频繁的进入中断，如果需要20个PWM脉冲就要触发20次中断进行计数，如果需要20000个PWM脉冲则要触发20000次中断，太浪费系统资源，并且过于频繁的中断会让系统出现跑飞或者其他一些莫名其妙的错误，只有在数量比较小时才适合这种方法。
利用STM32自带的定时器主从模式进行计数
将主定时器的PWM输出脉冲作为从定时器的时钟，同时将从定时器的period设置为所需脉冲数，当从定时器产生溢出中断时则表示到达了所需脉冲数，即可在中断中关闭主定时器的PWM输出，达到精确的位移控制的目的。这种方法只需要触发一次中断，并且计数非常精确。
权衡利弊，本次使用了
方法三
，需要两个定时器资源，主控为STM32F103ZET6，选用TIM3的CH2作为PWM输出通道即主定时器为TIM3，从定时器选用TIM4。
关于STM32主从定时器
在stm32中文参考手册”定时器同步“那一小节中有详细介绍
选择使用模式1 使用一个定时器（主）作为另一个定时器（从）的预分频器
其实就是将stm32的72MHz的时钟由主定时器分为一个周期为主定时器period的新脉冲（可理解为从定时器的新时钟），在主定时器的每个period溢出的那一刻会产生更新事件，由更新事件作为从定时器的时钟。
由下表可以看到STM32 TIMX的内部连接，在程序中通过选择ITRX将主从定时器联系起来，如本程序从定时器为TIM4，主定时器选择TIM3，则应选择ITR2.
下面直接上代码：
下为伺服电机控制头文件代码
下为伺服电机控制头文件代码
#ifndef ms_counter_h
#define ms_counter_h
#include "sys.h"
#define PWM_CLK RCC_APB2Periph_GPIOC //定义PWM输出时钟
#define Motor_CCW GPIO_ResetBits(GPIOE,GPIO_Pin_5) //电机逆时针旋转
#define Motor_CW GPIO_SetBits(GPIOE,GPIO_Pin_5) //电机顺时针旋转
void Master_TIM(u16 period,u16 prescaler,u16 pulse); //主定时器配置函数
void Slave_TIM(u16 period); //从定时器配置函数
void DIR_Crl(void); //方向控制IO配置函数
#endif
下为主/从定时器配置函数代码：
#include"stm32f10x.h"
#include "MS_Counter.h"
/***************
主定时器配置函数
period:PWM周期
prescaler:预分频系数
pulse:占空比控制变量 也就是PWM有效电平的宽度
PWM输出IO为GPIOC_7
完全重映射至 TIM3_CH2
***************/
void Master_TIM(u16 period,u16 prescaler,u16 pulse)
{
TIM_OCInitTypeDef TIM_OCInitStructure; //OC2初始化结构体
TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure; //TIM3时基初始化结构体
GPIO_InitTypeDef GPIO_InitTypeStructure; //GPIO初始化结构体
RCC_APB2PeriphClockCmd(PWM_CLK|RCC_APB2Periph_GPIOB|RCC_APB2Periph_AFIO,ENABLE);
//使能PWM输出的时钟和复用IO时钟
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE); //使能主定时器时钟
GPIO_InitTypeStructure.GPIO_Mode=GPIO_Mode_Out_PP;
//沙雕核心板默认蜂鸣器开启状态，每次还要专门写代码关蜂鸣器...
GPIO_InitTypeStructure.GPIO_Pin=GPIO_Pin_8;
GPIO_InitTypeStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOB,&GPIO_InitTypeStructure);
GPIO_ResetBits(GPIOB,GPIO_Pin_8);
GPIO_InitTypeStructure.GPIO_Mode=GPIO_Mode_AF_PP; //PWM输出IO设为复用推挽
GPIO_InitTypeStructure.GPIO_Pin=GPIO_Pin_7;
GPIO_InitTypeStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOC,&GPIO_InitTypeStructure);
GPIO_PinRemapConfig(GPIO_FullRemap_TIM3,ENABLE); //完全重映射至TIM3_CH2
/*********
初始化TIM3的时基
设定PWM周期和预分频系数
*********/
TIM_TimeBaseInitStructure.TIM_ClockDivision=1; //时钟分频为1即为72MHz
TIM_TimeBaseInitStructure.TIM_CounterMode=TIM_CounterMode_Up;
TIM_TimeBaseInitStructure.TIM_Period=period;
TIM_TimeBaseInitStructure.TIM_Prescaler=prescaler;
TIM_TimeBaseInitStructure.TIM_RepetitionCounter=0;
TIM_TimeBaseInit(TIM3,&TIM_TimeBaseInitStructure);
/***********
初始化PWM输出通道OC2
设定PWM占空比
***********/
TIM_OCInitStructure.TIM_OCIdleState=ENABLE;
TIM_OCInitStructure.TIM_OCMode=TIM_OCMode_PWM1; //PWM模式1
TIM_OCInitStructure.TIM_OCPolarity=TIM_OCPolarity_High; //高电平为有效位
TIM_OCInitStructure.TIM_OutputState=ENABLE;
TIM_OCInitStructure.TIM_Pulse=pulse;
TIM_OC2Init(TIM3,&TIM_OCInitStructure);
TIM_OC2PreloadConfig(TIM3,TIM_OCPreload_Enable); //预装载TIM3的pulse值
TIM_Cmd(TIM3,DISABLE); //初始化过程中不开启TIM3
//中断响应后再开启，保证主从定时器同步工作
TIM_SelectMasterSlaveMode(TIM3,TIM_MasterSlaveMode_Enable); //TIM3选择使能主从模式主定时器
TIM_SelectOutputTrigger(TIM3,TIM_TRGOSource_Update); //TIM3选择更新事件作为
trgo触发源
}
/************
从定时器配置函数
period：TIM4的溢出值 即设定的PWM脉冲数
***********/
void Slave_TIM(u16 period)
{
NVIC_InitTypeDef NVIC_InitStructure; //中断初始化结构体
TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure; //TIM4时基初始化结构体
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4,ENABLE); //使能TIM4时钟
/********
初始化TIM4时基
设定所需PWM脉冲数
********/
TIM_TimeBaseInitStructure.TIM_ClockDivision=TIM_CKD_DIV1; //时钟不分频即直接使用
//TIM3脉冲
TIM_TimeBaseInitStructure.TIM_CounterMode=TIM_CounterMode_Up;
TIM_TimeBaseInitStructure.TIM_Period=period;
TIM_TimeBaseInitStructure.TIM_Prescaler=0; //PWM不分频
TIM_TimeBaseInitStructure.TIM_RepetitionCounter=0;
TIM_TimeBaseInit(TIM4,&TIM_TimeBaseInitStructure);
TIM_SelectSlaveMode(TIM4,TIM_SlaveMode_External1); //TIM4选择从定时器模式
TIM_SelectInputTrigger(TIM4,TIM_TS_ITR2); //TIM4选择内部触发来源为
//TIM3
TIM_Cmd(TIM4,DISABLE); //同样初始化中不使能TIM4
/***************
配置TIM4的中断
利用TIM4计数溢出作为中断事件关闭TIM3
可达到精确计数的目的
****************/
NVIC_InitStructure.NVIC_IRQChannel=TIM4_IRQn;
NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE;
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=2;
NVIC_InitStructure.NVIC_IRQChannelSubPriority=2;
NVIC_Init(&NVIC_InitStructure);
TIM_ITConfig(TIM4,TIM_IT_Update,ENABLE); //TIM4中断触发事件为update
}
/*************
方向控制IO配置函数
GPIOE_5
高电平顺时针
低电平逆时针
*************/
void DIR_Crl(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE,ENABLE);
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP;
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_5;
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOE,&GPIO_InitStructure);
}
使用按键信号来模拟外部触发信号，通过外部中断开启TIM3进行PWM输出，开启TIM4进行计数
下为按键配置代码：
#include"stm32f10x.h"
#include "key.h"
/**********
按键配置函数
通过外部按键触发中断
使主定时器发出设定数量的PWM脉冲
也可将按键改为其他触发信号接入
按键IO为 GPIOE_4
**********/
void KEY_Config(void)
{
NVIC_InitTypeDef NVIC_InitStructure; //中断初始化结构体
EXTI_InitTypeDef EXTI_InitStructure; //外部中断通道初始化结构体
GPIO_InitTypeDef GPIO_InitStructure; //按键IO初始化结构体
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE|RCC_APB2Periph_AFIO,ENABLE);
//使能按键IO时钟和复用时钟
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_IPU;
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_4;
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOE,&GPIO_InitStructure);
GPIO_EXTILineConfig(GPIO_PortSourceGPIOE,GPIO_PinSource4); //选择外部中断通道
EXTI_InitStructure.EXTI_Line=EXTI_Line4;
EXTI_InitStructure.EXTI_LineCmd=ENABLE;
EXTI_InitStructure.EXTI_Mode=EXTI_Mode_Interrupt;
EXTI_InitStructure.EXTI_Trigger=EXTI_Trigger_Falling;
EXTI_Init(&EXTI_InitStructure);
NVIC_InitStructure.NVIC_IRQChannel=EXTI4_IRQn;
NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE;
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=1;
NVIC_InitStructure.NVIC_IRQChannelSubPriority=2;
NVIC_Init(&NVIC_InitStructure);
}
下为中断服务函数：
外部按键按下后触发外部中断 在外部中断中将主从定时器同时开启 主定时器开始发出设定数量的PWM脉冲
void TIM4_IRQHandler (void) //TIM4中断服务函数
{
if (TIM_GetITStatus(TIM4,TIM_IT_Update)!=RESET)
{
TIM_Cmd(TIM3,DISABLE); //TIM4产生中断后关闭TIM3
TIM_ClearITPendingBit(TIM4,TIM_IT_Update);
}
}
void EXTI4_IRQHandler(void) //按键外部中断服务函数
{
if (EXTI_GetITStatus(EXTI_Line4)!=RESET) //按键按下后TIM3/4开启，电机动作
{
TIM_Cmd(TIM3,ENABLE);
TIM_Cmd(TIM4,ENABLE);
}
EXTI_ClearITPendingBit(EXTI_Line4);
}
下为主函数：
include "stm32f10x.h"
#include "MS_Counter.h"
#include "key.h"
#include "delay.h"
int main()
{
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //配置中断优先级
delay_init();
DIR_Crl(); //电机方向接口初始化
Motor_CCW; //控制电机逆时针旋转
Master_TIM(999,719,399); //主定时器预分频为720，周期为1000则PWM频率为100Hz
Slave_TIM(20); //设定脉冲数为20，小数量便于验证
KEY_Config();
delay_ms(10);
while(1);
}
不多不少 正好20个脉冲
举报
更多回帖
rotate(-90deg);
回复
相关问答
STM32
伺服电机
如何去
实现
步进
电机
的XY
精确
位置
控制
2021-10-11
1827
步进
电机
可以
实现
电机
转速和
位置
的
精确
控制
吗
2021-09-14
1632
PLC步进
电机
指令
可以
控制
伺服
电机
吗？
2023-03-30
4303
如何
利用
DSP与FPGA设计运动
控制
器？
2019-08-06
2606
求助
伺服
电机
的
控制
，速度可调又能
精确
定位
2016-07-04
10857
如何选择
伺服
电机
的
控制
方式
2021-01-22
1207
无刷
电机
做
位置
伺服
控制
的精度问题
2015-11-10
9543
求大神分享
伺服
电机
的几种常用
模式
及
控制
模式
的设置
2021-09-27
1755
如何确定选择
伺服
电机
控制
方式
2021-01-21
1770
求助毕业设计 基于Labview语言的《 交流
伺服
电机
PID
控制
...
2013-05-14
3790
发帖
登录/注册
20万+
工程师都在用，
免费
PCB检查工具
无需安装、支持浏览器和手机在线查看、实时共享
查看
点击登录
登录更多精彩功能！
英国威廉希尔公司网站
william hill官网 版块
小组
免费开发板试用
ebook
直播
搜索
登录
×
20
完善资料，
赚取积分
举报
