APDS9960 gesture sensor library for use with mbed. Ported from Justin Woodman's RPI APDS9960 library.

Files at this revision

API Documentation at this revision

Comitter:
chiggayeuh
Date:
Tue May 19 11:00:23 2015 +0000
Commit message:
Initial release of APDS9960 library for mBed

Changed in this revision

APDS9960_I2C.cpp Show annotated file Show diff for this revision Revisions of this file
APDS9960_I2C.h Show annotated file Show diff for this revision Revisions of this file
diff -r 000000000000 -r 49ae62548910 APDS9960_I2C.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/APDS9960_I2C.cpp	Tue May 19 11:00:23 2015 +0000
@@ -0,0 +1,2158 @@
+/**
+* @file    APDS9960.cpp
+* @brief   Raspberry Pi library for the SparkFun APDS-9960 breakout board
+* @author  Shawn Hymel (SparkFun Electronics), Modified for Raspberry Pi by Justin Woodman
+*
+* @copyright    This code is public domain but you buy me a beer if you use
+* this and we meet someday (Beerware license).
+*
+* This library interfaces the Avago APDS-9960 to Raspberry Pi over I2C. The library
+* relies on the wiringPi library. to use the library, instantiate an
+* APDS9960 object, call init(), and call the appropriate functions.
+*
+* APDS-9960 current draw tests (default parameters):
+*   Off:                   1mA
+*   Waiting for gesture:   14mA
+*   Gesture in progress:   35mA
+*/
+
+#include "APDS9960_I2C.h"
+#include <bitset>
+#include <stdio.h>
+#include <stdlib.h>
+#include <bitset>
+#include <iostream>
+#include <iomanip>
+#include "mbed.h"
+
+
+
+
+
+
+/**
+* @brief Constructor - Instantiates APDS9960 object
+*/
+
+
+APDS9960_I2C::APDS9960_I2C( PinName sda, PinName scl ) : i2c( sda, scl )
+{
+    i2c.frequency(100000);
+    
+    gesture_ud_delta_ = 0;
+    gesture_lr_delta_ = 0;
+    
+    gesture_ud_count_ = 0;
+    gesture_lr_count_ = 0;
+    
+    gesture_near_count_ = 0;
+    gesture_far_count_ = 0;
+    
+    gesture_state_ = 0;
+    gesture_motion_ = DIR_NONE;
+}
+
+/**
+* @brief Destructor
+*/
+//APDS9960_I2C::~APDS9960()
+//{
+
+//}
+
+/**
+* @brief Configures I2C communications and initializes registers to defaults
+*
+* @return True if initialized successfully. False otherwise.
+*/
+
+uint8_t APDS9960_I2C::read_this(){
+    //uint8_t val;
+    //wireReadDataByte(APDS9960_GFLVL, val);
+    //val &= 1;
+    /*uint8_t fifo_data[128];
+    uint8_t fifo_level;
+    
+    if( !wireReadDataByte(APDS9960_GFLVL, fifo_level) ) {
+                return ERROR;
+            }
+    
+    
+    val = wireReadDataBlock(  APDS9960_GFIFO_U, 
+                (uint8_t*)fifo_data, 
+                (fifo_level * 4) );
+                
+    return val;*/
+    
+}
+
+int APDS9960_I2C::write_this(){
+    int id;
+    id = wireWriteDataByte(APDS9960_WTIME, DEFAULT_WTIME);
+    return id;
+}
+
+bool APDS9960_I2C::init()
+{
+    uint8_t id;
+    /* Initialize I2C */
+    /*fd_ = wiringPiI2CSetup(APDS9960_I2C_ADDR);
+    if(fd_ == -1) {
+        return false;
+    }*/
+    
+    /* Read ID register and check against known values for APDS-9960 */
+    if( !wireReadDataByte(0x92, id) ) {
+        return false;
+    }
+    if( !(id == 0xAB || id == 0x9C) ) {
+        return false;
+    }
+    
+    /* Set ENABLE register to 0 (disable all features) */
+    if( !setMode(7, 0) ) {
+        return false;
+    }
+    
+    /* Set default values for ambient light and proximity registers */
+    //if( !(0x81, 219) ) {
+    //    return false;
+    //}
+    if( !wireWriteDataByte(APDS9960_WTIME, DEFAULT_WTIME) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_PPULSE, DEFAULT_PROX_PPULSE) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_POFFSET_UR, DEFAULT_POFFSET_UR) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_POFFSET_DL, DEFAULT_POFFSET_DL) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(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;
+    }
+    if( !setProxIntHighThresh(DEFAULT_PIHT) ) {
+        return false;
+    }
+    if( !setLightIntLowThreshold(DEFAULT_AILT) ) {
+        return false;
+    }
+    if( !setLightIntHighThreshold(DEFAULT_AIHT) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_PERS, DEFAULT_PERS) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_CONFIG2, DEFAULT_CONFIG2) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_CONFIG3, DEFAULT_CONFIG3) ) {
+        return false;
+    }
+    
+    /* Set default values for gesture sense registers */
+    if( !setGestureEnterThresh(DEFAULT_GPENTH) ) {
+        return false;
+    }
+    if( !setGestureExitThresh(DEFAULT_GEXTH) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_GCONF1, DEFAULT_GCONF1) ) {
+        return false;
+    }
+    if( !setGestureGain(DEFAULT_GGAIN) ) {
+        return false;
+    }
+    if( !setGestureLEDDrive(DEFAULT_GLDRIVE) ) {
+        return false;
+    }
+    if( !setGestureWaitTime(DEFAULT_GWTIME) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_GOFFSET_U, DEFAULT_GOFFSET) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_GOFFSET_D, DEFAULT_GOFFSET) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_GOFFSET_L, DEFAULT_GOFFSET) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_GOFFSET_R, DEFAULT_GOFFSET) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_GPULSE, DEFAULT_GPULSE) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_GCONF3, DEFAULT_GCONF3) ) {
+        return false;
+    }
+    if( !setGestureIntEnable(DEFAULT_GIEN) ) {
+        return false;
+    }
+    
+
+
+    return true;
+}
+
+/*******************************************************************************
+* Public methods for controlling the APDS-9960
+******************************************************************************/
+
+/**
+* @brief Reads and returns the contents of the ENABLE register
+*
+* @return Contents of the ENABLE register. 0xFF if error.
+*/
+uint8_t APDS9960_I2C::getMode()
+{
+    uint8_t enable_value;
+    
+    /* Read current ENABLE register */
+    if( !wireReadDataByte(APDS9960_ENABLE, enable_value) ) {
+        return ERROR;
+    }
+    
+    return enable_value;
+}
+
+/**
+* @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 APDS9960_I2C::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( !wireWriteDataByte(APDS9960_ENABLE, reg_val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Starts the light (R/G/B/Ambient) sensor on the APDS-9960
+*
+* @param[in] interrupts true to enable hardware interrupt on high or low light
+* @return True if sensor enabled correctly. False on error.
+*/
+bool APDS9960_I2C::enableLightSensor(bool interrupts)
+{
+    
+    /* Set default gain, interrupts, enable power, and enable sensor */
+    if( !setAmbientLightGain(DEFAULT_AGAIN) ) {
+        return false;
+    }
+    if( interrupts ) {
+        if( !setAmbientLightIntEnable(1) ) {
+            return false;
+        }
+    } else {
+        if( !setAmbientLightIntEnable(0) ) {
+            return false;
+        }
+    }
+    if( !enablePower() ){
+        return false;
+    }
+    if( !setMode(AMBIENT_LIGHT, 1) ) {
+        return false;
+    }
+    
+    return true;
+
+}
+
+/**
+* @brief Ends the light sensor on the APDS-9960
+*
+* @return True if sensor disabled correctly. False on error.
+*/
+bool APDS9960_I2C::disableLightSensor()
+{
+    if( !setAmbientLightIntEnable(0) ) {
+        return false;
+    }
+    if( !setMode(AMBIENT_LIGHT, 0) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Starts the proximity sensor on the APDS-9960
+*
+* @param[in] interrupts true to enable hardware external interrupt on proximity
+* @return True if sensor enabled correctly. False on error.
+*/
+bool APDS9960_I2C::enableProximitySensor(bool interrupts)
+{
+    /* Set default gain, LED, interrupts, enable power, and enable sensor */
+    if( !setProximityGain(DEFAULT_PGAIN) ) {
+        return false;
+    }
+    if( !setLEDDrive(DEFAULT_LDRIVE) ) {
+        return false;
+    }
+    if( interrupts ) {
+        if( !setProximityIntEnable(1) ) {
+            return false;
+        }
+    } else {
+        if( !setProximityIntEnable(0) ) {
+            return false;
+        }
+    }
+    if( !enablePower() ){
+        return false;
+    }
+    if( !setMode(PROXIMITY, 1) ) {
+        return false;
+    }
+    
+    return true;
+}
+bool disableProximitySensor();
+
+/**
+* @brief Starts the gesture recognition engine on the APDS-9960
+*
+* @param[in] interrupts true to enable hardware external interrupt on gesture
+* @return True if engine enabled correctly. False on error.
+*/
+bool APDS9960_I2C::enableGestureSensor(bool interrupts)
+{
+    
+    /* Enable gesture mode
+    Set ENABLE to 0 (power off)
+    Set WTIME to 0xFF
+    Set AUX to LED_BOOST_300
+    Enable PON, WEN, PEN, GEN in ENABLE 
+    */
+    resetGestureParameters();
+    if( !wireWriteDataByte(APDS9960_WTIME, 0xFF) ) {
+        return false;
+    }
+    if( !wireWriteDataByte(APDS9960_PPULSE, DEFAULT_GESTURE_PPULSE) ) {
+        return false;
+    }
+    if( !setLEDBoost(LED_BOOST_300) ) {
+        return false;
+    }
+    if( interrupts ) {
+        if( !setGestureIntEnable(1) ) {
+            return false;
+        }
+    } else {
+        if( !setGestureIntEnable(0) ) {
+            return false;
+        }
+    }
+    if( !setGestureMode(1) ) {
+        return false;
+    }
+    if( !enablePower() ){
+        return false;
+    }
+    if( !setMode(WAIT, 1) ) {
+        return false;
+    }
+    if( !setMode(PROXIMITY, 1) ) {
+        return false;
+    }
+    if( !setMode(GESTURE, 1) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Ends the gesture recognition engine on the APDS-9960
+*
+* @return True if engine disabled correctly. False on error.
+*/
+bool APDS9960_I2C::disableGestureSensor()
+{
+    resetGestureParameters();
+    if( !setGestureIntEnable(0) ) {
+        return false;
+    }
+    if( !setGestureMode(0) ) {
+        return false;
+    }
+    if( !setMode(GESTURE, 0) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Determines if there is a gesture available for reading
+*
+* @return True if gesture available. False otherwise.
+*/
+bool APDS9960_I2C::isGestureAvailable()
+{
+    uint8_t val;
+    
+    /* Read value from GSTATUS register */
+    if( !wireReadDataByte(APDS9960_GSTATUS, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out GVALID bit */
+    val &= 1; //00000001
+    
+    /* Return true/false based on GVALID bit */
+    if( val == 1) {
+        return true;
+    } else {
+        return false;
+    }
+}
+
+/**
+* @brief Processes a gesture event and returns best guessed gesture
+*
+* @return Number corresponding to gesture. -1 on error.
+*/
+int APDS9960_I2C::readGesture()
+{
+    uint8_t fifo_level = 0;
+    uint8_t bytes_read = 0;
+    uint8_t fifo_data[128];
+    uint8_t gstatus;
+    int motion;
+    int i;
+    
+    /* Make sure that power and gesture is on and data is valid */
+    if( !isGestureAvailable() || !(getMode() & 65) ) { //01000001
+        return DIR_NONE;
+    }
+    
+    /* Keep looping as long as gesture data is valid */
+    while(1) {
+        /* Wait some time to collect next batch of FIFO data */
+        wait_ms(FIFO_PAUSE_TIME);
+        
+        /* Get the contents of the STATUS register. Is data still valid? */
+        if( !wireReadDataByte(APDS9960_GSTATUS, gstatus) ) {
+            return ERROR;
+        }
+        
+        /* If we have valid data, read in FIFO */
+        
+        if( (gstatus & APDS9960_GVALID) == APDS9960_GVALID ) {//00000001    
+
+            /* Read the current FIFO level */
+            //return DIR_UP;
+            if( !wireReadDataByte(APDS9960_GFLVL, fifo_level) ) {
+                return ERROR;
+            }
+
+
+            /* If there's stuff in the FIFO, read it into our data block */
+            if( fifo_level > 0) {
+                bytes_read = wireReadDataBlock(  APDS9960_GFIFO_U, 
+                (uint8_t*)fifo_data, 
+                (fifo_level * 4) );
+                if( bytes_read == -1 ) {
+                    return ERROR;
+                }
+
+
+                /* If at least 1 set of data, sort the data into U/D/L/R */
+                if( bytes_read >= 4 ) {
+                    //return DIR_UP;
+                    for( i = 0; i < bytes_read; i += 4 ) {
+                        gesture_data_.u_data[gesture_data_.index] = fifo_data[i + 0];
+                        gesture_data_.d_data[gesture_data_.index] = fifo_data[i + 1];
+                        gesture_data_.l_data[gesture_data_.index] = fifo_data[i + 2];
+                        gesture_data_.r_data[gesture_data_.index] = fifo_data[i + 3];
+                        gesture_data_.index++;
+                        gesture_data_.total_gestures++;
+                    }
+                    
+
+                    /* Filter and process gesture data. Decode near/far state */
+                    if( processGestureData() ) {
+                        
+                        if( decodeGesture() ) {
+                            //***TODO: U-Turn Gesturesf
+                        }
+                    }
+                    
+                    /* Reset data */
+                    gesture_data_.index = 0;
+                    gesture_data_.total_gestures = 0;
+                }
+            }
+        } else {
+            
+            /* Determine best guessed gesture and clean up */
+            wait_ms(FIFO_PAUSE_TIME);
+            decodeGesture();
+            motion = gesture_motion_;
+
+            resetGestureParameters();
+            return motion;
+        }
+    }
+}
+
+/**
+* Turn the APDS-9960 on
+*
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::enablePower()
+{
+    if( !setMode(POWER, 1) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* Turn the APDS-9960 off
+*
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::disablePower()
+{
+    if( !setMode(POWER, 0) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/*******************************************************************************
+* Ambient light and color sensor controls
+******************************************************************************/
+
+/**
+* @brief Reads the ambient (clear) light level as a 16-bit value
+*
+* @param[out] val value of the light sensor.
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::readAmbientLight(uint16_t &val)
+{
+    uint8_t val_byte;
+    val = 0;
+    
+    /* Read value from clear channel, low byte register */
+    if( !wireReadDataByte(APDS9960_CDATAL, val_byte) ) {
+        return false;
+    }
+    val = val_byte;
+    
+    /* Read value from clear channel, high byte register */
+    if( !wireReadDataByte(APDS9960_CDATAH, val_byte) ) {
+        return false;
+    }
+    val = val + ((uint16_t)val_byte << 8);
+    
+    return true;
+}
+
+/**
+* @brief Reads the red light level as a 16-bit value
+*
+* @param[out] val value of the light sensor.
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::readRedLight(uint16_t &val)
+{
+    uint8_t val_byte;
+    val = 0;
+    
+    /* Read value from clear channel, low byte register */
+    if( !wireReadDataByte(APDS9960_RDATAL, val_byte) ) {
+        return false;
+    }
+    val = val_byte;
+    
+    /* Read value from clear channel, high byte register */
+    if( !wireReadDataByte(APDS9960_RDATAH, val_byte) ) {
+        return false;
+    }
+    val = val + ((uint16_t)val_byte << 8);
+    
+    return true;
+}
+
+/**
+* @brief Reads the green light level as a 16-bit value
+*
+* @param[out] val value of the light sensor.
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::readGreenLight(uint16_t &val)
+{
+    uint8_t val_byte;
+    val = 0;
+    
+    /* Read value from clear channel, low byte register */
+    if( !wireReadDataByte(APDS9960_GDATAL, val_byte) ) {
+        return false;
+    }
+    val = val_byte;
+    
+    /* Read value from clear channel, high byte register */
+    if( !wireReadDataByte(APDS9960_GDATAH, val_byte) ) {
+        return false;
+    }
+    val = val + ((uint16_t)val_byte << 8);
+    
+    return true;
+}
+
+/**
+* @brief Reads the red light level as a 16-bit value
+*
+* @param[out] val value of the light sensor.
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::readBlueLight(uint16_t &val)
+{
+    uint8_t val_byte;
+    val = 0;
+    
+    /* Read value from clear channel, low byte register */
+    if( !wireReadDataByte(APDS9960_BDATAL, val_byte) ) {
+        return false;
+    }
+    val = val_byte;
+    
+    /* Read value from clear channel, high byte register */
+    if( !wireReadDataByte(APDS9960_BDATAH, val_byte) ) {
+        return false;
+    }
+    val = val + ((uint16_t)val_byte << 8);
+    
+    return true;
+}
+
+/*******************************************************************************
+* Proximity sensor controls
+******************************************************************************/
+
+/**
+* @brief Reads the proximity level as an 8-bit value
+*
+* @param[out] val value of the proximity sensor.
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::readProximity(uint8_t &val)
+{
+    val = 0;
+    
+    /* Read value from proximity data register */
+    if( !wireReadDataByte(APDS9960_PDATA, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/*******************************************************************************
+* High-level gesture controls
+******************************************************************************/
+
+/**
+* @brief Resets all the parameters in the gesture data member
+*/
+void APDS9960_I2C::resetGestureParameters()
+{
+    gesture_data_.index = 0;
+    gesture_data_.total_gestures = 0;
+    
+    gesture_ud_delta_ = 0;
+    gesture_lr_delta_ = 0;
+    
+    gesture_ud_count_ = 0;
+    gesture_lr_count_ = 0;
+    
+    gesture_near_count_ = 0;
+    gesture_far_count_ = 0;
+    
+    gesture_state_ = 0;
+    gesture_motion_ = DIR_NONE;
+}
+
+/**
+* @brief Processes the raw gesture data to determine swipe direction
+*
+* @return True if near or far state seen. False otherwise.
+*/
+bool APDS9960_I2C::processGestureData()
+{
+    uint8_t u_first = 0;
+    uint8_t d_first = 0;
+    uint8_t l_first = 0;
+    uint8_t r_first = 0;
+    uint8_t u_last = 0;
+    uint8_t d_last = 0;
+    uint8_t l_last = 0;
+    uint8_t r_last = 0;
+    int ud_ratio_first;
+    int lr_ratio_first;
+    int ud_ratio_last;
+    int lr_ratio_last;
+    int ud_delta;
+    int lr_delta;
+    int i;
+
+    /* If we have less than 4 total gestures, that's not enough */
+    if( gesture_data_.total_gestures <= 4 ) {
+        return false;
+    }
+    
+    /* Check to make sure our data isn't out of bounds */
+    if( (gesture_data_.total_gestures <= 32) && \
+            (gesture_data_.total_gestures > 0) ) {
+        
+        /* Find the first value in U/D/L/R above the threshold */
+        for( i = 0; i < gesture_data_.total_gestures; i++ ) {
+            if( (gesture_data_.u_data[i] > GESTURE_THRESHOLD_OUT) &&
+                    (gesture_data_.d_data[i] > GESTURE_THRESHOLD_OUT) &&
+                    (gesture_data_.l_data[i] > GESTURE_THRESHOLD_OUT) &&
+                    (gesture_data_.r_data[i] > GESTURE_THRESHOLD_OUT) ) {
+                
+                u_first = gesture_data_.u_data[i];
+                d_first = gesture_data_.d_data[i];
+                l_first = gesture_data_.l_data[i];
+                r_first = gesture_data_.r_data[i];
+                break;
+            }
+        }
+        
+        /* If one of the _first values is 0, then there is no good data */
+        if( (u_first == 0) || (d_first == 0) || \
+                (l_first == 0) || (r_first == 0) ) {
+            
+            return false;
+        }
+        /* Find the last value in U/D/L/R above the threshold */
+        for( i = gesture_data_.total_gestures - 1; i >= 0; i-- ) {
+#if DEBUG
+            Serial.print(F("Finding last: "));
+            Serial.print(F("U:"));
+            Serial.print(gesture_data_.u_data[i]);
+            Serial.print(F(" D:"));
+            Serial.print(gesture_data_.d_data[i]);
+            Serial.print(F(" L:"));
+            Serial.print(gesture_data_.l_data[i]);
+            Serial.print(F(" R:"));
+            Serial.println(gesture_data_.r_data[i]);
+#endif
+            if( (gesture_data_.u_data[i] > GESTURE_THRESHOLD_OUT) &&
+                    (gesture_data_.d_data[i] > GESTURE_THRESHOLD_OUT) &&
+                    (gesture_data_.l_data[i] > GESTURE_THRESHOLD_OUT) &&
+                    (gesture_data_.r_data[i] > GESTURE_THRESHOLD_OUT) ) {
+                
+                u_last = gesture_data_.u_data[i];
+                d_last = gesture_data_.d_data[i];
+                l_last = gesture_data_.l_data[i];
+                r_last = gesture_data_.r_data[i];
+                break;
+            }
+        }
+    }
+    
+    /* Calculate the first vs. last ratio of up/down and left/right */
+    ud_ratio_first = ((u_first - d_first) * 100) / (u_first + d_first);
+    lr_ratio_first = ((l_first - r_first) * 100) / (l_first + r_first);
+    ud_ratio_last = ((u_last - d_last) * 100) / (u_last + d_last);
+    lr_ratio_last = ((l_last - r_last) * 100) / (l_last + r_last);
+    
+#if DEBUG
+    Serial.print(F("Last Values: "));
+    Serial.print(F("U:"));
+    Serial.print(u_last);
+    Serial.print(F(" D:"));
+    Serial.print(d_last);
+    Serial.print(F(" L:"));
+    Serial.print(l_last);
+    Serial.print(F(" R:"));
+    Serial.println(r_last);
+
+    Serial.print(F("Ratios: "));
+    Serial.print(F("UD Fi: "));
+    Serial.print(ud_ratio_first);
+    Serial.print(F(" UD La: "));
+    Serial.print(ud_ratio_last);
+    Serial.print(F(" LR Fi: "));
+    Serial.print(lr_ratio_first);
+    Serial.print(F(" LR La: "));
+    Serial.println(lr_ratio_last);
+#endif
+    
+    /* Determine the difference between the first and last ratios */
+    ud_delta = ud_ratio_last - ud_ratio_first;
+    lr_delta = lr_ratio_last - lr_ratio_first;
+    
+#if DEBUG
+    Serial.print("Deltas: ");
+    Serial.print("UD: ");
+    Serial.print(ud_delta);
+    Serial.print(" LR: ");
+    Serial.println(lr_delta);
+#endif
+
+    /* Accumulate the UD and LR delta values */
+    gesture_ud_delta_ += ud_delta;
+    gesture_lr_delta_ += lr_delta;
+    
+#if DEBUG
+    Serial.print("Accumulations: ");
+    Serial.print("UD: ");
+    Serial.print(gesture_ud_delta_);
+    Serial.print(" LR: ");
+    Serial.println(gesture_lr_delta_);
+#endif
+    
+    /* Determine U/D gesture */
+    if( gesture_ud_delta_ >= GESTURE_SENSITIVITY_1 ) {
+        gesture_ud_count_ = 1;
+    } else if( gesture_ud_delta_ <= -GESTURE_SENSITIVITY_1 ) {
+        gesture_ud_count_ = -1;
+    } else {
+        gesture_ud_count_ = 0;
+    }
+    
+    /* Determine L/R gesture */
+    if( gesture_lr_delta_ >= GESTURE_SENSITIVITY_1 ) {
+        gesture_lr_count_ = 1;
+    } else if( gesture_lr_delta_ <= -GESTURE_SENSITIVITY_1 ) {
+        gesture_lr_count_ = -1;
+    } else {
+        gesture_lr_count_ = 0;
+    }
+    
+    /* Determine Near/Far gesture */
+    if( (gesture_ud_count_ == 0) && (gesture_lr_count_ == 0) ) {
+        if( (abs(ud_delta) < GESTURE_SENSITIVITY_2) && \
+                (abs(lr_delta) < GESTURE_SENSITIVITY_2) ) {
+            
+            if( (ud_delta == 0) && (lr_delta == 0) ) {
+                gesture_near_count_++;
+            } else if( (ud_delta != 0) || (lr_delta != 0) ) {
+                gesture_far_count_++;
+            }
+            
+            if( (gesture_near_count_ >= 10) && (gesture_far_count_ >= 2) ) {
+                if( (ud_delta == 0) && (lr_delta == 0) ) {
+                    gesture_state_ = NEAR_STATE;
+                } else if( (ud_delta != 0) && (lr_delta != 0) ) {
+                    gesture_state_ = FAR_STATE;
+                }
+                return true;
+            }
+        }
+    } else {
+        if( (abs(ud_delta) < GESTURE_SENSITIVITY_2) && \
+                (abs(lr_delta) < GESTURE_SENSITIVITY_2) ) {
+            
+            if( (ud_delta == 0) && (lr_delta == 0) ) {
+                gesture_near_count_++;
+            }
+            
+            if( gesture_near_count_ >= 10 ) {
+                gesture_ud_count_ = 0;
+                gesture_lr_count_ = 0;
+                gesture_ud_delta_ = 0;
+                gesture_lr_delta_ = 0;
+            }
+        }
+    }
+    
+#if DEBUG
+    Serial.print("UD_CT: ");
+    Serial.print(gesture_ud_count_);
+    Serial.print(" LR_CT: ");
+    Serial.print(gesture_lr_count_);
+    Serial.print(" NEAR_CT: ");
+    Serial.print(gesture_near_count_);
+    Serial.print(" FAR_CT: ");
+    Serial.println(gesture_far_count_);
+    Serial.println("----------");
+#endif
+    
+    return false;
+}
+
+/**
+* @brief Determines swipe direction or near/far state
+*
+* @return True if near/far event. False otherwise.
+*/
+bool APDS9960_I2C::decodeGesture()
+{
+    /* Return if near or far event is detected */
+    if( gesture_state_ == NEAR_STATE ) {
+        gesture_motion_ = DIR_NEAR;
+        return true;
+    } else if ( gesture_state_ == FAR_STATE ) {
+        gesture_motion_ = DIR_FAR;
+        return true;
+    }
+    
+    /* Determine swipe direction */
+    if( (gesture_ud_count_ == -1) && (gesture_lr_count_ == 0) ) {
+        gesture_motion_ = DIR_UP;
+    } else if( (gesture_ud_count_ == 1) && (gesture_lr_count_ == 0) ) {
+        gesture_motion_ = DIR_DOWN;
+    } else if( (gesture_ud_count_ == 0) && (gesture_lr_count_ == 1) ) {
+        gesture_motion_ = DIR_RIGHT;
+    } else if( (gesture_ud_count_ == 0) && (gesture_lr_count_ == -1) ) {
+        gesture_motion_ = DIR_LEFT;
+    } else if( (gesture_ud_count_ == -1) && (gesture_lr_count_ == 1) ) {
+        if( abs(gesture_ud_delta_) > abs(gesture_lr_delta_) ) {
+            gesture_motion_ = DIR_UP;
+        } else {
+            gesture_motion_ = DIR_RIGHT;
+        }
+    } else if( (gesture_ud_count_ == 1) && (gesture_lr_count_ == -1) ) {
+        if( abs(gesture_ud_delta_) > abs(gesture_lr_delta_) ) {
+            gesture_motion_ = DIR_DOWN;
+        } else {
+            gesture_motion_ = DIR_LEFT;
+        }
+    } else if( (gesture_ud_count_ == -1) && (gesture_lr_count_ == -1) ) {
+        if( abs(gesture_ud_delta_) > abs(gesture_lr_delta_) ) {
+            gesture_motion_ = DIR_UP;
+        } else {
+            gesture_motion_ = DIR_LEFT;
+        }
+    } else if( (gesture_ud_count_ == 1) && (gesture_lr_count_ == 1) ) {
+        if( abs(gesture_ud_delta_) > abs(gesture_lr_delta_) ) {
+            gesture_motion_ = DIR_DOWN;
+        } else {
+            gesture_motion_ = DIR_RIGHT;
+        }
+    } else {
+        return false;
+    }
+    
+    return true;
+}
+
+/*******************************************************************************
+* Getters and setters for register values
+******************************************************************************/
+
+/**
+* @brief Returns the lower threshold for proximity detection
+*
+* @return lower threshold
+*/
+uint8_t APDS9960_I2C::getProxIntLowThresh()
+{
+    uint8_t val;
+    
+    /* Read value from PILT register */
+    if( !wireReadDataByte(APDS9960_PILT, val) ) {
+        val = 0;
+    }
+    
+    return val;
+}
+
+/**
+* @brief Sets the lower threshold for proximity detection
+*
+* @param[in] threshold the lower proximity threshold
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setProxIntLowThresh(uint8_t threshold)
+{
+    if( !wireWriteDataByte(APDS9960_PILT, threshold) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Returns the high threshold for proximity detection
+*
+* @return high threshold
+*/
+uint8_t APDS9960_I2C::getProxIntHighThresh()
+{
+    uint8_t val;
+    
+    /* Read value from PIHT register */
+    if( !wireReadDataByte(APDS9960_PIHT, val) ) {
+        val = 0;
+    }
+    
+    return val;
+}
+
+/**
+* @brief Sets the high threshold for proximity detection
+*
+* @param[in] threshold the high proximity threshold
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setProxIntHighThresh(uint8_t threshold)
+{
+    if( !wireWriteDataByte(APDS9960_PIHT, threshold) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Returns LED drive strength for proximity and ALS
+*
+* Value    LED Current
+*   0        100 mA
+*   1         50 mA
+*   2         25 mA
+*   3         12.5 mA
+*
+* @return the value of the LED drive strength. 0xFF on failure.
+*/
+uint8_t APDS9960_I2C::getLEDDrive()
+{
+    uint8_t val;
+    
+    /* Read value from CONTROL register */
+    if( !wireReadDataByte(APDS9960_CONTROL, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out LED drive bits */
+    val = (val >> 6) & 3; //00000011
+    
+    return val;
+}
+
+/**
+* @brief Sets the LED drive strength for proximity and ALS
+*
+* Value    LED Current
+*   0        100 mA
+*   1         50 mA
+*   2         25 mA
+*   3         12.5 mA
+*
+* @param[in] drive the value (0-3) for the LED drive strength
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setLEDDrive(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 &= 3; //00000011
+    drive = drive << 6;
+    val &= 63; //
+    val |= drive;
+    
+    /* Write register value back into CONTROL register */
+    if( !wireWriteDataByte(APDS9960_CONTROL, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Returns receiver gain for proximity detection
+*
+* Value    Gain
+*   0       1x
+*   1       2x
+*   2       4x
+*   3       8x
+*
+* @return the value of the proximity gain. 0xFF on failure.
+*/
+uint8_t APDS9960_I2C::getProximityGain()
+{
+    uint8_t val;
+    
+    /* Read value from CONTROL register */
+    if( !wireReadDataByte(APDS9960_CONTROL, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out PDRIVE bits */
+    val = (val >> 2) & 3; //00000011
+    
+    return val;
+}
+
+/**
+* @brief Sets the receiver gain for proximity detection
+*
+* Value    Gain
+*   0       1x
+*   1       2x
+*   2       4x
+*   3       8x
+*
+* @param[in] drive the value (0-3) for the gain
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::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 &= 3; //00000011
+    drive = drive << 2;
+    val &= 11110011;
+    val |= drive;
+    
+    /* Write register value back into CONTROL register */
+    if( !wireWriteDataByte(APDS9960_CONTROL, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Returns receiver gain for the ambient light sensor (ALS)
+*
+* Value    Gain
+*   0        1x
+*   1        4x
+*   2       16x
+*   3       64x
+*
+* @return the value of the ALS gain. 0xFF on failure.
+*/
+uint8_t APDS9960_I2C::getAmbientLightGain()
+{
+    uint8_t val;
+    
+    /* Read value from CONTROL register */
+    if( !wireReadDataByte(APDS9960_CONTROL, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out ADRIVE bits */
+    val &= 3; //00000011
+    
+    return val;
+}
+
+/**
+* @brief Sets the receiver gain for the ambient light sensor (ALS)
+*
+* Value    Gain
+*   0        1x
+*   1        4x
+*   2       16x
+*   3       64x
+*
+* @param[in] drive the value (0-3) for the gain
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setAmbientLightGain(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 &= 3; //00000011
+    val &= 11111100;
+    val |= drive;
+    
+    /* Write register value back into CONTROL register */
+    if( !wireWriteDataByte(APDS9960_CONTROL, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Get the current LED boost value
+* 
+* Value  Boost Current
+*   0        100%
+*   1        150%
+*   2        200%
+*   3        300%
+*
+* @return The LED boost value. 0xFF on failure.
+*/
+uint8_t APDS9960_I2C::getLEDBoost()
+{
+    uint8_t val;
+    
+    /* Read value from CONFIG2 register */
+    if( !wireReadDataByte(APDS9960_CONFIG2, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out LED_BOOST bits */
+    val = (val >> 4) & 3; //00000011
+    
+    return val;
+}
+
+/**
+* @brief Sets the LED current boost value
+*
+* Value  Boost Current
+*   0        100%
+*   1        150%
+*   2        200%
+*   3        300%
+*
+* @param[in] drive the value (0-3) for current boost (100-300%)
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setLEDBoost(uint8_t boost)
+{
+    uint8_t val;
+    
+    /* Read value from CONFIG2 register */
+    if( !wireReadDataByte(APDS9960_CONFIG2, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    boost &= 3; //00000011
+    boost = boost << 4;
+    val &= 11001111;
+    val |= boost;
+    
+    /* Write register value back into CONFIG2 register */
+    if( !wireWriteDataByte(APDS9960_CONFIG2, val) ) {
+        return false;
+    }
+    
+    return true;
+}    
+
+/**
+* @brief Gets proximity gain compensation enable
+*
+* @return 1 if compensation is enabled. 0 if not. 0xFF on error.
+*/
+uint8_t APDS9960_I2C::getProxGainCompEnable()
+{
+    uint8_t val;
+    
+    /* Read value from CONFIG3 register */
+    if( !wireReadDataByte(APDS9960_CONFIG3, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out PCMP bits */
+    val = (val >> 5) & 1; //00000001
+    
+    return val;
+}
+
+/**
+* @brief Sets the proximity gain compensation enable
+*
+* @param[in] enable 1 to enable compensation. 0 to disable compensation.
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setProxGainCompEnable(uint8_t enable)
+{
+    uint8_t val;
+    
+    /* Read value from CONFIG3 register */
+    if( !wireReadDataByte(APDS9960_CONFIG3, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    enable &= 1; //00000001
+    enable = enable << 5;
+    val &= 11011111;
+    val |= enable;
+    
+    /* Write register value back into CONFIG3 register */
+    if( !wireWriteDataByte(APDS9960_CONFIG3, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the current mask for enabled/disabled proximity photodiodes
+*
+* 1 = disabled, 0 = enabled
+* Bit    Photodiode
+*  3       UP
+*  2       DOWN
+*  1       LEFT
+*  0       RIGHT
+*
+* @return Current proximity mask for photodiodes. 0xFF on error.
+*/
+uint8_t APDS9960_I2C::getProxPhotoMask()
+{
+    uint8_t val;
+    
+    /* Read value from CONFIG3 register */
+    if( !wireReadDataByte(APDS9960_CONFIG3, val) ) {
+        return ERROR;
+    }
+    
+    /* Mask out photodiode enable mask bits */
+    val &= 15; //00001111
+    
+    return val;
+}
+
+/**
+* @brief Sets the mask for enabling/disabling proximity photodiodes
+*
+* 1 = disabled, 0 = enabled
+* Bit    Photodiode
+*  3       UP
+*  2       DOWN
+*  1       LEFT
+*  0       RIGHT
+*
+* @param[in] mask 4-bit mask value
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setProxPhotoMask(uint8_t mask)
+{
+    uint8_t val;
+    
+    /* Read value from CONFIG3 register */
+    if( !wireReadDataByte(APDS9960_CONFIG3, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    mask &= 15; //00001111
+    val &= 11110000;
+    val |= mask;
+    
+    /* Write register value back into CONFIG3 register */
+    if( !wireWriteDataByte(APDS9960_CONFIG3, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the entry proximity threshold for gesture sensing
+*
+* @return Current entry proximity threshold.
+*/
+uint8_t APDS9960_I2C::getGestureEnterThresh()
+{
+    uint8_t val;
+    
+    /* Read value from GPENTH register */
+    if( !wireReadDataByte(APDS9960_GPENTH, val) ) {
+        val = 0;
+    }
+    
+    return val;
+}
+
+/**
+* @brief Sets the entry proximity threshold for gesture sensing
+*
+* @param[in] threshold proximity value needed to start gesture mode
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setGestureEnterThresh(uint8_t threshold)
+{
+    if( !wireWriteDataByte(APDS9960_GPENTH, threshold) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the exit proximity threshold for gesture sensing
+*
+* @return Current exit proximity threshold.
+*/
+uint8_t APDS9960_I2C::getGestureExitThresh()
+{
+    uint8_t val;
+    
+    /* Read value from GEXTH register */
+    if( !wireReadDataByte(APDS9960_GEXTH, val) ) {
+        val = 0;
+    }
+    
+    return val;
+}
+
+/**
+* @brief Sets the exit proximity threshold for gesture sensing
+*
+* @param[in] threshold proximity value needed to end gesture mode
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setGestureExitThresh(uint8_t threshold)
+{
+    if( !wireWriteDataByte(APDS9960_GEXTH, threshold) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the gain of the photodiode during gesture mode
+*
+* Value    Gain
+*   0       1x
+*   1       2x
+*   2       4x
+*   3       8x
+*
+* @return the current photodiode gain. 0xFF on error.
+*/
+uint8_t APDS9960_I2C::getGestureGain()
+{
+    uint8_t val;
+    
+    /* Read value from GCONF2 register */
+    if( !wireReadDataByte(APDS9960_GCONF2, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out GGAIN bits */
+    val = (val >> 5) & 3; //00000011
+    
+    return val;
+}
+
+/**
+* @brief Sets the gain of the photodiode during gesture mode
+*
+* Value    Gain
+*   0       1x
+*   1       2x
+*   2       4x
+*   3       8x
+*
+* @param[in] gain the value for the photodiode gain
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setGestureGain(uint8_t gain)
+{
+    uint8_t val;
+    
+    /* Read value from GCONF2 register */
+    if( !wireReadDataByte(APDS9960_GCONF2, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    gain &= 3; //00000011
+    gain = gain << 5;
+    val &= 10011111;
+    val |= gain;
+    
+    /* Write register value back into GCONF2 register */
+    if( !wireWriteDataByte(APDS9960_GCONF2, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the drive current of the LED during gesture mode
+*
+* Value    LED Current
+*   0        100 mA
+*   1         50 mA
+*   2         25 mA
+*   3         12.5 mA
+*
+* @return the LED drive current value. 0xFF on error.
+*/
+uint8_t APDS9960_I2C::getGestureLEDDrive()
+{
+    uint8_t val;
+    
+    /* Read value from GCONF2 register */
+    if( !wireReadDataByte(APDS9960_GCONF2, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out GLDRIVE bits */
+    val = (val >> 3) & 3; //00000011
+    
+    return val;
+}
+
+/**
+* @brief Sets the LED drive current during gesture mode
+*
+* Value    LED Current
+*   0        100 mA
+*   1         50 mA
+*   2         25 mA
+*   3         12.5 mA
+*
+* @param[in] drive the value for the LED drive current
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setGestureLEDDrive(uint8_t drive)
+{
+    uint8_t val;
+    
+    /* Read value from GCONF2 register */
+    if( !wireReadDataByte(APDS9960_GCONF2, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    drive &= 3; //00000011
+    drive = drive << 3;
+    val &= 11100111;
+    val |= drive;
+    
+    /* Write register value back into GCONF2 register */
+    if( !wireWriteDataByte(APDS9960_GCONF2, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the time in low power mode between gesture detections
+*
+* Value    Wait time
+*   0          0 ms
+*   1          2.8 ms
+*   2          5.6 ms
+*   3          8.4 ms
+*   4         14.0 ms
+*   5         22.4 ms
+*   6         30.8 ms
+*   7         39.2 ms
+*
+* @return the current wait time between gestures. 0xFF on error.
+*/
+uint8_t APDS9960_I2C::getGestureWaitTime()
+{
+    uint8_t val;
+    
+    /* Read value from GCONF2 register */
+    if( !wireReadDataByte(APDS9960_GCONF2, val) ) {
+        return ERROR;
+    }
+    
+    /* Mask out GWTIME bits */
+    val &= 7; //00000111
+    
+    return val;
+}
+
+/**
+* @brief Sets the time in low power mode between gesture detections
+*
+* Value    Wait time
+*   0          0 ms
+*   1          2.8 ms
+*   2          5.6 ms
+*   3          8.4 ms
+*   4         14.0 ms
+*   5         22.4 ms
+*   6         30.8 ms
+*   7         39.2 ms
+*
+* @param[in] the value for the wait time
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setGestureWaitTime(uint8_t time)
+{
+    uint8_t val;
+    
+    /* Read value from GCONF2 register */
+    if( !wireReadDataByte(APDS9960_GCONF2, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    time &= 7; //00000111
+    val &= 11111000;
+    val |= time;
+    
+    /* Write register value back into GCONF2 register */
+    if( !wireWriteDataByte(APDS9960_GCONF2, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the low threshold for ambient light interrupts
+*
+* @param[out] threshold current low threshold stored on the APDS-9960
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::getLightIntLowThreshold(uint16_t &threshold)
+{
+    uint8_t val_byte;
+    threshold = 0;
+    
+    /* Read value from ambient light low threshold, low byte register */
+    if( !wireReadDataByte(APDS9960_AILTL, val_byte) ) {
+        return false;
+    }
+    threshold = val_byte;
+    
+    /* Read value from ambient light low threshold, high byte register */
+    if( !wireReadDataByte(APDS9960_AILTH, val_byte) ) {
+        return false;
+    }
+    threshold = threshold + ((uint16_t)val_byte << 8);
+    
+    return true;
+}
+
+/**
+* @brief Sets the low threshold for ambient light interrupts
+*
+* @param[in] threshold low threshold value for interrupt to trigger
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setLightIntLowThreshold(uint16_t threshold)
+{
+    uint8_t val_low;
+    uint8_t val_high;
+    
+    /* Break 16-bit threshold into 2 8-bit values */
+    val_low = threshold & 0x00FF;
+    val_high = (threshold & 0xFF00) >> 8;
+    
+    /* Write low byte */
+    if( !wireWriteDataByte(APDS9960_AILTL, val_low) ) {
+        return false;
+    }
+    
+    /* Write high byte */
+    if( !wireWriteDataByte(APDS9960_AILTH, val_high) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the high threshold for ambient light interrupts
+*
+* @param[out] threshold current low threshold stored on the APDS-9960
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::getLightIntHighThreshold(uint16_t &threshold)
+{
+    uint8_t val_byte;
+    threshold = 0;
+    
+    /* Read value from ambient light high threshold, low byte register */
+    if( !wireReadDataByte(APDS9960_AIHTL, val_byte) ) {
+        return false;
+    }
+    threshold = val_byte;
+    
+    /* Read value from ambient light high threshold, high byte register */
+    if( !wireReadDataByte(APDS9960_AIHTH, val_byte) ) {
+        return false;
+    }
+    threshold = threshold + ((uint16_t)val_byte << 8);
+    
+    return true;
+}
+
+/**
+* @brief Sets the high threshold for ambient light interrupts
+*
+* @param[in] threshold high threshold value for interrupt to trigger
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setLightIntHighThreshold(uint16_t threshold)
+{
+    uint8_t val_low;
+    uint8_t val_high;
+    
+    /* Break 16-bit threshold into 2 8-bit values */
+    val_low = threshold & 0x00FF;
+    val_high = (threshold & 0xFF00) >> 8;
+    
+    /* Write low byte */
+    if( !wireWriteDataByte(APDS9960_AIHTL, val_low) ) {
+        return false;
+    }
+    
+    /* Write high byte */
+    if( !wireWriteDataByte(APDS9960_AIHTH, val_high) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the low threshold for proximity interrupts
+*
+* @param[out] threshold current low threshold stored on the APDS-9960
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::getProximityIntLowThreshold(uint8_t &threshold)
+{
+    threshold = 0;
+    
+    /* Read value from proximity low threshold register */
+    if( !wireReadDataByte(APDS9960_PILT, threshold) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Sets the low threshold for proximity interrupts
+*
+* @param[in] threshold low threshold value for interrupt to trigger
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setProximityIntLowThreshold(uint8_t threshold)
+{
+    
+    /* Write threshold value to register */
+    if( !wireWriteDataByte(APDS9960_PILT, threshold) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets the high threshold for proximity interrupts
+*
+* @param[out] threshold current low threshold stored on the APDS-9960
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::getProximityIntHighThreshold(uint8_t &threshold)
+{
+    threshold = 0;
+    
+    /* Read value from proximity low threshold register */
+    if( !wireReadDataByte(APDS9960_PIHT, threshold) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Sets the high threshold for proximity interrupts
+*
+* @param[in] threshold high threshold value for interrupt to trigger
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setProximityIntHighThreshold(uint8_t threshold)
+{
+    
+    /* Write threshold value to register */
+    if( !wireWriteDataByte(APDS9960_PIHT, threshold) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets if ambient light interrupts are enabled or not
+*
+* @return 1 if interrupts are enabled, 0 if not. 0xFF on error.
+*/
+uint8_t APDS9960_I2C::getAmbientLightIntEnable()
+{
+    uint8_t val;
+    
+    /* Read value from ENABLE register */
+    if( !wireReadDataByte(APDS9960_ENABLE, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out AIEN bit */
+    val = (val >> 4) & 1; //00000001
+    
+    return val;
+}
+
+/**
+* @brief Turns ambient light interrupts on or off
+*
+* @param[in] enable 1 to enable interrupts, 0 to turn them off
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setAmbientLightIntEnable(uint8_t enable)
+{
+    uint8_t val;
+    
+    /* Read value from ENABLE register */
+    if( !wireReadDataByte(APDS9960_ENABLE, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    enable &= 1; //00000001
+    enable = enable << 4;
+    val &= 11101111;
+    val |= enable;
+    
+    /* Write register value back into ENABLE register */
+    if( !wireWriteDataByte(APDS9960_ENABLE, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets if proximity interrupts are enabled or not
+*
+* @return 1 if interrupts are enabled, 0 if not. 0xFF on error.
+*/
+uint8_t APDS9960_I2C::getProximityIntEnable()
+{
+    uint8_t val;
+    
+    /* Read value from ENABLE register */
+    if( !wireReadDataByte(APDS9960_ENABLE, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out PIEN bit */
+    val = (val >> 5) & 1; //00000001
+    
+    return val;
+}
+
+/**
+* @brief Turns proximity interrupts on or off
+*
+* @param[in] enable 1 to enable interrupts, 0 to turn them off
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setProximityIntEnable(uint8_t enable)
+{
+    uint8_t val;
+    
+    /* Read value from ENABLE register */
+    if( !wireReadDataByte(APDS9960_ENABLE, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    enable &= 1; //00000001
+    enable = enable << 5;
+    val &= 11011111;
+    val |= enable;
+    
+    /* Write register value back into ENABLE register */
+    if( !wireWriteDataByte(APDS9960_ENABLE, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Gets if gesture interrupts are enabled or not
+*
+* @return 1 if interrupts are enabled, 0 if not. 0xFF on error.
+*/
+uint8_t APDS9960_I2C::getGestureIntEnable()
+{
+    uint8_t val;
+    
+    /* Read value from GCONF4 register */
+    if( !wireReadDataByte(APDS9960_GCONF4, val) ) {
+        return ERROR;
+    }
+    
+    /* Shift and mask out GIEN bit */
+    val = (val >> 1) & 1; //00000001
+    
+    return val;
+}
+
+/**
+* @brief Turns gesture-related interrupts on or off
+*
+* @param[in] enable 1 to enable interrupts, 0 to turn them off
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setGestureIntEnable(uint8_t enable)
+{
+    uint8_t val;
+    
+    /* Read value from GCONF4 register */
+    if( !wireReadDataByte(APDS9960_GCONF4, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    enable &= 1; //00000001
+    enable = enable << 1;
+    val &= 11111101;
+    val |= enable;
+    
+    /* Write register value back into GCONF4 register */
+    if( !wireWriteDataByte(APDS9960_GCONF4, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Clears the ambient light interrupt
+*
+* @return True if operation completed successfully. False otherwise.
+*/
+bool APDS9960_I2C::clearAmbientLightInt()
+{
+    uint8_t throwaway;
+    if( !wireReadDataByte(APDS9960_AICLEAR, throwaway) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Clears the proximity interrupt
+*
+* @return True if operation completed successfully. False otherwise.
+*/
+bool APDS9960_I2C::clearProximityInt()
+{
+    uint8_t throwaway;
+    if( !wireReadDataByte(APDS9960_PICLEAR, throwaway) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/**
+* @brief Tells if the gesture state machine is currently running
+*
+* @return 1 if gesture state machine is running, 0 if not. 0xFF on error.
+*/
+uint8_t APDS9960_I2C::getGestureMode()
+{
+    uint8_t val;
+    
+    /* Read value from GCONF4 register */
+    if( !wireReadDataByte(APDS9960_GCONF4, val) ) {
+        return ERROR;
+    }
+    
+    /* Mask out GMODE bit */
+    val &= 1; //00000001
+    
+    return val;
+}
+
+/**
+* @brief Tells the state machine to either enter or exit gesture state machine
+*
+* @param[in] mode 1 to enter gesture state machine, 0 to exit.
+* @return True if operation successful. False otherwise.
+*/
+bool APDS9960_I2C::setGestureMode(uint8_t mode)
+{
+    uint8_t val;
+    
+    /* Read value from GCONF4 register */
+    if( !wireReadDataByte(APDS9960_GCONF4, val) ) {
+        return false;
+    }
+    
+    /* Set bits in register to given value */
+    mode &= 1; //00000001
+    val &= 11111110;
+    val |= mode;
+    
+    /* Write register value back into GCONF4 register */
+    if( !wireWriteDataByte(APDS9960_GCONF4, val) ) {
+        return false;
+    }
+    
+    return true;
+}
+
+/*******************************************************************************
+* Raw I2C Reads and Writes
+******************************************************************************/
+
+
+/**
+* @brief Writes a single byte to the I2C device and specified register
+*
+* @param[in] reg the register in the I2C device to write to
+* @param[in] val the 1-byte value to write to the I2C device
+* @return True if successful write operation. False otherwise.
+*/
+
+int APDS9960_I2C::wireWriteDataByte(uint8_t address, uint8_t data){
+    char address_fixed = address;
+    char data_fixed = data;
+    char tx[2] = { address_fixed, data_fixed }; //0d160 = 0b10100000
+    int ack = i2c.write(APDS9960_I2C_ADDR << 1, tx, 2 );
+    return !ack;
+}
+
+
+/////////////////////////////////////////////////////////////////////////////////////////////
+
+/**
+* @brief Writes a block (array) of bytes to the I2C device and register
+*
+* @param[in] reg the register in the I2C device to write to
+* @param[in] val pointer to the beginning of the data byte array
+* @param[in] len the length (in bytes) of the data to write
+* @return True if successful write operation. False otherwise.
+*/
+
+int APDS9960_I2C::wireWriteDataBlock(uint8_t address, uint8_t* data, unsigned int quantity){
+    char address_fixed = address;
+    //char* data_fixed = data;
+    
+    char tx[ quantity + 1 ];
+    tx[0] = address;
+    for ( int i = 1; i <= quantity; i++ ){
+        tx[ i ] = data[ i - 1 ];
+    }
+    int ack = i2c.write( APDS9960_I2C_ADDR << 1, tx, quantity + 1 );
+    return !ack;
+}
+
+
+/////////////////////////////////////////////////////////////////////////////////////////////
+
+
+/**
+* @brief Reads a single byte from the I2C device and specified register
+*
+* @param[in] reg the register to read from
+* @param[out] the value returned from the register
+* @return True if successful read operation. False otherwise.
+*/
+
+int APDS9960_I2C::wireReadDataByte(uint8_t address, uint8_t &val){
+    char output = 255;
+    //char address_fixed = address;
+    //char vag;
+    char command = address; //0d160 = 0b10100000
+    i2c.write( APDS9960_I2C_ADDR << 1, &command, 1, true);
+    
+    int ack = i2c.read( APDS9960_I2C_ADDR << 1, &output, 1 );
+    val = output;
+    return !ack;
+
+}
+
+
+/////////////////////////////////////////////////////////////////////////////////////////////
+
+/**
+* @brief Reads a block (array) of bytes from the I2C device and register
+*
+* @param[in] reg the register to read from
+* @param[out] val pointer to the beginning of the data
+* @param[in] len number of bytes to read
+* @return Number of bytes read. -1 on read error.
+*/
+
+int APDS9960_I2C::wireReadDataBlock( uint8_t address, uint8_t* val, unsigned int quantity ){
+    
+    char* val_holder = reinterpret_cast<char*>(val);
+    char command = address;
+    i2c.write( APDS9960_I2C_ADDR << 1, &command, 1, true );
+    int ack = i2c.read(APDS9960_I2C_ADDR << 1, val_holder, quantity);
+    return quantity;
+}
diff -r 000000000000 -r 49ae62548910 APDS9960_I2C.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/APDS9960_I2C.h	Tue May 19 11:00:23 2015 +0000
@@ -0,0 +1,357 @@
+/**
+* @file    APDS9960_RPi.h
+* @brief   Raspberry Pi library for the SparkFun APDS-9960 breakout board
+* @author  Shawn Hymel (SparkFun Electronics), Modified for Raspberry Pi by Justin Woodman
+*
+* @copyright    This code is public domain but you buy me a beer if you use
+* this and we meet someday (Beerware license).
+*
+* This library interfaces the Avago APDS-9960 to Raspberry Pi over I2C. The library
+* relies on the wiringPi library. to use the library, instantiate an
+* APDS9960 object, call init(), and call the appropriate functions.
+*
+* APDS-9960 current draw tests (default parameters):
+*   Off:                   1mA
+*   Waiting for gesture:   14mA
+*   Gesture in progress:   35mA
+*/
+
+#ifndef APDS9960_I2C_H
+#define APDS9960_I2C_H
+#include "mbed.h"
+
+#include <stdint.h>
+#include <stdlib.h>
+
+/* Debug */
+#define DEBUG                   0
+
+/* APDS-9960 I2C address */
+#define APDS9960_I2C_ADDR       0x39
+
+/* Gesture parameters */
+#define GESTURE_THRESHOLD_OUT   10
+#define GESTURE_SENSITIVITY_1   50
+#define GESTURE_SENSITIVITY_2   20
+
+/* Error code for returned values */
+#define ERROR                   0xFF
+
+/* Acceptable device IDs */
+#define APDS9960_ID_1           0xAB
+#define APDS9960_ID_2           0x9C 
+
+/* Misc parameters */
+#define FIFO_PAUSE_TIME         30      // Wait period (ms) between FIFO reads
+
+/* APDS-9960 register addresses */
+#define APDS9960_ENABLE         0x80
+#define APDS9960_ATIME          0x81
+#define APDS9960_WTIME          0x83
+#define APDS9960_AILTL          0x84
+#define APDS9960_AILTH          0x85
+#define APDS9960_AIHTL          0x86
+#define APDS9960_AIHTH          0x87
+#define APDS9960_PILT           0x89
+#define APDS9960_PIHT           0x8B
+#define APDS9960_PERS           0x8C
+#define APDS9960_CONFIG1        0x8D
+#define APDS9960_PPULSE         0x8E
+#define APDS9960_CONTROL        0x8F
+#define APDS9960_CONFIG2        0x90
+#define APDS9960_ID             0x92
+#define APDS9960_STATUS         0x93
+#define APDS9960_CDATAL         0x94
+#define APDS9960_CDATAH         0x95
+#define APDS9960_RDATAL         0x96
+#define APDS9960_RDATAH         0x97
+#define APDS9960_GDATAL         0x98
+#define APDS9960_GDATAH         0x99
+#define APDS9960_BDATAL         0x9A
+#define APDS9960_BDATAH         0x9B
+#define APDS9960_PDATA          0x9C
+#define APDS9960_POFFSET_UR     0x9D
+#define APDS9960_POFFSET_DL     0x9E
+#define APDS9960_CONFIG3        0x9F
+#define APDS9960_GPENTH         0xA0
+#define APDS9960_GEXTH          0xA1
+#define APDS9960_GCONF1         0xA2
+#define APDS9960_GCONF2         0xA3
+#define APDS9960_GOFFSET_U      0xA4
+#define APDS9960_GOFFSET_D      0xA5
+#define APDS9960_GOFFSET_L      0xA7
+#define APDS9960_GOFFSET_R      0xA9
+#define APDS9960_GPULSE         0xA6
+#define APDS9960_GCONF3         0xAA
+#define APDS9960_GCONF4         0xAB
+#define APDS9960_GFLVL          0xAE
+#define APDS9960_GSTATUS        0xAF
+#define APDS9960_IFORCE         0xE4
+#define APDS9960_PICLEAR        0xE5
+#define APDS9960_CICLEAR        0xE6
+#define APDS9960_AICLEAR        0xE7
+#define APDS9960_GFIFO_U        0xFC
+#define APDS9960_GFIFO_D        0xFD
+#define APDS9960_GFIFO_L        0xFE
+#define APDS9960_GFIFO_R        0xFF
+
+/* Bit fields */
+#define APDS9960_PON            00000001
+#define APDS9960_AEN            00000010
+#define APDS9960_PEN            00000100
+#define APDS9960_WEN            00001000
+#define APSD9960_AIEN           00010000
+#define APDS9960_PIEN           00100000
+#define APDS9960_GEN            01000000
+#define APDS9960_GVALID         00000001
+
+/* On/Off definitions */
+#define OFF                     0
+#define ON                      1
+
+/* Acceptable parameters for setMode */
+#define POWER                   0
+#define AMBIENT_LIGHT           1
+#define PROXIMITY               2
+#define WAIT                    3
+#define AMBIENT_LIGHT_INT       4
+#define PROXIMITY_INT           5
+#define GESTURE                 6
+#define ALL                     7
+
+/* LED Drive values */
+#define LED_DRIVE_100MA         0
+#define LED_DRIVE_50MA          1
+#define LED_DRIVE_25MA          2
+#define LED_DRIVE_12_5MA        3
+
+/* Proximity Gain (PGAIN) values */
+#define PGAIN_1X                0
+#define PGAIN_2X                1
+#define PGAIN_4X                2
+#define PGAIN_8X                3
+
+/* ALS Gain (AGAIN) values */
+#define AGAIN_1X                0
+#define AGAIN_4X                1
+#define AGAIN_16X               2
+#define AGAIN_64X               3
+
+/* Gesture Gain (GGAIN) values */
+#define GGAIN_1X                0
+#define GGAIN_2X                1
+#define GGAIN_4X                2
+#define GGAIN_8X                3
+
+/* LED Boost values */
+#define LED_BOOST_100           0
+#define LED_BOOST_150           1
+#define LED_BOOST_200           2
+#define LED_BOOST_300           3    
+
+/* Gesture wait time values */
+#define GWTIME_0MS              0
+#define GWTIME_2_8MS            1
+#define GWTIME_5_6MS            2
+#define GWTIME_8_4MS            3
+#define GWTIME_14_0MS           4
+#define GWTIME_22_4MS           5
+#define GWTIME_30_8MS           6
+#define GWTIME_39_2MS           7
+
+/* Default values */
+#define DEFAULT_ATIME           219     // 103ms
+#define DEFAULT_WTIME           246     // 27ms
+#define DEFAULT_PROX_PPULSE     0x87    // 16us, 8 pulses
+#define DEFAULT_GESTURE_PPULSE  0x89    // 16us, 10 pulses
+#define DEFAULT_POFFSET_UR      0       // 0 offset
+#define DEFAULT_POFFSET_DL      0       // 0 offset      
+#define DEFAULT_CONFIG1         0x60    // No 12x wait (WTIME) factor
+#define DEFAULT_LDRIVE          LED_DRIVE_100MA
+#define DEFAULT_PGAIN           PGAIN_4X
+#define DEFAULT_AGAIN           AGAIN_4X
+#define DEFAULT_PILT            0       // Low proximity threshold
+#define DEFAULT_PIHT            50      // High proximity threshold
+#define DEFAULT_AILT            0xFFFF  // Force interrupt for calibration
+#define DEFAULT_AIHT            0
+#define DEFAULT_PERS            0x11    // 2 consecutive prox or ALS for int.
+#define DEFAULT_CONFIG2         0x01    // No saturation interrupts or LED boost  
+#define DEFAULT_CONFIG3         0       // Enable all photodiodes, no SAI
+#define DEFAULT_GPENTH          40      // Threshold for entering gesture mode
+#define DEFAULT_GEXTH           30      // Threshold for exiting gesture mode    
+#define DEFAULT_GCONF1          0x40    // 4 gesture events for int., 1 for exit
+#define DEFAULT_GGAIN           GGAIN_4X
+#define DEFAULT_GLDRIVE         LED_DRIVE_100MA
+#define DEFAULT_GWTIME          GWTIME_2_8MS
+#define DEFAULT_GOFFSET         0       // No offset scaling for gesture mode
+#define DEFAULT_GPULSE          0xC9    // 32us, 10 pulses
+#define DEFAULT_GCONF3          0       // All photodiodes active during gesture
+#define DEFAULT_GIEN            0       // Disable gesture interrupts
+
+/* Direction definitions */
+enum {
+    DIR_NONE,
+    DIR_LEFT,
+    DIR_RIGHT,
+    DIR_UP,
+    DIR_DOWN,
+    DIR_NEAR,
+    DIR_FAR,
+    DIR_ALL
+};
+
+/* State definitions */
+enum {
+    NA_STATE,
+    NEAR_STATE,
+    FAR_STATE,
+    ALL_STATE
+};
+
+/* Container for gesture data */
+typedef struct gesture_data_type {
+    uint8_t u_data[32];
+    uint8_t d_data[32];
+    uint8_t l_data[32];
+    uint8_t r_data[32];
+    uint8_t index;
+    uint8_t total_gestures;
+    uint8_t in_threshold;
+    uint8_t out_threshold;
+} gesture_data_type;
+
+/* APDS9960 Class */
+class APDS9960_I2C {
+public:
+
+    /* Initialization methods */
+    APDS9960_I2C( PinName sda, PinName scl );
+    //~APDS9960();
+    bool init();
+    uint8_t read_this();
+    uint8_t getMode();
+    int write_this();
+    bool setMode(uint8_t mode, uint8_t enable);
+    
+    /* Turn the APDS-9960 on and off */
+    bool enablePower();
+    bool disablePower();
+    
+    /* Enable or disable specific sensors */
+    bool enableLightSensor(bool interrupts = false);
+    bool disableLightSensor();
+    bool enableProximitySensor(bool interrupts = false);
+    bool disableProximitySensor();
+    bool enableGestureSensor(bool interrupts = true);
+    bool disableGestureSensor();
+    
+    /* LED drive strength control */
+    uint8_t getLEDDrive();
+    bool setLEDDrive(uint8_t drive);
+    uint8_t getGestureLEDDrive();
+    bool setGestureLEDDrive(uint8_t drive);
+    
+    /* Gain control */
+    uint8_t getAmbientLightGain();
+    bool setAmbientLightGain(uint8_t gain);
+    uint8_t getProximityGain();
+    bool setProximityGain(uint8_t gain);
+    uint8_t getGestureGain();
+    bool setGestureGain(uint8_t gain);
+    
+    /* Get and set light interrupt thresholds */
+    bool getLightIntLowThreshold(uint16_t &threshold);
+    bool setLightIntLowThreshold(uint16_t threshold);
+    bool getLightIntHighThreshold(uint16_t &threshold);
+    bool setLightIntHighThreshold(uint16_t threshold);
+    
+    /* Get and set proximity interrupt thresholds */
+    bool getProximityIntLowThreshold(uint8_t &threshold);
+    bool setProximityIntLowThreshold(uint8_t threshold);
+    bool getProximityIntHighThreshold(uint8_t &threshold);
+    bool setProximityIntHighThreshold(uint8_t threshold);
+    
+    /* Get and set interrupt enables */
+    uint8_t getAmbientLightIntEnable();
+    bool setAmbientLightIntEnable(uint8_t enable);
+    uint8_t getProximityIntEnable();
+    bool setProximityIntEnable(uint8_t enable);
+    uint8_t getGestureIntEnable();
+    bool setGestureIntEnable(uint8_t enable);
+    
+    /* Clear interrupts */
+    bool clearAmbientLightInt();
+    bool clearProximityInt();
+    
+    /* Ambient light methods */
+    bool readAmbientLight(uint16_t &val);
+    bool readRedLight(uint16_t &val);
+    bool readGreenLight(uint16_t &val);
+    bool readBlueLight(uint16_t &val);
+    
+    /* Proximity methods */
+    bool readProximity(uint8_t &val);
+    
+    /* Gesture methods */
+    bool isGestureAvailable();
+    int readGesture();
+    
+private:
+    I2C i2c;
+
+    /* Gesture processing */
+    void resetGestureParameters();
+    bool processGestureData();
+    bool decodeGesture();
+
+    /* Proximity Interrupt Threshold */
+    uint8_t getProxIntLowThresh();
+    bool setProxIntLowThresh(uint8_t threshold);
+    uint8_t getProxIntHighThresh();
+    bool setProxIntHighThresh(uint8_t threshold);
+    
+    /* LED Boost Control */
+    uint8_t getLEDBoost();
+    bool setLEDBoost(uint8_t boost);
+    
+    /* Proximity photodiode select */
+    uint8_t getProxGainCompEnable();
+    bool setProxGainCompEnable(uint8_t enable);
+    uint8_t getProxPhotoMask();
+    bool setProxPhotoMask(uint8_t mask);
+    
+    /* Gesture threshold control */
+    uint8_t getGestureEnterThresh();
+    bool setGestureEnterThresh(uint8_t threshold);
+    uint8_t getGestureExitThresh();
+    bool setGestureExitThresh(uint8_t threshold);
+    
+    /* Gesture LED, gain, and time control */
+    uint8_t getGestureWaitTime();
+    bool setGestureWaitTime(uint8_t time);
+    
+    /* Gesture mode */
+    uint8_t getGestureMode();
+    bool setGestureMode(uint8_t mode);
+
+    /* Raw I2C Commands */
+    //bool wireWriteByte(uint8_t val);
+    int wireWriteDataByte(uint8_t reg, uint8_t val);
+    int wireWriteDataBlock(uint8_t reg, uint8_t *val, unsigned int len);
+    int wireReadDataByte(uint8_t reg, uint8_t &val);
+    int wireReadDataBlock(uint8_t reg, uint8_t *val, unsigned int len);
+
+    /* Members */
+    gesture_data_type gesture_data_;
+    int gesture_ud_delta_;
+    int gesture_lr_delta_;
+    int gesture_ud_count_;
+    int gesture_lr_count_;
+    int gesture_near_count_;
+    int gesture_far_count_;
+    int gesture_state_;
+    int gesture_motion_;
+    int fd_;
+};
+
+#endif
\ No newline at end of file