src/Device/Driver/Volkslogger/Database.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 "Database.hpp"
  25 #include "Geo/GeoPoint.hpp"
  26
  27 #include <stdlib.h>
  28
  29 GeoPoint
  30 Volkslogger::Waypoint::GetLocation() const
  31 {
  32   uint32_t ll = ((latitude[0] & 0x7f) << 16) |
  33     (latitude[1] << 8) | latitude[2];
  34   fixed lat = fixed(ll) / 60000;
  35   if (latitude[0] & 0x80)
  36     lat = -lat;
  37
  38   ll = (longitude[0] << 16) |
  39     (longitude[1] << 8) | longitude[2];
  40   fixed lon = fixed(ll) / 60000;
  41   if (type_and_longitude_sign & 0x80)
  42     lon = -lon;
  43
  44   return GeoPoint(Angle::Degrees(lon), Angle::Degrees(lat));
  45 }
  46
  47 void
  48 Volkslogger::Waypoint::SetLocation(GeoPoint gp)
  49 {
  50   uint32_t llat = labs((long)(gp.latitude.Degrees() * 60000));
  51   uint32_t llon = labs((long)(gp.longitude.Degrees() * 60000));
  52
  53   if (negative(gp.longitude.Native()))
  54     type_and_longitude_sign |= 0x80;
  55   else
  56     type_and_longitude_sign &= ~0x80;
  57
  58   latitude[0] = llat >> 16;
  59   if (negative(gp.latitude.Native()))
  60     latitude[0] |= 0x80;
  61   latitude[1] = llat >> 8;
  62   latitude[2] = llat;
  63
  64   longitude[0] = llon >> 16;
  65   longitude[1] = llon >> 8;
  66   longitude[2] = llon;
  67 }