|
|
|
@ -1076,22 +1076,27 @@ void AP_TECS::update_pitch_throttle(int32_t hgt_dem_cm,
@@ -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, |
|
|
|
|