GET_HW_INFO refactoring

This commit is contained in:
Bertrand Songis
2019-03-26 16:49:55 +01:00
parent a11dbdf2cb
commit 4f8e7da449
7 changed files with 335 additions and 8 deletions
+3 -3
View File
@@ -130,12 +130,12 @@ void Pxx2Pulses::setupTelemetryFrame(uint8_t module)
void Pxx2Pulses::setupHardwareInfoFrame(uint8_t module)
{
if (reusableBuffer.hardware.modules[module].step >= -1 && reusableBuffer.hardware.modules[module].step < PXX2_MAX_RECEIVERS_PER_MODULE) {
if (reusableBuffer.hardware.modules[module].current <= reusableBuffer.hardware.modules[module].maximum) {
if (reusableBuffer.hardware.modules[module].timeout == 0) {
addFrameType(PXX2_TYPE_C_MODULE, PXX2_TYPE_ID_HW_INFO);
Pxx2Transport::addByte(reusableBuffer.hardware.modules[module].step);
Pxx2Transport::addByte(reusableBuffer.hardware.modules[module].current);
reusableBuffer.hardware.modules[module].timeout = 20;
reusableBuffer.hardware.modules[module].step++;
reusableBuffer.hardware.modules[module].current++;
}
else {
reusableBuffer.hardware.modules[module].timeout--;