matlab经纬度距离方位角,计算经纬度、距离、方位角(示例代码)

1 packagecom.zhs.util;2

3 /**

4 *5 * 计算经纬度、距离、方位角6 *7 *@authorlillian.he8 * @time 2016-06-029 **/

10 public classCalculationLogLatDistance {11 /**

12 * 地球赤道半径(km)13 **/

14 public final static double EARTH_RADIUS = 6378.137;15 /**

16 * 地球每度的弧长(km)17 **/

18 public final static double EARTH_ARC = 111.199;19

20 /**

21 * 转化为弧度(rad)22 **/

23 public static double rad(doubled) {24 return d * Math.PI / 180.0;25 }26

27 /**

28 * 求两经纬度距离29 *30 *@paramlon131 * 第一点的经度32 *@paramlat133 * 第一点的纬度34 *@paramlon235 * 第二点的经度36 *@paramlat237 * 第二点的纬度38 *@return两点距离，单位km39 **/

40 public static double GetDistanceOne(double lon1, double lat1, doublelon2,41 doublelat2) {42 double r1 =rad(lat1);43 double r2 =rad(lon1);44 double a =rad(lat2);45 double b =rad(lon2);46 double s = Math.acos(Math.cos(r1) * Math.cos(a) * Math.cos(r2 -b)47 + Math.sin(r1) *Math.sin(a))48 *EARTH_RADIUS;49 returns;50 }51

52 /**

53 * 求两经纬度距离(google maps源码中)54 *55 *@paramlon156 * 第一点的经度57 *@paramlat158 * 第一点的纬度59 *@paramlon260 * 第二点的经度61 *@paramlat262 * 第二点的纬度63 *@return两点距离，单位km64 **/

65 public static double GetDistanceTwo(double lon1, double lat1, doublelon2,66 doublelat2) {67 double radLat1 =rad(lat1);68 double radLat2 =rad(lat2);69 double a = radLat1 -radLat2;70 double b = rad(lon1) -rad(lon2);71 double s = 2 * Math.asin(Math.sqrt(Math.pow(Math.sin(a / 2), 2)72 + Math.cos(radLat1) *Math.cos(radLat2)73 * Math.pow(Math.sin(b / 2), 2)));74 s = s *EARTH_RADIUS;75 returns;76 }77

78 /**

79 * 求两经纬度距离80 *81 *@paramlon182 * 第一点的经度83 *@paramlat184 * 第一点的纬度85 *@paramlon286 * 第二点的经度87 *@paramlat288 * 第二点的纬度89 *@return两点距离，单位km90 **/

91 public static double GetDistanceThree(double lon1, doublelat1,92 double lon2, doublelat2) {93 double radLat1 =rad(lat1);94 double radLat2 =rad(lat2);95 double radLon1 =rad(lon1);96 double radLon2 =rad(lon2);97 if (radLat1 < 0)98 radLat1 = Math.PI / 2 + Math.abs(radLat1);//south

99 if (radLat1 > 0)100 radLat1 = Math.PI / 2 - Math.abs(radLat1);//north

101 if (radLon1 < 0)102 radLon1 = Math.PI * 2 - Math.abs(radLon1);//west

103 if (radLat2 < 0)104 radLat2 = Math.PI / 2 + Math.abs(radLat2);//south

105 if (radLat2 > 0)106 radLat2 = Math.PI / 2 - Math.abs(radLat2);//north

107 if (radLon2 < 0)108 radLon2 = Math.PI * 2 - Math.abs(radLon2);//west

109 double x1 = Math.cos(radLon1) *Math.sin(radLat1);110 double y1 = Math.sin(radLon1) *Math.sin(radLat1);111 double z1 =Math.cos(radLat1);112

113 double x2 = Math.cos(radLon2) *Math.sin(radLat2);114 double y2 = Math.sin(radLon2) *Math.sin(radLat2);115 double z2 =Math.cos(radLat2);116

117 double d = Math.pow((x1 - x2), 2) + Math.pow((y1 - y2), 2)118 + Math.pow((z1 - z2), 2);119 // //余弦定理求夹角120 //double theta = Math.acos((2 - d) / 2);

121

122 d = Math.pow(EARTH_RADIUS, 2) *d;123 // //余弦定理求夹角

124 double theta = Math.acos((2 * Math.pow(EARTH_RADIUS, 2) -d)125 / (2 * Math.pow(EARTH_RADIUS, 2)));126

127 double dist = theta *EARTH_RADIUS;128 returndist;129 }130

131 /**

132 * 求两经纬度方向角133 *134 *@paramlon1135 * 第一点的经度136 *@paramlat1137 * 第一点的纬度138 *@paramlon2139 * 第二点的经度140 *@paramlat2141 * 第二点的纬度142 *@return方位角，角度(单位：°)143 **/

144 public static double GetAzimuth(double lon1, double lat1, doublelon2,145 doublelat2) {146 lat1 =rad(lat1);147 lat2 =rad(lat2);148 lon1 =rad(lon1);149 lon2 =rad(lon2);150 double azimuth = Math.sin(lat1) * Math.sin(lat2) +Math.cos(lat1)151 * Math.cos(lat2) * Math.cos(lon2 -lon1);152 azimuth = Math.sqrt(1 - azimuth *azimuth);153 azimuth = Math.cos(lat2) * Math.sin(lon2 - lon1) /azimuth;154 azimuth = Math.asin(azimuth) * 180 /Math.PI;155 if(Double.isNaN(azimuth)) {156 if (lon1

165 /**

166 * 已知一点经纬度A，和与另一点B的距离和方位角，求B的经纬度(计算结果有误)167 *168 *@paramlon1169 * A的经度170 *@paramlat1171 * A的纬度172 *@paramdistance173 * AB距离(单位：米)174 *@paramazimuth175 * AB方位角176 *@returnB的经纬度177 **/

178 public static String GetOtherPoint(double lon1, doublelat1,179 double distance, doubleazimuth) {180 azimuth =rad(azimuth);181 double ab = distance / EARTH_ARC;//AB间弧线长

182 ab =rad(ab);183 double Lat = Math.asin(Math.sin(lat1) * Math.cos(ab) +Math.cos(lat1)184 * Math.sin(ab) *Math.cos(azimuth));185 double Lon =lon1186 + Math.asin(Math.sin(azimuth) * Math.sin(ab) /Math.cos(Lat));187 System.out.println(Lon + "," +Lat);188

189 double a = Math.acos(Math.cos(90 - lon1) *Math.cos(ab)190 + Math.sin(90 - lon1) * Math.sin(ab) *Math.cos(azimuth));191 double C = Math.asin(Math.sin(ab) * Math.sin(azimuth) /Math.sin(a));192 System.out.println("c=" +C);193 double lon2 = lon1 +C;194 double lat2 = 90 -a;195 return lon2 + "," +lat2;196 }197

198 /**

199 * 已知一点经纬度A，和与另一点B的距离和方位角，求B的经纬度200 *201 *@paramlon1202 * A的经度203 *@paramlat1204 * A的纬度205 *@paramdistance206 * AB距离(单位：米)207 *@paramazimuth208 * AB方位角209 *@returnB的经纬度210 **/

211 public static String ConvertDistanceToLogLat(double lng1, doublelat1,212 double distance, doubleazimuth) {213 azimuth =rad(azimuth);214 //将距离转换成经度的计算公式

215 double lon = lng1 + (distance *Math.sin(azimuth))216 / (EARTH_ARC *Math.cos(rad(lat1)));217 //将距离转换成纬度的计算公式

218 double lat = lat1 + (distance * Math.cos(azimuth)) /EARTH_ARC;219 return lon + "," +lat;220 }221

222 public static voidmain(String[] args) {223 double lon1 = 121.469156;224 double lat1 = 31.232307;225 double lon2 = 121.469156;226 double lat2 = 31.233205;227 double distance =GetDistanceTwo(lon1, lat1, lon2, lat2);228 double azimuth =GetAzimuth(lon1, lat1, lon2, lat2);229 System.out.println("经纬度为(" + lon1 + "," + lat1 + ")的点与经纬度为(" +lon2230 + "," + lat2 + ")相距：" + distance + "千米," + "方位角：" +azimuth231 + "°");232 System.out.println("距经纬度为(" + lon1 + "," + lat1 + ")的点" +distance233 + "千米,方位角为" + azimuth + "°的另一点经纬度为("

234 + ConvertDistanceToLogLat(lon1, lat1, distance, azimuth) + ")");235 }236 }