2016-02-17 21:25:53 -04:00
|
|
|
#pragma once
|
2015-08-06 09:18:28 -03:00
|
|
|
|
2015-11-09 18:14:22 -04:00
|
|
|
#include "DataFlash_Backend.h"
|
2015-08-06 09:18:28 -03:00
|
|
|
|
2015-11-09 18:14:22 -04:00
|
|
|
#include <AP_Mission/AP_Mission.h>
|
2015-08-06 09:18:28 -03:00
|
|
|
|
|
|
|
class DFMessageWriter {
|
|
|
|
public:
|
|
|
|
|
|
|
|
virtual void reset() = 0;
|
|
|
|
virtual void process() = 0;
|
2016-07-01 02:35:45 -03:00
|
|
|
virtual bool finished() { return _finished; }
|
2015-08-06 09:18:28 -03:00
|
|
|
|
2015-11-09 18:14:22 -04:00
|
|
|
virtual void set_dataflash_backend(class DataFlash_Backend *backend) {
|
|
|
|
_dataflash_backend = backend;
|
|
|
|
}
|
|
|
|
|
2015-08-06 09:18:28 -03:00
|
|
|
protected:
|
2015-09-17 07:28:50 -03:00
|
|
|
bool _finished = false;
|
2015-11-09 18:14:22 -04:00
|
|
|
DataFlash_Backend *_dataflash_backend = nullptr;
|
2015-08-06 09:18:28 -03:00
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
class DFMessageWriter_WriteSysInfo : public DFMessageWriter {
|
|
|
|
public:
|
|
|
|
|
2018-11-07 07:26:49 -04:00
|
|
|
void reset() override;
|
|
|
|
void process() override;
|
2015-08-06 09:18:28 -03:00
|
|
|
|
|
|
|
private:
|
|
|
|
enum write_sysinfo_blockwriter_stage {
|
|
|
|
ws_blockwriter_stage_init,
|
|
|
|
ws_blockwriter_stage_firmware_string,
|
|
|
|
ws_blockwriter_stage_git_versions,
|
|
|
|
ws_blockwriter_stage_system_id
|
|
|
|
};
|
2015-11-09 18:14:22 -04:00
|
|
|
write_sysinfo_blockwriter_stage stage = ws_blockwriter_stage_init;
|
2015-08-06 09:18:28 -03:00
|
|
|
};
|
|
|
|
|
|
|
|
class DFMessageWriter_WriteEntireMission : public DFMessageWriter {
|
|
|
|
public:
|
2015-11-09 18:14:22 -04:00
|
|
|
|
2018-11-07 07:26:49 -04:00
|
|
|
void reset() override;
|
|
|
|
void process() override;
|
2015-08-06 09:18:28 -03:00
|
|
|
|
|
|
|
private:
|
|
|
|
enum entire_mission_blockwriter_stage {
|
|
|
|
em_blockwriter_stage_init,
|
|
|
|
em_blockwriter_stage_write_new_mission_message,
|
|
|
|
em_blockwriter_stage_write_mission_items,
|
|
|
|
em_blockwriter_stage_done
|
|
|
|
};
|
|
|
|
|
2015-09-03 07:24:50 -03:00
|
|
|
uint16_t _mission_number_to_send = 0;
|
|
|
|
entire_mission_blockwriter_stage stage = em_blockwriter_stage_init;
|
2015-08-06 09:18:28 -03:00
|
|
|
};
|
|
|
|
|
|
|
|
class DFMessageWriter_DFLogStart : public DFMessageWriter {
|
|
|
|
public:
|
2018-06-12 00:34:00 -03:00
|
|
|
DFMessageWriter_DFLogStart() :
|
|
|
|
_writesysinfo(),
|
2015-11-09 18:14:22 -04:00
|
|
|
_writeentiremission()
|
2015-08-06 09:18:28 -03:00
|
|
|
{
|
|
|
|
}
|
|
|
|
|
2018-11-07 07:26:49 -04:00
|
|
|
virtual void set_dataflash_backend(class DataFlash_Backend *backend) override {
|
2015-11-09 18:14:22 -04:00
|
|
|
DFMessageWriter::set_dataflash_backend(backend);
|
|
|
|
_writesysinfo.set_dataflash_backend(backend);
|
|
|
|
_writeentiremission.set_dataflash_backend(backend);
|
|
|
|
}
|
|
|
|
|
2018-11-07 07:26:49 -04:00
|
|
|
void reset() override;
|
|
|
|
void process() override;
|
2016-07-01 02:35:45 -03:00
|
|
|
bool fmt_done() { return _fmt_done; }
|
2015-08-06 09:18:28 -03:00
|
|
|
|
|
|
|
private:
|
|
|
|
|
|
|
|
enum log_start_blockwriter_stage {
|
|
|
|
ls_blockwriter_stage_init,
|
|
|
|
ls_blockwriter_stage_formats,
|
2015-12-07 20:51:46 -04:00
|
|
|
ls_blockwriter_stage_units,
|
|
|
|
ls_blockwriter_stage_multipliers,
|
|
|
|
ls_blockwriter_stage_format_units,
|
2015-08-06 09:18:28 -03:00
|
|
|
ls_blockwriter_stage_parms,
|
|
|
|
ls_blockwriter_stage_sysinfo,
|
|
|
|
ls_blockwriter_stage_write_entire_mission,
|
|
|
|
ls_blockwriter_stage_vehicle_messages,
|
|
|
|
ls_blockwriter_stage_done,
|
|
|
|
};
|
|
|
|
|
2015-09-17 07:28:50 -03:00
|
|
|
bool _fmt_done = false;
|
|
|
|
|
2015-11-09 18:14:22 -04:00
|
|
|
log_start_blockwriter_stage stage = ls_blockwriter_stage_init;
|
2015-08-06 09:18:28 -03:00
|
|
|
|
|
|
|
uint16_t next_format_to_send;
|
2015-12-07 20:51:46 -04:00
|
|
|
|
|
|
|
uint8_t _next_unit_to_send;
|
|
|
|
uint8_t _next_format_unit_to_send;
|
|
|
|
uint8_t _next_multiplier_to_send;
|
|
|
|
|
2015-08-06 09:18:28 -03:00
|
|
|
AP_Param::ParamToken token;
|
|
|
|
AP_Param *ap;
|
|
|
|
enum ap_var_type type;
|
|
|
|
|
|
|
|
|
|
|
|
DFMessageWriter_WriteSysInfo _writesysinfo;
|
|
|
|
DFMessageWriter_WriteEntireMission _writeentiremission;
|
|
|
|
};
|