#region BLH2XYZ
private const double a = 6378137;
private const double f = 1 / 298.257222101;
private static void BLH2XYZ(double B, double L, double H, out double X, out double Y, out double Z)
{
// 三个输入B、L、H,三个输出X、Y、Z
// 角度转弧度
B = B * Math.PI / 180;
L = L * Math.PI / 180;
// 计算相关参数
double e2 = GetE2();
double N = GetN(B);
// 转化计算
X = (N + H) * Math.Cos(B) * Math.Cos(L);
Y = (N + H) * Math.Cos(B) * Math.Sin(L);
Z = (N * (1 - e2) + H) * Math.Sin(B);
}
private static double GetE2()
{
double e2 = 2 * f - f * f;
return e2;
}
private static double GetN(double B)
{
double e2 = GetE2();
double sinB = Math.Sin(B);
double N = a / Math.Sqrt(1 - e2 * sinB * sinB);
return N;
}
#endregion
选的好像是WGS84(参考椭球体)的长短轴,扁率
#region WGS2UTM
static double pi = Math.PI;
static double sm_a = 6378137.0;
static double sm_b = 6356752.314;
//static double sm_EccSquared = 6.69437999013e-03;
static double UTMScaleFactor = 0.9996;
//得到的结果是:x坐标,y坐标,区域编号
public static double[] LatLonToUTM(double lat, double lon)
{
double zone = Math.Floor((lon + 180.0) / 6) + 1;
double cm = UTMCentralMeridian(zone);
double[] xy = new double[2];
MapLatLonToXY(lat / 180.0 * pi, lon / 180 * pi, cm, out xy);
/* Adjust easting and northing for UTM system. */
xy[0] = xy[0] * UTMScaleFactor + 500000.0;
xy[1] = xy[1] * UTMScaleFactor;
if (xy[1] < 0.0)
{
xy[1] = xy[1] + 10000000.0;
}
return new double[] { xy[0], xy[1], zone };
}
public static double UTMCentralMeridian(double zone)
{
double cmeridian;
double deg = -183.0 + (zone * 6.0);
cmeridian = deg / 180.0 * pi;
return cmeridian;
}
internal static void MapLatLonToXY(double phi, double lambda, double lambda0, out double[] xy)
{
double N, nu2, ep2, t, t2, l;
double l3coef, l4coef, l5coef, l6coef, l7coef, l8coef;
double tmp;
/* Precalculate ep2 */
ep2 = (Math.Pow(sm_a, 2.0) - Math.Pow(sm_b, 2.0)) / Math.Pow(sm_b, 2.0);
/* Precalculate nu2 */
nu2 = ep2 * Math.Pow(Math.Cos(phi), 2.0);
/* Precalculate N */
N = Math.Pow(sm_a, 2.0) / (sm_b * Math.Sqrt(1 + nu2));
/* Precalculate t */
t = Math.Tan(phi);
t2 = t * t;
tmp = (t2 * t2 * t2) - Math.Pow(t, 6.0);
/* Precalculate l */
l = lambda - lambda0;
/* Precalculate coefficients for l**n in the equations below
so a normal human being can read the expressions for easting
and northing
-- l**1 and l**2 have coefficients of 1.0 */
l3coef = 1.0 - t2 + nu2;
l4coef = 5.0 - t2 + 9 * nu2 + 4.0 * (nu2 * nu2);
l5coef = 5.0 - 18.0 * t2 + (t2 * t2) + 14.0 * nu2
- 58.0 * t2 * nu2;
l6coef = 61.0 - 58.0 * t2 + (t2 * t2) + 270.0 * nu2
- 330.0 * t2 * nu2;
l7coef = 61.0 - 479.0 * t2 + 179.0 * (t2 * t2) - (t2 * t2 * t2);
l8coef = 1385.0 - 3111.0 * t2 + 543.0 * (t2 * t2) - (t2 * t2 * t2);
/* Calculate easting (x) */
xy = new double[2];
xy[0] = N * Math.Cos(phi) * l
+ (N / 6.0 * Math.Pow(Math.Cos(phi), 3.0) * l3coef * Math.Pow(l, 3.0))
+ (N / 120.0 * Math.Pow(Math.Cos(phi), 5.0) * l5coef * Math.Pow(l, 5.0))
+ (N / 5040.0 * Math.Pow(Math.Cos(phi), 7.0) * l7coef * Math.Pow(l, 7.0));
/* Calculate northing (y) */
xy[1] = ArcLengthOfMeridian(phi)
+ (t / 2.0 * N * Math.Pow(Math.Cos(phi), 2.0) * Math.Pow(l, 2.0))
+ (t / 24.0 * N * Math.Pow(Math.Cos(phi), 4.0) * l4coef * Math.Pow(l, 4.0))
+ (t / 720.0 * N * Math.Pow(Math.Cos(phi), 6.0) * l6coef * Math.Pow(l, 6.0))
+ (t / 40320.0 * N * Math.Pow(Math.Cos(phi), 8.0) * l8coef * Math.Pow(l, 8.0));
return;
}
internal static double ArcLengthOfMeridian(double phi)
{
double alpha, beta, gamma, delta, epsilon, n;
double result;
/* Precalculate n */
n = (sm_a - sm_b) / (sm_a + sm_b);
/* Precalculate alpha */
alpha = ((sm_a + sm_b) / 2.0)
* (1.0 + (Math.Pow(n, 2.0) / 4.0) + (Math.Pow(n, 4.0) / 64.0));
/* Precalculate beta */
beta = (-3.0 * n / 2.0) + (9.0 * Math.Pow(n, 3.0) / 16.0)
+ (-3.0 * Math.Pow(n, 5.0) / 32.0);
/* Precalculate gamma */
gamma = (15.0 * Math.Pow(n, 2.0) / 16.0)
+ (-15.0 * Math.Pow(n, 4.0) / 32.0);
/* Precalculate delta */
delta = (-35.0 * Math.Pow(n, 3.0) / 48.0)
+ (105.0 * Math.Pow(n, 5.0) / 256.0);
/* Precalculate epsilon */
epsilon = (315.0 * Math.Pow(n, 4.0) / 512.0);
/* Now calculate the sum of the series and return */
result = alpha
* (phi + (beta * Math.Sin(2.0 * phi))
+ (gamma * Math.Sin(4.0 * phi))
+ (delta * Math.Sin(6.0 * phi))
+ (epsilon * Math.Sin(8.0 * phi)));
return result;
}
#endregion