From 6e9e264c65f30e4046efbf27ebe801cd1f338122 Mon Sep 17 00:00:00 2001 From: Joey Castillo Date: Sun, 10 Apr 2022 18:08:37 -0400 Subject: rewrite lis2dh logger for lis2dw --- watch-library/shared/driver/lis2dw.c | 29 +++++++++++++++++++++++++++++ watch-library/shared/driver/lis2dw.h | 36 ++++++++++++++++++++++++++++++++---- 2 files changed, 61 insertions(+), 4 deletions(-) (limited to 'watch-library/shared') diff --git a/watch-library/shared/driver/lis2dw.c b/watch-library/shared/driver/lis2dw.c index fce266b3..4d60fcff 100644 --- a/watch-library/shared/driver/lis2dw.c +++ b/watch-library/shared/driver/lis2dw.c @@ -164,3 +164,32 @@ void lis2dw_clear_fifo(void) { watch_i2c_write8(LIS2DW_ADDRESS, LIS2DW_REG_FIFO_CTRL, LIS2DW_FIFO_CTRL_MODE_OFF); watch_i2c_write8(LIS2DW_ADDRESS, LIS2DW_REG_FIFO_CTRL, LIS2DW_FIFO_CTRL_MODE_COLLECT_AND_STOP | LIS2DW_FIFO_CTRL_FTH); } + +void lis2dw_configure_wakeup_int1(uint8_t threshold, bool latch, bool active_state) { + uint8_t configuration; + + // enable wakeup interrupt on INT1 pin + configuration = watch_i2c_read8(LIS2DW_ADDRESS, LIS2DW_REG_CTRL4_INT1); + watch_i2c_write8(LIS2DW_ADDRESS, LIS2DW_REG_CTRL4_INT1, configuration | LIS2DW_CTRL4_INT1_WU); + + // set threshold + watch_i2c_write8(LIS2DW_ADDRESS, LIS2DW_REG_WAKE_UP_THS, threshold | LIS2DW_WAKE_UP_THS_VAL_SLEEP_ON); + watch_i2c_write8(LIS2DW_ADDRESS, LIS2DW_REG_INT1_DUR, 0b01111111); + + configuration = watch_i2c_read8(LIS2DW_ADDRESS, LIS2DW_REG_CTRL3) & ~(LIS2DW_CTRL3_VAL_LIR); + if (!active_state) configuration |= LIS2DW_CTRL3_VAL_H_L_ACTIVE; + if (latch) configuration |= LIS2DW_CTRL3_VAL_LIR; + watch_i2c_write8(LIS2DW_ADDRESS, LIS2DW_REG_CTRL3, configuration); + + // enable interrupts + configuration = watch_i2c_read8(LIS2DW_ADDRESS, LIS2DW_REG_CTRL7); + watch_i2c_write8(LIS2DW_ADDRESS, LIS2DW_REG_CTRL7, configuration | LIS2DW_CTRL7_VAL_INTERRUPTS_ENABLE); +} + +lis2dw_wakeup_source lis2dw_get_wakeup_source() { + return (lis2dw_wakeup_source) watch_i2c_read8(LIS2DW_ADDRESS, LIS2DW_REG_WAKE_UP_SRC); +} + +lis2dw_interrupt_source lis2dw_get_interrupt_source(void) { + return (lis2dw_interrupt_source) watch_i2c_read8(LIS2DW_ADDRESS, LIS2DW_REG_ALL_INT_SRC); +} diff --git a/watch-library/shared/driver/lis2dw.h b/watch-library/shared/driver/lis2dw.h index 41611172..f9373e04 100644 --- a/watch-library/shared/driver/lis2dw.h +++ b/watch-library/shared/driver/lis2dw.h @@ -94,6 +94,24 @@ typedef enum { LIS2DW_RANGE_2_G = 0b00 // +/- 2g (default value) } lis2dw_range_t; +typedef enum { + LIS2DW_INTERRUPT_SRC_SLEEP_CHANGE = 0b00100000, + LIS2DW_INTERRUPT_SRC_6D = 0b00010000, + LIS2DW_INTERRUPT_SRC_DOUBLE_TAP = 0b00001000, + LIS2DW_INTERRUPT_SRC_SINGLE_TAP = 0b00000100, + LIS2DW_INTERRUPT_SRC_WU = 0b00000010, + LIS2DW_INTERRUPT_SRC_FF = 0b00000001 +} lis2dw_interrupt_source; + +typedef enum { + LIS2DW_WAKEUP_SRC_FREEFALL = 0b00100000, + LIS2DW_WAKEUP_SRC_SLEEP_STATE = 0b00010000, + LIS2DW_WAKEUP_SRC_WAKEUP = 0b00001000, + LIS2DW_WAKEUP_SRC_WAKEUP_X = 0b00000100, + LIS2DW_WAKEUP_SRC_WAKEUP_Y = 0b00000010, + LIS2DW_WAKEUP_SRC_WAKEUP_Z = 0b00000001 +} lis2dw_wakeup_source; + // Assumes SA0 is high; if low, its 0x18 #define LIS2DW_ADDRESS (0x19) @@ -130,15 +148,15 @@ typedef enum { #define LIS2DW_CTRL2_VAL_IF_ADD_INC 0b00000100 #define LIS2DW_REG_CTRL3 0x22 -#define LIS2DW_CTRL4_VAL_SELF_TEST_POS 0b10000000 -#define LIS2DW_CTRL4_VAL_SELF_TEST_NEG 0b01000000 +#define LIS2DW_CTRL3_VAL_SELF_TEST_POS 0b10000000 +#define LIS2DW_CTRL3_VAL_SELF_TEST_NEG 0b01000000 #define LIS2DW_CTRL3_VAL_PP_OD 0b00100000 #define LIS2DW_CTRL3_VAL_LIR 0b00010000 #define LIS2DW_CTRL3_VAL_H_L_ACTIVE 0b00001000 #define LIS2DW_CTRL3_VAL_SLP_MODE_SEL 0b00000010 #define LIS2DW_CTRL3_VAL_SLP_MODE_1 0b00000001 -#define LIS2DW_REG_CTRL4 0x23 +#define LIS2DW_REG_CTRL4_INT1 0x23 #define LIS2DW_CTRL4_INT1_6D 0b10000000 #define LIS2DW_CTRL4_INT1_SINGLE_TAP 0b01000000 #define LIS2DW_CTRL4_INT1_WU 0b00100000 @@ -148,7 +166,7 @@ typedef enum { #define LIS2DW_CTRL4_INT1_FTH 0b00000010 #define LIS2DW_CTRL4_INT1_DRDY 0b00000001 -#define LIS2DW_REG_CTRL5 0x24 +#define LIS2DW_REG_CTRL5_INT2 0x24 #define LIS2DW_CTRL5_INT2_SLEEP_STATE 0b10000000 #define LIS2DW_CTRL5_INT2_SLEEP_CHG 0b01000000 #define LIS2DW_CTRL5_INT2_BOOT 0b00100000 @@ -206,7 +224,11 @@ typedef enum { #define LIS2DW_REG_TAP_THS_Y 0x31 #define LIS2DW_REG_TAP_THS_Z 0x32 #define LIS2DW_REG_INT1_DUR 0x33 + #define LIS2DW_REG_WAKE_UP_THS 0x34 +#define LIS2DW_WAKE_UP_THS_VAL_TAP_EVENT_ENABLED 0b10000000 +#define LIS2DW_WAKE_UP_THS_VAL_SLEEP_ON 0b01000000 + #define LIS2DW_REG_WAKE_UP_DUR 0x35 #define LIS2DW_REG_FREE_FALL 0x36 #define LIS2DW_REG_STATUS_DUP 0x37 @@ -293,4 +315,10 @@ bool lis2dw_read_fifo(lis2dw_fifo_t *fifo_data); void lis2dw_clear_fifo(void); +void lis2dw_configure_wakeup_int1(uint8_t threshold, bool latch, bool active_state); + +lis2dw_interrupt_source lis2dw_get_interrupt_source(void); + +lis2dw_wakeup_source lis2dw_get_wakeup_source(void); + #endif // LIS2DW_H -- cgit v1.2.3