TestPad.java
3.3 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
package com.bsth.util;
public class TestPad {
static double Rc = 6378137; // 赤道半径
static double Rj = 6356725; // 极半径
double m_LoDeg, m_LoMin, m_LoSec; // longtitude 经度
double m_LaDeg, m_LaMin, m_LaSec;
double m_Longitude, m_Latitude;
double m_RadLo, m_RadLa;
double Ec;
double Ed;
public static void main(String[] args) {
TestPad A = new TestPad(121.60613, 31.270115);
TestPad B = new TestPad(121.605239 ,31.269705);
System.out.println(TestPad.angle(A, B));
}
public TestPad(double longitude, double latitude)
{
m_LoDeg = (int)longitude;
m_LoMin = (int)((longitude - m_LoDeg)*60);
m_LoSec = (longitude - m_LoDeg - m_LoMin/60.)*3600;
m_LaDeg = (int)latitude;
m_LaMin = (int)((latitude - m_LaDeg)*60);
m_LaSec = (latitude - m_LaDeg - m_LaMin/60.)*3600;
m_Longitude = longitude;
m_Latitude = latitude;
m_RadLo = longitude * Math.PI/180.;
m_RadLa = latitude * Math.PI/180.;
Ec = Rj + (Rc - Rj) * (90.-m_Latitude) / 90.;
Ed = Ec * Math.cos(m_RadLa);
}
public static TestPad GetJWDB(TestPad A, double distance, double angle)
{
double dx = distance*1000 * Math.sin(angle * Math.PI /180.);
double dy = distance*1000 * Math.cos(angle * Math.PI /180.);
//double dx = (B.m_RadLo - A.m_RadLo) * A.Ed;
//double dy = (B.m_RadLa - A.m_RadLa) * A.Ec;
double BJD = (dx/A.Ed + A.m_RadLo) * 180./Math.PI;
double BWD = (dy/A.Ec + A.m_RadLa) * 180./Math.PI;
TestPad B = new TestPad(BJD, BWD);
return B;
}
//! 已知点A经纬度，根据B点据A点的距离，和方位，求B点的经纬度
/*!
* /param longitude 已知点A经度
* /param latitude 已知点A纬度
* /param distance B点到A点的距离
* /param angle B点相对于A点的方位
* /return B点的经纬度坐标
*/
public static TestPad GetJWDB(double longitude, double latitude, double distance, double angle)
{
TestPad A = new TestPad(longitude,latitude);
return GetJWDB(A, distance, angle);
}
//! 计算点A 和 点B的经纬度，求他们的距离和点B相对于点A的方位
/*!
* \param A A点经纬度
* \param B B点经纬度
* \param angle B相对于A的方位, 不需要返回该值，则将其设为空
* \return A点B点的角度
*/
public static double angle(TestPad A, TestPad B)
{
double dx = (B.m_RadLo - A.m_RadLo) * A.Ed;
double dy = (B.m_RadLa - A.m_RadLa) * A.Ec;
// double out = Math.sqrt(dx * dx + dy * dy);
double angle = 0.0;
angle = Math.atan(Math.abs(dx/dy))*180./Math.PI;
// 判断象限
double dLo = B.m_Longitude - A.m_Longitude;
double dLa = B.m_Latitude - A.m_Latitude;
if(dLo > 0 && dLa <= 0) {
angle = (90. - angle) + 90.;
}
else if(dLo <= 0 && dLa < 0) {
angle = angle + 180.;
}
else if(dLo < 0 && dLa >= 0) {
angle = (90. - angle) + 270;
}
return angle;
}
}