C语言写一段用编码器脉冲测距的代码

好的，以下是一段使用编码器脉冲测距的C语言代码：

#include <stdio.h>
#include <wiringPi.h>

int main(void) {
  wiringPiSetup(); // 初始化WiringPi库

  int pinA = 0; // 编码器信号A
  int pinB = 1; // 编码器信号B

  int count = 0; // 记录脉冲数量
  int distance = 0; // 记录距离

  int lastA = 0; // 上一次的信号A

  pinMode(pinA, INPUT);
  pinMode(pinB, INPUT);

  while(1) { // 无限循环
    int currentA = digitalRead(pinA); // 读取当前信号A
    int currentB = digitalRead(pinB); // 读取当前信号B

    if (currentA == 1 && lastA == 0) { // 如果检测到下降沿
      if (currentB == 0) { // 如果信号B是0
        count++; // 脉冲数量加1
      } else { // 如果信号B是1
        count--; // 脉冲数量减1
      }
    }

    lastA = currentA; // 更新上一次的信号A

    delay(1); // 延时1毫秒

    if (count >= 100) { // 如果脉冲数量达到100个
      distance++; // 距离加1
      count = 0; // 重新计数
    } else if (count <= -100) { // 如果脉冲数量达到-100个
      distance--; // 距离减1
      count = 0; // 重新计数
    }

    printf("Distance: %d\n", distance); // 打印距离
  }

  return 0;
}

这段代码使用了编码器信号的A和B两个引脚，输入到Raspberry Pi的GPIO0和GPIO1引脚中。根据脉冲的数量和方向，可计算出物体运动的距离。请确保正确连接硬件并进行测试后再使用。