Revision 0:6bf9c1ce7bdc, committed 2020-03-17

Comitter:

Sigma884

Date:

Tue Mar 17 12:30:36 2020 +0000

Commit message:

commit for publish stability_seed2019_v1

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ADXL375_spi.cpp	Tue Mar 17 12:30:36 2020 +0000
@@ -0,0 +1,160 @@
+#include "ADXL375_spi.h"
+
+ADXL375_spi :: ADXL375_spi(SPI &userSPI, PinName userPIN) : cs(userPIN){
+    /*
+    if(LOW_HIGH == ALT_ADDRESS_LOW){
+        ADXL375_I2C_READ = ADXL375_I2C_LOW_READ;
+        ADXL375_I2C_WRITE = ADXL375_I2C_LOW_WRITE;
+        ADXL375_I2C_ADDRESS = ADXL375_I2C_LOW_ADDRESS;
+    }
+    else if(LOW_HIGH == ALT_ADDRESS_HIGH){
+        ADXL375_I2C_READ = ADXL375_I2C_HIGH_READ;
+        ADXL375_I2C_WRITE = ADXL375_I2C_HIGH_WRITE;
+        ADXL375_I2C_ADDRESS = ADXL375_I2C_HIGH_ADDRESS;
+    }
+    */
+    /*
+    i2c = &userI2C;
+    i2c -> frequency(400000);
+    */
+    spi = &userSPI;
+    
+    spi -> format(8, 3);
+    spi -> frequency(5000000);
+    cs = 0;
+    spi -> write(0x00);
+    spi -> write(0x00);
+    cs = 1;
+    
+    /*
+    char tx[2];
+    tx[0] = ADXL375_BW_RATE_REG;
+    tx[1] = ADXL375_3200HZ;
+    i2c -> write(ADXL375_I2C_WRITE, tx, 2);
+    */
+    cs = 0;
+    spi -> write(ADXL375_BW_RATE_REG & 0x3F);
+    spi -> write(ADXL375_3200HZ);
+    cs = 1;
+    /*
+    char rx[2];
+    rx[0] = ADXL375_DATA_FORMAT_REG;
+    rx[1] = 0x0B;
+    i2c -> write(ADXL375_I2C_WRITE, rx, 2);
+    */
+    cs = 0;
+    spi -> write(ADXL375_DATA_FORMAT_REG & 0x3F);
+    spi -> write(0x0B);
+    cs = 1;
+    
+    /*
+    char x[2];
+    x[0] = ADXL375_OFSX_REG ;
+    x[1] = 0xFE;
+    i2c -> write(ADXL375_I2C_WRITE, x, 2);
+    char y[2];
+    y[0] = ADXL375_OFSY_REG ;
+    y[1] = 0xFE;
+    i2c -> write(ADXL375_I2C_WRITE, y, 2);
+    char z[2];
+    z[0] = ADXL375_OFSZ_REG ;
+    z[1] = 0x00;
+    i2c -> write(ADXL375_I2C_WRITE, z, 2);
+    */
+    cs = 0;
+    spi -> write(ADXL375_OFSX_REG & 0x3F);
+    spi -> write(0xFE);
+    cs = 1;
+    
+    cs = 0;
+    spi -> write(ADXL375_OFSY_REG & 0x3F);
+    spi -> write(0xFE);
+    cs = 1;
+    
+    cs = 0;
+    spi -> write(ADXL375_OFSZ_REG & 0x3F);
+    spi -> write(0x00);
+    cs = 1;
+    
+    singleByteWrite(ADXL375_POWER_CTL_REG, 0x08);
+    
+    offset_x = offset_y = offset_z = 0.0f;
+    
+}
+
+char ADXL375_spi :: singleByteRead(char address){
+    //char tx = address;
+    char output;
+    /*
+    i2c -> write(ADXL375_I2C_WRITE, &tx, 1);
+    i2c -> read(ADXL375_I2C_READ, &output, 1);
+    */
+    cs = 0;
+    spi -> write(address | 0x80 & 0xBF);
+    output = spi -> write(0x00);
+    cs = 1;
+    
+    return output;
+}
+
+void ADXL375_spi :: singleByteWrite(char address, char data){
+    /*
+    char tx[2];
+    tx[0] = address;
+    tx[1] = data;
+    i2c -> write(ADXL375_I2C_WRITE, tx, 2);
+    */
+    cs = 0;
+    spi -> write(address & 0x3F);
+    spi -> write(data);
+    cs = 1;
+}
+
+void ADXL375_spi :: multiByteRead(char address, char* output, int size){
+    /*
+    i2c -> write(ADXL375_I2C_WRITE, &address, 1);
+    i2c -> read(ADXL375_I2C_READ, output, size);
+    */
+    cs = 0;
+    spi -> write(address | 0xC0);
+    for(int i = 0; i < size; i ++){
+        output[i] = spi -> write(0x00);
+    }
+    cs = 1;
+}
+
+void ADXL375_spi :: getOutput(float* output){
+    char buffer[6];
+    short int data[3];
+    multiByteRead(ADXL375_DATAX0_REG, buffer, 6);
+    data[0] = (int)buffer[1] << 8 | (int)buffer[0];
+    data[1] = (int)buffer[3] << 8 | (int)buffer[2];
+    data[2] = (int)buffer[5] << 8 | (int)buffer[4];
+    
+    output[0] = (float)data[0] / 20.0f - offset_x;
+    output[1] = (float)data[1] / 20.0f - offset_y;
+    output[2] = (float)data[2] / 20.0f - offset_z;
+}
+
+int ADXL375_spi :: whoAmI(){
+    char who_am_i = singleByteRead(ADXL375_DEVID_REG);
+    if(who_am_i == 0xE5){
+        return 1;
+    }
+    else{
+        return -1;
+    }
+}
+
+void ADXL375_spi :: offset(float x, float y, float z){
+    offset_x = x;
+    offset_y = y;
+    offset_z = z;
+}
+
+void ADXL375_spi :: setDataRate(char rate){
+    char buff = singleByteRead(ADXL375_BW_RATE_REG);
+    buff &= 0x10;
+    buff |= rate;
+    singleByteWrite(ADXL375_BW_RATE_REG, buff);
+}
\ No newline at end of file

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ADXL375_spi.h	Tue Mar 17 12:30:36 2020 +0000
@@ -0,0 +1,103 @@
+#ifndef ADXL375_SPI_H
+#define ADXL375_SPI_H
+
+#include "mbed.h"
+
+//Registers.
+#define ADXL375_DEVID_REG          0x00
+#define ADXL375_THRESH_TAP_REG     0x1D
+#define ADXL375_OFSX_REG           0x1E
+#define ADXL375_OFSY_REG           0x1F
+#define ADXL375_OFSZ_REG           0x20
+#define ADXL375_DUR_REG            0x21
+#define ADXL375_LATENT_REG         0x22
+#define ADXL375_WINDOW_REG         0x23
+#define ADXL375_THRESH_ACT_REG     0x24
+#define ADXL375_THRESH_INACT_REG   0x25
+#define ADXL375_TIME_INACT_REG     0x26
+#define ADXL375_ACT_INACT_CTL_REG  0x27
+#define ADXL375_THRESH_FF_REG      0x28
+#define ADXL375_TIME_FF_REG        0x29
+#define ADXL375_TAP_AXES_REG       0x2A
+#define ADXL375_ACT_TAP_STATUS_REG 0x2B
+#define ADXL375_BW_RATE_REG        0x2C
+#define ADXL375_POWER_CTL_REG      0x2D
+#define ADXL375_INT_ENABLE_REG     0x2E
+#define ADXL375_INT_MAP_REG        0x2F
+#define ADXL375_INT_SOURCE_REG     0x30
+#define ADXL375_DATA_FORMAT_REG    0x31
+#define ADXL375_DATAX0_REG         0x32
+#define ADXL375_DATAX1_REG         0x33
+#define ADXL375_DATAY0_REG         0x34
+#define ADXL375_DATAY1_REG         0x35
+#define ADXL375_DATAZ0_REG         0x36
+#define ADXL375_DATAZ1_REG         0x37
+#define ADXL375_FIFO_CTL           0x38
+#define ADXL375_FIFO_STATUS        0x39
+
+//Data rate codes.
+#define ADXL375_3200HZ      0x0F
+#define ADXL375_1600HZ      0x0E
+#define ADXL375_800HZ       0x0D
+#define ADXL375_400HZ       0x0C
+#define ADXL375_200HZ       0x0B
+#define ADXL375_100HZ       0x0A
+#define ADXL375_50HZ        0x09
+#define ADXL375_25HZ        0x08
+#define ADXL375_12HZ5       0x07
+#define ADXL375_6HZ25       0x06
+
+/*
+// when ALT ADDRESS pin is LOW
+#define ADXL375_I2C_LOW_READ    0xA7
+#define ADXL375_I2C_LOW_WRITE   0xA6
+#define ADXL375_I2C_LOW_ADDRESS 0x53
+
+//when ALT ADDRESS pin is HIGH
+#define ADXL375_I2C_HIGH_READ    0x3B
+#define ADXL375_I2C_HIGH_WRITE   0x3A
+#define ADXL375_I2C_HIGH_ADDRESS 0x1D
+*/
+
+#define ADXL375_X           0x00
+#define ADXL375_Y           0x01
+#define ADXL375_Z           0x02
+
+// modes
+#define MeasurementMode     0x08
+
+class ADXL375_spi
+{
+
+public:
+    
+    ADXL375_spi(SPI &userSPI, PinName userPIN);
+    
+    void getOutput(float* output);
+    
+    int whoAmI();
+    
+    void offset(float x, float y, float z);
+    
+    void setDataRate(char rate);
+    
+private:
+    
+    /*
+    I2C *i2c;
+    char ADXL375_I2C_READ;
+    char ADXL375_I2C_WRITE;
+    char ADXL375_I2C_ADDRESS;
+    */
+    SPI *spi;
+    DigitalOut cs;
+    
+    float offset_x, offset_y, offset_z;
+    
+    char singleByteRead(char address);
+    void singleByteWrite(char address, char data);
+    void multiByteRead(char startAddress, char* ptr_output, int size);
+    
+};
+
+#endif
\ No newline at end of file