public Point Project(LatLongAlt worldPosition)
{
double x = worldPosition.Longitude.Degrees;
double latRads = worldPosition.Latitude.Radians;
double tan = Math.Tan(latRads);
double sec = 1 / Math.Cos(latRads);
double y = Math.Log(tan + sec);
Point point = new Point(x, y);
return point;
}
public UTMLocation Project(LatLongAlt worldPosition, IEllipsoid ellipsoid)
{
double lonDeg = worldPosition.LongitudeNormalized.Degrees;
double lonRad = lonDeg * Math.PI / 180;
double latDeg = worldPosition.LatitudeNormalized.Degrees;
double latRad = latDeg * Math.PI / 180;
int zone = GetZone(lonDeg, latDeg);
double lonOrigDeg = (zone - 1) * 6 - 180 + 3; //+3 puts origin in middle of zone
double lonOrigRad = lonOrigDeg * Math.PI / 180;
double ecc2 = ellipsoid.EccentricitySquared;
double ecc4 = ecc2 * ecc2;
double ecc6 = ecc4 * ecc2;
double eccPrimeSquared = ecc2 / (1 - ecc2);
double a = ellipsoid.SemiMajorAxis.Meters;
double sinLat = Math.Sin(latRad);
double cosLat = Math.Cos(latRad);
double tanLat = Math.Tan(latRad);
double N = a / Math.Sqrt(1 - ellipsoid.EccentricitySquared * sinLat * sinLat);
double T = tanLat * tanLat;
double C = eccPrimeSquared * cosLat * cosLat;
double A = cosLat * (lonRad - lonOrigRad);
double A2 = A * A;
double A3 = A * A * A;
double M = a * ((1 - ecc2 / 4 - 3 * ecc4 / 64 - 5 * ecc6 / 256) * latRad
- (3 * ecc2 / 8 + 3 * ecc4 / 32 + 45 * ecc6 / 1024) * Math.Sin(2 * latRad)
+ (15 * ecc4 / 256 + 45 * ecc6 / 1024) * Math.Sin(4 * latRad)
- (35 * ecc6 / 3072) * Math.Sin(6 * latRad));
double k0 = 0.9996;
double easting = (double)(k0 * N * (A + (1 - T + C) * A3 / 6
+ (5 - 18 * T + T * T + 72 * C - 58 * eccPrimeSquared) * A3 * A2 / 120)
+ 500000.0);
double northing = (double)(k0 * (M + N * tanLat * (A2 / 2 + (5 - T + 9 * C + 4 * C * C) * A3 * A / 24
+ (61 - 58 * T + T * T + 600 * C - 330 * eccPrimeSquared) * A3 * A3 / 720)));
if (latDeg < 0)
northing += 10000000.0; //10000000 meter offset for southern hemisphere
return new UTMLocation(Length.FromMeters(easting), Length.FromMeters(northing), zone);
}
public Point Project(LatLongAlt worldPosition)
{
throw new NotImplementedException();
}