Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-09 01:18:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

DataFlash: added power status logging

Browse Source
This commit is contained in:
Andrew Tridgell 2014-02-13 22:07:32 +11:00
parent 87355127ca
commit ce43e674fe
2 changed files with 29 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
libraries/DataFlash/DataFlash.h
View File

@ -51,6 +51,7 @@ public:
void Log_Write_RCIN(void);
void Log_Write_RCOUT(void);
void Log_Write_Baro(AP_Baro &baro);
void Log_Write_Power(void);
void Log_Write_Message(const char *message);
void Log_Write_Message_P(const prog_char_t *message);
@ -211,6 +212,14 @@ struct PACKED log_BARO {
int16_t temperature;
};
struct PACKED log_POWR {
LOG_PACKET_HEADER;
uint32_t time_ms;
uint16_t Vcc;
uint16_t Vservo;
uint16_t flags;
};
#define LOG_COMMON_STRUCTURES \
{ LOG_FORMAT_MSG, sizeof(log_Format), \
"FMT", "BBnNZ", "Type,Length,Name,Format" }, \
@ -229,7 +238,9 @@ struct PACKED log_BARO {
{ LOG_RCOUT_MSG, sizeof(log_RCOUT), \
"RCOU", "Ihhhhhhhh", "TimeMS,Chan1,Chan2,Chan3,Chan4,Chan5,Chan6,Chan7,Chan8" }, \
{ LOG_BARO_MSG, sizeof(log_BARO), \
"BARO", "Iffc", "TimeMS,Alt,Press,Temp" }
"BARO", "Iffc", "TimeMS,Alt,Press,Temp" }, \
{ LOG_POWR_MSG, sizeof(log_POWR), \
"POWR","ICCH","TimeMS,Vcc,VServo,Flags" }
// message types for common messages
#define LOG_FORMAT_MSG 128
@ -241,6 +252,7 @@ struct PACKED log_BARO {
#define LOG_RCOUT_MSG 134
#define LOG_IMU2_MSG 135
#define LOG_BARO_MSG 136
#define LOG_POWR_MSG 137
#include "DataFlash_Block.h"
#include "DataFlash_File.h"

16
libraries/DataFlash/LogFile.cpp
View File

@ -777,3 +777,19 @@ void DataFlash_Class::Log_Write_Message_P(const prog_char_t *message)
strncpy_P(pkt.msg, message, sizeof(pkt.msg));
WriteBlock(&pkt, sizeof(pkt));
}
// Write a POWR packet
void DataFlash_Class::Log_Write_Power(void)
{
#if CONFIG_HAL_BOARD == HAL_BOARD_PX4
struct log_POWR pkt = {
LOG_PACKET_HEADER_INIT(LOG_POWR_MSG),
time_ms : hal.scheduler->millis(),
Vcc : (uint16_t)(hal.analogin->board_voltage() * 100),
Vservo : (uint16_t)(hal.analogin->servorail_voltage() * 100),
flags : hal.analogin->power_status_flags()
};
WriteBlock(&pkt, sizeof(pkt));
#endif
}