專利名稱：二自由度機器人運動控制方法
技術領域：
本發明涉及一種機器人運動控制方法，特別是涉及一種二自由度機器人運動控制方法。
背景技術：
文獻“武衛霞，兩輪自平衡機器人運動平衡控制方法的研究，北京工業大學碩士學位論文，2010.5.”公開了兩輪自平衡機器人運動平衡控制的三種方法，LQR控制方法，模糊PID控制方法和反饋線性化控制方法。二自由度機器人的控制包括轉彎和跑點兩個最基礎的任務，在此基礎上可組合出復雜的任務和動作。文獻公開的三種控制方法完全適用于二自由度機器人的控制。其中，LQR控制方法主要針對線性系統或非線性系統的局部控制問題；模糊PID控制方法有延遲時間和震蕩超調量，抗干擾能力和實時性有限；反饋線性化控制方法較模糊PID控制方法性能有所改善，但由于未充分考慮控制對象的動力學性，在控制二自由度機器人時，二自由度機器人完成任務的精確度和快速性之間的折衷還有較大的優化余地。其次，三種控制方法都需要通過人工調試，手動優化參數，才能使用，工作較為繁復。再者，三種控制方法由于未能充分考慮控制對象的動力學特性，無法從根本上消除0 —0時，二自由度機器人的震蕩，進而影響完成任務的時間和精度。

發明內容
為了克服現有機器人控制方法控制精度差的不足，本發明提供一種二自由度機器人運動控制方法。該方法首先對二自由度機器人的客觀物理動力學特性進行建模，抽象出二自由度機器人一般形式的動力學特性方程。在此基礎上，采用逐次逼近，最終收斂的方法完成轉角控制，從根本上消除了 0 —0時，二自由度機器人的震蕩，為后續線運動控制奠定基礎。然后引入實半徑02和軌跡曲率半徑P1，變換二自由度機器人在二維極坐標下的運動學方程，令P2正比于COte，再利用已有的轉角控制，得到線運動控制方程，完成跑點控制。可以提高二自由度機器人的控制精度，而且方程中的參數物理意義明確，不需人工調試即可確定。本發明解決其技術問題所采用的技術方案是:一種二自由度機器人運動控制方法，其特點是包括以下步驟:(I)獲取二自由度機器人運動控制系統的動力學特性方程:
權利要求
1.一種二自由度機器人運動控制方法，其特征在于包括以下步驟: (I)獲取二自由度機器人運動控制系統的動力學特性方程:
全文摘要
本發明公開了一種二自由度機器人運動控制方法，用于解決現有機器人控制方法控制精度差的技術問題。技術方案是首先首先對二自由度機器人的客觀物理動力學特性進行建模，抽象出二自由度機器人一般形式的動力學特性方程。在此基礎上，采用逐次逼近，最終收斂的方法完成轉角控制，從根本上消除了θ→0時，二自由度機器人的震蕩，為后續線運動控制奠定基礎。然后引入實半徑ρ2和軌跡曲率半徑ρ1，變換二自由度機器人在二維極坐標下的運動學方程，令ρ2正比于cotθ，再利用已有的轉角控制，得到線運動控制方程，完成跑點控制。提高了二自由度機器人的控制精度，而且方程中的參數物理意義明確，不需人工調試即可確定。
文檔編號B25J13/00GK103170976SQ20131008021
公開日2013年6月26日 申請日期2013年3月13日 優先權日2013年3月13日
發明者史豪斌, 徐林程, 郭志巍, 黃伯崢, 李小婷, 沈楷 申請人:西北工業大學