mirror of https://github.com/ArduPilot/ardupilot
TECS: support for units on fields
This commit is contained in:
parent
6ed0d645a3
commit
22f1b5ed6f
|
@ -1076,22 +1076,27 @@ void AP_TECS::update_pitch_throttle(int32_t hgt_dem_cm,
|
|||
_update_pitch();
|
||||
|
||||
// log to DataFlash
|
||||
DataFlash_Class::instance()->Log_Write("TECS", "TimeUS,h,dh,hdem,dhdem,spdem,sp,dsp,ith,iph,th,ph,dspdem,w,f", "QfffffffffffffB",
|
||||
now,
|
||||
(double)_height,
|
||||
(double)_climb_rate,
|
||||
(double)_hgt_dem_adj,
|
||||
(double)_hgt_rate_dem,
|
||||
(double)_TAS_dem_adj,
|
||||
(double)_TAS_state,
|
||||
(double)_vel_dot,
|
||||
(double)_integTHR_state,
|
||||
(double)_integSEB_state,
|
||||
(double)_throttle_dem,
|
||||
(double)_pitch_dem,
|
||||
(double)_TAS_rate_dem,
|
||||
(double)logging.SKE_weighting,
|
||||
_flags_byte);
|
||||
DataFlash_Class::instance()->Log_Write(
|
||||
"TECS",
|
||||
"TimeUS,h,dh,hdem,dhdem,spdem,sp,dsp,ith,iph,th,ph,dspdem,w,f",
|
||||
"smnmnnnn----o--",
|
||||
"F0000000----0--",
|
||||
"QfffffffffffffB",
|
||||
now,
|
||||
(double)_height,
|
||||
(double)_climb_rate,
|
||||
(double)_hgt_dem_adj,
|
||||
(double)_hgt_rate_dem,
|
||||
(double)_TAS_dem_adj,
|
||||
(double)_TAS_state,
|
||||
(double)_vel_dot,
|
||||
(double)_integTHR_state,
|
||||
(double)_integSEB_state,
|
||||
(double)_throttle_dem,
|
||||
(double)_pitch_dem,
|
||||
(double)_TAS_rate_dem,
|
||||
(double)logging.SKE_weighting,
|
||||
_flags_byte);
|
||||
DataFlash_Class::instance()->Log_Write("TEC2", "TimeUS,KErr,PErr,EDelta,LF", "Qffff",
|
||||
now,
|
||||
(double)logging.SKE_error,
|
||||
|
|
Loading…
Reference in New Issue