給個建議：
做這種包含數學參照系的程序，先建立參照系，水平和垂直法線，寫好所有的象限變換，角度變換函數。
邏輯坐標和實際程序內坐標要區分開，變量命名規範不容易暈
涉及到物理計算的程序，先畫好圖再做，角度計算正確後，再通過邏輯坐標和程序內坐標計算。