hal_ser_imu.h 6.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215
  1. #ifndef __HAL_SER_IMU_H__
  2. #define __HAL_SER_IMU_H__
  3. #ifdef __cplusplus
  4. extern "C" {
  5. #endif
  6. /*Includes ------------------------------------------------------*/
  7. #include <stdbool.h>
  8. #include <stdint.h>
  9. #include <string.h>
  10. #include "sdk_common.h"
  11. #include "SEGGER_RTT.h"
  12. #include "usr_config.h"
  13. #include "drv_qmc6310_v2.h"
  14. #include "drv_lsm6ds3tr_c.h"
  15. /*STRUCTION ----------------------------------------------------*/
  16. typedef enum{
  17. SER_IMU_ACC_ODR_OFF = 0, //关闭加速度 优先级 - 0 优先级越大,级别越高
  18. SER_IMU_ACC_ODR_12HZ5 = 1, //采样频率 - 12.5赫兹 优先级 - 1
  19. SER_IMU_ACC_ODR_104HZ = 2, //采样频率 - 104赫兹 优先级 - 2
  20. } SER_IMU_ACC_ODR_e;
  21. typedef enum{
  22. SER_IMU_GRY_ODR_OFF = 0, //关闭陀螺仪 优先级 - 0 优先级越大,级别越高
  23. SER_IMU_GRY_ODR_12HZ5 = 1, //采样频率 - 12.5赫兹 优先级 - 1
  24. SER_IMU_GRY_ODR_104HZ = 2, //采样频率 - 104赫兹 优先级 - 2
  25. } SER_IMU_GRY_ODR_e;
  26. typedef enum{
  27. SER_IMU_MAG_ODR_OFF = 0, //关闭地磁计 优先级 - 0 优先级越大,级别越高
  28. SER_IMU_MAG_ODR_10HZ = 1, //采样频率 - 10赫兹 优先级 - 1
  29. SER_IMU_MAG_ODR_100HZ = 2, //采样频率 - 100赫兹 优先级 - 2
  30. SER_IMU_MAG_ODR_200HZ = 3, //采样频率 - 200赫兹 优先级 - 3
  31. } SER_IMU_MAG_ODR_e;
  32. typedef enum{
  33. SER_IMU_FIFO_ODR_OFF = 0, //关闭FIFO 优先级 - 0 优先级越大,级别越高
  34. SER_IMU_FIFO_ODR_104HZ = 1, //采样频率 - 104赫兹 优先级 - 1
  35. } SER_IMU_FIFO_ODR_e;
  36. typedef enum{
  37. SER_IMU_ACC_POWER_MODE_HIGH_PERFORMANCE = 0, //加速度工作模式 - 高性能 优先级 - 0 优先级越大,级别越高
  38. SER_IMU_ACC_POWER_MODE_NORMAL = 1, //加速度工作模式 - 正常 优先级 - 1
  39. } SER_IMU_ACC_POWER_MODE_e;
  40. typedef enum{
  41. SER_IMU_GRY_POWER_MODE_HIGH_PERFORMANCE = 0, //陀螺仪工作模式 - 高性能 优先级 - 0 优先级越大,级别越高
  42. SER_IMU_GRY_POWER_MODE_NORMAL = 1, //陀螺仪工作模式 - 正常 优先级 - 1
  43. } SER_IMU_GRY_POWER_MODE_e;
  44. typedef enum{
  45. SER_IMU_TIMESTAMP_6MS4 = 0, //时间戳精度 - 6.4毫秒 优先级 - 0 优先级越大,级别越高
  46. SER_IMU_TIMESTAMP_25US = 1, //时间戳精度 - 25微妙 优先级 - 1
  47. } SER_IMU_TIMESTAMP_RESOLUTION_e;
  48. typedef enum{
  49. SER_IMU_TIMESTAMP_OFF = 0, //时间戳关闭 优先级 - 0 优先级越大,级别越高
  50. SER_IMU_TIMESTAMP_ON = 1, //时间戳开启 优先级 - 1
  51. } SER_IMU_TIMESTAMP_SWITCH_e;
  52. typedef enum{
  53. SER_IMU_ACC_FS_2G = 0, //量程 - 2倍重力加速度 优先级 - 0 优先级越大,级别越高
  54. SER_IMU_ACC_FS_16G = 1, //量程 - 16倍重力加速度 优先级 - 1
  55. } SER_IMU_ACC_FS_e;
  56. typedef enum{
  57. SER_IMU_GRY_FS_250DPS = 0, //量程 - 250角速度/秒 优先级 - 0 优先级越大,级别越高
  58. SER_IMU_GRY_FS_2000DPS = 1, //量程 - 2000角速度/秒 优先级 - 1
  59. } SER_IMU_GRY_FS_e;
  60. typedef enum{
  61. SER_IMU_MAG_FS_30GS = 0, //量程 - 30高斯 优先级 - 0 优先级越大,级别越高
  62. } SER_IMU_MAG_FS_e;
  63. typedef enum{
  64. SER_IMU_DIR_FRONT = 0, //方向 - 前脚
  65. SER_IMU_DIR_BACK = 1, //方向 - 后脚
  66. SER_IMU_DIR_NUM = 2, //方向 - 方向数量
  67. } SER_IMU_DIR_e;
  68. typedef struct
  69. {
  70. SER_IMU_ACC_POWER_MODE_e acc_power_mode; //加速度工作模式
  71. SER_IMU_GRY_POWER_MODE_e gry_power_mode; //陀螺仪工作模式
  72. SER_IMU_FIFO_ODR_e fifo_odr; //FIFO采样频率
  73. SER_IMU_TIMESTAMP_RESOLUTION_e timestamp_resolution; //时间戳精度
  74. SER_IMU_TIMESTAMP_SWITCH_e timestamp_switch; //时间戳开关,注:时间戳采样率和FIFO采样率一致
  75. SER_IMU_ACC_ODR_e acc_odr; //加速度采样频率
  76. SER_IMU_GRY_ODR_e gry_odr; //陀螺仪采样频率
  77. SER_IMU_MAG_ODR_e mag_odr; //地磁计采样频率
  78. SER_IMU_ACC_FS_e acc_fs; //加速度量程
  79. SER_IMU_GRY_FS_e gry_fs; //陀螺仪量程
  80. SER_IMU_MAG_FS_e mag_fs; //地磁计量程
  81. } ser_imu_config_param_t;
  82. typedef struct
  83. {
  84. int16_t acc[3]; //加速度三轴
  85. int16_t gry[3]; //陀螺仪三轴
  86. int16_t mag[3]; //地磁计三轴
  87. int32_t fifo_timestamp; //fifo时间戳
  88. } ser_imu_data_t;
  89. typedef void (*hal_ser_imu_data_update_callback)(int front_num, int back_num);
  90. /*API -------------------------------------------------------*/
  91. /**
  92. @brief 初始化IMU服务
  93. @param 无
  94. @return 错误代码 - [out] -1失败,0成功
  95. */
  96. int hal_ser_imu_Init(void);
  97. /**
  98. @brief 获取IMU服务句柄
  99. @param p_name - [in] 为服务句柄设置的名字
  100. @param p_handle_id - [out] 返回的服务句柄ID
  101. @return 错误代码 - [out] -1失败,0成功
  102. */
  103. int hal_ser_imu_get_handle(char *p_name, int *p_handle_id);
  104. /**
  105. @brief 设置IMU需要的配置参数
  106. @param handle - [in] 操作的IMU服务句柄
  107. @param foot - [in] IMU方向 - 前/后脚
  108. @param param - [in] IMU配置参数
  109. @return 错误代码 - [out] -1失败,0成功
  110. */
  111. int hal_ser_imu_set_required_param(int handle_id, SER_IMU_DIR_e dir, ser_imu_config_param_t *param);
  112. /**
  113. @brief IMU配置参数是否准备好
  114. @param foot - [in] IMU方向 - 前/后脚
  115. @param param - [in] IMU配置参数
  116. @return 错误代码 - [out] -1失败,0成功
  117. */
  118. int hal_ser_imu_is_param_get_ready(SER_IMU_DIR_e dir, ser_imu_config_param_t *param);
  119. /**
  120. @brief 获取IMU当前数据数量
  121. @param dir - [in] IMU方向 - 前/后脚
  122. @return 错误代码 - [out] 返回数据数量
  123. */
  124. int hal_ser_imu_get_data_num(SER_IMU_DIR_e dir);
  125. /**
  126. @brief 获取IMU数据
  127. @param dir - [in] IMU方向 - 前/后脚
  128. @param index - [in] 第几组数据
  129. @param pdata - [out] IMU数据
  130. @return 错误代码 - [out] -1失败,0成功
  131. */
  132. int hal_ser_imu_get_data(SER_IMU_DIR_e dir, int index, ser_imu_data_t *pdata);
  133. /**
  134. @brief 数据更新通知
  135. @param p_cb - [in] 需要回调的函数
  136. @return 错误代码 - [out] -1失败,0成功,-2已存在
  137. */
  138. int hal_ser_imu_data_update_notify(hal_ser_imu_data_update_callback p_cb);
  139. #ifdef __cplusplus
  140. }
  141. #endif
  142. #endif