ADXL375をspiで使えるようにしたライブラリ
Dependents: Stability_seed2019_v2
Diff: ADXL375_spi.cpp
- Revision:
- 0:6bf9c1ce7bdc
--- /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