|
|
|
@ -69,6 +69,7 @@ private:
@@ -69,6 +69,7 @@ private:
|
|
|
|
|
DATA_DOUBLE, |
|
|
|
|
DATA_VECTOR3F, |
|
|
|
|
DATA_VECTOR3F_ARRAY, |
|
|
|
|
DATA_FLOAT_ARRAY, |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
struct { |
|
|
|
@ -89,6 +90,9 @@ private:
@@ -89,6 +90,9 @@ private:
|
|
|
|
|
struct { |
|
|
|
|
struct vector3f_array points; |
|
|
|
|
} lidar; |
|
|
|
|
struct { |
|
|
|
|
struct float_array rc_channels; |
|
|
|
|
} rc; |
|
|
|
|
} state, last_state; |
|
|
|
|
|
|
|
|
|
// table to aid parsing of JSON sensor data
|
|
|
|
@ -97,7 +101,7 @@ private:
@@ -97,7 +101,7 @@ private:
|
|
|
|
|
const char *key; |
|
|
|
|
void *ptr; |
|
|
|
|
enum data_type type; |
|
|
|
|
} keytable[11] = { |
|
|
|
|
} keytable[12] = { |
|
|
|
|
{ "", "timestamp", &state.timestamp, DATA_UINT64 }, |
|
|
|
|
{ "imu", "angular_velocity", &state.imu.angular_velocity, DATA_VECTOR3F }, |
|
|
|
|
{ "imu", "linear_acceleration", &state.imu.linear_acceleration, DATA_VECTOR3F }, |
|
|
|
@ -109,6 +113,7 @@ private:
@@ -109,6 +113,7 @@ private:
|
|
|
|
|
{ "pose", "yaw", &state.pose.yaw, DATA_FLOAT }, |
|
|
|
|
{ "velocity", "world_linear_velocity", &state.velocity.world_linear_velocity, DATA_VECTOR3F }, |
|
|
|
|
{ "lidar", "point_cloud", &state.lidar.points, DATA_VECTOR3F_ARRAY }, |
|
|
|
|
{ "rc", "channels", &state.rc.rc_channels, DATA_FLOAT_ARRAY }, |
|
|
|
|
}; |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|