Diff: glibr.cpp

Revision:

0:437ae08befe3

Child:

1:c7215f5f9a72

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/glibr.cpp	Thu Mar 05 04:53:07 2015 +0000
@@ -0,0 +1,189 @@
+#include "glibr.h"
+#include "mbed.h"
+
+
+
+
+glibr::glibr(PinName sda, PinName scl):i2c(sda, scl){
+       
+}    
+   
+glibr::~glibr(){
+       
+} 
+
+ uint8_t  glibr::ginit(){
+    uint8_t id;
+    
+ //   if( !wireReadDataByte(APDS9960_ID, id) ) {
+        
+     id=I2CreadByte(APDS9960_I2C_ADDR, APDS9960_ID);
+    
+    if( (!(id == APDS9960_ID_1 || id == APDS9960_ID_2))||id==ERROR) {
+         return false;
+    }
+    
+    if(!setMode(ALL, OFF)) {
+        return false;
+    }
+    if(I2CwriteByte(APDS9960_I2C_ADDR,APDS9960_ATIME, DEFAULT_ATIME)){
+        return false;
+    }
+    if(I2CwriteByte(APDS9960_I2C_ADDR,APDS9960_WTIME, DEFAULT_WTIME)){
+        return false;
+    }
+    if(I2CwriteByte(APDS9960_I2C_ADDR,APDS9960_PPULSE, DEFAULT_PROX_PPULSE)){
+        return false;
+    }
+    if(I2CwriteByte(APDS9960_I2C_ADDR,APDS9960_POFFSET_UR, DEFAULT_POFFSET_UR)){
+        return false;
+    }
+    if(I2CwriteByte(APDS9960_I2C_ADDR,APDS9960_POFFSET_DL, DEFAULT_POFFSET_DL)){
+        return false;
+    }
+    if(I2CwriteByte(APDS9960_I2C_ADDR,APDS9960_CONFIG1, DEFAULT_CONFIG1)){
+        return false;
+    }
+    
+    if( !setLEDDrive(DEFAULT_LDRIVE) ) {
+        return false;
+    }
+    
+    if( !setProximityGain(DEFAULT_PGAIN) ) {
+        return false;
+    }
+    if( !setAmbientLightGain(DEFAULT_AGAIN) ) {
+        return false;
+    }
+    if( !setProxIntLowThresh(DEFAULT_PILT) ) {
+        return false;
+    }
+
+
+    
+    
+    
+    return id;
+}
+
+
+
+
+/**
+ * @brief Enables or disables a feature in the APDS-9960
+ *
+ * @param[in] mode which feature to enable
+ * @param[in] enable ON (1) or OFF (0)
+ * @return True if operation success. False otherwise.
+ */
+bool glibr::setMode(uint8_t mode, uint8_t enable)
+{
+    uint8_t reg_val;
+
+    /* Read current ENABLE register */
+    reg_val = getMode();
+    if( reg_val == ERROR ) {
+        return false;
+    }
+    
+    /* Change bit(s) in ENABLE register */
+    enable = enable & 0x01;
+    if( mode >= 0 && mode <= 6 ) {
+        if (enable) {
+            reg_val |= (1 << mode);
+        } else {
+            reg_val &= ~(1 << mode);
+        }
+    } else if( mode == ALL ) {
+        if (enable) {
+            reg_val = 0x7F;
+        } else {
+            reg_val = 0x00;
+        }
+    }
+    
+    /* Write value back to ENABLE register */     
+    if(I2CwriteByte(APDS9960_I2C_ADDR,APDS9960_ENABLE, reg_val)){
+        return false;
+    }
+   
+
+        
+    return true;
+}
+
+uint8_t glibr::getMode()
+{
+    return I2CreadByte(APDS9960_I2C_ADDR, APDS9960_ENABLE);
+}
+
+bool glibr::setLEDDrive(uint8_t drive)
+{
+    uint8_t val;
+    
+    /* Read value from CONTROL register */
+
+    val=I2CreadByte(APDS9960_I2C_ADDR,APDS9960_CONTROL);
+    if(val==ERROR){
+        return false;   
+    }
+    /* Set bits in register to given value */
+    drive &= 0x03;
+    drive = drive << 6;
+    //val &= 0b00111111;
+    val &= 0x3F;
+    val |= drive;
+    
+    /* Write register value back into CONTROL register */
+    if( I2CwriteByte(APDS9960_I2C_ADDR,APDS9960_CONTROL, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+bool glibr::setProximityGain(uint8_t drive)
+{
+    uint8_t val;
+    
+    /* Read value from CONTROL register */
+    if( !wireReadDataByte(APDS9960_CONTROL, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    drive &= 0b00000011;
+    drive = drive << 2;
+    val &= 0b11110011;
+    val |= drive;
+    
+    /* Write register value back into CONTROL register */
+    if( !wireWriteDataByte(APDS9960_CONTROL, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+
+
+
+int glibr::I2CwriteByte(char address, char subAddress, char data)
+{   
+    int ret;
+    char cmd[2] = {subAddress, data};
+    ret=i2c.write(address<<1, cmd, 2);  //if ret is 1, then not acked.
+    return ret;
+}
+
+uint8_t glibr::I2CreadByte(char address, char subAddress)
+{
+    char data; // store the register data
+    
+    if(i2c.write(address<<1, &subAddress, 1, true)){
+        return ERROR;   //7 bit   //not acked
+    } 
+    i2c.read(address<<1, &data, 1);
+    return data;
+
+}