footPDR.h 552 B

123456789101112131415161718192021222324252627
  1. #ifndef __foot_pdr_h__
  2. #define __foot_pdr_h__
  3. #include "main.h"
  4. #include "ekfPDR.h"
  5. #include "matrixOperations.h"
  6. #include "motion_config.h"
  7. #include "nrf_nvmc.h"
  8. #define FLASH_ADD 0x0007c000
  9. #define ZUPT_threshold 0.81
  10. #define SIGMA 0.01
  11. #define SIGMA_V 0.01
  12. #define PI 3.14159265f
  13. #define RUN 1
  14. #define STAND 0
  15. unsigned char footPDR(int32_t num, float *gyr, float *acc, int16_t front_zero, int16_t back_zero, int16_t acc_zero, int32_t* pos_res, int16_t* att);
  16. void quat2angle(float qin[4], float *roll, float *pitch, float *yaw);
  17. #endif