こんにちは。
現在、移動する物体に対して
移動体のIDと、1分刻みの位置情報(緯度・経度)、時刻、向いている方向の情報を持っています。
この情報から目標としている図は次の通りです。
ある時刻(例:2022-08-05 20:00:00)に自分自身が向いている(例図では003度)
前方のいくつかの範囲(例図では、6マイル、-11.25度から+11.25度)内に
存在する物体を探すコードを組みたいです。
色々調べた結果、geographiclib.geodesicのGeodesicとgeopyのdistanceという関数を見つかり次のようにコードを組んでみました。しかし、思った結果と異なる結果になってしまし質問いたします。
from geographiclib.geodesic import Geodesic
from geopy import distance
from mpl_toolkits.basemap import Basemap
def get_bearing(long1,lat1,long2, lat2):
brng = Geodesic.WGS84.Inverse(lat1, long1, lat2, long2)['azi1']
if brng<0:
b=brng+360
else:
b=brng
return b
dfdf=pd.read_csv('filename.csv')
own_df=dfdf[(dfdf['ID']=="A")&(dfdf['utc']=="2022-08-05 20:00:00")].reset_index(drop=True)
tar_df=dfdf[(dfdf['ID']!="A")&(dfdf['utc']=="2022-08-05 20:00:00")].reset_index(drop=True)
dist=[]
bear=[]
for ts in range(len(tar_df)):
dist.append(distance.distance((own_df['lat'].iloc[0], own_df['lon'].iloc[0]), (tar_df['lat'][ts], tar_df['lon'][ts])).nm)
bear.append(get_bearing(own_df['lon'].iloc[0],owndf['lat'].iloc[0],tar_df['lon'][ts],tar_df['lat'][ts]))
tar_df['distnm']=dist
tar_df['o2tbearing']=bear
tgdf_6 = tar_df[(tar_df['distnm']<=6)].reset_index(drop=True)
tgdf_6['o2tbearing2'] = np.rad2deg(np.unwrap(np.deg2rad(tgdf_6['o2tbearing'])))%360
HL_sec1=(np.rad2deg(np.unwrap(np.deg2rad([own_df['cosg'][0]-11.25,own_df['cosg'][0]+11.25])))%360)[0] ## 003degree-11.25degree(O) // 003degree+11.25degree
HR_sec1=(np.rad2deg(np.unwrap(np.deg2rad([own_df['cosg'][0]-11.25,own_df['cosg'][0]+11.25])))%360)[1] ## 003degree-11.25degree // 003degree+11.25degree(O)
if abs(HL_sec1-HR_sec1)>180:
sec1_1=tgshipdf_6[(tgshipdf_6['o2tbearing2']>=HL_sec1)&(tgshipdf_6['o2tbearing2']<=360)]
sec1_2=tgshipdf_6[(tgshipdf_6['o2tbearing2']>=0)&(tgshipdf_6['o2tbearing2']<=HR_sec1)]
sec1=pd.concat([sec1_1,sec1_2]).reset_index(drop=True)
sec1['sector']='sector11.25'
elif abs(HL_sec1-HR_sec1)<180:
sec1=tgshipdf_6[(tgshipdf_6['o2tbearing2']>=HL_sec1)&(tgshipdf_6['o2tbearing2']<=HR_sec1)].reset_index(drop=True)
sec1['sector']='sector11.25'
コードを概要は次のようになります。
まず、同じ時刻の自分自身と、自分自身ではない物体をIDと時刻で検索します。
その後、自分自身と自分自身ではない移動体の距離と方位を求めます。
それから距離(6マイル)の条件で該当物体のみ残します。
また、残された物体のBearingを測ります。
現在自分自身が向いている方向003度に角度の加減のためunwrap関数を使い-11.25度と+11.25度を加算し
検索するBearingの領域を作ります。
対象物体がこの検索エリアに入っているかを判断していきます。
上記のコード通り実行すると、6マイル以内の距離の条件は上手く適用されますが、
いま現在の方向003度とプラスマイナス11.25度の領域の条件が正しく適用されなく、
おかしい方向に存在する物体を拾っています。
コードのどの部分を修正すればよろしいでしょうか?
あるいは、他の良い方法があれば教えてもらえますか?
どうぞよろしくお願いいたします。