5. 编码器与PID控制

编码器基础

对机器人实现位置和速度的控制需要使用传感器获取机器人运动的信息，编码器是常用的方式。常见的编码器有增量式编码器和绝对式编码器。

绝对式编码器

绝对式编码器通过对码盘上的各个位置设计特定的编码，可以输出转动轴的绝对位置信息。

增量式编码器

增量式编码器无法直接得到轴的绝对位置信息。对于轴的每一圈转动，增量式编码器提供一定数量的脉冲（通常编码器参数中用n线/n脉冲来表示）。通过测量脉冲的数量可以得到旋转的角度，或者测量单位时间内的脉冲数可以得到轴的转速。

但这里涉及到方向的问题，单纯从一相的脉冲输出无法判断轴的旋转方向，所以通常增量式编码器通过输出AB两相脉冲实现方向的测量。AB两相脉冲之间相差90°。

例如上图中的增量式编码器脉冲，当编码器正转时，B相脉冲的上升沿对应A相高电平，而当编码器反转时，B相上升沿对应A向低电平。如此判断旋转方向。

旋转编码器很重要的参数是其每圈输出的脉冲数，以400线的编码器为例，每转动一圈，AB相各输出400个脉冲。通过4倍频可以实现更高的测量精度。

4倍频

所谓4倍频就是对AB相的上升沿和下降沿均作检测，这样在一个周期内有四种状态，如下：

旋转方向为正向时，A相上升沿对应B相低电平 -> B相上升沿对应A相高电平 -> A相下降沿对应B相高电平 -> B相下降沿对应A相低电平

旋转方向为反向时，B相上升沿对应A相低电平 -> A相上升沿对应B相高电平 -> B相下降沿对应A相高电平 -> A相下降沿对应B相低电平

测试代码

具体代码实现可以通过Arduino中的中断判断CHANGE很容易实现4倍频。

#define Phase_A 2   //定义A相引脚
#define Phase_B 3   //定义B相引脚

unsigned long time;
long Position = 0;

boolean A = false;
boolean B = false;

void setup()
{
    pinMode(Phase_A, INPUT_PULLUP);//内部上拉，防止信号干扰
    pinMode(Phase_B, INPUT_PULLUP);

    attachInterrupt(0, Interrupt_A, CHANGE);//检测上升沿、下降沿
    attachInterrupt(1, Interrupt_B, CHANGE);//检测上升沿、下降沿

    Serial.begin(115200); //初始化Arduino串口
}

void loop(){
    time = millis();
    if(time%30 == 0){
        Serial.println(Position,DEC);
    }
}

void Interrupt_A(){ 
    if(A == false){
        if( B == false){Position = Position + 1;A == true;}
        else{Position = Position - 1;A == true;}
    }
    else{
        if( B == false){Position = Position - 1;A == false;}
        else{Position = Position + 1;A == false;}
    }
}

void Interrupt_B(){ 
    if(B == false){
        if( A == false){Position = Position - 1;B == true;}
        else{Position = Position + 1;A == true;}
    }
    else{
        if( A == false){Position = Position + 1;B == false;}
        else{Position = Position - 1;B == false;}
    }
}

转载于:https://www.cnblogs.com/pibot/articles/8021724.html