Bugfix sensitivity options typo + add more options

Changes sensitivity scale to be more precise.
Fixes #17
This commit is contained in:
Ben V. Brown
2017-07-10 19:31:48 +10:00
parent 54356d53a9
commit a40ad665fe
4 changed files with 11 additions and 35 deletions

View File

@@ -34,19 +34,8 @@ void StartUp_Accelerometer(uint8_t sensitivity) {
I2C_RegisterWrite( CTRL_REG2, 0x40); // Reset all registers to POR values
delayMs(2); // ~1ms delay
I2C_RegisterWrite(FF_MT_CFG_REG, 0x78); // Enable motion detection for X and Y axis, latch enabled
uint8_t sens =0x0F;
switch(sensitivity)
{
case 0:
sens=0x1A;
break;
case 1:
sens=0x20;
break;
case 2:
sens=0x2A;
break;
}
uint8_t sens = 0x3F;
sens -= 0x08 * sensitivity;
I2C_RegisterWrite(FF_MT_THS_REG, sens); // Set threshold
I2C_RegisterWrite(FF_MT_COUNT_REG, 0x01); // Set debounce to 100ms