vcs.maemo.org Git - ptas/blob - zouba/src/location.cpp

   1 #include "location.h"
   2
   3 #include "ytv.h"
   4
   5 #include <QString>
   6 #include <QObject>
   7 #include <QNetworkAccessManager>
   8 #include <QUrl>
   9 #include <QNetworkRequest>
  10 #include <QNetworkReply>
  11 #include <QXmlStreamReader>
  12 #include <QDebug>
  13 #include <QXmlStreamAttributes>
  14 #include <QStringRef>
  15 #include <QGeoPositionInfo>
  16
  17 #include <math.h>
  18
  19 const double KkjZoneInfo[6][2] = {
  20     {18.0,  500000.0},
  21     {21.0, 1500000.0},
  22     {24.0, 2500000.0},
  23     {27.0, 3500000.0},
  24     {30.0, 4500000.0},
  25     {33.0, 5500000.0}
  26 };
  27
  28 #ifdef Q_WS_MAEMO_5
  29 QTM_USE_NAMESPACE
  30 #endif
  31
  32         Location::Location( const QString &x, const QString &y, const QString &label ) :
  33         m_label(label),
  34         m_address(QString()),
  35         m_x(x),
  36         m_y(y),
  37         m_valid(true)
  38 {
  39 }
  40 #ifdef Q_WS_MAEMO_5
  41 Location::Location(const QGeoPositionInfo &positionInfo, const QString &label) :
  42         m_label(label),
  43         m_address(QString()),
  44         m_x("0"),
  45         m_y("0"),
  46         m_valid(false)
  47 {
  48     setLocation(positionInfo);
  49 }
  50
  51 void Location::setLocation(const QGeoPositionInfo &positionInfo)
  52 {
  53     qDebug() << "Setting new location based on GeoPositionInfo";
  54     qreal latitude = positionInfo.coordinate().latitude();
  55     qreal longitude = positionInfo.coordinate().longitude();
  56
  57     //qDebug() << "Calculating new values";
  58
  59     KKJ outX(0);
  60     KKJ outY(0);
  61
  62     WGS84lola_to_KKJxy( longitude, latitude, &outX, &outY);
  63
  64     /*qDebug() << "Storing new values";
  65     qDebug() << "x";
  66     qDebug() << outX;
  67     qDebug() << "y";
  68     qDebug() << outY;*/
  69
  70     //qDebug() << "Setting x";
  71     //this->m_x = QString("%1").arg(outX);
  72     this->m_x.setNum(outX);
  73     //qDebug() << "Setting y";
  74     //this->m_y = QString("%1").arg(outY);
  75     this->m_y.setNum(outY);
  76     //qDebug() << "Setting as valid";
  77     this->m_valid = true;
  78     emit(becomeValid());
  79     //qDebug() << "Location set";
  80 }
  81 #endif
  82
  83 void Location::setPosition(const QString &x, const QString &y)
  84 {
  85     this->m_x = x;
  86     this->m_y = y;
  87     this->m_valid = true;
  88 }
  89
  90 Location::Location(const QString &label) :
  91         m_label(label),
  92         m_address(QString()),
  93         m_x("0"),
  94         m_y("0"),
  95         m_valid(false)
  96 {
  97 }
  98
  99 Location::Location(const Location *location) :
 100         m_label(location->m_label),
 101         m_address(location->m_address),
 102         m_x(location->m_x),
 103         m_y(location->m_y),
 104         m_valid(location->m_valid)
 105 {
 106 }
 107
 108 QString Location::x() const
 109 {
 110     return m_x;
 111 }
 112
 113 QString Location::y() const
 114 {
 115     return m_y;
 116 }
 117
 118 void Location::setLabel(const QString &label)
 119 {
 120     m_label = label;
 121 }
 122
 123 QString Location::label() const
 124 {
 125     return m_label;
 126 }
 127
 128 void Location::setAddress(const QString &address)
 129 {
 130     m_address = address;
 131 }
 132
 133 QString Location::address() const
 134 {
 135     return m_address;
 136 }
 137
 138 bool Location::isValid() const
 139 {
 140     return m_valid;
 141 }
 142
 143 // Degrees to radians
 144 double radians(double deg)
 145 {
 146     return deg * M_PI / 180.0;
 147 }
 148
 149 // Radians to degrees
 150 double degrees(double rad)
 151 {
 152     return rad * 180.0 / M_PI;
 153 }
 154
 155 // Function:  KKJ_Zone_I
 156 int KKJ_Zone_I(KKJ easting)
 157 {
 158     int zoneNumber = floor(easting / 1000000.0);
 159     if (zoneNumber < 0 || zoneNumber > 5) {
 160         zoneNumber = -1;
 161     }
 162
 163     return zoneNumber;
 164 }
 165
 166 // Function:  KKJ_Zone_Lo
 167 int KKJ_Zone_Lo(double kkjlo)
 168 {
 169     // determine the zonenumber from KKJ easting
 170     // takes KKJ zone which has center meridian
 171     // longitude nearest (in math value) to
 172     // the given KKJ longitude
 173     int zoneNumber = 5;
 174     while (zoneNumber >= 0) {
 175         if (fabs(kkjlo - KkjZoneInfo[zoneNumber][0]) <= 1.5) {
 176             break;
 177         }
 178         zoneNumber--;
 179     }
 180
 181     return zoneNumber;
 182 }
 183
 184
 185 // Function:  KKJlalo_to_WGS84lalo
 186 void KKJlola_to_WGS84lola(double kkjlo, double kkjla, double *outLongitude, double *outLatitude)
 187 {
 188     double dLa = radians(0.124867E+01 + -0.269982E+00 * kkjla + 0.191330E+00 * kkjlo + 0.356119E-02 * kkjla * kkjla + -0.122312E-02 * kkjla * kkjlo + -0.335514E-03 * kkjlo * kkjlo) / 3600.0;
 189     double dLo = radians(-0.286111E+02 + 0.114183E+01 * kkjla + -0.581428E+00 * kkjlo + -0.152421E-01 * kkjla * kkjla + 0.118177E-01 * kkjla * kkjlo + 0.826646E-03 * kkjlo * kkjlo) / 3600.0;
 190
 191     *outLatitude = degrees(radians(kkjla) + dLa);
 192     *outLongitude = degrees(radians(kkjlo) + dLo);
 193 }
 194
 195
 196 // Function:  WGS84lalo_to_KKJlalo
 197 void WGS84lola_to_KKJlola(double longitude, double latitude, double *outLongitude, double *outLatitude)
 198 {
 199     double dLa = radians(-0.124766E+01 + 0.269941E+00 * latitude + -0.191342E+00 * longitude + -0.356086E-02 * latitude * latitude + 0.122353E-02 * latitude * longitude + 0.335456E-03 * longitude * longitude) / 3600.0;
 200     double dLo = radians(0.286008E+02 + -0.114139E+01 * latitude + 0.581329E+00 * longitude + 0.152376E-01 * latitude * latitude + -0.118166E-01 * latitude * longitude + -0.826201E-03 * longitude * longitude) / 3600.0;
 201
 202     *outLatitude = degrees(radians(latitude) + dLa);
 203     *outLongitude = degrees(radians(longitude) + dLo);
 204 }
 205
 206
 207 // Function:  KKJlalo_to_KKJxy
 208 void KKJlola_to_KKJxy(double lon, double lat, int zoneNumber, KKJ *outX, KKJ *outY)
 209 {
 210     // Hayford ellipsoid
 211     double a = 6378388.0;
 212     double f  = 1.0 / 297.0;
 213     double b  = (1.0 - f) * a;
 214     double bb = b * b;
 215     double c  = (a / b) * a;
 216     double ee = (a * a - bb) / bb;
 217     double n = (a - b) / (a + b);
 218     double nn = n * n;
 219
 220     double Lo = radians(lon) - radians(KkjZoneInfo[zoneNumber][0]);
 221     double cosLa = cos(radians(lat));
 222     double NN = ee * cosLa * cosLa;
 223     double LaF = atan(tan(radians(lat)) / cos(Lo * sqrt(1.0 + NN)));
 224     double cosLaF = cos(LaF);
 225     double t = (tan(Lo) * cosLaF) / sqrt(1.0 + ee * cosLaF * cosLaF);
 226     double A = a / (1.0 + n);
 227     double A1 = A * (1.0 + nn / 4.0 + nn * nn / 64.0);
 228     double A2 = A * 1.5 * n * (1.0 - nn / 8.0);
 229     double A3 = A * 0.9375 * nn * (1.0 - nn / 4.0);
 230     double A4 = A * 35.0 / 48.0 * nn * n;
 231
 232     *outY = A1 * LaF - A2 * sin(2.0 * LaF) + A3 * sin(4.0 * LaF) - A4 * sin(6.0 * LaF);
 233     *outX = c * log(t + sqrt(1.0 + t * t)) + 500000.0 + zoneNumber * 1000000.0;
 234 }
 235
 236 // Function:  KKJxy_to_KKJlalo
 237 void KKJxy_to_KKJlola(KKJ x, KKJ y, double *outLongitude, double *outLatitude)
 238 {
 239     // Scan iteratively the target area, until find matching
 240     // KKJ coordinate value.  Area is defined with Hayford Ellipsoid.
 241     int zoneNumber = KKJ_Zone_I(x);
 242     double minLo = radians(18.5);
 243     double maxLo = radians(32.0);
 244     double minLa = radians(59.0);
 245     double maxLa = radians(70.5);
 246
 247     int i = 1;
 248     KKJ tmpX, tmpY;
 249
 250     while (i < 35) {
 251         double deltaLo = maxLo - minLo;
 252         double deltaLa = maxLa - minLa;
 253         *outLongitude = degrees(minLo + 0.5 * deltaLo);
 254         *outLatitude = degrees(minLa + 0.5 * deltaLa);
 255         KKJlola_to_KKJxy(*outLongitude, *outLatitude, zoneNumber, &tmpX, &tmpY);
 256         if (tmpY < y) {
 257             minLa = minLa + 0.45 * deltaLa;
 258         } else {
 259             maxLa = minLa + 0.55 * deltaLa;
 260         }
 261
 262         if (tmpX < x) {
 263             minLo = minLo + 0.45 * deltaLo;
 264         } else {
 265             maxLo = minLo + 0.55 * deltaLo;
 266         }
 267
 268         i++;
 269     }
 270 }
 271
 272 void WGS84lola_to_KKJxy(double longitude, double latitude, KKJ *outX, KKJ *outY)
 273 {
 274     double kkjlo, kkjla;
 275
 276     WGS84lola_to_KKJlola(longitude, latitude, &kkjlo, &kkjla);
 277     int zoneNumber = KKJ_Zone_Lo(kkjlo);
 278     KKJlola_to_KKJxy(kkjlo, kkjla, zoneNumber, outX, outY);
 279 }
 280
 281 void KKJxy_to_WGS84lola(KKJ x, KKJ y, double *outLongitude, double *outLatitude)
 282 {
 283     double kkjlo, kkjla;
 284
 285     KKJxy_to_KKJlola(x, y, &kkjlo, &kkjla);
 286     KKJlola_to_WGS84lola(kkjlo, kkjla, outLongitude, outLatitude);
 287
 288 }