2

前面と背面にそれぞれ赤色の 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])

どのように進めればよいですか?助けてくれてありがとう。

4

1 に答える 1