STM32 伺服电机 指令脉冲+方向位置控制模式 主从定时器 实现PWM脉冲数精确控制

最新推荐文章于 2024-06-28 19:41:04 发布
最新推荐文章于 2024-06-28 19:41:04 发布
阅读量1.7w 收藏 316
点赞数 58
文章标签： stm32
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/phcdd/article/details/117655161
版权

实验室有个项目涉及到多个步进电机以及伺服电机的控制，需要电机得到一个触发信号后精确移动一段距离。

下面以单个伺服电机控制为例，利用伺服电机的指令脉冲加方向位置控制模式实现精确位置控制。

 

关于伺服电机

所谓指令脉冲+方向控制模式 就是由一路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脉冲数精确控制有以下三种方案：

  1. 利用延时   在开始发出脉冲的同时开始延时         时长=PWM周期*PWM脉冲数                        这是非常土的方法 且弊端显而易见       一是延时使系统的实时性降低                    二是精确度不高
  2. 两个定时器同步，一个发PWM波另外一个计数      即将两个定时器时基参数配置相同且同时开启      定时器在1个period中产生一个PWM脉冲 定时器2在一个period更新时产生一个中断，通过中断使计数变量加一，至设定脉冲数后关闭定时器1。  这个方法可以实现精确的脉冲数量控制，但是需要系统频繁的进入中断，如果需要20个PWM脉冲就要触发20次中断进行计数，如果需要20000个PWM脉冲则要触发20000次中断，太浪费系统资源，并且过于频繁的中断会让系统出现跑飞或者其他一些莫名其妙的错误，只有在数量比较小时才适合这种方法。
  3. 利用STM32自带的定时器主从模式进行计数       将主定时器的PWM输出脉冲作为从定时器的时钟，同时将从定时器的period设置为所需脉冲数，当从定时器产生溢出中断时则表示到达了所需脉冲数，即可在中断中关闭主定时器的PWM输出，达到精确的位移控制的目的。这种方法只需要触发一次中断，并且计数非常精确。

 权衡利弊，本次使用了方法三，需要两个定时器资源，主控为STM32F103ZET6，选用TIM3的CH2作为PWM输出通道即主定时器为TIM3，从定时器选用TIM4。

关于STM32主从定时器

在stm32中文参考手册”定时器同步“那一小节中有详细介绍

选择使用模式1 使用一个定时器（主）作为另一个定时器（从）的预分频器

其实就是将stm32的72MHz的时钟由主定时器分为一个周期为主定时器period的新脉冲（可理解为从定时器的新时钟），在主定时器的每个period溢出的那一刻会产生更新事件，由更新事件作为从定时器的时钟。

由下表可以看到STM32 TIMX的内部连接，在程序中通过选择ITRX将主从定时器联系起来，如本程序从定时器为TIM4，主定时器选择TIM3，则应选择ITR2.

下面直接上代码：

下为伺服电机控制头文件代码

<MS_Counter.h>


#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);
	
}

通过MDK5自带的逻辑分析仪进行仿真如下

不多不少 正好20个脉冲 

Pector
关注
  • 58
    点赞
  • 踩
  • 316
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
STM32伺服电机控制器
01-23
STM32伺服电机控制，串口，支持G代码解析，移植方便，
定时器主从方式输出可控个数的PWM脉冲
12-21
STM32定时器利用主从方式的门控模式输出可控个数的PWM脉冲
STM32伺服步进定位控制源码：实现相对定位、绝对定位和回原点功能，使用梯形加减速算法精确控制运动，STM32伺服步进定位控制源码：相对定位、绝对定位、回原点与梯形加减速算法的实现与运动控制
最新发布
BpPISEnw的博客
06-28 363
通过分析STM32伺服步进定位控制源码，我们可以了解其是如何实现回原点功能的，并为实际应用中的回原点操作提供一定的参考。首先，相对定位和绝对定位是伺服步进定位控制中的两个重要概念。通过对STM32伺服步进定位控制源码的研究和分析，我们可以了解其是如何实现相对定位和绝对定位功能的。本文将围绕STM32伺服步进定位控制的源码展开，并深入探讨相对定位、绝对定位、回原点以及梯形加减速算法和运动控制方面的相关内容。STM32伺服步进定位控制源码，相对定位绝对定位，回原点，梯形加减速算法，运动控制。
STM32F103 主从模式 步进电机 精确脉冲
04-21
STM32F103使用定时器主从模式输出精确脉冲 主定时器 定时器3 从定时器 定时器2
stm32单片机控制伺服电机转动固定角度
07-20
stm32单片机控制伺服电机转动固定角度
基于STM32（HAL）的CAN通信驱动伺服电机
qq_52552006的博客
07-13 6707
基于STM32（HAL库）的CAN通信驱动伺服电机，使用电机的通信协议，使用CAN数据发送。
基于STM32的伺服电机控制系统设计
z137531的博客
01-17 3366
基于STM32的伺服电机控制系统设计
STM32 精确控制PWM脉冲个数
博客
04-13 2万+
一般情况下我们在控制指定书目PWM输出的时候，都是采用在对每一次的脉冲中断进行，虽然也能产生对硬件的PWM脉冲数目精确控制，但却是通过对每一次的脉冲都进行计数实现的，然而有的情况下我们用到PWM脉冲周期可能会达到us级甚至更低，这样的情况下，对于中断频繁计数脉冲这种状况，会非常的占用MCU的资源，甚至严重的情况下 可能会影响到程序的运行。下面介绍一种，无需对脉冲个数每个都进行计数而是产生指定脉冲个...
基于STM32电机驱动学习笔记
weixin_74157522的博客
04-26 9047
直流有刷电机（Brushed DC Motor）是内含电刷装置的将直流电能转换成机械能的电动机。特点结构简单、操控方便、成本低廉等特点电刷和换向器之间有摩擦，导致换向时产生电火花易产生电磁干扰，故障多，维护工作量大，寿命短主要应用场景：各类电动玩具，电动自行车，印刷机械等等原理左手定则（死去的记忆偷袭我）中间镂空的位置是为了保持转子换向的直流有刷电机（BDC）是一种内含电刷装置的将直流电能转换成机械能的电动机。在允许的范围之内，供电即可工作，只需要调整电压，即可调整电机的转速。
嵌入式STM32学习笔记（5）——定时器主从模式，精确输出PWM脉冲数量
热门推荐
abcvincent的博客
07-09 2万+
当要控制步进电机或其他通过控制器输入脉冲控制电机的时候，需要能根据需求调整的脉冲数量等；STM32中发出脉冲一般有两种方式：1）利用定时中断输出脉冲，但是间隔的延时会影响其他主程序的进程，当控制多个电机的时候就非常不可取；2）利用PWM脉宽调制，并通过主从定时器进行设定，好处是不占用主程序时钟，且能精准控制； 主从模式主要设置如下几个函数，比如设置定时器1为主，定时器1为从的时候： /...
STM32精准控制PWM脉冲数_库函数版
08-22
利用STM32定时器的同步，可以精准控制PWM脉冲数量（库函数版）
STM32：F103/F407定时器主从模式输出精准脉冲个数
12-10
本主题聚焦于STM32 F103和F407型号的定时器在主从模式下的使用，目的是输出精准的脉冲个数以实现对步进电机的精确控制。 **主从定时器模式** 主从定时器模式是一种高级定时器功能，允许两个或多个定时器协同工作。...
基于STM32F103C8单片机主从模式实现两路同步PWM脉冲输出，频率、占空比可调软件源码.zip
04-04
在这个项目中，它被用来实现主从模式的两路同步PWM脉冲输出，允许用户调整频率和占空比，这对于电机控制、电源调节等应用至关重要。 首先，我们来看PWM（Pulse Width Modulation）脉宽调制的基本概念。PWM是一种...
STM32 CUBEMX主从定时器配置PWM任意相位可调，占空比可调工程包方法二
05-15
总的来说，使用STM32 CUBEMX配置主从定时器以生成可调节相位和占空比的PWM信号，是一种实用且高效的方案，尤其适合需要精确控制电机速度、亮度或其他模拟信号的场合。通过理解这些配置步骤和背后的原理，开发者能够...
使用STM32F4做主控、A5驱动控制交流伺服电机
ponima的博客
01-26 3297
选用定时器的主从模式，TIM2为主，TIM4为从。TIM2 输出PWM，TIM4记录脉冲数；选用PA3做为方向控制接线引脚。 关键代码如下： //定时器2主模式,定时器4从模式 //PWM输出 void DIR_config(void) { GPIO_InitTypeDef GPIO_InitStructure;//GPIO设置，创建结构体 RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA,ENABLE); GPIO_InitStructure
STM32F0输出固定数量脉冲，主从定时器
dy_ngmm的博客
11-17 2248
主要介绍基于STM32F0单片机输出固定数量脉冲，主要使用主从定时器的级联
基于STM32的位置速度环PID控制伺服电机转动位置及程序说明
wqsdqw的博客
06-04 1425
用实际使用过的代码来解释一下位置速度环PID的实现过程。
stm32脉冲计数程序
06-06
STM32脉冲计数程序是使用STM32微控制器进行脉冲计数的一种程序。脉冲计数是指通过对某个物理量进行计数来确定其频率或周期的方法，常用于测量电子设备、机械设备等的运行状态。在STM32中，通过配置GPIO输入输出功能和定时器模块，可以实现简单的脉冲计数程序。 首先，设置GPIO口为输入模式，用于接收脉冲信号。然后，通过定时器输入捕获模式，可以按照指定的时钟频率来捕获脉冲信号，从而计数。使用定时器还可以设置计数器的计数方式、计数范围等参数，从而适应不同的计数需求。 此外，为了提高计数的准确性和稳定性，可以使用手动或自动校准技术。手动校准需要通过外部测量仪器对计数值进行补偿，而自动校准则可以利用STM32的内置时钟校准电路来自动校准计数误差。 总之，STM32脉冲计数程序是一种非常实用和广泛应用的技术，适用于各种领域的计数需求，例如电子测量、机械运行状态监测等。通过合理的设置和校准，可以实现精度较高的计数结果。
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值