33 lines
792 B
C
33 lines
792 B
C
|
|
#ifndef _SENSOR_MEMS_H_
|
||
|
|
#define _SENSOR_MEMS_H_
|
||
|
|
|
||
|
|
#include <stdint.h>
|
||
|
|
|
||
|
|
#define MEMS_FRAME_LENGTH 44
|
||
|
|
|
||
|
|
typedef struct __attribute__((packed)){
|
||
|
|
uint8_t header;
|
||
|
|
uint8_t x_angle_delta[3];
|
||
|
|
uint16_t x_mems_integral_Cnt;
|
||
|
|
uint8_t y_angle_delta[3];
|
||
|
|
uint16_t y_mems_integral_Cnt;
|
||
|
|
uint8_t z_angle_delta[3];
|
||
|
|
uint16_t z_mems_integral_Cnt;
|
||
|
|
uint8_t x_acc_v_delta[3];
|
||
|
|
uint16_t x_acc_integral_time;
|
||
|
|
uint8_t y_acc_v_delta[3];
|
||
|
|
uint16_t y_acc_integral_time;
|
||
|
|
uint8_t z_acc_v_delta[3];
|
||
|
|
uint16_t z_acc_integral_time;
|
||
|
|
uint16_t x_gyro_temp;
|
||
|
|
uint16_t y_gyro_temp;
|
||
|
|
uint16_t z_gyro_temp;
|
||
|
|
uint16_t x_acc_temp;
|
||
|
|
uint16_t y_acc_temp;
|
||
|
|
uint16_t z_acc_temp;
|
||
|
|
uint8_t checksum;
|
||
|
|
}MEMS_Frame;
|
||
|
|
|
||
|
|
uint8_t generate_mems_frame(uint8_t *frame, double AttiVelECI[3]);
|
||
|
|
|
||
|
|
#endif
|