2016-02-17 21:25:26 -04:00
|
|
|
#pragma once
|
2013-01-03 04:35:05 -04:00
|
|
|
|
2015-08-11 03:28:43 -03:00
|
|
|
#include <AP_HAL/AP_HAL.h>
|
2013-01-03 04:35:05 -04:00
|
|
|
#include "AP_HAL_PX4_Namespace.h"
|
2013-01-24 00:02:10 -04:00
|
|
|
#include <systemlib/perf_counter.h>
|
2013-01-03 04:35:05 -04:00
|
|
|
|
2014-08-13 05:41:47 -03:00
|
|
|
#define PX4_STORAGE_SIZE HAL_STORAGE_SIZE
|
2013-01-23 01:54:11 -04:00
|
|
|
#define PX4_STORAGE_MAX_WRITE 512
|
2013-01-23 18:21:01 -04:00
|
|
|
#define PX4_STORAGE_LINE_SHIFT 9
|
2013-01-23 01:37:11 -04:00
|
|
|
#define PX4_STORAGE_LINE_SIZE (1<<PX4_STORAGE_LINE_SHIFT)
|
|
|
|
#define PX4_STORAGE_NUM_LINES (PX4_STORAGE_SIZE/PX4_STORAGE_LINE_SIZE)
|
|
|
|
|
|
|
|
class PX4::PX4Storage : public AP_HAL::Storage {
|
2013-01-03 04:35:05 -04:00
|
|
|
public:
|
2014-01-13 00:04:22 -04:00
|
|
|
PX4Storage();
|
|
|
|
|
2015-12-02 11:14:20 -04:00
|
|
|
void init() {}
|
2014-08-13 01:59:28 -03:00
|
|
|
void read_block(void *dst, uint16_t src, size_t n);
|
2013-06-04 01:02:13 -03:00
|
|
|
void write_block(uint16_t dst, const void* src, size_t n);
|
2013-01-03 04:35:05 -04:00
|
|
|
|
2013-01-23 01:37:11 -04:00
|
|
|
void _timer_tick(void);
|
|
|
|
|
2013-01-03 04:35:05 -04:00
|
|
|
private:
|
2013-01-23 01:37:11 -04:00
|
|
|
int _fd;
|
2013-01-26 22:38:47 -04:00
|
|
|
volatile bool _initialised;
|
2013-01-23 01:37:11 -04:00
|
|
|
void _storage_create(void);
|
|
|
|
void _storage_open(void);
|
|
|
|
void _mark_dirty(uint16_t loc, uint16_t length);
|
2013-08-12 23:21:29 -03:00
|
|
|
uint8_t _buffer[PX4_STORAGE_SIZE] __attribute__((aligned(4)));
|
2013-01-23 01:37:11 -04:00
|
|
|
volatile uint32_t _dirty_mask;
|
2013-01-24 00:02:10 -04:00
|
|
|
perf_counter_t _perf_storage;
|
|
|
|
perf_counter_t _perf_errors;
|
2014-01-13 21:39:02 -04:00
|
|
|
bool _have_mtd;
|
|
|
|
void _upgrade_to_mtd(void);
|
2014-01-14 00:06:51 -04:00
|
|
|
uint32_t _mtd_signature(void);
|
|
|
|
void _mtd_write_signature(void);
|
2016-02-23 01:32:19 -04:00
|
|
|
|
|
|
|
#if defined (CONFIG_ARCH_BOARD_PX4FMU_V4)
|
|
|
|
irqstate_t irq_state;
|
|
|
|
#endif
|
|
|
|
void bus_lock(bool lock);
|
2013-01-03 04:35:05 -04:00
|
|
|
};
|