Diff: Peripherals/SX9306.cpp

Revision:

20:626b92b70bf7

diff -r 45d0ce0f0677 -r 626b92b70bf7 Peripherals/SX9306.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Peripherals/SX9306.cpp	Thu Nov 08 10:14:39 2018 +0000
@@ -0,0 +1,264 @@
+/*
+  ______                              _
+ / _____)             _              | |
+( (____  _____ ____ _| |_ _____  ____| |__
+ \____ \| ___ |    (_   _) ___ |/ ___)  _ \
+ _____) ) ____| | | || |_| ____( (___| | | |
+(______/|_____)_|_|_| \__)_____)\____)_| |_|
+    (C)2016 Semtech
+
+Description: SX9306 Proximity sensor
+
+Maintainer: Gregory Cristian & Gilbert Menth
+*/
+
+#include "mbed.h"
+#include <stdio.h>
+#include "DmTftBase.h"
+#include "SX9306.h"
+#include "Timers.h"
+#include "Eeprom.h"
+
+union ProximityData_t
+{
+    ProximityStruct ThisAntenna;
+    char Buffer[sizeof( ProximityStruct )];
+};
+
+typedef enum
+{
+    PROXIMITY_STATE_START_RESET,
+    PROXIMITY_STATE_WAIT_RESET,
+    PROXIMITY_STATE_INIT,
+    PROXIMITY_STATE_READ,
+    PROXIMITY_STATE_WAIT
+}ProximityAppState_t;
+
+
+DigitalOut ProximityIcReset( PA_1 );
+I2C ProxI2C( I2C_SDA, I2C_SCL );
+
+static uint32_t ProximityTimer;
+static char ReadDataBuffer[2];
+static char WriteDataBuffer[2];
+static ProximityAppState_t ProximityAppState;
+static ProximityData_t ProximityReading;
+static ProximityStruct Antenna[2];
+
+
+static bool SX9306ProximityReadRegister( char thisRegAddress, char *value );
+static bool SX9306ProximityWriteRegister( char thisRegAddress, char value );
+static bool SX9306ProximityReadAntennaValues( void );
+
+
+void SX9306ProximityInit( void )
+{
+    int count;
+    
+    ProximityAppState = PROXIMITY_STATE_START_RESET;
+    for( count = 0; count < 2; count++ )
+    {
+        Antenna[count].Averaged = 0;
+        Antenna[count].Instantaneous = 0;
+    }
+}
+
+void SX9306ProximityHandle( void )
+{
+    bool i2cResult;
+    
+    switch( ProximityAppState )
+    {
+        case PROXIMITY_STATE_START_RESET:
+            ProximityIcReset = false;
+            TimersSetTimer( &ProximityTimer, 10 * TIM_MSEC );
+            ProximityAppState = PROXIMITY_STATE_WAIT_RESET;
+            break;
+
+        case PROXIMITY_STATE_WAIT_RESET:
+            if( TimersTimerHasExpired( &ProximityTimer ) )
+            {
+                ProximityIcReset = true;
+                TimersSetTimer( &ProximityTimer, 10 * TIM_MSEC );
+                ProximityAppState = PROXIMITY_STATE_INIT;
+            }
+            break;
+
+        case PROXIMITY_STATE_INIT:
+            if( TimersTimerHasExpired( &ProximityTimer ) )
+            {
+                TimersSetTimer( &ProximityTimer, 1 * TIM_SEC );
+                //Clear interrupts after power on
+                i2cResult = SX9306ProximityReadRegister( REG_IRQ_SRC, \
+                                                         &ReadDataBuffer[0] );
+                if( !i2cResult )
+                {
+                    //Enable antennas 1 & 2
+                    i2cResult = SX9306ProximityWriteRegister( REG_CONTROL_0, \
+                                                              SENSOR_ENABLE_23 );
+                    if( !i2cResult )
+                    {
+                        //Stop doze mode
+                        i2cResult = SX9306ProximityWriteRegister( REG_CONTROL_3, \
+                                                                  SENSOR_DOZE_OFF );
+                        if( !i2cResult )
+                        {
+                            //Set max gain and granularity
+                            i2cResult = SX9306ProximityWriteRegister( REG_CONTROL_2, \
+                                                                      MAX_GAIN );
+                        }
+                    }
+                }
+                if( !i2cResult )
+                {
+                    ProximityAppState = PROXIMITY_STATE_READ;
+                }
+                else
+                {
+                    ProximityAppState = PROXIMITY_STATE_START_RESET;
+                }
+            }
+            break;
+
+        case PROXIMITY_STATE_READ:
+            TimersSetTimer( &ProximityTimer, 1 * TIM_SEC );
+            //Select antenna 1
+            i2cResult = SX9306ProximityWriteRegister( REG_SENSORSEL, SENSOR_SEL_1 );
+            if( i2cResult )
+            {
+                ProximityAppState = PROXIMITY_STATE_START_RESET;
+                break;
+            }
+            i2cResult = SX9306ProximityReadAntennaValues( ); //Read values
+            if( i2cResult )
+            {
+                ProximityAppState = PROXIMITY_STATE_START_RESET;
+                break;
+            }
+            Antenna[ANTENNA_1] = ProximityReading.ThisAntenna;
+            //Select antenna 2
+            i2cResult = SX9306ProximityWriteRegister( REG_SENSORSEL, SENSOR_SEL_2 );
+            if( i2cResult )
+            {
+                ProximityAppState = PROXIMITY_STATE_START_RESET;
+                break;
+            }
+            i2cResult = SX9306ProximityReadAntennaValues( ); //Read values
+            if( i2cResult )
+            {
+                ProximityAppState = PROXIMITY_STATE_START_RESET;
+                break;
+            }
+            Antenna[ANTENNA_2] = ProximityReading.ThisAntenna;
+            ProximityAppState = PROXIMITY_STATE_WAIT;
+            break;
+
+        case PROXIMITY_STATE_WAIT:
+            if( TimersTimerHasExpired( &ProximityTimer ) )
+            {
+                ProximityAppState = PROXIMITY_STATE_READ;
+            }
+            break;
+    }
+}
+
+static bool SX9306ProximityReadRegister( char thisRegAddress, char *value )
+{
+    WriteDataBuffer[0] = thisRegAddress;
+    // Write the register address
+    if( ProxI2C.write( PROXIMITY_I2C_ADDR, &WriteDataBuffer[0], 1, 0 ) )
+    {
+        return true;
+    }
+    // Read data from the address
+    if( ProxI2C.read( PROXIMITY_I2C_ADDR, value, 1, 0 ) )
+    {
+        return true;
+    }
+    return false;
+}
+
+static bool SX9306ProximityWriteRegister( char thisRegAddress, char value )
+{
+    WriteDataBuffer[0] = thisRegAddress;
+    WriteDataBuffer[1] = value;
+    
+    // Write the register address and data byte
+    if( ProxI2C.write( PROXIMITY_I2C_ADDR, &WriteDataBuffer[0], 2, 0 ) )
+    {
+        return true;
+    }
+    return false;
+}
+
+static bool SX9306ProximityReadAntennaValues( void )
+{
+    bool i2cResult;
+    
+    i2cResult = SX9306ProximityReadRegister( REG_PROXUSEFUL, \
+                                             &ProximityReading.Buffer[1] );
+    if( i2cResult )
+    {
+        return true;
+    }
+    i2cResult = SX9306ProximityReadRegister( REG_PROXUSEFUL + 1, \
+                                             &ProximityReading.Buffer[0] );
+    if( i2cResult )
+    {
+        return true;
+    }
+    i2cResult = SX9306ProximityReadRegister( REG_PROXAVG, \
+                                             &ProximityReading.Buffer[3] );
+    if( i2cResult )
+    {
+        return true;
+    }
+    i2cResult = SX9306ProximityReadRegister( REG_PROXAVG + 1, \
+                                             &ProximityReading.Buffer[2] );
+    if( i2cResult )
+    {
+        return true;
+    }
+    return false;
+}
+
+uint8_t SX9306proximitySerialCommand( uint8_t writeNotRead, uint8_t address, \
+                                      uint8_t writeValue, uint8_t *readValue )
+{
+    char valueRead = 0;
+    bool i2cResult;
+    
+    if( writeNotRead )
+    {
+        i2cResult = SX9306ProximityWriteRegister( address, writeValue );
+    }
+    else
+    {
+        i2cResult = SX9306ProximityReadRegister( address, &valueRead );
+        *readValue = ( uint8_t )valueRead;
+    }
+    if( i2cResult )
+    {
+        return 0;
+    }
+    return 1;
+}
+
+uint16_t SX9306proximityGetReadValue( uint32_t thisAntenna )
+{
+    uint16_t retVal;
+    
+    switch( thisAntenna )
+    {
+        case 0:
+        case 1:
+            retVal = Antenna[thisAntenna].Instantaneous;
+            break;
+
+        default:
+            retVal = Antenna[0].Instantaneous;
+            break;
+    }
+    return retVal;
+}
+