基于32位DSP及電機驅動(dòng)芯片的懸掛運動(dòng)控制系統設計

　　3.3電機位置閉環(huán)控制方法

　　步進(jìn)電機閉環(huán)控制框圖如圖6所示，TMS320F28027分別用2個(gè)定時(shí)器來(lái)控制兩個(gè)電機，用絕對式編碼器對位置進(jìn)行監控，進(jìn)行失步補償，保證位置正確，并且可以使曲線(xiàn)圓滑。

　　圖6步進(jìn)電機閉環(huán)控制框圖

　　步進(jìn)電機的型號為42HS4813A4，為了防止失步，步進(jìn)電機每步的最小間隔為4ms，并且用軟件對步進(jìn)電機進(jìn)行了十六細分，即每步的間距為0.45°?？刂齐姍C部分的程序流程圖如圖7所示。

　　圖7控制電機部分的程序流程圖

　　控制代碼如下：

　　3.4畫(huà)圖算法

　　利用幾何關(guān)系任意點(diǎn)到任意點(diǎn)的算法，分別給處理器一連串的位置坐標，控制物體的運動(dòng)軌跡，如圖8所示。

　　圖8畫(huà)圓取點(diǎn)示意圖

　　相同間隔取N個(gè)點(diǎn)，分別輸入處理器，來(lái)控制物體的坐標。將取的點(diǎn)傳遞給TMS320F28027時(shí)，為了讓圓足夠的平滑，消去鋸齒狀，所以在圓上取了200個(gè)點(diǎn)?？刂拼a如下所示：

　　4系統測試

　　系統完成后，進(jìn)行了兩項測試，分別是畫(huà)圓運動(dòng)和運動(dòng)到指定點(diǎn)。

　　其中畫(huà)圓運動(dòng)測試是在輸入圓心坐標以及半徑后，對實(shí)際畫(huà)出圓的直徑與理論直徑作了對比，并且記錄了畫(huà)圓的耗時(shí)。此測試中，圓心坐標為(40.0cm，40.0cm)，輸入的半徑值為30.0cm，測試結果如表1所列。

　　表1畫(huà)圖運動(dòng)測試結果

　　其中，運動(dòng)到指定點(diǎn)測試是以坐標原點(diǎn)為起始點(diǎn)，在輸入指定坐標之后，對原點(diǎn)到指定點(diǎn)距離的理論值和實(shí)際值作了對比，并且記錄了運動(dòng)完后回到原點(diǎn)的誤差距離，即是否能準確回到原點(diǎn)。在此測試中，運動(dòng)的原點(diǎn)坐標為(0cm，0cm)，目標坐標為(49.0cm，50.0cm)，即距離原點(diǎn)為70.0cm，實(shí)際測試時(shí)，運動(dòng)到(49.1cm，49.2cm)，即距離原點(diǎn)69.5cm，測試結果如表2所列。

　　表2運動(dòng)到指定點(diǎn)測試

　　由測試結果可看出，該系統具有高效、穩定、準確的優(yōu)點(diǎn)，符合實(shí)驗預期。