XYGRAPH比較數值

map1.mpeg

map2.mpeg

如圖片所示

機器一開始起始點(黃點)為(0,0),隨著機器的移動本身XY的數值會跟著變動,但還要隨時和四個點(綠點)要作距離遠近的比較!

分別為(0,-1000)(6000,-1000)(6000,1000)(0,1000)

四個點都採取轉極座標的方式取出 r 來決定距離長短!

目前運動控制已經準備好了!(只缺與主程式結合)

四個點的數值一直無法和起始點作判斷及無法與運動控制作整合!!

請問板上的強者們,

我有什麼方法可以作比較然後順利的移動嗎??

謝謝各位花時間看完我的發問!

謝謝!!