Create Adafruit_VCNL4010.cpp

Author: TheKitty

Feather_Holiday_Lights/Feather_32u4_Lights/Adafruit_VCNL4010.cpp

@@ -0,0 +1,110 @@
+#include "Arduino.h"
+#include "Wire.h"
+
+#include "Adafruit_VCNL4010.h"
+
+bool Adafruit_VCNL4010::begin(uint8_t addr) {
+  _i2caddr = addr;
+  Wire.begin();
+
+  uint8_t rev = read8(VCNL4010_PRODUCTID);
+  if ((rev & 0xF0) != 0x20) {
+    return false;
+  }
+
+  write8(VCNL4010_IRLED, 20);
+  uint8_t r =  read8(VCNL4010_MODTIMING);
+  r &= ~(0b00011000);
+  r |= VCNL4010_390K625 << 3;
+  write8(VCNL4010_MODTIMING, r);
+
+  write8(VCNL4010_INTCONTROL, 0x08);
+  return true;
+}
+
+uint16_t Adafruit_VCNL4010::readProximity() {
+  uint8_t i = read8(VCNL4010_INTSTAT);
+  i &= ~0x80;
+  write8(VCNL4010_INTSTAT, i);
+
+  write8(VCNL4010_COMMAND, VCNL4010_MEASUREPROXIMITY);
+  while (1) {
+    //Serial.println(read8(VCNL4010_INTSTAT), HEX);
+    uint8_t result = read8(VCNL4010_COMMAND);
+    //Serial.print("Ready = 0x"); Serial.println(result, HEX);
+    if (result & VCNL4010_PROXIMITYREADY) {
+      return read16(VCNL4010_PROXIMITYDATA);
+    }
+    delay(1);
+  }
+}
+
+// Read 1 byte from the VCNL4000 at 'address'
+uint8_t Adafruit_VCNL4010::read8(uint8_t address)
+{
+  uint8_t data;
+
+  Wire.beginTransmission(_i2caddr);
+#if ARDUINO >= 100
+  Wire.write(address);
+#else
+  Wire.send(address);
+#endif
+  Wire.endTransmission();
+
+  delayMicroseconds(170);  // delay required
+
+  Wire.requestFrom(_i2caddr, (uint8_t)1);
+  while(!Wire.available());
+
+#if ARDUINO >= 100
+  return Wire.read();
+#else
+  return Wire.receive();
+#endif
+}
+
+
+// Read 2 byte from the VCNL4000 at 'address'
+uint16_t Adafruit_VCNL4010::read16(uint8_t address)
+{
+  uint16_t data;
+
+  Wire.beginTransmission(_i2caddr);
+#if ARDUINO >= 100
+  Wire.write(address);
+#else
+  Wire.send(address);
+#endif
+  Wire.endTransmission();
+
+  Wire.requestFrom(_i2caddr, (uint8_t)2);
+  while(!Wire.available());
+#if ARDUINO >= 100
+  data = Wire.read();
+  data <<= 8;
+  while(!Wire.available());
+  data |= Wire.read();
+#else
+  data = Wire.receive();
+  data <<= 8;
+  while(!Wire.available());
+  data |= Wire.receive();
+#endif
+  
+  return data;
+}
+
+// write 1 byte
+void Adafruit_VCNL4010::write8(uint8_t address, uint8_t data)
+{
+  Wire.beginTransmission(_i2caddr);
+#if ARDUINO >= 100
+  Wire.write(address);
+  Wire.write(data);  
+#else
+  Wire.send(address);
+  Wire.send(data);  
+#endif
+  Wire.endTransmission();
+}