7d0af3fc4c
* Estimated pinout into the ioc file * Fix Atollic paths to be somewhat more portable * Add make command * Add rough calls to ADC2 [untested] * Using dual ADC injected modes * Start both ADCs * Move some IRQ's to ram exec * Stabilize PID a bit more * Add in ideas for tip type selection * Update peripheral setup to support TS80 * Add tiptype formula / settings struct * Add function ids to the settings menu * Rough tip selection * Rough out new cal routine for simple tips * Hardware test is fairly close for first pass * Add Simple calibration case [UNTESTED] This adds the calibration option that uses boiling water to the calibration menu. This is untested, and may need gain adjustments before use. * [Feat] Add some QC testing code * Typo fix * Add double button press handler for different rising times * Add hook for jump to sleep mode * QC for 9V Works! * Rough out QC handler, trim out old menu help text thats useless * QC 9V working... Static all the things (Low on ROM)! * Static all I2C to save space * Move QC negotiation into background task so it doesnt block the UI * Input V display works, tune ADC * QC 3 steps working * Start tip R measurements * Impliment tip resistance * Fix up the accel position, link in auto QC stages * Fix tip title * Tip type settings, Static OLED * Revert I2C callbacks * Misc Cleanup * Better Gain value, need to investiate offset * Add model warning * Add TS80 Boot Logo (#367) * Add TS80 Boot Logo * Refined * Moved down by 1px * Add in power selection 18/24W * Clean up accelerometer, fix TS100 builds, Fix voltage div cal
74 lines
2.4 KiB
C++
74 lines
2.4 KiB
C++
/*
|
|
* MMA8652FC.cpp
|
|
*
|
|
* Created on: 31Aug.,2017
|
|
* Author: Ben V. Brown
|
|
*/
|
|
|
|
#include <MMA8652FC.hpp>
|
|
#include "cmsis_os.h"
|
|
|
|
typedef struct {
|
|
const uint8_t reg;
|
|
const uint8_t val;
|
|
} MMA_REG;
|
|
|
|
static const MMA_REG i2c_registers[] = { { CTRL_REG2, 0 }, //Normal mode
|
|
{ CTRL_REG2, 0x40 }, // Reset all registers to POR values
|
|
{ FF_MT_CFG_REG, 0x78 }, // Enable motion detection for X, Y, Z axis, latch disabled
|
|
{ PL_CFG_REG, 0x40 }, //Enable the orientation detection
|
|
{ PL_COUNT_REG, 200 }, //200 count debounce
|
|
{ PL_BF_ZCOMP_REG, 0b01000111 }, //Set the threshold to 42 degrees
|
|
{ P_L_THS_REG, 0b10011100 }, //Up the trip angles
|
|
{ CTRL_REG4, 0x01 | (1 << 4) }, // Enable dataready interrupt & orientation interrupt
|
|
{ CTRL_REG5, 0x01 }, // Route data ready interrupts to INT1 ->PB5 ->EXTI5, leaving orientation routed to INT2
|
|
{ CTRL_REG2, 0x12 }, //Set maximum resolution oversampling
|
|
{ XYZ_DATA_CFG_REG, (1 << 4) }, //select high pass filtered data
|
|
{ HP_FILTER_CUTOFF_REG, 0x03 }, //select high pass filtered data
|
|
{ CTRL_REG1, 0x19 } // ODR=12 Hz, Active mode
|
|
};
|
|
|
|
|
|
void MMA8652FC::initalize() {
|
|
size_t index = 0;
|
|
|
|
//send all the init commands to the unit
|
|
|
|
FRToSI2C::I2C_RegisterWrite(MMA8652FC_I2C_ADDRESS,i2c_registers[index].reg, i2c_registers[index].val);
|
|
index++;
|
|
FRToSI2C::I2C_RegisterWrite(MMA8652FC_I2C_ADDRESS,i2c_registers[index].reg, i2c_registers[index].val);
|
|
index++;
|
|
|
|
HAL_Delay(2); // ~1ms delay
|
|
|
|
while (index < (sizeof(i2c_registers) / sizeof(i2c_registers[0]))) {
|
|
FRToSI2C::I2C_RegisterWrite(MMA8652FC_I2C_ADDRESS,i2c_registers[index].reg, i2c_registers[index].val);
|
|
index++;
|
|
}
|
|
}
|
|
|
|
Orientation MMA8652FC::getOrientation() {
|
|
//First read the PL_STATUS register
|
|
uint8_t plStatus = FRToSI2C::I2C_RegisterRead(MMA8652FC_I2C_ADDRESS,PL_STATUS_REG);
|
|
if ((plStatus & 0b10000000) == 0b10000000) {
|
|
plStatus >>= 1; //We don't need the up/down bit
|
|
plStatus &= 0x03; //mask to the two lower bits
|
|
|
|
//0 == left handed
|
|
//1 == right handed
|
|
|
|
return static_cast<Orientation>(plStatus);
|
|
}
|
|
|
|
return ORIENTATION_FLAT;
|
|
}
|
|
void MMA8652FC::getAxisReadings(int16_t *x, int16_t *y, int16_t *z) {
|
|
uint8_t tempArr[6];
|
|
FRToSI2C::Mem_Read( MMA8652FC_I2C_ADDRESS, OUT_X_MSB_REG, I2C_MEMADD_SIZE_8BIT,
|
|
(uint8_t*) tempArr, 6);
|
|
|
|
(*x) = tempArr[0] << 8 | tempArr[1];
|
|
(*y) = tempArr[2] << 8 | tempArr[3];
|
|
(*z) = tempArr[4] << 8 | tempArr[5];
|
|
}
|