OpenEdv-开源电子网

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

求一个增量编码器求速度的程序

[复制链接]

5

主题

54

帖子

0

精华

初级会员

Rank: 2

积分
112
金钱
112
注册时间
2012-7-19
在线时间
4 小时
发表于 2012-7-20 09:01:05 | 显示全部楼层 |阅读模式
A接T0,B接T1,希望可判断方向,求的速度,不胜感激
佛法无边啊
正点原子逻辑分析仪DL16劲爆上市
回复

使用道具 举报

530

主题

11万

帖子

34

精华

管理员

Rank: 12Rank: 12Rank: 12

积分
165309
金钱
165309
注册时间
2010-12-1
在线时间
2108 小时
发表于 2012-7-20 09:04:37 | 显示全部楼层
没用过这东东.帮不了你.
我是开源电子网www.openedv.com站长,有关站务问题请与我联系。
正点原子STM32开发板购买店铺http://openedv.taobao.com
正点原子官方微信公众平台,点击这里关注“正点原子”
回复 支持 反对

使用道具 举报

109

主题

1606

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
2222
金钱
2222
注册时间
2011-12-15
在线时间
37 小时
发表于 2012-7-20 09:47:18 | 显示全部楼层
我知道编码器可以测脉冲,速度的话,我也不是很清楚
专业制作STM32 物联网通信模块板,模块交流群:369840039。
回复 支持 反对

使用道具 举报

5

主题

54

帖子

0

精华

初级会员

Rank: 2

积分
112
金钱
112
注册时间
2012-7-19
在线时间
4 小时
 楼主| 发表于 2012-7-20 09:48:28 | 显示全部楼层
回复【3楼】sun1238898:
---------------------------------
就是计量脉冲 计算速度的
佛法无边啊
回复 支持 反对

使用道具 举报

43

主题

228

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1073
金钱
1073
注册时间
2012-1-10
在线时间
237 小时
发表于 2012-7-20 10:00:55 | 显示全部楼层
回复【楼主位】电子苹果:
---------------------------------
给个思路:
进入中断(A相低电平),检测端口(B相)如果是高电平,正转(脉冲加1);否则 反转(脉冲减1)
在退出中断前再次判断B相电平,如果前次和后次相同则脉冲有效加减,否则认为是干扰回复原脉冲值。
回复 支持 反对

使用道具 举报

43

主题

228

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1073
金钱
1073
注册时间
2012-1-10
在线时间
237 小时
发表于 2012-7-20 10:02:12 | 显示全部楼层
回复【5楼】magicoctoy:
---------------------------------
本方案适合任何单片机,如果使用STM32则可以使用其编码器接口。
回复 支持 反对

使用道具 举报

5

主题

54

帖子

0

精华

初级会员

Rank: 2

积分
112
金钱
112
注册时间
2012-7-19
在线时间
4 小时
 楼主| 发表于 2012-7-20 10:05:45 | 显示全部楼层
回复【6楼】magicoctoy:
---------------------------------
A接外部中断吗?
佛法无边啊
回复 支持 反对

使用道具 举报

5

主题

54

帖子

0

精华

初级会员

Rank: 2

积分
112
金钱
112
注册时间
2012-7-19
在线时间
4 小时
 楼主| 发表于 2012-7-20 10:06:34 | 显示全部楼层
回复【6楼】magicoctoy:
---------------------------------
检测B是否为高电平,程序如何实现
佛法无边啊
回复 支持 反对

使用道具 举报

43

主题

228

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1073
金钱
1073
注册时间
2012-1-10
在线时间
237 小时
发表于 2012-7-20 10:34:52 | 显示全部楼层
回复【8楼】电子苹果:
---------------------------------
程序51?AVR?430?STM32?C?汇编?我只有51汇编的
回复 支持 反对

使用道具 举报

5

主题

54

帖子

0

精华

初级会员

Rank: 2

积分
112
金钱
112
注册时间
2012-7-19
在线时间
4 小时
 楼主| 发表于 2012-7-20 10:48:10 | 显示全部楼层
我用stc12c5a60s2芯片,51的。有没有c语言,你的接口怎么设置的
佛法无边啊
回复 支持 反对

使用道具 举报

43

主题

228

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1073
金钱
1073
注册时间
2012-1-10
在线时间
237 小时
发表于 2012-7-20 11:59:17 | 显示全部楼层
回复【10楼】电子苹果:
---------------------------------
没有,A相中断0,B相普通io口。当A相低电平进入中断0,检测当前B相电平,如果是高电平,正转(脉冲加1);否则 反转(脉冲减1)。
回复 支持 反对

使用道具 举报

2

主题

1436

帖子

1

精华

金牌会员

Rank: 6Rank: 6

积分
2209
金钱
2209
注册时间
2010-12-16
在线时间
190 小时
发表于 2012-7-20 14:52:03 | 显示全部楼层
这种方法有潜在bug的,必须要使用支持上下边沿中断的机制.

比如,码盘在A0B0和A1B0之间来回跳动,输出值应该是在两个数字之间跳的,但这种方法下数据会不断递增或者递减.而且这种情况在伺服里是经常出现的.
技术讨论请发帖 , 需要我回复请点左下的 < 回复 > 让系统通知我 . 本人不通过其他方式返回任何参数.
回复 支持 反对

使用道具 举报

43

主题

228

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1073
金钱
1073
注册时间
2012-1-10
在线时间
237 小时
发表于 2012-7-20 15:59:39 | 显示全部楼层
回复【12楼】shihantu:
---------------------------------
是的,存在这个bug,所以在程序中需要记录本次电平和上次电平作比较,是否存在临界点来回的问题。
回复 支持 反对

使用道具 举报

43

主题

228

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1073
金钱
1073
注册时间
2012-1-10
在线时间
237 小时
发表于 2012-7-20 16:06:01 | 显示全部楼层
51单片机+编码器+ZLG7290显示,完全可以实现功能,但是如还需加入其它功能的模块或程序编写代码过于复杂的话,还存在51单片机无法处理过快的编码器电平,导致显示、处理跟不上实际编码器的运动导致测量不准确。
回复 支持 反对

使用道具 举报

5

主题

54

帖子

0

精华

初级会员

Rank: 2

积分
112
金钱
112
注册时间
2012-7-19
在线时间
4 小时
 楼主| 发表于 2012-7-25 08:46:12 | 显示全部楼层
   略
佛法无边啊
回复 支持 反对

使用道具 举报

5

主题

54

帖子

0

精华

初级会员

Rank: 2

积分
112
金钱
112
注册时间
2012-7-19
在线时间
4 小时
 楼主| 发表于 2012-7-25 08:47:42 | 显示全部楼层
上面是我的程序,电机正反转正常,但是一接编码器测速,就停止工作 求解
佛法无边啊
回复 支持 反对

使用道具 举报

5

主题

54

帖子

0

精华

初级会员

Rank: 2

积分
112
金钱
112
注册时间
2012-7-19
在线时间
4 小时
 楼主| 发表于 2012-7-25 08:49:27 | 显示全部楼层
其中串口显示,ad转换都正常,就是测速一加入板子停止工作
佛法无边啊
回复 支持 反对

使用道具 举报

18

主题

158

帖子

1

精华

中级会员

Rank: 3Rank: 3

积分
400
金钱
400
注册时间
2011-11-23
在线时间
0 小时
发表于 2012-8-2 19:50:34 | 显示全部楼层
//PWM输出初始化
//arr:自动重装值
//psc:时钟预分频数
void Encoder_Init(u16 arr)
{    
RCC->APB1ENR|=1<<1;       //TIM3时钟使能    
RCC->APB2ENR|=1<<0;     //开启辅助时钟   
AFIO->MAPR&=0XF8FFFFFF; //清除MAPR的[26:24]
AFIO->MAPR|=0X04000000; //关闭JTAG
  
GPIOA->CRL&=0X00FFFFFF;//PA7.PA6输入
GPIOA->CRL|=0X88000000;//下拉输入    
GPIOA->ODR|=1<<7;//PA7上拉   
GPIOA->ODR|=1<<6;//PA7上拉

Ex_NVIC_Config(GPIO_A,7,FTIR); //上升沿触发
Ex_NVIC_Config(GPIO_A,6,FTIR);//上升沿触发

TIM3->ARR=arr;//设定计数器自动重装值 
    TIM3->CCMR1|=1<<0;  //CC1S=01
TIM3->CCMR1|=1<<8;  //CC2S=01
TIM3->CCER|=0<<1;  //CC1P=0
TIM3->CCER|=0<<5;  //CC2P=0
    TIM3->SMCR|=3<<0; //SMS=011
TIM3->CR1|=1<<0;;   //CEN使能 
TIM3->CR1|=0x01;    //使能定时器3    
}    
回复 支持 反对

使用道具 举报

43

主题

228

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1073
金钱
1073
注册时间
2012-1-10
在线时间
237 小时
发表于 2012-8-2 21:50:19 | 显示全部楼层
回复【17楼】电子苹果:
---------------------------------
看不懂51的c,你可以接仿真器仿真下程序,应该是程序进入死循环了跳不出那一段子程序了!
回复 支持 反对

使用道具 举报

0

主题

3

帖子

0

精华

新手入门

积分
23
金钱
23
注册时间
2012-8-17
在线时间
0 小时
发表于 2012-8-30 09:07:41 | 显示全部楼层
回复【18楼】shuilian007:
//PWM输出初始化
//arr:自动重装值
//psc:时钟预分频数
void Encoder_Init(u16 arr)
{    
RCC->APB1ENR|=1<<1;       //TIM3时钟使能    
RCC->APB2ENR|=1<<0;     //开启辅助时钟   
AFIO->MAPR&=0XF8FFFFFF; //清除MAPR的[26:24]
AFIO->MAPR|=0X04000000; //关闭JTAG
  
GPIOA->CRL&=0X00FFFFFF;//PA7.PA6输入
GPIOA->CRL|=0X88000000;//下拉输入    
GPIOA->ODR|=1<<7;//PA7上拉   
GPIOA->ODR|=1<<6;//PA7上拉
Ex_NVIC_Config(GPIO_A,7,FTIR); //上升沿触发
Ex_NVIC_Config(GPIO_A,6,FTIR);//上升沿触发

......
---------------------------------
请问这个程序中“arr”是计数器计到arr个数就溢出中断一次吗??不知道能否做成在lcd上一直显示编码器脉冲数值的形式???谢谢!!!
回复 支持 反对

使用道具 举报

18

主题

158

帖子

1

精华

中级会员

Rank: 3Rank: 3

积分
400
金钱
400
注册时间
2011-11-23
在线时间
0 小时
发表于 2012-8-30 20:28:24 | 显示全部楼层
回复【20楼】南国椰风:
---------------------------------
arr”是计数器计到arr个数就溢出中断一次,可以做成在lcd上显示编码器脉冲计数个数
回复 支持 反对

使用道具 举报

2

主题

18

帖子

0

精华

新手上路

积分
46
金钱
46
注册时间
2012-8-31
在线时间
0 小时
发表于 2012-8-31 14:16:58 | 显示全部楼层
我前一阵写过一个编码器测距的  没有测速度  不过你可以自己加计时就可以   我用的是STC12C5A的  CA上升和下降沿中断
#include "global.h"
#include "USBInterface.h"

#include "Encoder.h"

/***********************************************/
/***********************************************/
/***********************************************/
/***********************************************/

#define ENCODER_A 14
#define ENCODER_B 13


INT8  _EncoderVal=0;
UINT8 Encoder_Flag_A=0;
UINT8 Encoder_Flag_B=0;

Encoder_Init()
{
Encoder_Flag_A=ENCODER_A;
Encoder_Flag_B=ENCODER_B;
}



INT8 Encoder_Switch(UINT8 Flag_A,UINT8 Flag_B)
{
static UINT8 Encoder_Last_A=0;
static UINT8 Encoder_Last_B=0;

if(Encoder_Last_A^Flag_A)   // A变化
{
Encoder_Last_A=Flag_A;

if(Encoder_Last_A)   // A为高电平,捕获的A为上升沿
{
if(Encoder_Last_B)   // B为高 则反转
{
return -1;
}
else  //  B为低 则正转
{
return 1;
}
}
else    // A为低电平,捕获的A为下降沿
{
if(Encoder_Last_B) // B为高 则正转
{
return 1;
}
else //B为低 则反转
{
return -1;
}
}
}
if(Encoder_Last_B^Flag_B)   // B变化
{
Encoder_Last_B=Flag_B;
if(Encoder_Last_B)   // B为高电平,捕获的A为上升沿
{
if(Encoder_Last_A)   // A为高 则正转
{
return 1;
}
else  //  A为低 则反转
{
return -1;
}
}
else    // B为低电平,捕获的A为下降沿
{
if(Encoder_Last_A) // A为高 则反转
{
return -1;
}
else //A为低 则正转
{
return 1;
}
}
}
else return 0;


}







void EncoderAp(void)
{
static UINT8 buf[64]={0};
ENTER_CRITICAL();
SYSPostCurMsg(RUN_TIMER0_DISPOSE_DATA);
// SYSPostCurMsg(SYS_IDLE);   //进入下一个任务 空闲

if(_EncoderVal!=0)
{
buf[63]=_EncoderVal;
USBCiEP2Send(buf,64);   //发送数据到上位机
_EncoderVal=0;
}

EXIT_CRITICAL();

}
回复 支持 反对

使用道具 举报

2

主题

18

帖子

0

精华

新手上路

积分
46
金钱
46
注册时间
2012-8-31
在线时间
0 小时
发表于 2012-8-31 14:19:38 | 显示全部楼层
怎么放图上去啊   我不会 我写了个流程图 不过不知道 怎么放上来
回复 支持 反对

使用道具 举报

2

主题

18

帖子

0

精华

新手上路

积分
46
金钱
46
注册时间
2012-8-31
在线时间
0 小时
发表于 2012-8-31 14:20:19 | 显示全部楼层
先通过A,B二相的上升沿和下降沿产生中断 然后在中断函数里去判断是哪一相产生的中断,再通过检测该脚位的电平是高还是低去判断是上升沿产生的中断还是下降沿的中断 (如是低就说明是下降沿产生的中断,因为从高到低 中断后 检测到的就是低电平 ) 知道是哪一相产生的中断 而且 知道了 是上升 沿 还是下降沿 再通过 另一相的电平 就知道 是正转还反转
回复 支持 反对

使用道具 举报

6

主题

25

帖子

0

精华

中级会员

Rank: 3Rank: 3

积分
217
金钱
217
注册时间
2013-10-25
在线时间
44 小时
发表于 2014-3-3 15:55:35 | 显示全部楼层
回复【22楼】hahalz:
---------------------------------
mark
回复 支持 反对

使用道具 举报

5

主题

54

帖子

0

精华

初级会员

Rank: 2

积分
112
金钱
112
注册时间
2012-7-19
在线时间
4 小时
 楼主| 发表于 2014-11-27 15:16:17 | 显示全部楼层
谢谢大家了!
佛法无边啊
回复 支持 反对

使用道具 举报

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

本版积分规则



关闭

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

正点原子公众号

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

GMT+8, 2024-11-23 04:45

Powered by OpenEdv-开源电子网

© 2001-2030 OpenEdv-开源电子网

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