tof400f 测距代码arduino

TOF400F是一种基于时间的飞行测距传感器，可以用于测量物体与传感器之间的距离。它可以通过串口和I2C两种方式与Arduino进行通信，其中I2C通信方式需要外接I2C转接板。

以下是一份简单的TOF400F测距代码Arduino示例：

#include <Wire.h>

const int TOF_ADDR = 0x29; // TOF400F默认I2C地址
const byte CMD_RANGE = 0x51; // 测距命令

void setup() {
  Wire.begin(); // 初始化I2C通信
  Serial.begin(9600); // 初始化串口通信
}

void loop() {
  byte data;
  Wire.beginTransmission(TOF_ADDR);
  Wire.write(CMD_RANGE); // 发送测距命令
  Wire.endTransmission();

  delay(70); // 等待70毫秒，让传感器完成测距

  Wire.requestFrom(TOF_ADDR, 2); // 请求读取两个字节的数据
  if (Wire.available() >= 2) {
    data = Wire.read();
    data = Wire.read();
    int distance = (data << 8) | data; // 将两个字节合并成一个16位整数
    Serial.print("Distance: ");
    Serial.print(distance);
    Serial.println("mm");
  }

  delay(200); // 等待200毫秒，再次进行测距
}

这段代码使用了Arduino的Wire库来进行I2C通信，并使用了TOF400F的默认I2C地址0x29来进行通信。其中CMD_RANGE是测距命令，在每次测距前需要向传感器发送该命令。在请求读取两个字节的数据后，将其合并成一个16位整数，即为测距得到的距离值。