基于ARM單片機的智能旋轉(zhuǎn)倒立擺系統(tǒng)設計

　　2)其中要求(2)當擺桿高于水平位置時就不再進行控制，靠慣性就可完成圓周運動。

　　3)要求(3)中實現(xiàn)倒立擺保持倒立狀態(tài)，再進行直立控制時可通過導電塑料電位器返回的角度值與180°進行比較作比例控制，可以用軟件求得角速度來作微分控制。然后利用測速導電塑料電位器測得的旋轉(zhuǎn)臂的轉(zhuǎn)速進行速度的比例和積分控制，從而可以使擺桿在某一點附近完成倒立。

　　4)完成要求(4)、(5)兩項算法與之前相差無幾,只是在開始用角度的比例控制使得桿快擺到最高點處的某個位置時轉(zhuǎn)入直立控制即可。

　　5)完成項目(6)的算法與之前發(fā)揮部分的區(qū)別在于，在直立控制開始時延時一段時間，待其穩(wěn)定后，給定一個速度設定值，擺桿即可沿著一個方向做勻速圓周運動。

　　PID控制器的差分方程

　　式中 稱為比例項;稱為積分項; 稱為微分項;

　　系統(tǒng)軟件流程圖如圖6所示。

　　通過不斷地調(diào)試，測得要求(1)的比例系數(shù)K_p=45.0，要求(2)的比例系數(shù)K_p=110.0，要求(3)的比例系數(shù)K_p=1800.0，積分系數(shù)為K_p=450.0。項目(4)、(5)、(6)的比例環(huán)節(jié)控制擺動的系數(shù)K_p=85.0，直立環(huán)節(jié)系數(shù)K_p=2600.0，K_p=250.0。

　　6 系統(tǒng)測試方法與測試結果

　　6.1 主要測試儀器(見表1)

　　6.2 測試方法與測試結果

　　要求(1)：實驗中發(fā)現(xiàn)簡單設定電機正反轉(zhuǎn)時機，即可實現(xiàn)要求(1)、(2);為滿足要求(3)中的旋轉(zhuǎn)臂轉(zhuǎn)動不超過90度的限制條件，所設計的程序?qū)鞒虉D如圖6所示。此時做出來的實驗數(shù)據(jù)才有意義。實驗結果見表1。

　　要求(4)、(5)、(6)：從擺桿保持倒立狀態(tài)時開始計時，實驗結果見表3、表4。