38#include "generated/airframe.h"
51 sec_cnt =
imu_vn.vn_packet.counter - last_cnt;
54 pprz_msg_send_VECTORNAV_INFO(trans,
dev, AC_ID,
56 &
imu_vn.vn_packet.chksm_error,
57 &
imu_vn.vn_packet.hdr_error,
62 &
imu_vn.vn_data.ypr_u.theta,
63 &
imu_vn.vn_data.ypr_u.psi);
65 last_cnt =
imu_vn.vn_packet.counter;
84 imu_vn.vn_packet.msg_idx = 0;
85 imu_vn.vn_packet.msg_available =
false;
86 imu_vn.vn_packet.chksm_error = 0;
87 imu_vn.vn_packet.hdr_error = 0;
88 imu_vn.vn_packet.overrun_error = 0;
89 imu_vn.vn_packet.noise_error = 0;
90 imu_vn.vn_packet.framing_error = 0;
111 if (
imu_vn.vn_packet.msg_available) {
113 imu_vn.vn_packet.msg_available =
false;
129 sec_cnt =
imu_vn.vn_packet.counter - last_cnt;
133 if (
imu_vn.vn_freq >= (PERIODIC_FREQUENCY*0.75)) {
Main include for ABI (AirBorneInterface).
static void send_vn_info(struct transport_tx *trans, struct link_device *dev)
static struct uart_periph * dev
void imu_vectornav_init(void)
Init IMU struct and set up ABI messages.
void imu_vectornav_event(void)
Event function to read and parse data from the serial port.
struct ImuVectornav imu_vn
void imu_vectornav_periodic(void)
Periodic function checks for the frequency of packets, triggers warning in case the IMU stops sending...
void imu_vectornav_propagate(void)
Send ABI messages.
static void send_vn_info(struct transport_tx *trans, struct link_device *dev)
Vectornav VN-200 IMU module, to be used with other AHRS/INS algorithms.
Architecture independent timing functions.
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.
unsigned long long uint64_t
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)