Starting library to get the SI1143 Gesture Sensor to work. Currently only works in forced conversion mode.

Dependents:   Gesture_Sensor Gesture_Arm_Robot mbed_gesture Gesture_Sensor_Sample ... more

SI1143.cpp

Committer:
GAT27
Date:
2013-10-17
Revision:
0:18ebb7348150
Child:
1:28beeb2f209b

File content as of revision 0:18ebb7348150:

#include "SI1143.h"

SI1143::SI1143(PinName sda, PinName scl)
{
    wait_ms(30);
    i2c_ = new I2C(sda, scl);
    //3.4MHz, as specified by the datasheet.
    i2c_->frequency(3400000);
    
    command(RESET);
    wait_ms(30);
    //bias1=0;
    //bias2=0;
    //bias3=0;
    //PS1=0;
    //PS2=0;
    //PS3=0;
    
    write_reg(HW_KEY,HW_KEY_VAL0); // Setting up LED Power to full
    //write_reg(PS_LED21,0xFF);
    write_reg(PS_LED21,0xAA);
    //write_reg(PS_LED3, 0x0F);
    write_reg(PS_LED3,0x0A);
  //param_set(CHLIST,0b00010111);
    //param_set(CHLIST,0x17);
    //write_reg(PARAM_WR, 0x17);
    write_reg(PARAM_WR, ALS_IR_TASK + ALS_VIS_TASK + PS1_TASK + PS2_TASK + PS3_TASK);
    
    //write_reg(COMMAND, 0xA0|CHLIST);
    command(PARAM_SET + (CHLIST & 0x1F));
    
    write_reg(INT_CFG,0);
    write_reg(IRQ_ENABLE,0);
    write_reg(IRQ_MODE1,0);
    write_reg(IRQ_MODE2,0);
  
  //void write_reg(byte address, byte val) {  // Write a resigter
  //Wire.beginTransmission(IR_ADDRESS); 
  //Wire.write(address);      
  //Wire.write(val);       
  //Wire.endTransmission();     
//}
  
    //char parameter = read_reg(PARAM_RD,1);
 // Serial.print("CHLIST = ");
 // Serial.println(parameter,BIN);
  //delay(1000);
    //wait(2);
    /*
    for (int i=0; i<20; i++)
    {
          //write_reg(COMMAND,0b00000101);
        write_reg(COMMAND,0x05);
          //delay(50);
        //wait(0.05);
          
          //char LowB = read_reg(PS1_DATA0,1);
          //char HighB = read_reg(PS1_DATA1,1);
        LowB = read_reg(PS1_DATA0,1);
        HighB = read_reg(PS1_DATA1,1);
          
        bias1 = bias1 + (((HighB * 255) + LowB) / 20);
          
        LowB = read_reg(PS2_DATA0,1);
        HighB = read_reg(PS2_DATA1,1);
          
        bias2 = bias2 + (((HighB * 255) + LowB) / 20);
          
        LowB = read_reg(PS3_DATA0,1);
        HighB = read_reg(PS3_DATA1,1);
          
        bias3 = bias3 + (((HighB * 255) + LowB) / 20);
    }*/
}

void SI1143::command(char cmd)
{
    int val;
    
    val = read_reg(RESPONSE,1);
    while(val!=0)
    {
        write_reg(COMMAND,NOP);
        val = read_reg(RESPONSE,1);
        printf("%d\r\n",val);
    }
    do{
        write_reg(COMMAND,cmd);
        if(cmd==RESET) break;
        val = read_reg(RESPONSE,1);
        //printf("%d\r\n",val);
    }while(val==0);
}

char SI1143::read_reg(/*unsigned*/ char address, int num_data) // Read a Register
{
    //
  //unsigned char data;
    //char cmd[2]={address,num_data};
    //int data;
    
    //i2c_->start();
    //data = i2c_->read(IR_ADDRESS,cmd,2);
    //wait(0.05);
    //i2c_->stop();
    
    //return data;
    
    char tx[1];
    char rx[1];
    
    i2c_->start();
    tx[0] = address;
    i2c_->write((IR_ADDRESS << 1) & 0xFE, tx, num_data);
    wait_ms(1);
    i2c_->stop();
    
    i2c_->start();
    i2c_->read((IR_ADDRESS << 1) | 0x01, rx, num_data);
    wait_ms(1);
    i2c_->stop();
    
    return rx[0];

  //Wire.beginTransmission(IR_ADDRESS);
  //Wire.write(address);
  //Wire.endTransmission();

  //Wire.requestFrom(IR_ADDRESS, num_data);
  
  //while(Wire.available() < num_data);
  
  //return Wire.read();
}

void SI1143::write_reg(char address, char num_data)
{  // Write a resigter
    //char cmd[2]={address,val};
    
    //i2c_->start();
    //i2c_->write(IR_ADDRESS,cmd,1);
    //wait(0.05);
    //i2c_->stop();
    
    char tx[2];

    tx[0] = address;
    tx[1] = num_data;
    //tx[2] = data;
    
    i2c_->start();
    i2c_->write((IR_ADDRESS << 1) & 0xFE, tx, 2);
    wait_ms(1);
    i2c_->stop();
    
  //Wire.beginTransmission(IR_ADDRESS); 
  //Wire.write(address);      
  //Wire.write(val);       
  //Wire.endTransmission();     
}

void SI1143::bias()
{
    //command(PSALS_FORCE);
    sample(0);
    bias1 = PS1;
    bias2 = PS2;
    bias3 = PS3;
}

int SI1143::sample(int point)
{
    //int data[5];
    command(PSALS_FORCE);
    //write_reg(COMMAND,0x05); // Get a reading
    //delay(5);
    //wait(0.5);
    
    LowB = read_reg(ALS_VIS_DATA0,1); // Read the data for the first LED
    HighB = read_reg(ALS_VIS_DATA1,1);
    VIS = (HighB * 256) + LowB;
    
    LowB = read_reg(ALS_IR_DATA0,1); // Read the data for the first LED
    HighB = read_reg(ALS_IR_DATA1,1);
    IR = (HighB * 256) + LowB;
    
    LowB = read_reg(PS1_DATA0,1); // Read the data for the first LED
    HighB = read_reg(PS1_DATA1,1);
    PS1 = (HighB * 256) + LowB;
    
    LowB = read_reg(PS2_DATA0,1); // Read the data for the first LED
    HighB = read_reg(PS2_DATA1,1);
    PS2 = (HighB * 256) + LowB;
    
    LowB = read_reg(PS3_DATA0,1); // Read the data for the first LED
    HighB = read_reg(PS3_DATA1,1);
    PS3 = (HighB * 256) + LowB;
    
    if(PS1 > bias1)
        PS1 = PS1 - bias1;
    else
        PS1 = 0;
    if(PS2 > bias2)
        PS2 = PS2 - bias2;
    else
        PS2 = 0;
    if(PS3 > bias3)
        PS3 = PS3 - bias3;
    else
        PS3 = 0;
    
    switch(point)
    {
        case 1:     return VIS;
        case 2:     return IR;
        case 3:     return PS1;
        case 4:     return PS2;
        case 5:     return PS3;
        default:    return 0;
    }
    //data[0] = VIS;
    //data[1] = IR;
    //data[2] = PS1;
    //data[3] = PS2;
    //data[4] = PS3;
    
    //return data;
    
    //return PS1;
}
/*
int SI1143::read1()
{
    write_reg(COMMAND,0x05); // Get a reading
    //delay(5);
    //wait(0.5);
    
    LowB = read_reg(PS1_DATA0,1); // Read the data for the first LED
    HighB = read_reg(PS1_DATA1,1);
    PS1 = ((HighB * 255) + LowB) - bias1;
    
    return PS1;
}
        
int SI1143::read2()
{
    write_reg(COMMAND,0x05); // Get a reading
    //delay(5);
    //wait(0.5);
    
    LowB = read_reg(PS2_DATA0,1);  // Read the data for the second LED
    HighB = read_reg(PS2_DATA1,1);
    PS2 = (HighB * 255) + LowB - bias2;
    
    return PS2;
}
        
int SI1143::read3()
{
    write_reg(COMMAND,0x05); // Get a reading
    //delay(5);
    //wait(0.5);
    
    LowB = read_reg(PS3_DATA0,1);  // Read the data for the third LED
    HighB = read_reg(PS3_DATA1,1);
    PS3 = (HighB * 255) + LowB - bias3;
    
    return PS3;
}*/