PierMesh
/
direwolf
mirror of https://github.com/wb2osz/direwolf.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity
direwolf/utm/SwissGrid.cpp

141 lines
4.6 KiB
C++
Raw Normal View History

Version 1.0 - Initial commit Changes to be committed: new file: .gitattributes new file: .gitignore new file: APRStt-Implementation-Notes.pdf new file: CHANGES.txt new file: LICENSE-dire-wolf.txt new file: LICENSE-other.txt new file: Makefile.linux new file: Makefile.win new file: Quick-Start-Guide-Windows.pdf new file: Raspberry-Pi-APRS.pdf new file: User-Guide.pdf new file: aclients.c new file: aprs_tt.c new file: aprs_tt.h new file: atest.c new file: audio.c new file: audio.h new file: audio_win.c new file: ax25_pad.c new file: ax25_pad.h new file: beacon.c new file: beacon.h new file: config.c new file: config.h new file: decode_aprs.c new file: decode_aprs.h new file: dedupe.c new file: dedupe.h new file: demod.c new file: demod.h new file: demod_9600.c new file: demod_9600.h new file: demod_afsk.c new file: demod_afsk.h new file: digipeater.c new file: digipeater.h new file: direwolf.c new file: direwolf.conf new file: direwolf.desktop new file: direwolf.h new file: dsp.c new file: dsp.h new file: dtmf.c new file: dtmf.h new file: dw-icon.ico new file: dw-icon.png new file: dw-icon.rc new file: dw-start.sh new file: dwgps.c new file: dwgps.h new file: encode_aprs.c new file: encode_aprs.h new file: fcs_calc.c new file: fcs_calc.h new file: fsk_demod_agc.h new file: fsk_demod_state.h new file: fsk_filters.h new file: fsk_gen_filter.h new file: gen_packets.c new file: gen_tone.c new file: gen_tone.h new file: hdlc_rec.c new file: hdlc_rec.h new file: hdlc_rec2.c new file: hdlc_rec2.h new file: hdlc_send.c new file: hdlc_send.h new file: igate.c new file: igate.h new file: kiss.c new file: kiss.h new file: kiss_frame.c new file: kiss_frame.h new file: kissnet.c new file: kissnet.h new file: latlong.c new file: latlong.h new file: ll2utm.c new file: misc/README-dire-wolf.txt new file: misc/strcasestr.c new file: misc/strsep.c new file: misc/strtok_r.c new file: morse.c new file: multi_modem.c new file: multi_modem.h new file: ptt.c new file: ptt.h new file: pttest.c new file: rdq.c new file: rdq.h new file: redecode.c new file: redecode.h new file: regex/COPYING new file: regex/INSTALL new file: regex/LICENSES new file: regex/NEWS new file: regex/README new file: regex/README-dire-wolf.txt new file: regex/re_comp.h new file: regex/regcomp.c new file: regex/regex.c new file: regex/regex.h new file: regex/regex_internal.c new file: regex/regex_internal.h new file: regex/regexec.c new file: rrbb.c new file: rrbb.h new file: server.c new file: server.h new file: symbols-new.txt new file: symbols.c new file: symbols.h new file: symbolsX.txt new file: textcolor.c new file: textcolor.h new file: tocalls.txt new file: tq.c new file: tq.h new file: tt_text.c new file: tt_text.h new file: tt_user.c new file: tt_user.h new file: tune.h new file: udp_test.c new file: utm/LatLong-UTMconversion.c new file: utm/LatLong-UTMconversion.h new file: utm/README.txt new file: utm/SwissGrid.cpp new file: utm/UTMConversions.cpp new file: utm/constants.h new file: utm2ll.c new file: version.h new file: xmit.c new file: xmit.h
2015-07-27 00:35:07 +00:00
#include <math.h>
#include "constants.h"
#include "LatLong- UTM conversion.h"
//forward declarations
double CorrRatio(double LatRad, const double C);
double NewtonRaphson(const double initEstimate);
void LLtoSwissGrid(const double Lat, const double Long,
double &SwissNorthing, double &SwissEasting)
{
//converts lat/long to Swiss Grid coords. Equations from "Supplementary PROJ.4 Notes-
//Swiss Oblique Mercator Projection", August 5, 1995, Release 4.3.3, by Gerald I. Evenden
//Lat and Long are in decimal degrees
//This transformation is, of course, only valid in Switzerland
//Written by Chuck Gantz- chuck.gantz@globalstar.com
double a = ellipsoid[3].EquatorialRadius; //Bessel ellipsoid
double eccSquared = ellipsoid[3].eccentricitySquared;
double ecc = sqrt(eccSquared);
double LongOrigin = 7.43958333; //E7d26'22.500"
double LatOrigin = 46.95240556; //N46d57'8.660"
double LatRad = Lat*deg2rad;
double LongRad = Long*deg2rad;
double LatOriginRad = LatOrigin*deg2rad;
double LongOriginRad = LongOrigin*deg2rad;
double c = sqrt(1+((eccSquared * pow(cos(LatOriginRad), 4)) / (1-eccSquared)));
double equivLatOrgRadPrime = asin(sin(LatOriginRad) / c);
//eqn. 1
double K = log(tan(FOURTHPI + equivLatOrgRadPrime/2))
-c*(log(tan(FOURTHPI + LatOriginRad/2))
- ecc/2 * log((1+ecc*sin(LatOriginRad)) / (1-ecc*sin(LatOriginRad))));
double LongRadPrime = c*(LongRad - LongOriginRad); //eqn 2
double w = c*(log(tan(FOURTHPI + LatRad/2))
- ecc/2 * log((1+ecc*sin(LatRad)) / (1-ecc*sin(LatRad)))) + K; //eqn 1
double LatRadPrime = 2 * (atan(exp(w)) - FOURTHPI); //eqn 1
//eqn 3
double sinLatDoublePrime = cos(equivLatOrgRadPrime) * sin(LatRadPrime)
- sin(equivLatOrgRadPrime) * cos(LatRadPrime) * cos(LongRadPrime);
double LatRadDoublePrime = asin(sinLatDoublePrime);
//eqn 4
double sinLongDoublePrime = cos(LatRadPrime)*sin(LongRadPrime) / cos(LatRadDoublePrime);
double LongRadDoublePrime = asin(sinLongDoublePrime);
double R = a*sqrt(1-eccSquared) / (1-eccSquared*sin(LatOriginRad) * sin(LatOriginRad));
SwissNorthing = R*log(tan(FOURTHPI + LatRadDoublePrime/2)) + 200000.0; //eqn 5
SwissEasting = R*LongRadDoublePrime + 600000.0; //eqn 6
}
void SwissGridtoLL(const double SwissNorthing, const double SwissEasting,
double& Lat, double& Long)
{
double a = ellipsoid[3].EquatorialRadius; //Bessel ellipsoid
double eccSquared = ellipsoid[3].eccentricitySquared;
double ecc = sqrt(eccSquared);
double LongOrigin = 7.43958333; //E7d26'22.500"
double LatOrigin = 46.95240556; //N46d57'8.660"
double LatOriginRad = LatOrigin*deg2rad;
double LongOriginRad = LongOrigin*deg2rad;
double R = a*sqrt(1-eccSquared) / (1-eccSquared*sin(LatOriginRad) * sin(LatOriginRad));
double LatRadDoublePrime = 2*(atan(exp((SwissNorthing - 200000.0)/R)) - FOURTHPI); //eqn. 7
double LongRadDoublePrime = (SwissEasting - 600000.0)/R; //eqn. 8 with equation corrected
double c = sqrt(1+((eccSquared * pow(cos(LatOriginRad), 4)) / (1-eccSquared)));
double equivLatOrgRadPrime = asin(sin(LatOriginRad) / c);
double sinLatRadPrime = cos(equivLatOrgRadPrime)*sin(LatRadDoublePrime)
+ sin(equivLatOrgRadPrime)*cos(LatRadDoublePrime)*cos(LongRadDoublePrime);
double LatRadPrime = asin(sinLatRadPrime);
double sinLongRadPrime = cos(LatRadDoublePrime)*sin(LongRadDoublePrime)/cos(LatRadPrime);
double LongRadPrime = asin(sinLongRadPrime);
Long = (LongRadPrime/c + LongOriginRad) * rad2deg;
Lat = NewtonRaphson(LatRadPrime) * rad2deg;
}
double NewtonRaphson(const double initEstimate)
{
double Estimate = initEstimate;
double tol = 0.00001;
double corr;
double eccSquared = ellipsoid[3].eccentricitySquared;
double ecc = sqrt(eccSquared);
double LatOrigin = 46.95240556; //N46d57'8.660"
double LatOriginRad = LatOrigin*deg2rad;
double c = sqrt(1+((eccSquared * pow(cos(LatOriginRad), 4)) / (1-eccSquared)));
double equivLatOrgRadPrime = asin(sin(LatOriginRad) / c);
//eqn. 1
double K = log(tan(FOURTHPI + equivLatOrgRadPrime/2))
-c*(log(tan(FOURTHPI + LatOriginRad/2))
- ecc/2 * log((1+ecc*sin(LatOriginRad)) / (1-ecc*sin(LatOriginRad))));
double C = (K - log(tan(FOURTHPI + initEstimate/2)))/c;
do
{
corr = CorrRatio(Estimate, C);
Estimate = Estimate - corr;
}
while (fabs(corr) > tol);
return Estimate;
}
double CorrRatio(double LatRad, const double C)
{
double eccSquared = ellipsoid[3].eccentricitySquared;
double ecc = sqrt(eccSquared);
double corr = (C + log(tan(FOURTHPI + LatRad/2))
- ecc/2 * log((1+ecc*sin(LatRad)) / (1-ecc*sin(LatRad)))) * (((1-eccSquared*sin(LatRad)*sin(LatRad)) * cos(LatRad)) / (1-eccSquared));
return corr;
}