mirror of https://github.com/ArduPilot/ardupilot
152 lines
3.3 KiB
C++
152 lines
3.3 KiB
C++
#pragma once
|
|
|
|
#include "AP_Logger_Backend.h"
|
|
|
|
class LoggerMessageWriter {
|
|
public:
|
|
|
|
virtual void reset() = 0;
|
|
virtual void process() = 0;
|
|
virtual bool finished() { return _finished; }
|
|
|
|
virtual void set_logger_backend(class AP_Logger_Backend *backend) {
|
|
_logger_backend = backend;
|
|
}
|
|
|
|
bool out_of_time_for_writing_messages() const;
|
|
|
|
protected:
|
|
bool _finished = false;
|
|
AP_Logger_Backend *_logger_backend = nullptr;
|
|
};
|
|
|
|
|
|
class LoggerMessageWriter_WriteSysInfo : public LoggerMessageWriter {
|
|
public:
|
|
|
|
void reset() override;
|
|
void process() override;
|
|
|
|
private:
|
|
enum class Stage : uint8_t {
|
|
FIRMWARE_STRING = 0,
|
|
GIT_VERSIONS,
|
|
SYSTEM_ID,
|
|
PARAM_SPACE_USED,
|
|
RC_PROTOCOL
|
|
};
|
|
Stage stage;
|
|
};
|
|
|
|
class LoggerMessageWriter_WriteEntireMission : public LoggerMessageWriter {
|
|
public:
|
|
|
|
void reset() override;
|
|
void process() override;
|
|
|
|
private:
|
|
enum Stage {
|
|
WRITE_NEW_MISSION_MESSAGE = 0,
|
|
WRITE_MISSION_ITEMS,
|
|
DONE
|
|
};
|
|
|
|
uint16_t _mission_number_to_send;
|
|
Stage stage;
|
|
};
|
|
|
|
class LoggerMessageWriter_WriteAllRallyPoints : public LoggerMessageWriter {
|
|
public:
|
|
|
|
void reset() override;
|
|
void process() override;
|
|
|
|
private:
|
|
enum Stage {
|
|
WRITE_NEW_RALLY_MESSAGE = 0,
|
|
WRITE_ALL_RALLY_POINTS,
|
|
DONE
|
|
};
|
|
|
|
uint16_t _rally_number_to_send;
|
|
Stage stage = Stage::WRITE_NEW_RALLY_MESSAGE;
|
|
};
|
|
|
|
class LoggerMessageWriter_DFLogStart : public LoggerMessageWriter {
|
|
public:
|
|
LoggerMessageWriter_DFLogStart() :
|
|
_writesysinfo()
|
|
#if HAL_MISSION_ENABLED
|
|
, _writeentiremission()
|
|
#endif
|
|
#if HAL_RALLY_ENABLED
|
|
, _writeallrallypoints()
|
|
#endif
|
|
{
|
|
}
|
|
|
|
virtual void set_logger_backend(class AP_Logger_Backend *backend) override {
|
|
LoggerMessageWriter::set_logger_backend(backend);
|
|
_writesysinfo.set_logger_backend(backend);
|
|
#if HAL_MISSION_ENABLED
|
|
_writeentiremission.set_logger_backend(backend);
|
|
#endif
|
|
#if HAL_RALLY_ENABLED
|
|
_writeallrallypoints.set_logger_backend(backend);
|
|
#endif
|
|
}
|
|
|
|
bool out_of_time_for_writing_messages() const;
|
|
|
|
void reset() override;
|
|
void process() override;
|
|
bool fmt_done() const { return _fmt_done; }
|
|
bool params_done() const { return _params_done; }
|
|
|
|
// reset some writers so we push stuff out to logs again. Will
|
|
// only work if we are in state DONE!
|
|
#if HAL_MISSION_ENABLED
|
|
bool writeentiremission();
|
|
#endif
|
|
#if HAL_RALLY_ENABLED
|
|
bool writeallrallypoints();
|
|
#endif
|
|
|
|
private:
|
|
|
|
enum Stage {
|
|
FORMATS = 0,
|
|
UNITS,
|
|
MULTIPLIERS,
|
|
FORMAT_UNITS,
|
|
PARMS,
|
|
VEHICLE_MESSAGES,
|
|
RUNNING_SUBWRITERS, // must be last thing to run as we can redo bits of these
|
|
DONE,
|
|
};
|
|
|
|
bool _fmt_done;
|
|
bool _params_done;
|
|
|
|
Stage stage;
|
|
|
|
uint16_t next_format_to_send;
|
|
|
|
uint8_t _next_unit_to_send;
|
|
uint8_t _next_format_unit_to_send;
|
|
uint8_t _next_multiplier_to_send;
|
|
|
|
AP_Param::ParamToken token;
|
|
AP_Param *ap;
|
|
enum ap_var_type type;
|
|
|
|
|
|
LoggerMessageWriter_WriteSysInfo _writesysinfo;
|
|
#if HAL_MISSION_ENABLED
|
|
LoggerMessageWriter_WriteEntireMission _writeentiremission;
|
|
#endif
|
|
#if HAL_RALLY_ENABLED
|
|
LoggerMessageWriter_WriteAllRallyPoints _writeallrallypoints;
|
|
#endif
|
|
};
|