ADXL375をspiで使えるようにしたライブラリ
Dependents: Stability_seed2019_v2
ADXL375_spi.cpp
- Committer:
- Sigma884
- Date:
- 2020-03-17
- Revision:
- 0:6bf9c1ce7bdc
File content as of revision 0:6bf9c1ce7bdc:
#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); }