Unity中判斷地圖上兩點之間相對於正北方向的角度 c#實現
阿新 • • 發佈：2019-02-19
由於最近專案需要一些關於地理位置展示方面的需要，需要牽涉到地理位置方面與角度之間的計算。文章中參考了大神的程式碼，但是其是java程式碼實現的，無法在unity中直接使用。有興趣的可以直接閱讀原文http://blog.csdn.net/liang5630/article/details/42775997。
如圖所示，A、B兩點的經緯度已知，求其連線與經線 也就是與正北方向的角度。
首先，我們先定義一個經緯度類，
/// <summary>
/// 經緯度類
/// </summary>
///
public class MyLatLng
{ public static double Rc=6378137; public static double Rj=6356725; public double m_LoDeg, m_LoMin, m_LoSec; public double m_LaDeg, m_LaMin, m_LaSec; public double m_Longitude, m_Latitude; public double m_RadLo,m_RadLa; public double Ec; public double Ed; public MyLatLng(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*Mathf.PI/180; m_RadLa=latitude*Mathf.PI/180; Ec=Rj+(Rc-Rj)*(90-m_Latitude)/90; Ed=Ec*(Mathf.Cos((float )m_RadLa)); } }
儲存了經緯度，就可以在自己的類中實現 計算方法 返回的數值型別是一個double型別的資料。具體實現方法如下：
定義了上面 經緯度類和 獲取角度的方法，就可以進行角度計算了。/// <summary> /// 取得地圖上兩點的夾角 自己的寫在A 別人的寫在B /// </summary> /// <returns>The angle.</returns> /// <param name="A">A.</param> /// <param name="B">B.</param> public static double getAngle(MyLatLng A,MyLatLng B) { double dx=(B.m_RadLo-A.m_RadLo)*A.Ed; double dy=(B.m_RadLa-A.m_RadLa)*A.Ec; double angle=0.0; angle= Mathf.Atan (Mathf.Abs((float )dx/(float)dy)) *180/Mathf.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; }
*************************************************************************************************************
例項使用如下：
假設我們已知A地 深圳大學的經緯度為：113.942909,22.540435，B地天安門的經緯度為116.232922,39.542637。我們在Start方法中例項化他們，並呼叫方法，程式碼如下：
執行程式，結果如下：void Start () { MyLatLngTest AShenZhenUniversity = new MyLatLngTest(113.942909, 22.540435); MyLatLngTest BTianAnMen = new MyLatLngTest(116.232922, 39.542637); double AngleAToB= getAngle(AShenZhenUniversity, BTianAnMen); double AngleBToA = getAngle(BTianAnMen , AShenZhenUniversity ); Debug.Log("深圳大學到北京天安門的角度是北偏"+AngleAToB +"度"); Debug.Log("北京天安門到深圳大學的角度為北偏" +AngleBToA +"度"); }
大功告成！
完整示例程式碼如下 新建指令碼直接掛在攝像機上可以直接執行。
using UnityEngine;
using System.Collections;
using System;
public class Controller_GetAngle : MonoBehaviour {
// Use this for initialization
void Start () {
MyLatLngTest AShenZhenUniversity = new MyLatLngTest(113.942909, 22.540435);
MyLatLngTest BTianAnMen = new MyLatLngTest(116.232922, 39.542637);
double AngleAToB= getAngle(AShenZhenUniversity, BTianAnMen);
double AngleBToA = getAngle(BTianAnMen , AShenZhenUniversity );
Debug.Log("深圳大學到北京天安門的角度是北偏"+AngleAToB +"度");
Debug.Log("北京天安門到深圳大學的角度為北偏" +AngleBToA +"度");
}
// Update is called once per frame
void Update () {
}
/// <summary>
/// 取得地圖上兩點的夾角 自己的寫在A 別人的寫在B
/// </summary>
/// <returns>The angle.</returns>
/// <param name="A">A.</param>
/// <param name="B">B.</param>
public static double getAngle(MyLatLngTest A, MyLatLngTest B)
{
double dx = (B.m_RadLo - A.m_RadLo) * A.Ed;
double dy = (B.m_RadLa - A.m_RadLa) * A.Ec;
double angle = 0.0;
angle =
Mathf.Atan
(Mathf.Abs((float)dx / (float)dy))
* 180 / Mathf.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;
}
}
/// <summary>
/// 經緯度類
/// </summary>
///
public class MyLatLngTest
{
public static double Rc = 6378137;
public static double Rj = 6356725;
public double m_LoDeg, m_LoMin, m_LoSec;
public double m_LaDeg, m_LaMin, m_LaSec;
public double m_Longitude, m_Latitude;
public double m_RadLo, m_RadLa;
public double Ec;
public double Ed;
public MyLatLngTest(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 * Mathf.PI / 180;
m_RadLa = latitude * Mathf.PI / 180;
Ec = Rj + (Rc - Rj) * (90 - m_Latitude) / 90;
Ed = Ec * (Mathf.Cos((float)m_RadLa));
}
}