62 lines
1.8 KiB
C
62 lines
1.8 KiB
C
|
#ifndef __SHAKE_DETECT_H
|
|||
|
|
#define __SHAKE_DETECT_H
|
|||
|
|
|
|||
|
|
#include <stdint.h>
|
|||
|
|
|
|||
|
|
#define LIS3DSH_I2C_MASTER_NUM 0
|
|||
|
|
#define LIS3DSH_I2C_SEL_IO 11 // 地址选择
|
|||
|
|
#define LIS3DSH_I2C_MASTER_SDA_IO 12
|
|||
|
|
#define LIS3DSH_I2C_MASTER_SCL_IO 13
|
|||
|
|
#define LIS3DSH_I2C_MASTER_FREQ_HZ 400000
|
|||
|
|
#define LIS3DSH_I2C_SALVE_ADDR_L 0x18 // 7bit地址0b0011000
|
|||
|
|
#define LIS3DSH_I2C_MASTER_TIMEOUT_MS 1000
|
|||
|
|
#define ACK_CHECK_EN 0x1
|
|||
|
|
#define ACK_CHECK_DIS 0x0
|
|||
|
|
|
|||
|
|
#define LIS3DSH_INT1_IO 9 // 数据就绪信号
|
|||
|
|
#define LIS3DSH_CS_IO 10 // SPI I2C模式选择，1-I2C
|
|||
|
|
#define LIS3DSH_LED_IO 3
|
|||
|
|
#define BOOT_TIME 10
|
|||
|
|
|
|||
|
|
|
|||
|
|
#define N_SAMPLES 1024
|
|||
|
|
#define ANGLE_N_SAMPLES 128 // 需能整除N_SAMPLES
|
|||
|
|
|
|||
|
|
// 三轴加速度，已经过解析，单位g
|
|||
|
|
typedef struct
|
|||
|
|
{
|
|||
|
|
float a[3]; // x,y,z
|
|||
|
|
} lis3dsh_a_data_t;
|
|||
|
|
|
|||
|
|
typedef struct
|
|||
|
|
{
|
|||
|
|
int feq_min_id; // 注意，单位并不是HZ，为: 1600/N_SAMPLES HZ
|
|||
|
|
int feq_max_id;
|
|||
|
|
float enter_amplitude_th;
|
|||
|
|
float exit_amplitude_th;
|
|||
|
|
uint8_t channel1; // FFT可以同时计算两轴的频谱图，选择[1,2,3]->[x,y,z]
|
|||
|
|
uint8_t channel2;
|
|||
|
|
uint8_t select; // 选择进行震动检测的是频谱图，选择[1,2,3]->[ch1,ch2,both]
|
|||
|
|
} shake_detect_cfg_t;
|
|||
|
|
|
|||
|
|
typedef struct
|
|||
|
|
{
|
|||
|
|
float wind[N_SAMPLES];
|
|||
|
|
float y_cf[N_SAMPLES * 2];
|
|||
|
|
float *y1_cf;
|
|||
|
|
float *y2_cf;
|
|||
|
|
float sum_y[N_SAMPLES / 2];
|
|||
|
|
int is_shake;
|
|||
|
|
} fft_data_t;
|
|||
|
|
|
|||
|
|
typedef struct
|
|||
|
|
{
|
|||
|
|
float x;
|
|||
|
|
float y;
|
|||
|
|
float z;
|
|||
|
|
} angle_data_t;
|
|||
|
|
|
|||
|
|
void shake_detect_init(void);
|
|||
|
|
void lis3dsh_calculating_angle(float ax, float ay, float az, float *pitch, float *roll, float *yaw);
|
|||
|
|
|
|||
|
|
#endif
|