标题: VL53L0X arduino源代码+电路图+PDF资料 [打印本页]

---

作者: ZW_123456    时间: 2019-3-9 16:43
标题: VL53L0X arduino源代码+电路图+PDF资料
电路原理图如下：


VL53L0X 的Arduino源代码

1. //the original code by Ted Meyers
   
2. 
   
3. #include <Wire.h>
   
4. 
   
5. #define VL53L0X_REG_IDENTIFICATION_MODEL_ID         0xc0
   
6. #define VL53L0X_REG_IDENTIFICATION_REVISION_ID      0xc2
   
7. #define VL53L0X_REG_PRE_RANGE_CONFIG_VCSEL_PERIOD   0x50
   
8. #define VL53L0X_REG_FINAL_RANGE_CONFIG_VCSEL_PERIOD 0x70
   
9. #define VL53L0X_REG_SYSRANGE_START                  0x00
   
10. #define VL53L0X_REG_RESULT_INTERRUPT_STATUS         0x13
    
11. #define VL53L0X_REG_RESULT_RANGE_STATUS             0x14
    
12. #define address 0x29
    
13. 
    
14. byte gbuf[16];
    
15. 
    
16. void setup() {
    
17.   // put your setup code here, to run once:
    
18.   Wire.begin();        // join i2c bus (address optional for master)
    
19.   Serial.begin(9600);  // start serial for output
    
20.   Serial.println("VLX53LOX test started.");
    
21. }
    
22. 
    
23. void loop() {
    
24.   Serial.println("----- START TEST ----");
    
25.   test();
    
26.   Serial.println("----- END TEST ----");
    
27.   Serial.println("");
    
28.   delay(1000);
    
29. }
    
30. 
    
31. void test() {
    
32.   byte val1 = read_byte_data_at(VL53L0X_REG_IDENTIFICATION_REVISION_ID);
    
33.   Serial.print("Revision ID: "); Serial.println(val1);
    
34. 
    
35.   val1 = read_byte_data_at(VL53L0X_REG_IDENTIFICATION_MODEL_ID);
    
36.   Serial.print("Device ID: "); Serial.println(val1);
    
37. 
    
38.   val1 = read_byte_data_at(VL53L0X_REG_PRE_RANGE_CONFIG_VCSEL_PERIOD);
    
39.   Serial.print("PRE_RANGE_CONFIG_VCSEL_PERIOD="); Serial.println(val1);
    
40.   Serial.print(" decode: "); Serial.println(VL53L0X_decode_vcsel_period(val1));
    
41. 
    
42.   val1 = read_byte_data_at(VL53L0X_REG_FINAL_RANGE_CONFIG_VCSEL_PERIOD);
    
43.   Serial.print("FINAL_RANGE_CONFIG_VCSEL_PERIOD="); Serial.println(val1);
    
44.   Serial.print(" decode: "); Serial.println(VL53L0X_decode_vcsel_period(val1));
    
45. 
    
46.   write_byte_data_at(VL53L0X_REG_SYSRANGE_START, 0x01);
    
47. 
    
48.   byte val = 0;
    
49.   int cnt = 0;
    
50.   while (cnt < 100) { // 1 second waiting time max
    
51.     delay(10);
    
52.     val = read_byte_data_at(VL53L0X_REG_RESULT_RANGE_STATUS);
    
53.     if (val & 0x01) break;
    
54.     cnt++;
    
55.   }
    
56.   if (val & 0x01) Serial.println("ready"); else Serial.println("not ready");
    
57. 
    
58.   read_block_data_at(0x14, 12);
    
59.   uint16_t acnt = makeuint16(gbuf[7], gbuf[6]);
    
60.   uint16_t scnt = makeuint16(gbuf[9], gbuf[8]);
    
61.   uint16_t dist = makeuint16(gbuf[11], gbuf[10]);
    
62.   byte DeviceRangeStatusInternal = ((gbuf[0] & 0x78) >> 3);
    
63. 
    
64.   Serial.print("ambient count: "); Serial.println(acnt);
    
65.   Serial.print("signal count: ");  Serial.println(scnt);
    
66.   Serial.print("distance ");       Serial.println(dist);
    
67.   Serial.print("status: ");        Serial.println(DeviceRangeStatusInternal);
    
68. }
    
69. 
    
70. uint16_t bswap(byte b[]) {
    
71.   // Big Endian unsigned short to little endian unsigned short
    
72.   uint16_t val = ((b[0] << 8) & b[1]);
    
73.   return val;
    
74. }
    
75. 
    
76. uint16_t makeuint16(int lsb, int msb) {
    
77.     return ((msb & 0xFF) << 8) | (lsb & 0xFF);
    
78. }
    
79. 
    
80. void write_byte_data(byte data) {
    
81.   Wire.beginTransmission(address);
    
82.   Wire.write(data);
    
83.   Wire.endTransmission();
    
84. }
    
85. 
    
86. void write_byte_data_at(byte reg, byte data) {
    
87.   // write data word at address and register
    
88.   Wire.beginTransmission(address);
    
89.   Wire.write(reg);
    
90.   Wire.write(data);
    
91.   Wire.endTransmission();
    
92. }
    
93. 
    
94. void write_word_data_at(byte reg, uint16_t data) {
    
95.   // write data word at address and register
    
96.   byte b0 = (data &0xFF);
    
97.   byte b1 = ((data >> 8) && 0xFF);
    
98.    
    
99.   Wire.beginTransmission(address);
    
100.   Wire.write(reg);
     
101.   Wire.write(b0);
     
102.   Wire.write(b1);
     
103.   Wire.endTransmission();
     
104. }
     
105. 
     
106. byte read_byte_data() {
     
107.   Wire.requestFrom(address, 1);
     
108.   while (Wire.available() < 1) delay(1);
     
109.   byte b = Wire.read();
     
110.   return b;
     
111. }
     
112. 
     
113. byte read_byte_data_at(byte reg) {
     
114.   //write_byte_data((byte)0x00);
     
115.   write_byte_data(reg);
     
116.   Wire.requestFrom(address, 1);
     
117.   while (Wire.available() < 1) delay(1);
     
118.   byte b = Wire.read();
     
119.   return b;
     
120. }
     
121. 
     
122. uint16_t read_word_data_at(byte reg) {
     
123.   write_byte_data(reg);
     
124.   Wire.requestFrom(address, 2);
     
125.   while (Wire.available() < 2) delay(1);
     
126.   gbuf[0] = Wire.read();
     
127.   gbuf[1] = Wire.read();
     
128.   return bswap(gbuf);
     
129. }
     
130. 
     
131. void read_block_data_at(byte reg, int sz) {
     
132.   int i = 0;
     
133.   write_byte_data(reg);
     
134.   Wire.requestFrom(address, sz);
     
135.   for (i=0; i<sz; i++) {
     
136.     while (Wire.available() < 1) delay(1);
     
137.     gbuf[i] = Wire.read();
     
138.   }
     
139. }
     
140. 
     
141. 
     
142. uint16_t VL53L0X_decode_vcsel_period(short vcsel_period_reg) {
     
143.   // Converts the encoded VCSEL period register value into the real
     
144.   // period in PLL clocks
     
145.   uint16_t vcsel_period_pclks = (vcsel_period_reg + 1) << 1;
     
146.   return vcsel_period_pclks;
     
147. }
     

复制代码

全部资料51hei下载地址：
GY-530 VL53L0X激光测距传感器模块 ToF测距 飞行时间测距传感器.rar (1.01 MB, 下载次数: 42)

2019-3-9 16:43 上传

点击文件名下载附件
下载积分: 黑币 -5

---

欢迎光临 (http://www.51hei.com/bbs/)

Powered by Discuz! X3.1