src/ApplyVegaSwitches.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 "ApplyVegaSwitches.hpp"
  25 #include "Interface.hpp"
  26 #include "Input/InputQueue.hpp"
  27 #include "Thread/Debug.hpp"
  28
  29 static VegaSwitchState last_vega_switches;
  30
  31 void
  32 ApplyVegaSwitches()
  33 {
  34   assert(InMainThread());
  35
  36   const VegaSwitchState &switches = CommonInterface::Basic().switch_state.vega;
  37
  38   // detect changes to ON: on now (x) and not on before (!lastx)
  39   // detect changes to OFF: off now (!x) and on before (lastx)
  40
  41   const unsigned up_inputs = switches.inputs & ~last_vega_switches.inputs;
  42   const unsigned down_inputs = ~switches.inputs & last_vega_switches.inputs;
  43   const unsigned up_outputs = switches.outputs & ~last_vega_switches.outputs;
  44   const unsigned down_outputs = ~switches.outputs & last_vega_switches.outputs;
  45   last_vega_switches = switches;
  46
  47   for (unsigned i = 0; i < 32; ++i) {
  48     const unsigned thebit = 1 << i;
  49
  50     if (down_inputs & thebit)
  51       InputEvents::processNmea(i);
  52     else if (up_inputs & thebit)
  53       InputEvents::processNmea(i + 64);
  54
  55     if (down_outputs & thebit)
  56       InputEvents::processNmea(i + 32);
  57     else if (up_outputs & thebit)
  58       InputEvents::processNmea(i + 96);
  59   }
  60
  61 }