前面と背面にそれぞれ赤色の LED と緑色の LED が取り付けられたロボットがあります。greenLed - redLed ベクトルが指している方向として、ロボットの頭の方向を計算したいと思います。
下の画像の 1 と 2 でマークされたポイントが同じ角度、つまり反時計回りに 45 度、ポイント 3 が 225 度になるようにコーディングするにはどうすればよいでしょうか。
次のスクリプトを使用しましたが、間違った結果が得られました。
def headDirectionAngle(redLEDCoords, greenLEDCoords, referenceVector):
greenRedLEDVector = np.array(greenLEDCoords) - np.array(redLEDCoords)
angle = np.math.atan2(np.linalg.det([referenceVector,greenRedLEDVector]),np.dot(referenceVector,greenRedLEDVector))
return np.degrees(angle)
referenceVector = np.array([0,240])
どのように進めればよいですか?助けてくれてありがとう。