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