src/map/angularunits.cpp

   1 #include "common/util.h"
   2 #include "angularunits.h"
   3
   4 static double sDMS2deg(double val)
   5 {
   6         double angle;
   7         const char *decimal;
   8
   9         QString qstr(QString::number(qAbs(val), 'f', 7));
  10         QByteArray ba = qstr.toLatin1();
  11         const char *str = ba.constData();
  12         decimal = strrchr(str, '.');
  13         int deg = Util::str2int(str, decimal - str);
  14         int min = Util::str2int(decimal + 1, 2);
  15         int sec = Util::str2int(decimal + 3, 2);
  16         int f = Util::str2int(decimal + 5, 3);
  17
  18         angle = deg + min/60.0 + sec/3600.0 + (f/1000.0)/3600.0;
  19
  20         return (val < 0) ? -angle : angle;
  21 }
  22
  23 static double deg2sDMS(double val)
  24 {
  25         double aval = qAbs(val);
  26
  27         int deg = aval;
  28         double r1 = aval - deg;
  29
  30         int min = r1 * 60.0;
  31         double r2 = r1 - (min / 60.0);
  32
  33         int sec = r2 * 3600.0;
  34         double r3 = r2 - (sec / 3600.0);
  35         int f = (int)(r3 * 3600.0 * 1000.0);
  36
  37         QString str(QString("%1.%2%3%4").arg(deg).arg(min, 2, 10, QChar('0'))
  38           .arg(sec, 2, 10, QChar('0')).arg(f, 3, 10, QChar('0')));
  39
  40         return (val < 0) ? -str.toDouble() : str.toDouble();
  41 }
  42
  43 AngularUnits::AngularUnits(int code) : _code(code)
  44 {
  45         switch (code) {
  46                 case 9101:
  47                         _f = 180.0 / M_PI;
  48                         break;
  49                 case 9102:
  50                 case 9107:
  51                 case 9108:
  52                 case 9110:
  53                 case 9122:
  54                         _f = 1.0;
  55                         break;
  56                 case 9103:
  57                         _f = 1 / 60.0;
  58                         break;
  59                 case 9104:
  60                         _f = 1 / 3600.0;
  61                         break;
  62                 case 9105:
  63                         _f = 180.0 / 200.0;
  64                         break;
  65                 case 9106:
  66                         _f = 180.0 / 200.0;
  67                         break;
  68                 case 9109:
  69                         _f = 180.0 / (M_PI * 1000000.0);
  70                         break;
  71                 default:
  72                         _f = NAN;
  73         }
  74 }
  75
  76 double AngularUnits::toDegrees(double val) const
  77 {
  78         return (_code == 9110) ? sDMS2deg(val) : val * _f;
  79 }
  80
  81 double AngularUnits::fromDegrees(double val) const
  82 {
  83         return (_code == 9110) ? deg2sDMS(val) : val / _f;
  84 }
  85
  86 #ifndef QT_NO_DEBUG
  87 QDebug operator<<(QDebug dbg, const AngularUnits &au)
  88 {
  89         dbg.nospace() << "AngularUnits(" << deg2rad(au._f) << ")";
  90         return dbg.space();
  91 }
  92 #endif // QT_NO_DEBUG