src/Computer/AverageVarioComputer.cpp

   1 /*
   2 Copyright_License {
   3
   4   XCSoar Glide Computer - http://www.xcsoar.org/
   5   Copyright (C) 2000-2013 The XCSoar Project
   6   A detailed list of copyright holders can be found in the file "AUTHORS".
   7
   8   This program is free software; you can redistribute it and/or
   9   modify it under the terms of the GNU General Public License
  10   as published by the Free Software Foundation; either version 2
  11   of the License, or (at your option) any later version.
  12
  13   This program is distributed in the hope that it will be useful,
  14   but WITHOUT ANY WARRANTY; without even the implied warranty of
  15   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16   GNU General Public License for more details.
  17
  18   You should have received a copy of the GNU General Public License
  19   along with this program; if not, write to the Free Software
  20   Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  21 }
  22 */
  23
  24 #include "AverageVarioComputer.hpp"
  25 #include "NMEA/MoreData.hpp"
  26 #include "NMEA/Derived.hpp"
  27
  28 void
  29 AverageVarioComputer::Reset()
  30 {
  31   delta_time.Reset();
  32   vario_30s_filter.Reset();
  33   netto_30s_filter.Reset();
  34 }
  35
  36 void
  37 AverageVarioComputer::Compute(const MoreData &basic,
  38                               bool circling, bool last_circling,
  39                               VarioInfo &vario_info)
  40 {
  41   const fixed dt = delta_time.Update(basic.time, fixed(1), fixed(0));
  42   if (negative(dt) || circling != last_circling) {
  43     Reset();
  44     vario_info.average = basic.brutto_vario;
  45     vario_info.netto_average = basic.netto_vario;
  46     return;
  47   }
  48
  49   if (!positive(dt))
  50     return;
  51
  52   const unsigned Elapsed = uround(dt);
  53   if (Elapsed == 0)
  54     return;
  55
  56   for (unsigned i = 0; i < Elapsed; ++i) {
  57     vario_30s_filter.Update(basic.brutto_vario);
  58     netto_30s_filter.Update(basic.netto_vario);
  59   }
  60
  61   vario_info.average = vario_30s_filter.Average();
  62   vario_info.netto_average = netto_30s_filter.Average();
  63 }