ADD: new track message, Entity class and Position class
This commit is contained in:
Henry Winkel
227
libs/geographiclib/develop/TMTest.cpp
Normal file
227
libs/geographiclib/develop/TMTest.cpp
Normal file
@@ -0,0 +1,227 @@
|
||||
/**
|
||||
* \file TMTest.cpp
|
||||
* \brief Command line utility for testing transverse Mercator projections
|
||||
*
|
||||
* Copyright (c) Charles Karney (2008-2022) <charles@karney.com> and licensed
|
||||
* under the MIT/X11 License. For more information, see
|
||||
* https://geographiclib.sourceforge.io/
|
||||
**********************************************************************/
|
||||
|
||||
#include "GeographicLib/TransverseMercator.hpp"
|
||||
#include "GeographicLib/TransverseMercatorExact.hpp"
|
||||
#include "GeographicLib/Geodesic.hpp"
|
||||
#include "GeographicLib/Constants.hpp"
|
||||
#include <vector>
|
||||
#include <algorithm>
|
||||
#include <string>
|
||||
#include <limits>
|
||||
#include <iostream>
|
||||
#include <sstream>
|
||||
#include <fstream>
|
||||
#include <iomanip>
|
||||
#include <stdexcept>
|
||||
|
||||
using namespace GeographicLib;
|
||||
|
||||
GeographicLib::Math::real
|
||||
dist(GeographicLib::Math::real a, GeographicLib::Math::real f,
|
||||
GeographicLib::Math::extended lat0, GeographicLib::Math::extended lon0,
|
||||
GeographicLib::Math::real lat1, GeographicLib::Math::real lon1) {
|
||||
using namespace GeographicLib;
|
||||
using std::cos; using std::sin; using std::sqrt; using std::hypot;
|
||||
typedef Math::real real;
|
||||
real
|
||||
phi = real(lat0) * Math::degree(),
|
||||
e2 = f * (2 - f),
|
||||
sinphi = sin(phi),
|
||||
n = 1/sqrt(1 - e2 * sinphi * sinphi),
|
||||
// See Wikipedia article on latitude
|
||||
hlon = cos(phi) * n,
|
||||
hlat = (1 - e2) * n * n * n;
|
||||
Math::extended dlon = Math::extended(lon1) - lon0;
|
||||
if (dlon >= 180) dlon -= 360;
|
||||
else if (dlon < -180) dlon += 360;
|
||||
return a * Math::degree() *
|
||||
hypot(real(Math::extended(lat1) - lat0) * hlat, real(dlon) * hlon);
|
||||
}
|
||||
|
||||
int usage(int retval) {
|
||||
( retval ? std::cerr : std::cout ) <<
|
||||
"TMTest [-s] [-d]\n\
|
||||
\n\
|
||||
Read in TMcoords.dat on standard input and test TransverseMercatorExact\n\
|
||||
or (if -s is given) TransverseMercator. If -d dump the error for each\n\
|
||||
point; otherwise summarise errors. If -tf, perform a timing test of the\n\
|
||||
forward projection. If -tr, perform a timing test of the reverse\n\
|
||||
projection.\n";
|
||||
return retval;
|
||||
}
|
||||
|
||||
int main(int argc, char* argv[]) {
|
||||
using namespace GeographicLib;
|
||||
typedef Math::real real;
|
||||
bool series = false;
|
||||
bool dump = false;
|
||||
bool timefor = false, timerev = false;
|
||||
for (int m = 1; m < argc; ++m) {
|
||||
std::string arg(argv[m]);
|
||||
if (arg == "-s") {
|
||||
series = true;
|
||||
} else if (arg == "-d") {
|
||||
dump = true;
|
||||
timefor = false;
|
||||
timerev = false;
|
||||
} else if (arg == "-tf") {
|
||||
dump = false;
|
||||
timefor = true;
|
||||
timerev = false;
|
||||
} else if (arg == "-tr") {
|
||||
dump = false;
|
||||
timefor = false;
|
||||
timerev = true;
|
||||
} else
|
||||
return usage(arg != "-h");
|
||||
}
|
||||
|
||||
if (timefor || timerev) {
|
||||
real s = 0;
|
||||
int count = 0;
|
||||
real dlat = real(0.015), dlon = real(0.015), dx = 2e3, dy = 2e3;
|
||||
if (series) {
|
||||
const TransverseMercator& tm = TransverseMercator::UTM();
|
||||
if (timefor) {
|
||||
real x, y, gam, k;
|
||||
for (real lat = -80.0; lat <= 84.0; lat += dlat)
|
||||
for (real lon = -3.0; lon <= 3.0; lon += dlon) {
|
||||
tm.Forward(0.0, lat, lon, x, y, gam, k);
|
||||
s += k;
|
||||
++count;
|
||||
}
|
||||
} else {
|
||||
real lat, lon, gam, k;
|
||||
for (real x = -400e3; x <= 400e3; x += dx)
|
||||
for (real y = -9000e3; y <= 9500e3; y += dy) {
|
||||
tm.Reverse(0.0, x, y, lat, lon, gam, k);
|
||||
s += k;
|
||||
++count;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
const TransverseMercatorExact tm(Constants::WGS84_a<real>(),
|
||||
Constants::WGS84_f<real>(),
|
||||
Constants::UTM_k0<real>(),
|
||||
true);
|
||||
if (timefor) {
|
||||
real x, y, gam, k;
|
||||
for (real lat = -80.0; lat <= 84.0; lat += dlat)
|
||||
for (real lon = -3.0; lon <= 3.0; lon += dlon) {
|
||||
tm.Forward(0.0, lat, lon, x, y, gam, k);
|
||||
s += k;
|
||||
++count;
|
||||
}
|
||||
} else {
|
||||
real lat, lon, gam, k;
|
||||
for (real x = -400e3; x <= 400e3; x += dx)
|
||||
for (real y = -9000e3; y <= 9500e3; y += dy) {
|
||||
tm.Reverse(0.0, x, y, lat, lon, gam, k);
|
||||
s += k;
|
||||
++count;
|
||||
}
|
||||
}
|
||||
}
|
||||
std::cout << count << " " << s << "\n";
|
||||
return 0;
|
||||
}
|
||||
|
||||
try {
|
||||
real minlat = series ? 0 : (dump ? -100 : -15);
|
||||
const unsigned nbins = 101;
|
||||
std::vector<real> d(nbins);
|
||||
std::vector<real> errv(nbins, 0);
|
||||
std::vector<real> errvg(nbins, 0);
|
||||
std::vector<real> errvk(nbins, 0);
|
||||
real esterr = real(sizeof(real) == sizeof(double) ?
|
||||
(series ? 3e-9 : 8e-9) :
|
||||
(series ? 4e-12 : 4e-12));
|
||||
for (unsigned i = 0; i < nbins; ++i)
|
||||
d[i] = real(100e3 * i);
|
||||
d[0] = 10e3;
|
||||
d[nbins - 1] = 10001966;
|
||||
const TransverseMercator& tm = TransverseMercator::UTM();
|
||||
const TransverseMercatorExact tme(Constants::WGS84_a<real>(),
|
||||
Constants::WGS84_f<real>(),
|
||||
Constants::UTM_k0<real>(),
|
||||
true);
|
||||
real
|
||||
a = series ? tm.EquatorialRadius() : tme.EquatorialRadius(),
|
||||
f = series ? tm.Flattening() : tme.Flattening();
|
||||
const Geodesic geod(a, f);
|
||||
Math::extended lat0l, lon0l, x0l, y0l, gam0l, k0l;
|
||||
while (std::cin >> lat0l >> lon0l >> x0l >> y0l >> gam0l >> k0l) {
|
||||
using std::abs; using std::sin; using std::hypot;
|
||||
real
|
||||
lat0 = real(lat0l),
|
||||
lon0 = real(lon0l),
|
||||
x0 = real(x0l),
|
||||
y0 = real(y0l),
|
||||
gam0 = real(gam0l),
|
||||
k0 = real(k0l);
|
||||
if (lat0 < minlat)
|
||||
continue;
|
||||
real azi1, azi2, s12, m12;
|
||||
real errf, errgf, errkf, errr, errgr, errkr;
|
||||
geod.Inverse(std::max(lat0,real(0)), lon0, std::max(lat0,real(0)), -lon0,
|
||||
s12, azi1, azi2, m12);
|
||||
s12 /= 2;
|
||||
real lat, lon, x, y, gam, k;
|
||||
if (series) {
|
||||
tm.Forward(0, lat0, lon0, x, y, gam, k);
|
||||
} else
|
||||
tme.Forward(0, lat0, lon0, x, y, gam, k);
|
||||
errf = real(hypot(Math::extended(x) - x0l,
|
||||
Math::extended(y) - y0l)) / k0;
|
||||
errgf = real(abs(Math::extended(gam) - gam0));
|
||||
errkf = real(abs(Math::extended(k) - k0));
|
||||
if (series) {
|
||||
tm.Reverse(0, x0, y0, lat, lon, gam, k);
|
||||
} else
|
||||
tme.Reverse(0, x0, y0, lat, lon, gam, k);
|
||||
errr = dist(a, f, lat0l, lon0l, lat, lon);
|
||||
errgr = real(abs(Math::extended(gam) - gam0));
|
||||
errkr = real(abs(Math::extended(k) - k0));
|
||||
|
||||
real
|
||||
err = std::max(errf, errr),
|
||||
errg = std::max(errgf, errgr)
|
||||
- esterr/(a * sin((90 - lat0) * Math::degree())
|
||||
* Math::degree()),
|
||||
errk = std::max(errkf, errkr) / k0;
|
||||
if (dump)
|
||||
std::cout << std::fixed << std::setprecision(12)
|
||||
<< lat0 << " " << lon0 << " "
|
||||
<< std::scientific << std::setprecision(4)
|
||||
<< errf << " " << errr << " "
|
||||
<< errgf << " " << errgr << " "
|
||||
<< errkf << " " << errkr << "\n";
|
||||
else
|
||||
for (unsigned i = 0; i < nbins; ++i) {
|
||||
if (s12 <= d[i]) {
|
||||
errv[i] = std::max(err, errv[i]);
|
||||
errvg[i] = std::max(errg, errvg[i]);
|
||||
errvk[i] = std::max(errk, errvk[i]);
|
||||
}
|
||||
}
|
||||
}
|
||||
if (!dump)
|
||||
for (unsigned i = 0; i < nbins; ++i)
|
||||
std::cout << int(d[i]/1000) << " "
|
||||
<< errv[i] << " "
|
||||
<< errvg[i] << " "
|
||||
<< errvk[i] << "\n";
|
||||
}
|
||||
catch (const std::exception& e) {
|
||||
std::cout << "ERROR: " << e.what() << "\n";
|
||||
return 1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user