求助个代码关于旋转编码器计算转速与转角的

APTX4869

#define ENCODER_A_PIN 2
#define ENCODER_B_PIN 3
#define SWITCH_PIN    4
long position;

void setup(){
  //setup our pins 初始化我们的需要的引脚
  pinMode(ENCODER_A_PIN, INPUT);
  pinMode(ENCODER_B_PIN, INPUT);
  pinMode(SWITCH_PIN, INPUT);

  attachInterrupt(0, read_quadrature, CHANGE);

  //setup our serial 初始化Arduino串口
  Serial.begin(9600);
}

void loop(){
   if (digitalRead(SWITCH_PIN) == LOW){
     delay(10);
     if (digitalRead(SWITCH_PIN) == LOW){
       Serial.println("Switch Pressed");
     }
   }
   Serial.print("Position: ");
   Serial.println(position, DEC);
   delay(1000);
}

void read_quadrature(){  
  // found a low-to-high on channel A ENA脚下降沿中断触发
  if (digitalRead(ENCODER_A_PIN) == LOW){   
    // check channel B to see which way 查询ENB的电平以确认是顺时针还是逆时针旋转
    if (digitalRead(ENCODER_B_PIN) == LOW)
      position++;
  }
  // found a high-to-low on channel A ENA脚上升沿中断触发
  else{
    // check channel B to see which way 查询ENB的电平以确认是顺时针还是逆时针旋转
    if (digitalRead(ENCODER_B_PIN) == LOW)
      position--;
  }
}


网上关于旋转编码器的材料太少了，这是找到的别人写的代码，可惜不会改啊，串口能读出旋转过的位置数，不知道在哪填进角度转化啊，求个好人给改下，谢谢了

frame66

角度是更具编码器一整圈的脉冲数换算出来的。

APTX4869

frame66 发表于 2014-5-18 23:45
角度是更具编码器一整圈的脉冲数换算出来的。

嗯，编码器一圈是20个脉冲，不知道在哪改啊

frame66

20个脉冲是一圈360度，那么1个脉冲就是18度，用position*18就可以转换成度数了。

908495557

问一下。你用的是哪种旋转编码器啊。。？？？