-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathkari_icd.h
129 lines (95 loc) · 1.87 KB
/
kari_icd.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
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
#include <stdint.h>
typedef float float32;
typedef double float64;
typedef struct
{
uint8_t fs0; //0xAA
uint8_t fs1; //0x44
uint8_t len;
uint8_t checksum;
} Header;
typedef struct
{
uint64_t timestamp; // nsec, ros
float64 t_sec; // board time
float32 delt_sec;
float32 delx_rps;
float32 dely_rps;
float32 qual;
float32 gx_rps;
float32 gy_rps;
float32 gz_rps;
float32 ax_mps2;
float32 ay_mps2;
float32 az_mps2;
float32 h_mtr;
float32 mx_gauss;
float32 my_gauss;
float32 mz_gauss;
float32 rsv0;
float32 rsv1;
float32 rsv2;
float32 rsv3;
} SOpticBoardOut;
typedef struct
{
Header _header;
SOpticBoardOut _opticboardout;
} SopticBoardOutPacket;
typedef struct
{
uint64_t timestamp; // nsec, ros
float64 t_sec;
float64 lat_deg;
float64 lon_deg;
float32 h_mtr;
float32 nvel_mps;
float32 evel_mps;
float32 dvel_mps;
float32 roll_deg;
float32 pitch_deg;
float32 yaw_deg;
float32 gx_dps;
float32 gy_dps;
float32 gz_dps;
float32 ax_mps2;
float32 ay_mps2;
float32 az_mps2;
float32 gbx_dps;
float32 gby_dps;
float32 gbz_dps;
float32 abx_mps2;
float32 aby_mps2;
float32 abz_mps2;
} SKariEstiX;
typedef struct
{
uint64_t timestamp;
float64 t_sec;
float32 lat_deg;
float32 lon_deg;
float32 h_mtr;
float32 xvel_mps;
float32 yvel_mps;
float32 zvel_mps;
float32 roll_deg;
float32 pitch_deg;
float32 yaw_deg;
float32 gbx_dps;
float32 gby_dps;
float32 gbz_dps;
float32 abx_mps2;
float32 aby_mps2;
float32 abz_mps2;
} SKariEstiStd;
typedef struct
{
uint64_t timestamp;
float64 t_sec;
float32 rsv1;
float32 rsv2;
float32 rsv3;
float32 rsv4;
float32 rsv5;
float32 rsv6;
} SKariOpticExt;