4 Omni Wheel Drive Block

四輪全向移動足球機器人Block

雖然現在WRO足球組已經禁用了4輪萬向輪的足球機,但是4輪的全向移動在各方面都還是挺實用的,這裡我們把以前試驗過的4輪全向輪控制Block分享出來給各位看看啦~

使用說明

Angel:機器移動的目標角度,然後4顆馬達必須依照下圖擺放,方能正常運作:

4顆馬達關係圖

上圖中藍色箭頭為馬達預設正轉方向,如果要前進在Block Angel輸入0度就會往前,輸入90度往左…..這角度關係基本上與Compass的相對位置是相同的哦~

Power:機器人移動的基本馬力。

HT Compass RelHeading:把HT Compass的相對方位放進來就對了,沒有放等於沒校正。

Error Correction Kp:把HT Compass相對方位值當誤差(Error),由此Kp調整機器人校正量(自旋),偏離越大或Kp越大校正越快。

更新紀錄

  • Ver 1.2 2019.06.05 update info:
  • 加入HT Compass 相對方位輸入。
  • 加入Kp輸入。
  • 移除自旋量,被上面那兩個取代了。
  • 代碼由 OFDL HYT 重新優化。

Download

Download Link(GitHub):http://bit.ly/2HLXmee
Author:OFDL HSUOFDL WunOFDL HYT
Ver:1.2