Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 14:38:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_RangeFinder: log signal quality

Browse Source
This commit is contained in:
Willian Galvani 2023-07-27 23:46:02 -03:00 committed by Peter Barker
parent 88dd8130f6
commit fd4da61067
2 changed files with 8 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_Logger/LogStructure.h
View File

@ -467,6 +467,7 @@ struct PACKED log_RFND {
uint16_t dist; uint16_t dist;
uint8_t status; uint8_t status;
uint8_t orient; uint8_t orient;
int8_t quality;
}; };
/* /*
@ -1046,6 +1047,7 @@ struct PACKED log_VER {
// @Field: Stat: Sensor state // @Field: Stat: Sensor state
// @FieldValueEnum: Stat: RangeFinder::Status // @FieldValueEnum: Stat: RangeFinder::Status
// @Field: Orient: Sensor orientation // @Field: Orient: Sensor orientation
// @Field: Quality: Signal quality. -1 means invalid, 0 is no signal, 100 is perfect signal
// @LoggerMessage: RSSI // @LoggerMessage: RSSI
// @Description: Received Signal Strength Indicator for RC receiver // @Description: Received Signal Strength Indicator for RC receiver
@ -1239,7 +1241,7 @@ LOG_STRUCTURE_FROM_MOUNT \
{ LOG_MODE_MSG, sizeof(log_Mode), \ { LOG_MODE_MSG, sizeof(log_Mode), \
"MODE", "QMBB", "TimeUS,Mode,ModeNum,Rsn", "s---", "F---" }, \ "MODE", "QMBB", "TimeUS,Mode,ModeNum,Rsn", "s---", "F---" }, \
{ LOG_RFND_MSG, sizeof(log_RFND), \ { LOG_RFND_MSG, sizeof(log_RFND), \
"RFND", "QBCBB", "TimeUS,Instance,Dist,Stat,Orient", "s#m--", "F-B--", true }, \ "RFND", "QBCBBb", "TimeUS,Instance,Dist,Stat,Orient,Quality", "s#m--%", "F-B---", true }, \
{ LOG_MAV_STATS, sizeof(log_MAV_Stats), \ { LOG_MAV_STATS, sizeof(log_MAV_Stats), \
"DMS", "QIIIIBBBBBBBBB", "TimeUS,N,Dp,RT,RS,Fa,Fmn,Fmx,Pa,Pmn,Pmx,Sa,Smn,Smx", "s-------------", "F-------------" }, \ "DMS", "QIIIIBBBBBBBBB", "TimeUS,N,Dp,RT,RS,Fa,Fmn,Fmx,Pa,Pmn,Pmx,Sa,Smn,Smx", "s-------------", "F-------------" }, \
LOG_STRUCTURE_FROM_BEACON \ LOG_STRUCTURE_FROM_BEACON \

5
libraries/AP_RangeFinder/AP_RangeFinder.cpp
View File

@ -768,6 +768,10 @@ void RangeFinder::Log_RFND() const
continue; continue;
} }
int8_t signal_quality;
if (!s->get_signal_quality_pct(signal_quality)) {
signal_quality = -1;
}
const struct log_RFND pkt = { const struct log_RFND pkt = {
LOG_PACKET_HEADER_INIT(LOG_RFND_MSG), LOG_PACKET_HEADER_INIT(LOG_RFND_MSG),
time_us : AP_HAL::micros64(), time_us : AP_HAL::micros64(),
@ -775,6 +779,7 @@ void RangeFinder::Log_RFND() const
dist : s->distance_cm(), dist : s->distance_cm(),
status : (uint8_t)s->status(), status : (uint8_t)s->status(),
orient : s->orientation(), orient : s->orientation(),
quality : signal_quality,
}; };
AP::logger().WriteBlock(&pkt, sizeof(pkt)); AP::logger().WriteBlock(&pkt, sizeof(pkt));
} }