|
沒(méi)有用過(guò)陀螺儀, 不知道其性能如何, 下面僅供參考:
1. 你PWM的條件條件是什么(一般是占空比), PID的輸出直接和改變量關(guān)聯(lián)自然就能控制PWM, 但是占空比代表什么, 取決于你的電機(jī)的控制方法是什么.
1.2. 電機(jī)的速度可以通過(guò)陀螺儀的變化計(jì)算得到, 例如 控制x軸的電機(jī), x軸轉(zhuǎn)動(dòng)的角度的變化量就是陀螺儀x軸分量上的dθ/dt就是轉(zhuǎn)動(dòng)速度. 但是這也取決于你的陀螺儀的安裝點(diǎn)與電機(jī)軸的機(jī)械結(jié)構(gòu)上的相對(duì)關(guān)系.
這樣電機(jī)的轉(zhuǎn)速就可以得到了, 此轉(zhuǎn)速可以作為PID的反饋輸入. --- 但是我不知道陀螺儀的檢測(cè)會(huì)不會(huì)有很大滯后, 是否適于做為速度反饋, 這個(gè)要你自己計(jì)算評(píng)估.
2. 手的干擾可以認(rèn)為電機(jī)負(fù)載發(fā)生變化, 可以通過(guò)電路檢測(cè)電機(jī)的電流得到, 當(dāng)你檢測(cè)到電機(jī)的負(fù)載變大時(shí), 就加大輸出, 負(fù)載減少時(shí), 就減少輸出, 這樣手一松開(kāi), 就會(huì)立即相應(yīng)減少輸出, 也就不會(huì)突然沖過(guò)頭了.
我對(duì)陀螺儀也不是很了解, 希望以上對(duì)你有方向上的幫助. |
|