-
Notifications
You must be signed in to change notification settings - Fork 0
/
posFilter.h
52 lines (39 loc) · 1.1 KB
/
posFilter.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
#ifndef __POSFILTER_H__
#define __POSFILTER_H__
typedef struct
{
//posXYZ
int posX_real_value;
int posY_real_value;
int posZ_real_value;
float posX_filter_value;
float posY_filter_value;
float posZ_filter_value;
float posX_predict_value;
float posY_predict_value;
float posZ_predict_value;
//speedXYZ
float speedX_d_value;
float speedY_d_value;
float speedZ_d_value;
float speedX_predict_value;
float speedY_predict_value;
float speedZ_predict_value;
//accXYZ
float accX_real_value;
float accY_real_value;
float accZ_real_value;
float accX_filter_value;
float accY_filter_value;
float accZ_filter_value;
}posFilter_DataStruct;
//-----------------------------------------------------------------------//
//数据初始化
void posFilter_DataInit();
//速度解算
void posFilter_GetXYZSpeed_2ms_();
//位置解算数据滤波处理
void posFilter_DataDispose_5ms_();
//位置解算数据接口
void posFilter_GetData_10ms_(int posX_real_value, int posY_real_value, int posZ_real_value, float accX_real_value, float accY_real_value, float accZ_real_value);
#endif