OpenEdv-开源电子网

 找回密码
 立即注册
正点原子全套STM32/Linux/FPGA开发资料,上千讲STM32视频教程免费下载...
查看: 5463|回复: 7

模板程序改编一个光电编码器的车轮测速程序,结果不理想,望帮忙

[复制链接]

2

主题

5

帖子

0

精华

新手入门

积分
16
金钱
16
注册时间
2018-3-8
在线时间
3 小时
发表于 2018-3-8 16:21:06 | 显示全部楼层 |阅读模式
10金钱
原子哥,我根据你的输入捕获程序改编一个光电编码器的测速程序,结果不理想,望帮忙。
根据定时2秒钟捕获所产生高电平次数来判断单位时间内通过角度的大小。
错误结果是车轮没有转动 都有速度输出
<timer.c>
void TIM5_CH1_Cap_Init(u32 arr,u16 psc)
{
        GPIO_InitTypeDef GPIO_InitStructure;
        TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
        NVIC_InitTypeDef NVIC_InitStructure;
        TIM_ICInitTypeDef  TIM5_ICInitStructure;

       
        RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM5,ENABLE);         
        RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA, ENABLE);        
       
        GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0;
        GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
        GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz;       
        GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
        GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_DOWN;
        GPIO_Init(GPIOA,&GPIO_InitStructure);

        GPIO_PinAFConfig(GPIOA,GPIO_PinSource0,GPIO_AF_TIM5);

          
        TIM_TimeBaseStructure.TIM_Prescaler=psc;  
        TIM_TimeBaseStructure.TIM_CounterMode=TIM_CounterMode_Up;
        TIM_TimeBaseStructure.TIM_Period=arr;   
        TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;
       
        TIM_TimeBaseInit(TIM5,&TIM_TimeBaseStructure);

  TIM5_ICInitStructure.TIM_Channel = TIM_Channel_1;       
  TIM5_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising;       
  TIM5_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;
  TIM5_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1;       
  TIM5_ICInitStructure.TIM_ICFilter = 0x00;//IC1F=0000
  TIM_ICInit(TIM5, &TIM5_ICInitStructure);
               
        TIM_ITConfig(TIM5,TIM_IT_Update|TIM_IT_CC1,ENABLE);
       
       TIM_Cmd(TIM5,ENABLE );

  NVIC_InitStructure.NVIC_IRQChannel = TIM5_IRQn;
        NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=2;
        NVIC_InitStructure.NVIC_IRQChannelSubPriority =0;               
        NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;                       
        NVIC_Init(&NVIC_InitStructure);       
}
u8  TIM5CH1_CAPTURE_STA=0;        //输入捕获状态
int count=0;   
int ccount=0;

//定时器5中断服务函数         
void TIM5_IRQHandler(void)
{                     
  if(TIM_GetITStatus(TIM5,TIM_IT_Update)==SET)//更新中断
        {ccount=count;}  //捕获单位时间内通过的高电平个数,单位高电平对应的车轮转动角度固定
        else     //捕获中断
                {          if(TIM5CH1_CAPTURE_STA&0X40)                //捕获下降沿       
                           {                                 
                          count++;    //单位时间高电平个数
                                TIM5CH1_CAPTURE_STA=0;                        //清空
                                 TIM_OC1PolarityConfig(TIM5,TIM_ICPolarity_Rising); //设置上升沿触发
                           }else                                                                  //捕获到上升沿
                           {
                                TIM5CH1_CAPTURE_STA=0;                       
                                TIM5CH1_CAPTURE_STA|=0X40;                //比较捕捉到上升沿
                                 TIM_OC1PolarityConfig(TIM5,TIM_ICPolarity_Falling);                //设置为下降沿出发
                           }                    
    }
        TIM_ClearITPendingBit(TIM5, TIM_IT_CC1|TIM_IT_Update); //清空中断标志位
}

<main.c>


extern u8  TIM5CH1_CAPTURE_STA;                                                   
extern int count;
extern int ccount;

       
int main(void)
{
        float Vr;
        float Vw;
        float time=2.0;
        NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
        delay_init(168);  
        uart_init(115200);

        TIM5_CH1_Cap_Init(2000000-1,84-1); //定时器定时2s 更新中断

        while(1)
        {
                delay_ms(10);                         
                if(ccount!=0)//当有高电平时既有车轮有转动才打印速度
                {
                        Vr=(6*ccount)/time;  //测速盘的角速度  单位高电平走过6°
                        Vw=Vr*0.28;   //车轮的线速度
                        printf("COUNT:%d  SPEEDw:%f rad/s  Vw:%f m/s \n",ccount,Vr,Vw); //打印单位时间通过的高电平个数,测速盘的角速度,车轮的线速度
                        ccount=0;                             //测速后 清零
                        count=0;
                        TIM5CH1_CAPTURE_STA=0;
                }
        }
}




正点原子逻辑分析仪DL16劲爆上市
回复

使用道具 举报

530

主题

11万

帖子

34

精华

管理员

Rank: 12Rank: 12Rank: 12

积分
165536
金钱
165536
注册时间
2010-12-1
在线时间
2117 小时
发表于 2018-3-10 01:57:29 | 显示全部楼层
回复

使用道具 举报

2

主题

5

帖子

0

精华

新手入门

积分
16
金钱
16
注册时间
2018-3-8
在线时间
3 小时
 楼主| 发表于 2018-3-11 16:05:18 | 显示全部楼层

原子哥,您能解决一下吗
回复

使用道具 举报

29

主题

486

帖子

0

精华

论坛元老

Rank: 8Rank: 8

积分
3083
金钱
3083
注册时间
2014-7-19
在线时间
413 小时
发表于 2018-3-12 16:20:04 | 显示全部楼层
老爹爹 发表于 2018-3-11 16:05
原子哥,您能解决一下吗

光电编码器干嘛不用STM32的定时器编码器模式  
可以参考我的博客  http://blog.csdn.net/wang328452854/article/details/50579832
电子人生!
回复

使用道具 举报

2

主题

5

帖子

0

精华

新手入门

积分
16
金钱
16
注册时间
2018-3-8
在线时间
3 小时
 楼主| 发表于 2018-3-13 14:32:04 | 显示全部楼层
翱翔云端的鸟 发表于 2018-3-12 16:20
光电编码器干嘛不用STM32的定时器编码器模式  
可以参考我的博客  http://blog.csdn.net/wang328452854/ ...

你好,请恕我眼拙没有看明白你的程序,我的光电编码器就两个输入一个输出 VCC GND 信号线,请问能帮我看看我的程序出了什么问题吗?
程序结果是PA0没有信号输入也能打印出上升沿的个数出来,令人匪夷所思!
回复

使用道具 举报

12

主题

49

帖子

0

精华

中级会员

Rank: 3Rank: 3

积分
498
金钱
498
注册时间
2018-5-30
在线时间
121 小时
发表于 2018-6-21 16:11:38 | 显示全部楼层
楼主解决了嘛  我买错了  也是和你一样的传感器  不知道该怎么解决测量输出PWM  控制平衡小车
回复

使用道具 举报

1

主题

2

帖子

0

精华

新手上路

积分
20
金钱
20
注册时间
2018-9-20
在线时间
2 小时
发表于 2018-12-18 23:15:51 | 显示全部楼层
楼主解决了吗,我也遇到你这种传感器测速不知道怎么弄,想要个代码
回复

使用道具 举报

6

主题

359

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1604
金钱
1604
注册时间
2017-12-18
在线时间
173 小时
发表于 2019-3-8 14:43:18 | 显示全部楼层
帮顶一下
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则



关闭

原子哥极力推荐上一条 /2 下一条

正点原子公众号

QQ|手机版|OpenEdv-开源电子网 ( 粤ICP备12000418号-1 )

GMT+8, 2025-6-10 00:08

Powered by OpenEdv-开源电子网

© 2001-2030 OpenEdv-开源电子网

快速回复 返回顶部 返回列表