Diff: Prox.cpp

Revision:

0:10fe9a5a884f

Child:

1:159407640167

diff -r 000000000000 -r 10fe9a5a884f Prox.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Prox.cpp	Mon Jan 04 12:28:26 2016 +0000
@@ -0,0 +1,105 @@
+#include "Prox.h"
+
+Prox::Prox(PinName sda, PinName scl) { 
+    _sda = sda;
+    _scl = scl;
+
+    //WriteByte(0x72,0xE5); // Clear interrupt
+    
+    char PTIME;
+    char WTIME;
+    char PPULSE;
+
+    WTIME = 0xff; // 2.7 ms - minimum Wait time
+    PTIME = 0xff; // 2.7 ms - minimum Prox integration time
+    PPULSE = 1; // Minimum prox pulse count
+ 
+    WriteByte(0x72, 0, 0); //Disable and Powerdown
+    WriteByte (0x72, 2, PTIME);
+    WriteByte (0x72, 3, WTIME);
+    WriteByte (0x72, 0xe, PPULSE);
+    
+    char PDRIVE;
+    char PDIODE;
+    char PGAIN;
+    
+    PDRIVE = 0; //100mA of LED Power
+    PDIODE = 0x20; // CH1 Diode
+    PGAIN = 0x08; //4x Prox gain
+
+    WriteByte (0x72, 0xf, PDRIVE | PDIODE | PGAIN );
+
+    char WEN, PEN, PON, PIEN;
+    WEN = 8; // Enable Wait
+    PIEN = 5; //Enable interrupt
+    PEN = 4; // Enable Prox
+    PON = 1; // Enable Power On
+
+    WriteByte (0x72, 0, WEN | PIEN | PEN | PON);
+    
+    char PIHTL, PIHTH; //Upper interrupt threshold low and high bytes
+    
+    PIHTL = 0;
+    PIHTH = 0x80; //trigger at 256
+    
+    WriteByte (0x72, 0x0A, PIHTL);
+    WriteByte (0x72, 0x0B, PIHTH);
+    
+    wait(0.12); //Wait for 120 ms
+}
+
+uint8_t Prox::readProx(){
+    WriteByte (0x72, 0xE5); //clear interrupt pin (untested)
+    uint8_t prox;
+    ReadWord(0x72, 0x18, &prox);
+    return prox;
+}
+ 
+
+
+
+
+// Read a byte on the i2c interface
+
+void Prox::ReadWord(char addr, char reg, uint8_t *data) {
+  I2C i2c(_sda,_scl);
+  char reg1 = 0xA0 | reg;
+  char reading[2];
+  i2c.write(addr,&reg1,1);
+  i2c.read(addr,reading,2);
+  *data = reading[0] | (reading[1]<<8);
+  wait(0.07);
+}
+
+void Prox::ReadByte(char addr, char reg, char *bytedata) {
+  I2C i2c(_sda,_scl);
+  char tempdata;
+  char reg1 = 0x80 | reg;
+  i2c.write(addr,&reg1,1);
+  i2c.read(addr,&tempdata,1);
+  *bytedata = tempdata;
+  wait(0.07);
+}
+
+
+
+// Write a byte on the i2c interface
+
+void Prox::WriteByte(uint8_t addr, uint8_t reg, char data) {
+    I2C i2c(_sda,_scl);
+    char data1[2];
+    data1[0] = 0x80 | reg;
+    data1[1] = data;
+    i2c.write(addr,data1,2);
+    wait(0.07);
+
+}
+
+void Prox::WriteByte(uint8_t addr, uint8_t reg) {
+    I2C i2c(_sda,_scl);
+    char data1;
+    data1 = 0x80 | reg;
+    i2c.write(addr,&data1,1);
+    wait(0.07);
+
+}
\ No newline at end of file