21ic电子技术开发论坛 › 单片机与嵌入式系统 › ST MCU › stm32f4编码器模式
返回列表 发新帖我要提问

[STM32F4] stm32f4编码器模式

[复制链接]
2067|20
 楼主| kzlzqi 发表于 2023-8-26 16:43 | 显示全部楼层 |阅读模式
STM32F4, STM32F, STM32, STM, ST
一、编码器简介
1、分类
编码器可按以下方式来分类。

（1）增量型：
每转过单位的角度就发出一个脉冲信号，通常为A相、B相（某些包括Z相）输出。A相、B相为相互延迟1/4周期的脉冲输出（即正交信号），根据延迟关系可以区别正反转，而且通过取A相、B相的上升和下降沿可以进行2或4倍频。Z相为单圈脉冲，即每圈发出一个脉冲，常用于校正累计误差。

（2）绝对值型：
对应一圈，每个基准的角度发出一个唯一与该角度对应二进制的数值，通过外部记圈器件可以进行多个位置的记录和测量。

回复

收藏1 举报

评论

kzlzqi
———————————————— 版权声明：本文为CSDN博主「云端FFF」的原创文章，遵循CC 4.0 BY-SA版权协议，转载请附上原文出处链接及本声明。 原文链接：https://blog.csdn.net/wxc971231/article/details/82322957  发表于 2023-8-26 16:43

相关帖子
 楼主| kzlzqi 发表于 2023-8-26 16:44 | 显示全部楼层
3、编码器原理
4332964e9bb45b24ba.png
前文提到编码器通过发送正交脉冲信号表示角度信息，如图为一个示例。（其中TI1和TI2分别对应编码器输出A、B项）
8407864e9bb55301e1.png
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:44 | 显示全部楼层
二、stm32f4编码器模式
1、简介
我们可以利用外部中断分别捕获A、B项边沿，手写逻辑消除毛刺并解析编码器数据，但这是比较复杂的。其实这里的脉冲输入是一种特殊的输入捕获情况，因此stm32专门在定时器中提供了编码器模式，可大大简化解析过程。

（1）、stm32f407中定时器1、2、3、4、5、8提供编码器接口模式
（2）、可以对输入信号TI1,TI2进行滤波处理，数字滤波器由事件器组成，每N个事件才视为一个有效边沿，可以在TIMx_CCMR1、TIMx_CCMR2中的IC1F位域设置
（3）、stm32提供了单项计数（只能测速度）和双项计数模式（可测速度&方向），双项模式可以更好地消除毛刺干扰
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:44 | 显示全部楼层
一般使用双项模式，具体见下图
3176964e9bb7673dd3.png
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:44 | 显示全部楼层
下图为双项模式下计数效果，可见在A、B中仅一项有毛刺时，计数值加减后保持不变，实现了抖动补偿

1588564e9bb89bf6c0.png
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:45 | 显示全部楼层
（4）、 编码器A、B相输入的信号TI1、TI2经滤波和反相后成为TI1FP1 或 TI2FP2 ，定时器的时钟由他们上的每次有效信号转换提供，也就是说最终计数值即反映转过角度。
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:45 | 显示全部楼层
（5）、 TI1FP1 或 TI2FP2反相可以改变计数方向，如下图：
5921164e9bb9fd2427.png
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:45 | 显示全部楼层
（6）、定时器配置为编码器接口模式时，会提供传感器当前位置的相关信息。使用另一个配置为捕获模式的定时器测量两个编码器事件之间的周期，可获得动态信息（速度、加速度和减速度）。
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:45 | 显示全部楼层
（7）、计数溢出后，定时器会装载“重装载值”，并清零重新计数，此值可设置为编码器旋转一周的脉冲个数，这样既可利用溢出中断次数判断转了几圈。但若只要求旋转角度，此值可以任意。任意时刻角度为：溢出中断次数*重装载值+当前计数值
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:45 | 显示全部楼层
（8）、TIMx_CR1寄存器的 DIR 位指示当前旋转方向
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:45 | 显示全部楼层
2、示例代码
（1）定时器初始化设置
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:45 | 显示全部楼层
复制
  1. void TIM3_Int_Init() 
    

  2. {
    

  3.         TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure;
    

  4.         TIM_ICInitTypeDef TIM_ICInitStructure;
    

  5.         NVIC_InitTypeDef NVIC_InitStructure;
    

  6.         
    

  7.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE); 
    


  8. 

  9. //定时器设置-------------------------------------------------------------        
    

  10.   TIM_TimeBaseInitStructure.TIM_Period = 3600;         //重装载值
    

  11.         TIM_TimeBaseInitStructure.TIM_Prescaler=0x0;  //预分频
    

  12.         TIM_TimeBaseInitStructure.TIM_CounterMode=TIM_CounterMode_Up; //向上计数
    

  13.         TIM_TimeBaseInitStructure.TIM_ClockDivision=TIM_CKD_DIV1; //时钟分割
    

  14.         
    

  15.         TIM_TimeBaseInit(TIM3,&TIM_TimeBaseInitStructure);//初始化TIM3
    


  16. 

  17. //编码器模式设置--------------------------------------------------------------                                          
    


  18. 

  19.         TIM_EncoderInterfaceConfig(TIM3,TIM_EncoderMode_TI12,TIM_ICPolarity_Rising, TIM_ICPolarity_Rising);//计数模式3
    

  20.         
    

  21.         TIM_ICStructInit(&TIM_ICInitStructure); 
    

  22.     TIM_ICInitStructure.TIM_ICFilter = 10;//滤波器值
    

  23.     TIM_ICInit(TIM3, &TIM_ICInitStructure);
    

  24. //溢出中断设置--------------------------------------------------------------        
    

  25.         TIM_ITConfig(TIM3,TIM_IT_Update,ENABLE); //允许TIM3溢出中断
    


  26. 

  27.         NVIC_InitStructure.NVIC_IRQChannel=TIM3_IRQn; 
    

  28.         NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=0x01; 
    

  29.         NVIC_InitStructure.NVIC_IRQChannelSubPriority=0x01; 
    

  30.         NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE;
    

  31.         NVIC_Init(&NVIC_InitStructure);
    

  32.   
    

  33.  //Reset counter-----------------------------------------------
    

  34.   TIM_SetCounter(TIM3,0); //TIM3->CNT=0
    

  35.   TIM_Cmd(TIM3, ENABLE); 
    

  36. }
    


  37.
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:46 | 显示全部楼层
（2）在中断服务函数中进行圈数计算
复制
  1. int circle_count=0;//全局变量-圈数
    

  2. void TIM3_IRQHandler(void)
    

  3. {
    

  4.         if(TIM_GetITStatus(TIM3,TIM_IT_Update)==SET)
    

  5.         {                
    

  6.                 if((TIM3->CR1>>4 & 0x01)==0) //DIR==0
    

  7.                         circle_count++;
    

  8.                 else if((TIM3->CR1>>4 & 0x01)==1)//DIR==1
    

  9.                         circle_count--;
    

  10.         }
    

  11.         TIM_ClearITPendingBit(TIM3,TIM_IT_Update); 
    

  12. }
    


  13.
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:46 | 显示全部楼层
（3）获取当前角度值
复制
  1. int Encoder=0;
    

  2. extern int circle_count;
    


  3. 

  4. Encoder=TIM_GetCounter(TIM3)+3600*circle_count;//当前角度
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:47 | 显示全部楼层
上述代码在stm32f407平台测试通过
使用另一个配置为捕获模式的定时器测量两个编码器事件之间的周期，可获得动态信息（速度、加速度和减速度）。
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:47 | 显示全部楼层
三、update 2023/7/7
有网友想要完整代码，我从19年的上古工程中找了找，这是我们当初 robomaster 比赛时摩擦轮测速的代码，时间太久了我也看不太懂，请大家自行参考
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:47 | 显示全部楼层
编码器初始化
复制
  1. //摩擦轮编码器（右）
    

  2. void TIM2_Encoder_init(void)
    

  3. {
    

  4.         GPIO_InitTypeDef         GPIO_InitStructure; 
    

  5.     TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
    

  6.     TIM_ICInitTypeDef        TIM_ICInitStructure;
    

  7.  
    

  8.     RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2,ENABLE);
    

  9.     RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA,ENABLE);
    

  10.   
    

  11.     GPIO_PinAFConfig(GPIOA,GPIO_PinSource0,GPIO_AF_TIM2);
    

  12.     GPIO_PinAFConfig(GPIOA,GPIO_PinSource1,GPIO_AF_TIM2);
    

  13.  
    

  14.     GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0|GPIO_Pin_1; 
    

  15.     GPIO_InitStructure.GPIO_Mode  = GPIO_Mode_AF;
    

  16.     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz;
    

  17.     GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
    

  18.     GPIO_InitStructure.GPIO_PuPd  = GPIO_PuPd_UP ;
    

  19.     GPIO_Init(GPIOA,&GPIO_InitStructure); 
    

  20.  
    

  21.     TIM_TimeBaseStructure.TIM_Period = 60000; 
    

  22.     TIM_TimeBaseStructure.TIM_Prescaler = 0; 
    

  23.     TIM_TimeBaseStructure.TIM_ClockDivision = 0; 
    

  24.     TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  
    

  25.     TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure); 
    

  26.  
    

  27.     TIM_EncoderInterfaceConfig(TIM2, 
    

  28.                                                                 TIM_EncoderMode_TI1,
    

  29.                                                                 TIM_ICPolarity_Falling,
    

  30.                                                                 TIM_ICPolarity_Falling);
    

  31.     TIM_ICStructInit(&TIM_ICInitStructure);
    

  32.     TIM_ICInitStructure.TIM_ICFilter = 10; 
    

  33.     TIM_ICInit(TIM2, &TIM_ICInitStructure);
    

  34.     TIM_ClearFlag(TIM2, TIM_FLAG_Update); 
    

  35.     TIM_ITConfig(TIM2, TIM_IT_Update, ENABLE); 
    

  36.     TIM2->CNT = 30000;
    

  37.     TIM_Cmd(TIM2, ENABLE);
    

  38. }
    


  39. 


  40. 

  41. //摩擦轮编码器（左）
    

  42. void TIM8_Encoder_init(void)
    

  43. {
    

  44.         GPIO_InitTypeDef         GPIO_InitStructure; 
    

  45.     TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
    

  46.     TIM_ICInitTypeDef        TIM_ICInitStructure;
    

  47.  
    

  48.     RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM8,ENABLE);
    

  49.     RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOI,ENABLE);
    

  50.   
    

  51.     GPIO_PinAFConfig(GPIOI,GPIO_PinSource5,GPIO_AF_TIM8);
    

  52.     GPIO_PinAFConfig(GPIOI,GPIO_PinSource6,GPIO_AF_TIM8);
    

  53.  
    

  54.     GPIO_InitStructure.GPIO_Pin = GPIO_Pin_5|GPIO_Pin_6; //GPIOB0,GPIOB1
    

  55.     GPIO_InitStructure.GPIO_Mode  = GPIO_Mode_AF;
    

  56.     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz;
    

  57.     GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
    

  58.     GPIO_InitStructure.GPIO_PuPd  = GPIO_PuPd_UP ;
    

  59.     GPIO_Init(GPIOI,&GPIO_InitStructure); 
    

  60.  
    

  61.     TIM_TimeBaseStructure.TIM_Period = 60000; 
    

  62.     TIM_TimeBaseStructure.TIM_Prescaler = 0; 
    

  63.     TIM_TimeBaseStructure.TIM_ClockDivision = 0; 
    

  64.     TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  
    

  65.     TIM_TimeBaseInit(TIM8, &TIM_TimeBaseStructure); 
    

  66.  
    

  67.     TIM_EncoderInterfaceConfig(TIM8, 
    

  68.                                                                 TIM_EncoderMode_TI1,
    

  69.                                                                 TIM_ICPolarity_Falling,
    

  70.                                                                 TIM_ICPolarity_Falling);
    

  71.     TIM_ICStructInit(&TIM_ICInitStructure);
    

  72.     TIM_ICInitStructure.TIM_ICFilter = 10; 
    

  73.     TIM_ICInit(TIM8, &TIM_ICInitStructure);
    

  74.     TIM_ClearFlag(TIM8, TIM_FLAG_Update); 
    

  75.     TIM_ITConfig(TIM8, TIM_IT_Update, ENABLE); 
    

  76.     TIM8->CNT = 30000;
    

  77.     TIM_Cmd(TIM8, ENABLE);
    

  78. }
    


  79. 

  80. //编码器采集定时器
    

  81. void TIM6_Init(u16 prd,u16 psc)
    

  82. {
    

  83.         TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure;
    

  84.         NVIC_InitTypeDef NVIC_InitStructure;
    

  85.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6,ENABLE);  
    

  86.         
    

  87.           TIM_TimeBaseInitStructure.TIM_Period = prd;                 //自动重装载值
    

  88.         TIM_TimeBaseInitStructure.TIM_Prescaler=psc;                  //定时器分频
    

  89.         TIM_TimeBaseInitStructure.TIM_CounterMode=TIM_CounterMode_Up; //向上计数模式
    

  90.         TIM_TimeBaseInitStructure.TIM_ClockDivision=TIM_CKD_DIV1; 
    

  91.         
    

  92.         TIM_TimeBaseInit(TIM6,&TIM_TimeBaseInitStructure);
    

  93.         
    

  94.         NVIC_InitStructure.NVIC_IRQChannel=TIM6_DAC_IRQn; 
    

  95.         NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=0x03; //抢占优先级1
    

  96.         NVIC_InitStructure.NVIC_IRQChannelSubPriority=0x03; //子优先级3
    

  97.         NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE;
    

  98.         NVIC_Init(&NVIC_InitStructure);
    

  99.         
    

  100.         TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE); 
    

  101.         TIM_Cmd(TIM6,ENABLE); 
    

  102. }
回复

收藏1 举报

 楼主| kzlzqi 发表于 2023-8-26 16:48 | 显示全部楼层
中断服务函数
复制
  1. //编码器信息
    

  2. //编号0对应左边的电机，1对应右边电机
    

  3. //逆时针转计数增加
    

  4. uint16_t encoder_data[2];
    

  5. uint16_t encoder_data_last[2]={30000,30000};
    

  6. int16_t fric_spd[2];
    

  7. int16_t spd_last[2]={0,0};
    


  8. 

  9. //编码器信息采集
    

  10. void TIM6_DAC_IRQHandler(void)
    

  11. {
    

  12. //        static int i=0;
    

  13.         if(TIM_GetITStatus(TIM6,TIM_IT_Update)==SET) //溢出中断
    

  14.         {
    

  15. //                if(i==100)//0.1s
    

  16. //                        ANO_Send_UserData(RC_CtrlData.mouse.x,0,0,0);
    

  17. //                else if(i==200)
    

  18. //                        ANO_Send_UserData(RC_CtrlData.mouse.x,1,0,0),i=0;
    

  19. //                i++;
    

  20.                 
    

  21.                 //LED1=!LED1;//DS1翻转
    

  22.                 encoder_data[0]=TIM8->CNT;
    

  23.                 encoder_data[1]=TIM2->CNT;
    

  24.                 
    

  25.                 for(int i=0;i<2;i++)
    

  26.                 {
    

  27.                         fric_spd[i]=encoder_data[i]-encoder_data_last[i];
    

  28.                 
    

  29.                         //从0到60000的跳变
    

  30.                         if(fric_spd[i]>30000)
    

  31.                         {
    

  32.                                 fric_spd[i]-=60000;
    

  33.                         }
    

  34.                         //从60000到0的跳变
    

  35.                         else if(fric_spd[i]<-30000)
    

  36.                         {
    

  37.                                 fric_spd[i]+=60000;
    

  38.                         }
    

  39.                         if(fric_spd[i]>700||fric_spd[i]<-700)
    

  40.                                 fric_spd[i]=spd_last[i];
    

  41.                         else
    

  42.                                 spd_last[i]=fric_spd[i];
    

  43.                         encoder_data_last[i]=encoder_data[i];
    

  44.                 }
    

  45.                 
    

  46.                 ClientFrame.boolSet[0]=fabs(fric_spd[0])>70 ? 1:0;
    

  47.                 ClientFrame.boolSet[1]=fabs(fric_spd[1])>70 ? 1:0;
    

  48.                 
    

  49.                 if(ClientFrame.boolSet[0] && ClientFrame.boolSet[1])
    

  50.                         shooterEnable=1;
    

  51.                 else
    

  52.                         shooterEnable=0;
    

  53.         }
    

  54.         TIM_ClearITPendingBit(TIM6,TIM_IT_Update);  //清除中断标志位
    

  55. }
    


  56.
回复

收藏1 举报

morrisk 发表于 2023-8-27 11:44 | 显示全部楼层
通过外部记圈器件可以进行多个位置的记录和测量
回复

收藏1 举报

Bowclad 发表于 2024-5-12 23:21 | 显示全部楼层
编码器能判断正反转吗
回复

收藏1 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 注册

本版积分规则

kzlzqi

127

主题

996

帖子

2

粉丝
快速回复 在线客服 返回列表 返回顶部