44 sec_cnt =
ahrs_vn.vn_packet.counter - last_cnt;
47 pprz_msg_send_VECTORNAV_INFO(trans,
dev, AC_ID,
58 last_cnt =
ahrs_vn.vn_packet.counter;
74 if (
ahrs_vn.vn_packet.msg_available) {
76 ahrs_vn.vn_packet.msg_available =
false;
103 ahrs_vn.vn_packet.msg_available =
false;
104 ahrs_vn.vn_packet.chksm_error = 0;
105 ahrs_vn.vn_packet.hdr_error = 0;
106 ahrs_vn.vn_packet.overrun_error = 0;
107 ahrs_vn.vn_packet.noise_error = 0;
108 ahrs_vn.vn_packet.framing_error = 0;
115#if PERIODIC_TELEMETRY
Main include for ABI (AirBorneInterface).
void ahrs_vectornav_event(void)
Event handling for Vectornav.
void ahrs_vectornav_propagate(void)
Read received data.
struct AhrsVectornav ahrs_vn
void ahrs_vectornav_init(void)
Initialize Vectornav struct.
static void send_vn_info(struct transport_tx *trans, struct link_device *dev)
Vectornav VN-200 as AHRS.
Vectornav VN-200 as AHRS.
uint32_t get_sys_time_usec(void)
Get the time in microseconds since startup.
static struct uart_periph * dev
void float_rmat_ratemult(struct FloatRates *rb, const struct FloatRMat *m_a2b, const struct FloatRates *ra)
rotate anglular rates by rotation matrix.
void float_quat_of_eulers(struct FloatQuat *q, const struct FloatEulers *e)
quat of euler roation 'ZYX'
#define RATES_BFP_OF_REAL(_ri, _rf)
#define ACCELS_BFP_OF_REAL(_ef, _ei)
#define INT32_VECT3_ZERO(_v)
static struct FloatRMat * orientationGetRMat_f(struct OrientationReps *orientation)
Get vehicle body attitude rotation matrix (float).
static void stateSetNedToBodyQuat_f(uint16_t id, struct FloatQuat *ned_to_body_quat)
Set vehicle body attitude from quaternion (float).
static void stateSetBodyRates_f(uint16_t id, struct FloatRates *body_rate)
Set vehicle body angular rate (float).
API to get/set the generic vehicle states.
int16_t register_periodic_telemetry(struct periodic_telemetry *_pt, uint16_t _id, telemetry_cb _cb)
Register a telemetry callback function.
Periodic telemetry system header (includes downlink utility and generated code).
#define DefaultPeriodic
Set default periodic telemetry.
unsigned short uint16_t
Typedef defining 16 bit unsigned short type.
unsigned int uint32_t
Typedef defining 32 bit unsigned int type.
void vn200_read_message(struct VNPacket *vn_packet, struct VNData *vn_data)
Read received message and populate data struct with new measurements.
void vn200_event(struct VNPacket *vnp)