mirror of https://github.com/ArduPilot/ardupilot
110 lines
2.8 KiB
C++
110 lines
2.8 KiB
C++
// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: t -*-
|
|
|
|
/// @file AP_IMU_Shim.h
|
|
/// @brief IMU shim driver, used when the IMU data is coming from somewhere else.
|
|
|
|
#ifndef AP_IMU_Shim_h
|
|
#define AP_IMU_Shim_h
|
|
|
|
#include "IMU.h"
|
|
|
|
class AP_IMU_Shim : public IMU
|
|
{
|
|
public:
|
|
AP_IMU_Shim(void) {
|
|
_product_id = AP_PRODUCT_ID_NONE;
|
|
}
|
|
|
|
|
|
/// @name IMU protocol
|
|
//@{
|
|
virtual void init(Start_style style = COLD_START,
|
|
void (*callback)(unsigned long t) = delay,
|
|
void (*flash_leds_cb)(bool on) = NULL,
|
|
AP_PeriodicProcess * scheduler = NULL) {
|
|
};
|
|
virtual void init_accel(void (*callback)(unsigned long t) = delay,
|
|
void (*flash_leds_cb)(bool on) = NULL) {
|
|
};
|
|
virtual void init_gyro(void (*callback)(unsigned long t) = delay,
|
|
void (*flash_leds_cb)(bool on) = NULL) {
|
|
};
|
|
virtual bool update(void) {
|
|
bool updated = _updated;
|
|
_updated = false;
|
|
|
|
// return number of microseconds since last call
|
|
uint32_t us = micros();
|
|
uint32_t ret = us - last_ch6_micros;
|
|
last_ch6_micros = us;
|
|
|
|
_sample_time = ret;
|
|
return updated;
|
|
}
|
|
//@}
|
|
|
|
virtual bool new_data_available(void) {
|
|
return true;
|
|
}
|
|
|
|
float gx() {
|
|
return 0;
|
|
}
|
|
float gy() {
|
|
return 0;
|
|
}
|
|
float gz() {
|
|
return 0;
|
|
}
|
|
float ax() {
|
|
return 0;
|
|
}
|
|
float ay() {
|
|
return 0;
|
|
}
|
|
float az() {
|
|
return 0;
|
|
}
|
|
|
|
void ax(const int v) {
|
|
}
|
|
void ay(const int v) {
|
|
}
|
|
void az(const int v) {
|
|
}
|
|
|
|
/// Set the gyro vector. ::update will return
|
|
/// true once after this call.
|
|
///
|
|
/// @param v The new gyro vector.
|
|
///
|
|
void set_gyro(Vector3f v) {
|
|
_gyro = v; _updated = true;
|
|
}
|
|
|
|
/// Set the accelerometer vector. ::update will return
|
|
/// true once after this call.
|
|
///
|
|
/// @param v The new accelerometer vector.
|
|
///
|
|
void set_accel(Vector3f v) {
|
|
_accel = v; _updated = true;
|
|
}
|
|
|
|
// dummy save method
|
|
void save(void) {
|
|
}
|
|
|
|
float get_gyro_drift_rate(void) {
|
|
return 0;
|
|
}
|
|
|
|
|
|
private:
|
|
/// set true when new data is delivered
|
|
bool _updated;
|
|
uint32_t last_ch6_micros;
|
|
};
|
|
|
|
#endif
|