โมดูลวัดระยะทางด้วยเรเซอร์ TOF050F 50CM(max) based on VL6180 Modbus I2C Serial Output Multi-Mode High Precision Distance Sensor Module

Storage temperature:-20℃-80℃

การใช้งาน

ค่าเริ่มต้นของโมดูลคือ โมดูลจะส่งค่าระยะที่ตรวจจับได้ออกมาอย่างต่อเนื่อง ในรูปแบบ Modbus RTU protocal 
เช่น อ่านค่าได้เช่น วัตถุมีระยะห่างจากเซนเซอร์ 90 mm.
จะอ่านค่าได้  0x01 0x03 0x02 0x00 0x5D 0x79 0xBD  เป็นต้น

โดยรูปแบบของข้อมูลจะเป็นไปตามตาราง


ผู้ใช้งานสามารถเชื่อมต่อด้วยไมโครคอนโทรเลอร์หรือคอมพิวเตอร์ได้โดยใช้โมดูล USB to TTL 

วิธีการเชื่อมต่อสายสัญญาณ TOF050 (โหมด default) กับ Arduino NANO


ตัวอย่างโคด

ผลการทดสอบ


ภาพการทดสอบ


วิธีการเปลี่ยนการตั้งค่าโมดูลวัดระยะทางเป็นโหมด I2C
อุปกรณ์ที่เกี่ยวข้อง

วิธีการเชื่อมต่อสายสัญญาณเพื่อใช้กับ PC

ดาวน์โหลดโปรแกรม Serial Port Terminal เพื่อใช้รับค่าและส่งคำสั่งต่างๆกับโมดูล

เมื่อลงโปรแกรมแล้วเปิดโปรแกรมแล้วตั้งค่าตามรูปเมื่อกดปุ่ม connect จะอ่านค่าข้อมูลที่เซนเซอร์ส่งมาได้ต่อเนื่อง


หากต้องการเปลี่ยนโหมดให้สื่อสารเป็นแบบ I2C 

ให้ส่งคำสั่ง 01 06 00 09 00 01 98 08 โดยใช้โปรแกรม Serial Port Terminal แล้วกดปุ่ม Send Hex
จะเห็นได้ว่าข้อมูลที่ส่งมาต่อเนื่องจะหยุดลงทันทีเนื่องจากเปลี่ยนเป็นโหมด I2C แล้ว
โดยจะมี Address เริ่มต้นที่ 0x29

หากต้องการตั้งค่าอื่นๆก็สามารถทำได้โดยวิธีเดียวกันนี้แต่ต้องเอาคำสั่งมาคำนวน CRC ก่อนใช้งานด้วย
เนื่องจากเป็นมาตรฐานของ Modbus สามารถใช้เว็บคำนวนที่มีทั่วไปได้เพื่อความสะดวกเช่น 
เว็บ On-line CRC calculation and free library

ตัวอย่างเช่น คำสั่งที่เคยใช้เปลี่ยนโหมดเป็น I2C คือ 01 06 00 09 00 01 + CRC 2 byte 
เราจะหาค่านี้ได้โดยเข้าไปที่เว็บแล้วใส่คำสั่งลงไป เลือกประเภทเป็น Hex เมื่อกดคำนวนจะได้ค่า CRC ออกมา
ให้เราเลือกเป็น CRC-16 (Modbus) 

แต่เนื่องจากการส่งข้อมูล Modbus จะเป็นแบบ Little-endian: ไบต์ที่มีค่าสำคัญที่สุด (MSB) จึงต้องสลับตำแหน่ง CRC ด้วย
จาก 0898 จะต้องสลับเป็น 9808 จึงได้คำสั่งรวมทั้งหมดคือ 01 06 00 09 00 01 98 08 เพื่อนำไปใช้จริง
หลังจากนั้นให้ต่อสายสัญญาณต่างๆตามรูป

ลง จากจากนั้นให้ download Library Adafruit_VL6180x 


ตัวอย่างโคดในโหมด I2C

#include <Wire.h>

#include "Adafruit_VL6180X.h"

Adafruit_VL6180X vl = Adafruit_VL6180X();

void setup() {

  Serial.begin(115200);

  if (! vl.begin()) {

    Serial.println("Failed to find sensor");

    while (1);

  }

  Serial.println("Sensor found!");

}

void loop() {  

  uint8_t range = vl.readRange();

  uint8_t status = vl.readRangeStatus();

  if (status == VL6180X_ERROR_NONE) {

    Serial.print("Range: "); Serial.println(range);

  }

  delay(50);

}

ผลการทดสอบ


ภาพการทดสอบ