电机AB相编码器测速

控制任务

检测编码器的脉冲并测速

电路设计

图1 直流电机带减速器和编码器

图2  编码器接线定义

编码器接线定义如下

M1：电机电源接口，绿色的

GND：编码器电源负极输入口，橙色的

C1：编码器A相输出，黄色的，接Arduino控制板2号引脚

C2：编码器B相输出，白色的，接Arduino控制板3号引脚

3.3V：编码器电源正极输入口（兼容3.3V、5V)，红色的

M2：电机电源接口，黑色的，

程序设计

 1 int motor_c_ENA=6;   //控制板与驱动板的引脚连接
 2 int motor_c_IN1=8;
 3 int motor_c_IN2=7;
 4
 5 #define ENCODER_A_PIN  2     //编码器A相接控制板2号引脚，对应0号外部中断
 6 #define ENCODER_B_PIN  3     //编码器B相接控制板3号引脚，
 7 long pulse_number=0;   // 脉冲计数
 8 int rpm;
 9
10 #include <MsTimer2.h>        //定时器库的头文件
11
12 void setup()
13 {
14      pinMode(motor_c_ENA,OUTPUT);  //电机C使能和PWM调速口
15     pinMode(motor_c_IN1,OUTPUT);   //电机C控制口
16     pinMode(motor_c_IN2,OUTPUT);   //电机C控制口
17
18     MsTimer2::set(500, send);     // 中断设置函数，每 500ms 进入一次中断
19     MsTimer2::start();            //开始计时
20
21     pinMode(ENCODER_A_PIN, INPUT);
22      pinMode(ENCODER_B_PIN, INPUT);
23      attachInterrupt(0, read_quadrature, FALLING);   //EN_A脚下降沿触发中断
24     Serial.begin(9600);    //初始化Arduino串口
25 }
26
27 void loop()
28 {
29 //C加速正转
30    digitalWrite(motor_c_IN1,0);
31     digitalWrite(motor_c_IN2,1);
32     for (int a=100;a<=255;a++)
33      {
34         analogWrite(motor_c_ENA,a);
35         delay(200);
36      }
37
38 //C减速正转
39    digitalWrite(motor_c_IN1,0);
40     digitalWrite(motor_c_IN2,1);
41     for (int a=255;a>0;a--)
42     {
43         analogWrite(motor_c_ENA,a);
44         delay(200);
45      }
46 }
47
48 void send()     //速度串行传送
49 {
50      rpm=int(pulse_number/37.4);
51 //编码器精度为224线，减速器减速比为1:20，故系数=(224/(60/0.5))*20=37.4
52      Serial.print("rpm: ");
53      Serial.println(rpm, DEC);
54      pulse_number = 0;
55 }
56
57 void read_quadrature()    //编码器脉冲计数中断函数
58 {
59   if (digitalRead(ENCODER_A_PIN) == LOW)
60   {
61     if (digitalRead(ENCODER_B_PIN) == LOW)    // 查询EN_B的电平以确认正转
62     { pulse_number ++; }
63     if (digitalRead(ENCODER_B_PIN) == HIGH)     // 查询EN_B的电平以确认反转
64     { pulse_number --; }
65   }
66 }