mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-02-22 07:44:03 -04:00
Rover: Change Mode logging to use DataFlash library method.
This commit is contained in:
parent
7254de4e23
commit
89fd543f4d
@ -315,26 +315,6 @@ static void Log_Write_Attitude()
|
||||
#endif
|
||||
}
|
||||
|
||||
struct PACKED log_Mode {
|
||||
LOG_PACKET_HEADER;
|
||||
uint32_t time_ms;
|
||||
uint8_t mode;
|
||||
uint8_t mode_num;
|
||||
};
|
||||
|
||||
// Write a mode packet
|
||||
static void Log_Write_Mode()
|
||||
{
|
||||
struct log_Mode pkt = {
|
||||
LOG_PACKET_HEADER_INIT(LOG_MODE_MSG),
|
||||
time_ms : millis(),
|
||||
mode : (uint8_t)control_mode,
|
||||
mode_num : (uint8_t)control_mode
|
||||
};
|
||||
DataFlash.WriteBlock(&pkt, sizeof(pkt));
|
||||
}
|
||||
|
||||
|
||||
struct PACKED log_Sonar {
|
||||
LOG_PACKET_HEADER;
|
||||
uint32_t time_ms;
|
||||
@ -480,8 +460,6 @@ static const struct LogStructure log_structure[] PROGMEM = {
|
||||
"NTUN", "IHfHHb", "TimeMS,Yaw,WpDist,TargBrg,NavBrg,Thr" },
|
||||
{ LOG_SONAR_MSG, sizeof(log_Sonar),
|
||||
"SONR", "IfHHHbHCb", "TimeMS,LatAcc,S1Dist,S2Dist,DCnt,TAng,TTim,Spd,Thr" },
|
||||
{ LOG_MODE_MSG, sizeof(log_Mode),
|
||||
"MODE", "IMB", "TimeMS,Mode,ModeNum" },
|
||||
{ LOG_COMPASS_MSG, sizeof(log_Compass),
|
||||
"MAG", "Ihhhhhhhhh", "TimeMS,MagX,MagY,MagZ,OfsX,OfsY,OfsZ,MOfsX,MOfsY,MOfsZ" },
|
||||
{ LOG_COMPASS2_MSG, sizeof(log_Compass),
|
||||
@ -535,7 +513,6 @@ static void Log_Write_Cmd(const AP_Mission::Mission_Command &cmd) {}
|
||||
static int8_t process_logs(uint8_t argc, const Menu::arg *argv) { return 0; }
|
||||
static void Log_Write_Control_Tuning() {}
|
||||
static void Log_Write_Sonar() {}
|
||||
static void Log_Write_Mode() {}
|
||||
static void Log_Write_Attitude() {}
|
||||
static void Log_Write_Compass() {}
|
||||
static void start_logging() {}
|
||||
|
@ -67,7 +67,6 @@ enum mode {
|
||||
#define LOG_PERFORMANCE_MSG 0x03
|
||||
#define LOG_STARTUP_MSG 0x06
|
||||
#define LOG_SONAR_MSG 0x07
|
||||
#define LOG_MODE_MSG 0x09
|
||||
#define LOG_COMPASS_MSG 0x0A
|
||||
#define LOG_COMPASS2_MSG 0x0C
|
||||
#define LOG_STEERING_MSG 0x0D
|
||||
|
@ -317,7 +317,7 @@ static void set_mode(enum mode mode)
|
||||
}
|
||||
|
||||
if (should_log(MASK_LOG_MODE)) {
|
||||
Log_Write_Mode();
|
||||
DataFlash.Log_Write_Mode(control_mode);
|
||||
}
|
||||
}
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user