坐标方位角正算反算c#

在 C# 中，可以使用 Math 库中的一些函数来进行坐标方位角的正算和反算。下面是一些示例代码：

坐标方位角正算（计算从点 A 到点 B 的方位角和距离）：

public static void AzimuthDistance(double lat1, double lon1, double lat2, double lon2, out double azimuth, out double distance)
{
    double dLon = lon2 - lon1;
    double y = Math.Sin(dLon) * Math.Cos(lat2);
    double x = Math.Cos(lat1) * Math.Sin(lat2) - Math.Sin(lat1) * Math.Cos(lat2) * Math.Cos(dLon);

    azimuth = Math.Atan2(y, x);
    distance = Math.Sqrt(x * x + y * y) * 6371000; // 6371000 is the Earth's radius in meters
}

其中，`lat1` 和 `lon1` 是点 A 的纬度和经度，`lat2` 和 `lon2` 是点 B 的纬度和经度，`azimuth` 是从点 A 到点 B 的方位角（单位为弧度），`distance` 是从点 A 到点 B 的距离（单位为米）。

坐标方位角反算（计算从点 A 出发，按照给定方位角和距离到达的点的坐标）：

public static void DestinationPoint(double lat1, double lon1, double azimuth, double distance, out double lat2, out double lon2)
{
    lat2 = Math.Asin(Math.Sin(lat1) * Math.Cos(distance / 6371000) + Math.Cos(lat1) * Math.Sin(distance / 6371000) * Math.Cos(azimuth));
    lon2 = lon1 + Math.Atan2(Math.Sin(azimuth) * Math.Sin(distance / 6371000) * Math.Cos(lat1), Math.Cos(distance / 6371000) - Math.Sin(lat1) * Math.Sin(lat2));
}

其中，`lat1` 和 `lon1` 是出发点的纬度和经度，`azimuth` 是方位角（单位为弧度），`distance` 是距离（单位为米），`lat2` 和 `lon2` 是到达点的纬度和经度。