mirror of
https://agent.ghink.cloud/wb2osz/direwolf
synced 2025-04-09 08:08:36 +00:00
8978f2de6c
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
141 lines
4.6 KiB
C++
141 lines
4.6 KiB
C++
|
|
#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;
|
|
}
|