2015-12-01 12:07:15 -04:00
|
|
|
#pragma once
|
2011-11-05 22:11:25 -03:00
|
|
|
|
2015-12-01 12:07:15 -04:00
|
|
|
#include "AP_Baro_Backend.h"
|
2011-11-05 22:11:25 -03:00
|
|
|
|
2015-08-11 03:28:42 -03:00
|
|
|
#include <AP_HAL/AP_HAL.h>
|
2016-07-25 10:33:28 -03:00
|
|
|
#include <AP_HAL/Semaphores.h>
|
2016-01-04 09:59:19 -04:00
|
|
|
#include <AP_HAL/Device.h>
|
2013-01-03 14:06:22 -04:00
|
|
|
|
2015-07-10 00:56:06 -03:00
|
|
|
class AP_Baro_MS56XX : public AP_Baro_Backend
|
2011-11-27 01:43:34 -04:00
|
|
|
{
|
2012-08-17 03:09:24 -03:00
|
|
|
public:
|
2014-10-19 16:22:51 -03:00
|
|
|
void update();
|
2013-01-03 14:06:22 -04:00
|
|
|
|
2015-11-26 10:56:10 -04:00
|
|
|
protected:
|
2016-07-25 10:33:28 -03:00
|
|
|
/*
|
|
|
|
* Update @accum and @count with the new sample in @val, taking into
|
|
|
|
* account a maximum number of samples given by @max_count; in case
|
|
|
|
* maximum number is reached, @accum and @count are updated appropriately
|
|
|
|
*/
|
|
|
|
static void _update_and_wrap_accumulator(uint32_t *accum, uint32_t val,
|
|
|
|
uint8_t *count, uint8_t max_count);
|
|
|
|
|
2016-07-15 16:17:16 -03:00
|
|
|
AP_Baro_MS56XX(AP_Baro &baro, AP_HAL::OwnPtr<AP_HAL::Device> dev);
|
2015-11-26 10:56:10 -04:00
|
|
|
void _init();
|
|
|
|
|
2015-07-10 00:56:06 -03:00
|
|
|
virtual void _calculate() = 0;
|
2015-11-26 10:56:10 -04:00
|
|
|
virtual bool _read_prom(uint16_t prom[8]);
|
2016-01-04 09:59:19 -04:00
|
|
|
|
|
|
|
uint16_t _read_prom_word(uint8_t word);
|
|
|
|
uint32_t _read_adc();
|
|
|
|
|
2016-07-25 10:33:28 -03:00
|
|
|
bool _timer();
|
2015-11-04 18:17:38 -04:00
|
|
|
|
2016-01-04 09:59:19 -04:00
|
|
|
AP_HAL::OwnPtr<AP_HAL::Device> _dev;
|
2014-07-07 00:11:41 -03:00
|
|
|
|
2016-07-25 10:33:28 -03:00
|
|
|
/*
|
|
|
|
* Synchronize access to _accum between thread sampling the HW and main
|
|
|
|
* thread using the values
|
|
|
|
*/
|
|
|
|
AP_HAL::Semaphore *_sem;
|
|
|
|
|
|
|
|
/* Shared values between thread sampling the HW and main thread */
|
|
|
|
struct {
|
|
|
|
uint32_t s_D1;
|
|
|
|
uint32_t s_D2;
|
|
|
|
uint8_t d1_count;
|
|
|
|
uint8_t d2_count;
|
|
|
|
} _accum;
|
|
|
|
|
|
|
|
uint8_t _state;
|
2016-07-25 13:52:33 -03:00
|
|
|
uint8_t _instance;
|
2016-07-25 10:33:28 -03:00
|
|
|
uint32_t _last_cmd_usec;
|
2012-11-19 21:23:26 -04:00
|
|
|
|
2016-07-25 13:52:33 -03:00
|
|
|
/* Last compensated values from accumulated sample */
|
|
|
|
float _D1, _D2;
|
|
|
|
|
2014-10-19 16:22:51 -03:00
|
|
|
// Internal calibration registers
|
2016-07-25 13:52:33 -03:00
|
|
|
struct {
|
|
|
|
uint16_t c1, c2, c3, c4, c5, c6;
|
|
|
|
} _cal_reg;
|
2011-11-05 22:11:25 -03:00
|
|
|
};
|
|
|
|
|
2015-07-10 00:56:06 -03:00
|
|
|
class AP_Baro_MS5611 : public AP_Baro_MS56XX
|
|
|
|
{
|
|
|
|
public:
|
2016-07-15 16:17:16 -03:00
|
|
|
AP_Baro_MS5611(AP_Baro &baro, AP_HAL::OwnPtr<AP_HAL::Device> dev);
|
2016-01-04 09:59:19 -04:00
|
|
|
protected:
|
2016-07-25 13:52:33 -03:00
|
|
|
void _calculate() override;
|
2015-07-10 00:56:06 -03:00
|
|
|
};
|
|
|
|
|
|
|
|
class AP_Baro_MS5607 : public AP_Baro_MS56XX
|
|
|
|
{
|
|
|
|
public:
|
2016-07-15 16:17:16 -03:00
|
|
|
AP_Baro_MS5607(AP_Baro &baro, AP_HAL::OwnPtr<AP_HAL::Device> dev);
|
2016-01-04 09:59:19 -04:00
|
|
|
protected:
|
2016-07-25 13:52:33 -03:00
|
|
|
void _calculate() override;
|
2015-07-10 00:56:06 -03:00
|
|
|
};
|
2015-09-28 15:31:12 -03:00
|
|
|
|
|
|
|
class AP_Baro_MS5637 : public AP_Baro_MS56XX
|
|
|
|
{
|
|
|
|
public:
|
2016-07-15 16:17:16 -03:00
|
|
|
AP_Baro_MS5637(AP_Baro &baro, AP_HAL::OwnPtr<AP_HAL::Device> dev);
|
2016-01-04 09:59:19 -04:00
|
|
|
protected:
|
2016-07-25 13:52:33 -03:00
|
|
|
void _calculate() override;
|
2015-11-26 10:56:10 -04:00
|
|
|
bool _read_prom(uint16_t prom[8]) override;
|
2015-09-28 15:31:12 -03:00
|
|
|
};
|