Browse Source

AP_TECS: use TECS log bitmask in constructor

master
Joshua Henderson 3 years ago committed by Andrew Tridgell
parent
commit
e338e4cdb6
  1. 2
      libraries/AP_TECS/AP_TECS.cpp
  2. 6
      libraries/AP_TECS/AP_TECS.h

2
libraries/AP_TECS/AP_TECS.cpp

@ -1147,6 +1147,7 @@ void AP_TECS::update_pitch_throttle(int32_t hgt_dem_cm, @@ -1147,6 +1147,7 @@ void AP_TECS::update_pitch_throttle(int32_t hgt_dem_cm,
// Calculate pitch demand
_update_pitch();
if (AP::logger().should_log(_log_bitmask)){
// log to AP_Logger
// @LoggerMessage: TECS
// @Vehicles: Plane
@ -1215,4 +1216,5 @@ void AP_TECS::update_pitch_throttle(int32_t hgt_dem_cm, @@ -1215,4 +1216,5 @@ void AP_TECS::update_pitch_throttle(int32_t hgt_dem_cm,
(double)load_factor,
(double)hgt_dem_cm*0.01,
(double)_hgt_dem);
}
}

6
libraries/AP_TECS/AP_TECS.h

@ -26,10 +26,11 @@ @@ -26,10 +26,11 @@
class AP_Landing;
class AP_TECS {
public:
AP_TECS(AP_AHRS &ahrs, const AP_Vehicle::FixedWing &parms, const AP_Landing &landing)
AP_TECS(AP_AHRS &ahrs, const AP_Vehicle::FixedWing &parms, const AP_Landing &landing, const uint32_t log_bitmask)
: _ahrs(ahrs)
, aparm(parms)
, _landing(landing)
, _log_bitmask(log_bitmask)
{
AP_Param::setup_object_defaults(this, var_info);
}
@ -162,6 +163,9 @@ private: @@ -162,6 +163,9 @@ private:
// reference to const AP_Landing to access it's params
const AP_Landing &_landing;
// Logging bitmask
const uint32_t _log_bitmask;
// TECS tuning parameters
AP_Float _hgtCompFiltOmega;
AP_Float _spdCompFiltOmega;

Loading…
Cancel
Save