Autopilot: fix initialization of digital filters

diff --git a/src/Autopilot/digitalfilter.cxx b/src/Autopilot/digitalfilter.cxx
index 9edf53b8250f8cd1b09b2e2399fcc38f18bffd91..bdd39397a51b6dc97410e52a65188589ced08b1c 100644 (file)
--- a/src/Autopilot/digitalfilter.cxx
+++ b/src/Autopilot/digitalfilter.cxx
@@ -343,8 +343,10 @@ void DigitalFilter::update( bool firstTime, double dt)
 {
   if( _implementation == NULL ) return;
 
-  if( firstTime ) 
-    _implementation->initialize( get_output_value() );
+  if( firstTime ) {
+    SG_LOG(SG_AUTOPILOT,SG_DEBUG, "First time initialization of " << get_name() << " to " << _valueInput.get_value() );
+    _implementation->initialize( _valueInput.get_value() );
+  }
 
   double input = _valueInput.get_value() - _referenceInput.get_value();
   double output = _implementation->compute( dt, input );