20 lines
677 B
C
20 lines
677 B
C
#ifndef CORRECTION_H
|
|
#define CORRECTION_H
|
|
|
|
#include "main.h" // For CORDIC and FMAC handles
|
|
#include <stdint.h>
|
|
|
|
// 假设的校正参数结构体，你需要填充实际参数
|
|
typedef struct {
|
|
float offset_x, offset_y, offset_z;
|
|
float scale_xx, scale_xy, scale_xz;
|
|
float scale_yx, scale_yy, scale_yz;
|
|
float scale_zx, scale_zy, scale_zz;
|
|
} CorrectionParams_t;
|
|
|
|
void Init_CorrectionParams(CorrectionParams_t *params); // 初始化参数
|
|
void Apply_Correction(int32_t raw_x, int32_t raw_y, int32_t raw_z,
|
|
float *corrected_x, float *corrected_y, float *corrected_z,
|
|
CorrectionParams_t *params);
|
|
|
|
#endif // CORRECTION_H
|