footPDR.h 521 B

1234567891011121314151617181920212223242526
  1. #ifndef __foot_pdr_h__
  2. #define __foot_pdr_h__
  3. #include "main.h"
  4. #include "ekfPDR.h"
  5. #include "ukfPDR.h"
  6. #include "matrixOperations.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(int num, float *gyr, float *acc, float *mag ,int press, int16_t* pos_res, int16_t* att, int16_t* zupt);
  16. void quat2angle(float qin[4], float *roll, float *pitch, float *yaw);
  17. #endif