Diff: SI_LIS.cpp

Revision:

0:34bad5aca893

Child:

1:2efeed26d93a

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/SI_LIS.cpp	Thu Mar 20 02:50:57 2014 +0000
@@ -0,0 +1,166 @@
+
+#include "SI_LIS.h"
+
+I2C i2c(p9, p10);  //  (SDA,SCL)
+int bias1,bias2,bias3,PS1,PS2,PS3,VIS;
+unsigned char LowB,HighB;
+unsigned int IR;
+extern char rx_data[4];
+extern char accel_2_data[2];
+extern char accel_data;
+
+void restart()
+{
+    wait_ms(30);
+    i2c.frequency(400000);
+    command(RESET);
+    wait_ms(30);
+
+    write_reg(HW_KEY,HW_KEY_VAL0);
+    write_reg(PS_LED21,0x41);   // values when Si1142 and LED's put into hat
+    write_reg(PS_LED3,0x00);
+
+    //  CHLIST Parameter
+    write_reg(PARAM_WR, PS1_TASK + PS2_TASK);   //use PS1, PS2 to fire LED's
+    command(PARAM_SET + (CHLIST & 0x1F));
+
+    //  PS Gain:  by factor of (2 ^ PS_ADC_GAIN). Max gain: 128 (0x7).
+    write_reg(PARAM_WR, 0x03);
+    command(PARAM_SET + (PS_ADC_GAIN & 0x1F));
+
+    //  PS_ADC_COUNTER  (Recommend one’s complement of PS_ADC_GAIN.)
+    write_reg(PARAM_WR, 0x40);
+    command(PARAM_SET + (PS_ADC_COUNTER & 0x1F));
+
+    //  ADC_OFFSET (adds to reported so there's no confusion with 0xFFFF overrange indicator) reset: 0x80
+    write_reg(PARAM_WR, 0x00);
+    command(PARAM_SET + (ADC_OFFSET & 0x1F));
+    
+    //  PS_Encoding  (Bit 5: When set,  ADC reports least significant 16 bits of 17-bit ADC
+    //  Current Concept: don't set, but gain it up by another 2x
+
+    write_reg(INT_CFG,1);  //set bit 0 to 1.  Requires clearing interrupt pin 
+
+    // IRQ_ENABLE 0x04:   Bit 3:  PS2_IE     Bit 2: PS1_IE
+    write_reg(IRQ_ENABLE,0x04);
+
+    //IRQ_MODE1:  00: PS1_INT is set whenever a PS1 measurement has completed.
+    write_reg(IRQ_MODE1,0);
+    write_reg(IRQ_MODE2,0);
+    
+    wait_ms(30);
+
+    write_reg(MEAS_RATE,0x20);  //0x84 should be every 10 ms.  Need calcs if less than that
+    wait_ms(30);
+    write_reg(PS_RATE,0x08);  //this should be a multiplier of 1
+    wait_ms(30);
+}
+
+void command_test()
+{
+    write_reg(COMMAND,NOP);
+}
+
+void command(char cmd)
+{
+    int val;
+
+    val = read_reg(RESPONSE,1);
+    while(val!=0) {
+        write_reg(COMMAND,NOP);
+        val = read_reg(RESPONSE,1);
+    }
+    do {
+        write_reg(COMMAND,cmd);
+        if(cmd==RESET) break;
+        val = read_reg(RESPONSE,1);
+    } while(val==0);
+}
+
+int command2(char cmd)
+{
+    int val;
+    int i = 0;
+    do {
+        write_reg(COMMAND,cmd);
+        val = read_reg(RESPONSE,1);
+        i = i+1;
+    } while(val==0);
+    return val;
+}
+
+void command3(char cmd)
+{
+    write_reg(COMMAND,cmd);
+}
+
+char read_reg2 (/*unsigned*/ char address) // Read a register
+{
+    char tx[1];
+    tx[0] = address;
+    i2c.write((IR_ADDRESS << 1) & 0xFE, tx, 1);
+
+    i2c.read((IR_ADDRESS << 1) | 0x01, rx_data, 4);
+    return 0;
+}
+
+
+char read_reg (/*unsigned*/ char address, int num_data) // Read a register
+{
+    char tx[1];
+    char rx[1];
+    tx[0] = address;
+    i2c.write((IR_ADDRESS << 1) & 0xFE, tx, num_data);
+
+    i2c.read((IR_ADDRESS << 1) | 0x01, rx, num_data);
+    return rx[0];
+}
+
+void write_reg(char address, char num_data) // Write a resigter
+{
+    char tx[2];
+
+    tx[0] = address;
+    tx[1] = num_data;
+    i2c.write((IR_ADDRESS << 1) & 0xFE, tx, 2);
+}
+
+void Init_Accel (char Reg_Num, char Reg_Val)
+{
+    char        data[2];
+    data[0]   = Reg_Num;     //register to be written to
+    data[1]   = Reg_Val;     //data
+
+    i2c.write((LIS_Addr << 1) & 0xFE, data, 2);
+}
+
+void Get_Accel_Register (char Reg_Num)
+{
+    char        data;
+    char        reg;
+
+    reg = Reg_Num;
+
+    i2c.write((LIS_Addr << 1) & 0xFE , &reg, 1 );  // Write register number
+    i2c.read ((LIS_Addr << 1) | 0x01, &data, 1 );  // Receive Byte from Slave
+    accel_data = data;
+}
+
+void Get_Accel_Register_2 (char Reg_Num) // Read 2 registers
+/*
+In order to read multiple bytes, it is necessary to assert the most significant bit of the subaddress
+field. In other words, SUB(7) must be equal to 1 while SUB(6-0) represents the
+address of first register to be read.
+*/
+{
+    char  reg;
+    reg = Reg_Num | 0x80; // set bit 7 high
+    i2c.write((LIS_Addr << 1) & 0xFE, &reg, 1);
+    i2c.read((LIS_Addr << 1) | 0x01, accel_2_data, 2);
+}
+
+void i2c_start()  // also set by photodiode setup/reset
+{
+    i2c.frequency(400000);
+}
+