之前一直白嫖编码器代码,这次花了一早上学习了编码器。
一、编码器简介
1.概述
编码器是一种将角位移或者角速度转换成一连串电数字脉冲的旋转式传感器。
可以用来测量位置,测量速度。
每转过单位的角度就发出一个脉冲信号,通常为A相、B相输出。A相、B相为相互延迟1/4周期的脉冲输出(即正交信号),根据延迟关系可以区别正反转,而且通过取A相、B相的上升和下降沿可以进行2或4倍频。
例:四倍频的方法是测量A相和B相的上升沿和下降沿
2.原理
编码器通过发送正交脉冲信号表示角度信息,如图为一个示例。(其中TI1和TI2分别对应编码器输出A、B项)
脉冲信号特性 | 表示信息 |
---|
两项先后关系 | 旋转方向 | 脉冲个数 | 转过角度 |
二、stm32控制编码器
stm32控制编码器可以采用Timer的编码器模式,Tim1~8的CH1和CH2分别对应A相和B相
(1)大致过程
1、stm32f407中定时器1、2、3、4、5、8提供编码器接口模式
选择编码器接口模式的方法是:如果计数器只在TI2的边沿计数,则置TIMx_SMCR寄存器中的 SMS=001;如果只在TI1边沿计数,则置SMS=010;如果计数器同时在TI1和TI2边沿计数,则 置SMS=011。
通过设置TIMx_CCER寄存器中的CC1P和CC2P位,可以选择TI1和TI2极性;如果需要,还可以 对输入滤波器编程。
两个输入TI1和TI2被用来作为增量编码器的接口。假定计数器已经启动(TIMx_CR1 寄存器中的CEN=’1’),计数器由每次在TI1FP1或TI2FP2上的有效跳变驱动。
2、可以对输入信号TI1,TI2进行滤波处理,数字滤波器由事件器组成,每N个事件才视为一个有效边沿,可以在TIMx_CCMR1、TIMx_CCMR2中的IC1F位域设置 3、stm32提供了单项计数(只能测速度)和双项计数模式(可测速度&方向)
计数模式和编码器的关系
下图是一个计数器操作的实例,显示了计数信号的产生和方向控制。它还显示了当选择了双向计数模式时,输入抖动是如何被抑制的;抖动可能会在传感器的位置靠近一个转换点时产生。在这个例子中,我们假定配置如下:
CC1S=’01’ (TIMx_CCMR1寄存器, IC1FP1映射到TI1) CC2S=’01’ (TIMx_CCMR2寄存器, IC2FP2映射到TI2) CC1P=’0’ (TIMx_CCER寄存器, IC1FP1不反相, IC1FP1=TI1) CC2P=’0’ (TIMx_CCER寄存器, IC2FP2不反相, IC2FP2=TI2) SMS=’011’ (TIMx_SMCR寄存器,所有的输入均在上升沿和下降沿有效). CEN=’1’ (TIMx_CR1寄存器,计数器使能)
在A、B中仅一项有毛刺时,计数值加减后保持不变,实现了抖动补偿
两张图结合来看
仅在TI1计数时 相对信号的电平其实就是TI2的电平(不考虑反向的情况)这样再看这张表就会比较容易理解了 在TI2为高电平的时候TI1为上升沿时脉冲计数减1,TI1位下降沿时脉冲计数加1 在TI2为低电平的时候TI1为上升沿时脉冲计数加1,TI1位下降沿时脉冲计数减1
后面以此类推
4、 编码器A、B相输入的信号TI1、TI2经滤波和反相后成为TI1FP1 或 TI2FP2 ,定时器的时钟由他们上的每次有效信号转换提供,也就是说最终计数值即反映转过角度
根据两个输入信号的跳变顺序,产生了计数脉冲和方向信号。依据两个输入信号的跳变顺序,计数器向上或向下计数,同时硬件对TIMx_CR1寄存器的DIR位进行相应的设置。不管计数器是依靠TI1计数、依靠TI2计数或者同时依靠TI1和TI2计数。在任一输入端(TI1或者TI2)的跳变都会重新计算DIR位。
5、定时器配置为编码器接口模式时,会提供传感器当前位置的相关信息。使用另一个配置为捕获模式的定时器测量两个编码器事件之间的周期,可获得动态信息(速度、加速度和减速度)。
6、计数溢出后,定时器会装载“重装载值”,并清零重新计数,此值可设置为编码器旋转一周的脉冲个数,这样既可利用溢出中断次数判断转了几圈。但若只要求旋转角度,此值可以任意。任意时刻角度为=溢出中断次数*重装载值+当前计数值
(2)代码配置
1、编码器引脚初始化
static void Encoder_GPIO_Init(void) GPIO_InitTypeDef GPIO_InitStruct = {0}; ENCODER_TIM_CH1_GPIO_CLK_ENABLE(); ENCODER_TIM_CH2_GPIO_CLK_ENABLE(); GPIO_InitStruct.Mode = GPIO_MODE_AF_OD; GPIO_InitStruct.Pull = GPIO_PULLUP; GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH; GPIO_InitStruct.Pin = ENCODER_TIM_CH1_PIN; GPIO_InitStruct.Alternate = ENCODER_TIM_CH1_GPIO_AF; HAL_GPIO_Init(ENCODER_TIM_CH1_GPIO_PORT, &GPIO_InitStruct); GPIO_InitStruct.Pin = ENCODER_TIM_CH2_PIN; GPIO_InitStruct.Alternate = ENCODER_TIM_CH2_GPIO_AF; HAL_GPIO_Init(ENCODER_TIM_CH2_GPIO_PORT, &GPIO_InitStruct);
2、配置编码器模式
static void TIM_Encoder_Init(void) TIM_Encoder_InitTypeDef Encoder_ConfigStructure; ENCODER_TIM_CLK_ENABLE(); TIM_EncoderHandle.Instance = ENCODER_TIM; TIM_EncoderHandle.Init.Prescaler = ENCODER_TIM_PRESCALER; TIM_EncoderHandle.Init.CounterMode = TIM_COUNTERMODE_UP; TIM_EncoderHandle.Init.Period = ENCODER_TIM_PERIOD; TIM_EncoderHandle.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; TIM_EncoderHandle.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE; Encoder_ConfigStructure.EncoderMode = ENCODER_MODE; Encoder_ConfigStructure.IC1Polarity = ENCODER_IC1_POLARITY; Encoder_ConfigStructure.IC1Selection = TIM_ICSELECTION_DIRECTTI; Encoder_ConfigStructure.IC1Prescaler = TIM_ICPSC_DIV1; Encoder_ConfigStructure.IC1Filter = 0; Encoder_ConfigStructure.IC2Polarity = ENCODER_IC2_POLARITY; Encoder_ConfigStructure.IC2Selection = TIM_ICSELECTION_DIRECTTI; Encoder_ConfigStructure.IC2Prescaler = TIM_ICPSC_DIV1; Encoder_ConfigStructure.IC2Filter = 0; HAL_TIM_Encoder_Init(&TIM_EncoderHandle, &Encoder_ConfigStructure); __HAL_TIM_SET_COUNTER(&TIM_EncoderHandle, 0); __HAL_TIM_CLEAR_IT(&TIM_EncoderHandle,TIM_IT_UPDATE); __HAL_TIM_ENABLE_IT(&TIM_EncoderHandle,TIM_IT_UPDATE); __HAL_TIM_URS_ENABLE(&TIM_EncoderHandle); HAL_NVIC_SetPriority(ENCODER_TIM_IRQn, 5, 1); HAL_NVIC_EnableIRQ(ENCODER_TIM_IRQn); HAL_TIM_Encoder_Start(&TIM_EncoderHandle, TIM_CHANNEL_ALL);
3、圈数计算
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) if(__HAL_TIM_IS_TIM_COUNTING_DOWN(&TIM_EncoderHandle)) Encoder_Overflow_Count--; Encoder_Overflow_Count++;
4、最终计算
void HAL_SYSTICK_Callback(void) if(i == 100)/* 100ms计算一次 */ Motor_Direction = __HAL_TIM_IS_TIM_COUNTING_DOWN(&TIM_EncoderHandle); /* 当前时刻的总计数值 = 计数器值 + 计数溢出次数 * ENCODER_TIM_PERIOD */ Capture_Count =__HAL_TIM_GET_COUNTER(&TIM_EncoderHandle) + (Encoder_Overflow_Count * ENCODER_TIM_PERIOD); /* 转轴转数 = 单位时间内的计数值 / 编码器的总分辨率 * 时间系数 */ Shaft_Speed = (float)(Capture_Count - Last_Count) / ENCODER_TOTAL_RESOLUTION * 10 ; Last_Count = Capture_Count;
|