davidsastresas
1 year ago
committed by
David Sastre
10 changed files with 614 additions and 0 deletions
@ -0,0 +1,122 @@
@@ -0,0 +1,122 @@
|
||||
{ |
||||
"version": 1, |
||||
"fileType": "FactMetaData", |
||||
"QGC.MetaData.Facts": |
||||
[ |
||||
{ |
||||
"name": "health", |
||||
"shortDesc": "Health", |
||||
"type": "int8" |
||||
}, |
||||
{ |
||||
"name": "ecuIndex", |
||||
"shortDesc": "Ecu Index", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "A" |
||||
}, |
||||
{ |
||||
"name": "rpm", |
||||
"shortDesc": "Rpm", |
||||
"type": "float", |
||||
"decimalPlaces": 1 |
||||
}, |
||||
{ |
||||
"name": "fuelConsumed", |
||||
"shortDesc": "Fuel Consumed", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "cm^3" |
||||
}, |
||||
{ |
||||
"name": "fuelFlow", |
||||
"shortDesc": "Fuel Flow", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "cm^3/min" |
||||
}, |
||||
{ |
||||
"name": "engineLoad", |
||||
"shortDesc": "Engine Load", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "%" |
||||
}, |
||||
{ |
||||
"name": "throttlePos", |
||||
"shortDesc": "Throttle Position", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "%" |
||||
}, |
||||
{ |
||||
"name": "sparkTime", |
||||
"shortDesc": "Spark dwell time", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "ms" |
||||
}, |
||||
{ |
||||
"name": "baroPress", |
||||
"shortDesc": "BarometricPressure", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "kPa" |
||||
}, |
||||
{ |
||||
"name": "intakePress", |
||||
"shortDesc": "Intake mainfold pressure", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "kPa" |
||||
}, |
||||
{ |
||||
"name": "intakeTemp", |
||||
"shortDesc": "Intake mainfold temperature", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "°C" |
||||
}, |
||||
{ |
||||
"name": "cylinderTemp", |
||||
"shortDesc": "Cylinder head temperature", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "°C" |
||||
}, |
||||
{ |
||||
"name": "ignTime", |
||||
"shortDesc": "Ignition Timing", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "deg" |
||||
}, |
||||
{ |
||||
"name": "injTime", |
||||
"shortDesc": "Injection Time", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "ms" |
||||
}, |
||||
{ |
||||
"name": "exGasTemp", |
||||
"shortDesc": "Exhaust gas Temperature", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "°C" |
||||
}, |
||||
{ |
||||
"name": "throttleOut", |
||||
"shortDesc": "Throttle Out", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "%" |
||||
}, |
||||
{ |
||||
"name": "ptComp", |
||||
"shortDesc": "Pt Compensation", |
||||
"type": "float", |
||||
"decimalPlaces": 1 |
||||
} |
||||
] |
||||
} |
||||
@ -0,0 +1,77 @@
@@ -0,0 +1,77 @@
|
||||
{ |
||||
"version": 1, |
||||
"fileType": "FactMetaData", |
||||
"QGC.MetaData.Facts": |
||||
[ |
||||
{ |
||||
"name": "status", |
||||
"shortDesc": "Status", |
||||
"type": "uint64" |
||||
}, |
||||
{ |
||||
"name": "genSpeed", |
||||
"shortDesc": "Generator Speed", |
||||
"type": "uint16", |
||||
"units": "rpm" |
||||
}, |
||||
{ |
||||
"name": "batteryCurrent", |
||||
"shortDesc": "Battery Current", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "A" |
||||
}, |
||||
{ |
||||
"name": "loadCurrent", |
||||
"shortDesc": "Load Current", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "A" |
||||
}, |
||||
{ |
||||
"name": "powerGenerated", |
||||
"shortDesc": "Power Generated", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "W" |
||||
}, |
||||
{ |
||||
"name": "busVoltage", |
||||
"shortDesc": "Bus Voltage", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "V" |
||||
}, |
||||
{ |
||||
"name": "rectifierTemp", |
||||
"shortDesc": "Rectifier Temperature", |
||||
"type": "int16", |
||||
"units": "°C" |
||||
}, |
||||
{ |
||||
"name": "batCurrentSetpoint", |
||||
"shortDesc": "Battery Current Setpoint", |
||||
"type": "float", |
||||
"decimalPlaces": 1, |
||||
"units": "A" |
||||
}, |
||||
{ |
||||
"name": "genTemp", |
||||
"shortDesc": "Generator Temperature", |
||||
"type": "int16", |
||||
"units": "°C" |
||||
}, |
||||
{ |
||||
"name": "runtime", |
||||
"shortDesc": "runtime", |
||||
"type": "uint32", |
||||
"units": "sec" |
||||
}, |
||||
{ |
||||
"name": "timeMaintenance", |
||||
"shortDesc": "Time until Maintenance", |
||||
"type": "int32", |
||||
"units": "sec" |
||||
} |
||||
] |
||||
} |
||||
@ -0,0 +1,114 @@
@@ -0,0 +1,114 @@
|
||||
#include "VehicleEFIFactGroup.h" |
||||
#include "Vehicle.h" |
||||
|
||||
const char* VehicleEFIFactGroup::_healthFactName = "health"; |
||||
const char* VehicleEFIFactGroup::_ecuIndexFactName = "ecuIndex"; |
||||
const char* VehicleEFIFactGroup::_rpmFactName = "rpm"; |
||||
const char* VehicleEFIFactGroup::_fuelConsumedFactName = "fuelConsumed"; |
||||
const char* VehicleEFIFactGroup::_fuelFlowFactName = "fuelFlow"; |
||||
const char* VehicleEFIFactGroup::_engineLoadFactName = "engineLoad"; |
||||
const char* VehicleEFIFactGroup::_throttlePosFactName = "throttlePos"; |
||||
const char* VehicleEFIFactGroup::_sparkTimeFactName = "sparkTime"; |
||||
const char* VehicleEFIFactGroup::_baroPressFactName = "baroPress"; |
||||
const char* VehicleEFIFactGroup::_intakePressFactName = "intakePress"; |
||||
const char* VehicleEFIFactGroup::_intakeTempFactName = "intakeTemp"; |
||||
const char* VehicleEFIFactGroup::_cylinderTempFactName = "cylinderTemp"; |
||||
const char* VehicleEFIFactGroup::_ignTimeFactName = "ignTime"; |
||||
const char* VehicleEFIFactGroup::_injTimeFactName = "injTime"; |
||||
const char* VehicleEFIFactGroup::_exGasTempFactName = "exGasTemp"; |
||||
const char* VehicleEFIFactGroup::_throttleOutFactName = "throttleOut"; |
||||
const char* VehicleEFIFactGroup::_ptCompFactName = "ptComp"; |
||||
|
||||
|
||||
VehicleEFIFactGroup::VehicleEFIFactGroup(QObject* parent) |
||||
: FactGroup(1000, ":/json/Vehicle/EFIFact.json", parent) |
||||
, _healthFact (0, _healthFactName, FactMetaData::valueTypeInt8) |
||||
, _ecuIndexFact (0, _ecuIndexFactName, FactMetaData::valueTypeFloat) |
||||
, _rpmFact (0, _rpmFactName, FactMetaData::valueTypeFloat) |
||||
, _fuelConsumedFact (0, _fuelConsumedFactName, FactMetaData::valueTypeFloat) |
||||
, _fuelFlowFact (0, _fuelFlowFactName, FactMetaData::valueTypeFloat) |
||||
, _engineLoadFact (0, _engineLoadFactName, FactMetaData::valueTypeFloat) |
||||
, _throttlePosFact (0, _throttlePosFactName, FactMetaData::valueTypeFloat) |
||||
, _sparkTimeFact (0, _sparkTimeFactName, FactMetaData::valueTypeFloat) |
||||
, _baroPressFact (0, _baroPressFactName, FactMetaData::valueTypeFloat) |
||||
, _intakePressFact (0, _intakePressFactName, FactMetaData::valueTypeFloat) |
||||
, _intakeTempFact (0, _intakeTempFactName, FactMetaData::valueTypeFloat) |
||||
, _cylinderTempFact (0, _cylinderTempFactName, FactMetaData::valueTypeFloat) |
||||
, _ignTimeFact (0, _ignTimeFactName, FactMetaData::valueTypeFloat) |
||||
, _injTimeFact (0, _injTimeFactName, FactMetaData::valueTypeFloat) |
||||
, _exGasTempFact (0, _exGasTempFactName, FactMetaData::valueTypeFloat) |
||||
, _throttleOutFact (0, _throttleOutFactName, FactMetaData::valueTypeFloat) |
||||
, _ptCompFact (0, _ptCompFactName, FactMetaData::valueTypeFloat) |
||||
{ |
||||
_addFact(&_healthFact, _healthFactName); |
||||
_addFact(&_ecuIndexFact, _ecuIndexFactName); |
||||
_addFact(&_rpmFact, _rpmFactName); |
||||
_addFact(&_fuelConsumedFact, _fuelConsumedFactName); |
||||
_addFact(&_fuelFlowFact, _fuelFlowFactName); |
||||
_addFact(&_engineLoadFact, _engineLoadFactName); |
||||
_addFact(&_sparkTimeFact, _sparkTimeFactName); |
||||
_addFact(&_throttlePosFact, _throttlePosFactName); |
||||
_addFact(&_baroPressFact, _baroPressFactName); |
||||
_addFact(&_intakePressFact, _intakePressFactName); |
||||
_addFact(&_intakeTempFact, _intakeTempFactName); |
||||
_addFact(&_cylinderTempFact, _cylinderTempFactName); |
||||
_addFact(&_ignTimeFact, _ignTimeFactName); |
||||
_addFact(&_exGasTempFact, _exGasTempFactName); |
||||
_addFact(&_injTimeFact, _injTimeFactName); |
||||
_addFact(&_throttleOutFact, _throttleOutFactName); |
||||
_addFact(&_ptCompFact, _ptCompFactName); |
||||
|
||||
// Start out as not available "--.--"
|
||||
_healthFact.setRawValue(qQNaN()); |
||||
_ecuIndexFact.setRawValue(qQNaN()); |
||||
_rpmFact.setRawValue(qQNaN()); |
||||
_fuelConsumedFact.setRawValue(qQNaN()); |
||||
_fuelFlowFact.setRawValue(qQNaN()); |
||||
_engineLoadFact.setRawValue(qQNaN()); |
||||
_sparkTimeFact.setRawValue(qQNaN()); |
||||
_throttlePosFact.setRawValue(qQNaN()); |
||||
_baroPressFact.setRawValue(qQNaN()); |
||||
_intakePressFact.setRawValue(qQNaN()); |
||||
_intakeTempFact.setRawValue(qQNaN()); |
||||
_cylinderTempFact.setRawValue(qQNaN()); |
||||
_ignTimeFact.setRawValue(qQNaN()); |
||||
_exGasTempFact.setRawValue(qQNaN()); |
||||
_injTimeFact.setRawValue(qQNaN()); |
||||
_throttleOutFact.setRawValue(qQNaN()); |
||||
_ptCompFact.setRawValue(qQNaN()); |
||||
} |
||||
|
||||
void VehicleEFIFactGroup::handleMessage(Vehicle* /* vehicle */, mavlink_message_t& message) |
||||
{ |
||||
switch (message.msgid) { |
||||
case MAVLINK_MSG_ID_EFI_STATUS: |
||||
_handleEFIStatus(message); |
||||
break; |
||||
default: |
||||
break; |
||||
} |
||||
} |
||||
|
||||
void VehicleEFIFactGroup::_handleEFIStatus(mavlink_message_t& message) |
||||
{ |
||||
mavlink_efi_status_t efi; |
||||
mavlink_msg_efi_status_decode(&message, &efi); |
||||
|
||||
health()->setRawValue (efi.health == INT8_MAX ? qQNaN() : efi.health); |
||||
ecuIndex()->setRawValue (efi.ecu_index); |
||||
rpm()->setRawValue (efi.rpm); |
||||
fuelConsumed()->setRawValue (efi.fuel_consumed); |
||||
fuelFlow()->setRawValue (efi.fuel_flow); |
||||
engineLoad()->setRawValue (efi.engine_load); |
||||
throttlePos()->setRawValue (efi.throttle_position); |
||||
sparkTime()->setRawValue (efi.spark_dwell_time); |
||||
baroPress()->setRawValue (efi.barometric_pressure); |
||||
intakePress()->setRawValue (efi.intake_manifold_pressure); |
||||
intakeTemp()->setRawValue (efi.intake_manifold_temperature); |
||||
cylinderTemp()->setRawValue (efi.cylinder_head_temperature); |
||||
ignTime()->setRawValue (efi.ignition_timing); |
||||
injTime()->setRawValue (efi.injection_time); |
||||
exGasTemp()->setRawValue (efi.exhaust_gas_temperature); |
||||
throttleOut()->setRawValue (efi.throttle_out); |
||||
ptComp()->setRawValue (efi.pt_compensation); |
||||
} |
||||
@ -0,0 +1,94 @@
@@ -0,0 +1,94 @@
|
||||
#pragma once |
||||
|
||||
#include "FactGroup.h" |
||||
#include "QGCMAVLink.h" |
||||
|
||||
class VehicleEFIFactGroup : public FactGroup |
||||
{ |
||||
Q_OBJECT |
||||
|
||||
public: |
||||
VehicleEFIFactGroup(QObject* parent = nullptr); |
||||
|
||||
Q_PROPERTY(Fact* health READ health CONSTANT) |
||||
Q_PROPERTY(Fact* ecuIndex READ ecuIndex CONSTANT) |
||||
Q_PROPERTY(Fact* rpm READ rpm CONSTANT) |
||||
Q_PROPERTY(Fact* fuelConsumed READ fuelConsumed CONSTANT) |
||||
Q_PROPERTY(Fact* fuelFlow READ fuelFlow CONSTANT) |
||||
Q_PROPERTY(Fact* engineLoad READ engineLoad CONSTANT) |
||||
Q_PROPERTY(Fact* throttlePos READ throttlePos CONSTANT) |
||||
Q_PROPERTY(Fact* sparkTime READ sparkTime CONSTANT) |
||||
Q_PROPERTY(Fact* baroPress READ baroPress CONSTANT) |
||||
Q_PROPERTY(Fact* intakePress READ intakePress CONSTANT) |
||||
Q_PROPERTY(Fact* intakeTemp READ intakeTemp CONSTANT) |
||||
Q_PROPERTY(Fact* cylinderTemp READ cylinderTemp CONSTANT) |
||||
Q_PROPERTY(Fact* ignTime READ ignTime CONSTANT) |
||||
Q_PROPERTY(Fact* injTime READ injTime CONSTANT) |
||||
Q_PROPERTY(Fact* exGasTemp READ exGasTemp CONSTANT) |
||||
Q_PROPERTY(Fact* throttleOut READ throttleOut CONSTANT) |
||||
Q_PROPERTY(Fact* ptComp READ ptComp CONSTANT) |
||||
Q_PROPERTY(Fact* ignVoltage READ ignVoltage CONSTANT) |
||||
|
||||
Fact* health () { return &_healthFact; } |
||||
Fact* ecuIndex () { return &_ecuIndexFact; } |
||||
Fact* rpm () { return &_rpmFact; } |
||||
Fact* fuelConsumed () { return &_fuelConsumedFact; } |
||||
Fact* fuelFlow () { return &_fuelFlowFact; } |
||||
Fact* engineLoad () { return &_engineLoadFact; } |
||||
Fact* throttlePos () { return &_throttlePosFact; } |
||||
Fact* sparkTime () { return &_sparkTimeFact; } |
||||
Fact* baroPress () { return &_baroPressFact; } |
||||
Fact* intakePress () { return &_intakePressFact; } |
||||
Fact* intakeTemp () { return &_intakeTempFact; } |
||||
Fact* cylinderTemp () { return &_cylinderTempFact; } |
||||
Fact* ignTime () { return &_ignTimeFact; } |
||||
Fact* injTime () { return &_injTimeFact; } |
||||
Fact* exGasTemp () { return &_exGasTempFact; } |
||||
Fact* throttleOut () { return &_throttleOutFact; } |
||||
Fact* ptComp () { return &_ptCompFact; } |
||||
Fact* ignVoltage () { return &_ignVoltageFact; } |
||||
|
||||
// Overrides from FactGroup
|
||||
virtual void handleMessage(Vehicle* vehicle, mavlink_message_t& message) override; |
||||
|
||||
static const char* _healthFactName; |
||||
static const char* _ecuIndexFactName; |
||||
static const char* _rpmFactName; |
||||
static const char* _fuelConsumedFactName; |
||||
static const char* _fuelFlowFactName; |
||||
static const char* _engineLoadFactName; |
||||
static const char* _throttlePosFactName; |
||||
static const char* _sparkTimeFactName; |
||||
static const char* _baroPressFactName; |
||||
static const char* _intakePressFactName; |
||||
static const char* _intakeTempFactName; |
||||
static const char* _cylinderTempFactName; |
||||
static const char* _ignTimeFactName; |
||||
static const char* _injTimeFactName; |
||||
static const char* _exGasTempFactName; |
||||
static const char* _throttleOutFactName; |
||||
static const char* _ptCompFactName; |
||||
static const char* _ignVoltageFactName; |
||||
|
||||
protected: |
||||
void _handleEFIStatus(mavlink_message_t& message); |
||||
|
||||
Fact _healthFact; |
||||
Fact _ecuIndexFact; |
||||
Fact _rpmFact; |
||||
Fact _fuelConsumedFact; |
||||
Fact _fuelFlowFact; |
||||
Fact _engineLoadFact; |
||||
Fact _throttlePosFact; |
||||
Fact _sparkTimeFact; |
||||
Fact _baroPressFact; |
||||
Fact _intakePressFact; |
||||
Fact _intakeTempFact; |
||||
Fact _cylinderTempFact; |
||||
Fact _ignTimeFact; |
||||
Fact _injTimeFact; |
||||
Fact _exGasTempFact; |
||||
Fact _throttleOutFact; |
||||
Fact _ptCompFact; |
||||
Fact _ignVoltageFact; |
||||
}; |
||||
@ -0,0 +1,110 @@
@@ -0,0 +1,110 @@
|
||||
#include "VehicleGeneratorFactGroup.h" |
||||
#include "Vehicle.h" |
||||
#include <bitset> |
||||
|
||||
const char* VehicleGeneratorFactGroup::_statusFactName = "status"; |
||||
const char* VehicleGeneratorFactGroup::_genSpeedFactName = "genSpeed"; |
||||
const char* VehicleGeneratorFactGroup::_batteryCurrentFactName = "batteryCurrent"; |
||||
const char* VehicleGeneratorFactGroup::_loadCurrentFactName = "loadCurrent"; |
||||
const char* VehicleGeneratorFactGroup::_powerGeneratedFactName = "powerGenerated"; |
||||
const char* VehicleGeneratorFactGroup::_busVoltageFactName = "busVoltage"; |
||||
const char* VehicleGeneratorFactGroup::_rectifierTempFactName = "rectifierTemp"; |
||||
const char* VehicleGeneratorFactGroup::_batCurrentSetpointFactName = "batCurrentSetpoint"; |
||||
const char* VehicleGeneratorFactGroup::_genTempFactName = "genTemp"; |
||||
const char* VehicleGeneratorFactGroup::_runtimeFactName = "runtime"; |
||||
const char* VehicleGeneratorFactGroup::_timeMaintenanceFactName = "timeMaintenance"; |
||||
|
||||
VehicleGeneratorFactGroup::VehicleGeneratorFactGroup(QObject* parent) |
||||
: FactGroup(1000, ":/json/Vehicle/GeneratorFact.json", parent) |
||||
, _statusFact (0, _statusFactName, FactMetaData::valueTypeUint64) |
||||
, _genSpeedFact (0, _genSpeedFactName, FactMetaData::valueTypeUint16) |
||||
, _batteryCurrentFact (0, _batteryCurrentFactName, FactMetaData::valueTypeFloat) |
||||
, _loadCurrentFact (0, _loadCurrentFactName, FactMetaData::valueTypeFloat) |
||||
, _powerGeneratedFact (0, _powerGeneratedFactName, FactMetaData::valueTypeFloat) |
||||
, _busVoltageFact (0, _busVoltageFactName, FactMetaData::valueTypeFloat) |
||||
, _rectifierTempFact (0, _rectifierTempFactName, FactMetaData::valueTypeInt16) |
||||
, _batCurrentSetpointFact (0, _batCurrentSetpointFactName, FactMetaData::valueTypeFloat) |
||||
, _genTempFact (0, _genTempFactName, FactMetaData::valueTypeInt16) |
||||
, _runtimeFact (0, _runtimeFactName, FactMetaData::valueTypeUint32) |
||||
, _timeMaintenanceFact (0, _timeMaintenanceFactName, FactMetaData::valueTypeInt32) |
||||
{ |
||||
_addFact(&_statusFact, _statusFactName); |
||||
_addFact(&_genSpeedFact, _genSpeedFactName); |
||||
_addFact(&_batteryCurrentFact, _batteryCurrentFactName); |
||||
_addFact(&_loadCurrentFact, _loadCurrentFactName); |
||||
_addFact(&_powerGeneratedFact, _powerGeneratedFactName); |
||||
_addFact(&_busVoltageFact, _busVoltageFactName); |
||||
_addFact(&_batCurrentSetpointFact, _batCurrentSetpointFactName); |
||||
_addFact(&_rectifierTempFact, _rectifierTempFactName); |
||||
_addFact(&_genTempFact, _genTempFactName); |
||||
_addFact(&_runtimeFact, _runtimeFactName); |
||||
_addFact(&_timeMaintenanceFact, _timeMaintenanceFactName); |
||||
|
||||
// Start out as not available "--.--"
|
||||
_statusFact.setRawValue(qQNaN()); |
||||
_genSpeedFact.setRawValue(qQNaN()); |
||||
_batteryCurrentFact.setRawValue(qQNaN()); |
||||
_loadCurrentFact.setRawValue(qQNaN()); |
||||
_powerGeneratedFact.setRawValue(qQNaN()); |
||||
_busVoltageFact.setRawValue(qQNaN()); |
||||
_batCurrentSetpointFact.setRawValue(qQNaN()); |
||||
_rectifierTempFact.setRawValue(qQNaN()); |
||||
_genTempFact.setRawValue(qQNaN()); |
||||
_runtimeFact.setRawValue(qQNaN()); |
||||
_timeMaintenanceFact.setRawValue(qQNaN()); |
||||
} |
||||
|
||||
void VehicleGeneratorFactGroup::handleMessage(Vehicle* /* vehicle */, mavlink_message_t& message) |
||||
{ |
||||
switch (message.msgid) { |
||||
case MAVLINK_MSG_ID_GENERATOR_STATUS: |
||||
_handleGeneratorStatus(message); |
||||
break; |
||||
default: |
||||
break; |
||||
} |
||||
} |
||||
|
||||
void VehicleGeneratorFactGroup::_handleGeneratorStatus(mavlink_message_t& message) |
||||
{ |
||||
mavlink_generator_status_t generator; |
||||
mavlink_msg_generator_status_decode(&message, &generator); |
||||
|
||||
status()->setRawValue (generator.status == UINT16_MAX ? qQNaN() : generator.status); |
||||
_updateGeneratorFlags(); |
||||
genSpeed()->setRawValue (generator.generator_speed == UINT16_MAX ? qQNaN() : generator.generator_speed); |
||||
batteryCurrent()->setRawValue (generator.battery_current); |
||||
loadCurrent()->setRawValue (generator.load_current); |
||||
powerGenerated()->setRawValue (generator.power_generated); |
||||
busVoltage()->setRawValue (generator.bus_voltage); |
||||
rectifierTemp()->setRawValue (generator.rectifier_temperature == INT16_MAX ? qQNaN() : generator.rectifier_temperature); |
||||
batCurrentSetpoint()->setRawValue (generator.bat_current_setpoint); |
||||
genTemp()->setRawValue (generator.generator_temperature == INT16_MAX ? qQNaN() : generator.generator_temperature); |
||||
runtime()->setRawValue (generator.runtime == UINT32_MAX ? qQNaN() : generator.runtime); |
||||
timeMaintenance()->setRawValue (generator.time_until_maintenance == INT32_MAX ? qQNaN() : generator.time_until_maintenance); |
||||
} |
||||
|
||||
void VehicleGeneratorFactGroup::_updateGeneratorFlags() { |
||||
|
||||
// Check the status received, and convert it to a List with the state of each flag
|
||||
int statusFlag = _statusFact.rawValue().toInt(); |
||||
|
||||
// No need to update the list if we have the same flags
|
||||
if ( statusFlag == _prevFlag) { |
||||
return; |
||||
} |
||||
|
||||
_prevFlag = statusFlag; |
||||
_flagsListGenerator.clear(); |
||||
|
||||
std::bitset<23> bitsetFlags(statusFlag); |
||||
|
||||
for (size_t i=0; i<bitsetFlags.size(); i++) { |
||||
if (bitsetFlags.test(i)) { |
||||
_flagsListGenerator.append(1); |
||||
} else { |
||||
_flagsListGenerator.append(0); |
||||
} |
||||
} |
||||
emit flagsListGeneratorChanged(); |
||||
} |
||||
@ -0,0 +1,75 @@
@@ -0,0 +1,75 @@
|
||||
#pragma once |
||||
|
||||
#include "FactGroup.h" |
||||
#include "QGCMAVLink.h" |
||||
|
||||
class VehicleGeneratorFactGroup : public FactGroup |
||||
{ |
||||
Q_OBJECT |
||||
|
||||
public: |
||||
VehicleGeneratorFactGroup(QObject* parent = nullptr); |
||||
|
||||
Q_PROPERTY(Fact* status READ status CONSTANT) |
||||
Q_PROPERTY(Fact* genSpeed READ genSpeed CONSTANT) |
||||
Q_PROPERTY(Fact* batteryCurrent READ batteryCurrent CONSTANT) |
||||
Q_PROPERTY(Fact* loadCurrent READ loadCurrent CONSTANT) |
||||
Q_PROPERTY(Fact* powerGenerated READ powerGenerated CONSTANT) |
||||
Q_PROPERTY(Fact* busVoltage READ busVoltage CONSTANT) |
||||
Q_PROPERTY(Fact* rectifierTemp READ rectifierTemp CONSTANT) |
||||
Q_PROPERTY(Fact* batCurrentSetpoint READ batCurrentSetpoint CONSTANT) |
||||
Q_PROPERTY(Fact* genTemp READ genTemp CONSTANT) |
||||
Q_PROPERTY(Fact* runtime READ runtime CONSTANT) |
||||
Q_PROPERTY(Fact* timeMaintenance READ timeMaintenance CONSTANT) |
||||
Q_PROPERTY(QVariantList flagsListGenerator READ flagsListGenerator NOTIFY flagsListGeneratorChanged) |
||||
|
||||
Fact* status () { return &_statusFact; } |
||||
Fact* genSpeed () { return &_genSpeedFact; } |
||||
Fact* batteryCurrent () { return &_batteryCurrentFact; } |
||||
Fact* loadCurrent () { return &_loadCurrentFact; } |
||||
Fact* powerGenerated () { return &_powerGeneratedFact; } |
||||
Fact* busVoltage () { return &_busVoltageFact; } |
||||
Fact* rectifierTemp () { return &_rectifierTempFact; } |
||||
Fact* batCurrentSetpoint () { return &_batCurrentSetpointFact; } |
||||
Fact* genTemp () { return &_genTempFact; } |
||||
Fact* runtime () { return &_runtimeFact; } |
||||
Fact* timeMaintenance () { return &_timeMaintenanceFact; } |
||||
QVariantList& flagsListGenerator() {return _flagsListGenerator; } |
||||
|
||||
// Overrides from FactGroup
|
||||
virtual void handleMessage(Vehicle* vehicle, mavlink_message_t& message) override; |
||||
|
||||
static const char* _statusFactName; |
||||
static const char* _genSpeedFactName; |
||||
static const char* _batteryCurrentFactName; |
||||
static const char* _loadCurrentFactName; |
||||
static const char* _powerGeneratedFactName; |
||||
static const char* _busVoltageFactName; |
||||
static const char* _rectifierTempFactName; |
||||
static const char* _batCurrentSetpointFactName; |
||||
static const char* _genTempFactName; |
||||
static const char* _runtimeFactName; |
||||
static const char* _timeMaintenanceFactName; |
||||
|
||||
signals: |
||||
void flagsListGeneratorChanged(); |
||||
|
||||
protected: |
||||
void _handleGeneratorStatus(mavlink_message_t& message); |
||||
void _updateGeneratorFlags(); |
||||
|
||||
Fact _statusFact; |
||||
Fact _genSpeedFact; |
||||
Fact _batteryCurrentFact; |
||||
Fact _loadCurrentFact; |
||||
Fact _powerGeneratedFact; |
||||
Fact _busVoltageFact; |
||||
Fact _rectifierTempFact; |
||||
Fact _batCurrentSetpointFact; |
||||
Fact _genTempFact; |
||||
Fact _runtimeFact; |
||||
Fact _timeMaintenanceFact; |
||||
|
||||
QVariantList _flagsListGenerator; |
||||
int _prevFlag; |
||||
}; |
||||
Loading…
Reference in new issue