d3d8e3d2d5
* Refactor I2C_SOFT to new #define * Stitch in some of TS101 Update ShowStartupWarnings.cpp Update OLED.hpp Update stm32f1xx_hal_msp.c Update Setup.cpp Update Power.cpp Update Pins.h Update configuration.h Power Muxing Working dual input Voltage handler Scan mode required for differing injected channels Inject both dc readings Update configuration.h Update configuration.h Use htim4 for adc control on TS101 Refactor htim names Add ADC_TRIGGER Speed up BB I2C a lil Update configuration.h Update startup_stm32f103t8ux.S Update configuration.h Add LIS2DH clone LIS2DH gains another clone Create tooling to allow mapping accelerometers onto different buses Update startup_stm32f103t8ux.S Ensure PD IRQ is pulled up * Stitch in some of TS101 Update ShowStartupWarnings.cpp Update OLED.hpp Update stm32f1xx_hal_msp.c Update Setup.cpp Update Power.cpp Update Pins.h Update configuration.h Power Muxing Working dual input Voltage handler Scan mode required for differing injected channels Inject both dc readings Update configuration.h Update configuration.h Use htim4 for adc control on TS101 Refactor htim names Add ADC_TRIGGER Speed up BB I2C a lil Update configuration.h Update startup_stm32f103t8ux.S Update configuration.h Add LIS2DH clone LIS2DH gains another clone Create tooling to allow mapping accelerometers onto different buses Update startup_stm32f103t8ux.S Ensure PD IRQ is pulled up Allow toggle which button enters PD debug * Update Pins.h * Fix hard coded IRQ Pin Update stm32f1xx_it.c * Enable EPR * Tip resistance measurement * TS101 is a direct drive tip Update BSP.cpp * Add S60 and TS101 to builds Update push.yml * Update MOVThread.cpp * Refactor power menu handler * Correct prescaler Forgot to update since I changed the period * Tune in the timer divider for tip control to make PWM less audible --------- Co-authored-by: discip <53649486+discip@users.noreply.github.com>
57 lines
2.5 KiB
C++
57 lines
2.5 KiB
C++
/*
|
|
* LIS2DH12.cpp
|
|
*
|
|
* Created on: 27Feb.,2018
|
|
* Author: Ralim
|
|
*/
|
|
|
|
#include <array>
|
|
|
|
#include "LIS2DH12.hpp"
|
|
#include "cmsis_os.h"
|
|
|
|
static const ACCEL_I2C_CLASS::I2C_REG i2c_registers[] = {{LIS_CTRL_REG1, 0x17, 0}, // 25Hz
|
|
{LIS_CTRL_REG2, 0b00001000, 0}, // Highpass filter off
|
|
{LIS_CTRL_REG3, 0b01100000, 0}, // Setup interrupt pins
|
|
{LIS_CTRL_REG4, 0b00001000, 0}, // Block update mode off, HR on
|
|
{LIS_CTRL_REG5, 0b00000010, 0}, //
|
|
{LIS_CTRL_REG6, 0b01100010, 0},
|
|
// Basically setup the unit to run, and enable 4D orientation detection
|
|
{LIS_INT2_CFG, 0b01111110, 0}, // setup for movement detection
|
|
{LIS_INT2_THS, 0x28, 0}, //
|
|
{LIS_INT2_DURATION, 64, 0}, //
|
|
{LIS_INT1_CFG, 0b01111110, 0}, //
|
|
{LIS_INT1_THS, 0x28, 0}, //
|
|
{LIS_INT1_DURATION, 64, 0}};
|
|
|
|
bool LIS2DH12::initalize() { return ACCEL_I2C_CLASS::writeRegistersBulk(LIS2DH_I2C_ADDRESS, i2c_registers, sizeof(i2c_registers) / sizeof(i2c_registers[0])); }
|
|
|
|
void LIS2DH12::getAxisReadings(int16_t &x, int16_t &y, int16_t &z) {
|
|
std::array<int16_t, 3> sensorData;
|
|
|
|
ACCEL_I2C_CLASS::Mem_Read(LIS2DH_I2C_ADDRESS, 0xA8, reinterpret_cast<uint8_t *>(sensorData.begin()), sensorData.size() * sizeof(int16_t));
|
|
|
|
x = sensorData[0];
|
|
y = sensorData[1];
|
|
z = sensorData[2];
|
|
}
|
|
|
|
bool LIS2DH12::detect() {
|
|
if (!ACCEL_I2C_CLASS::probe(LIS2DH_I2C_ADDRESS)) {
|
|
return false;
|
|
}
|
|
// Read chip id to ensure its not an address collision
|
|
uint8_t id = 0;
|
|
if (ACCEL_I2C_CLASS::Mem_Read(LIS2DH_I2C_ADDRESS, LIS2DH_WHOAMI_REG, &id, 1)) {
|
|
return (id == LIS2DH_WHOAMI_ID) || (id == LIS2DH_CLONE_WHOAMI_ID);
|
|
}
|
|
return false; // cant read ID
|
|
}
|
|
|
|
bool LIS2DH12::isClone() {
|
|
uint8_t id = 0;
|
|
if (ACCEL_I2C_CLASS::Mem_Read(LIS2DH_I2C_ADDRESS, LIS2DH_WHOAMI_REG, &id, 1)) {
|
|
return (id == LIS2DH_CLONE_WHOAMI_ID);
|
|
}
|
|
return false;
|
|
} |