mirror of
https://github.com/Ralim/IronOS.git
synced 2025-02-26 07:53:55 +00:00
Bugfix sensitivity options typo + add more options
Changes sensitivity scale to be more precise. Fixes #17
This commit is contained in:
@@ -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
|
||||
|
||||
|
||||
Reference in New Issue
Block a user