一種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法及基于模式選擇的控制方法
【專利摘要】一種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法及基于模式選擇的控制方法，屬于懸吊漂浮物隨動系統(tǒng)領域。本發(fā)明是為了解決傳統(tǒng)方法針對隨動平臺驅動力設計的控制器無法直接用于電機轉速控制模式的問題。本發(fā)明所述的一種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法，首先建立運動學和動力學方程，確定懸吊漂浮物隨動系統(tǒng)的電機控制模式，設計控制器和調節(jié)參數(shù)四步解決了傳統(tǒng)方法將驅動力Fx和Fy作為控制項，電機只能采用轉矩模型，性能無法得到充分發(fā)揮的問題；降低了對電機本身控制模式的要求，從而更好的發(fā)揮電機本身性能，提高了懸吊漂浮物隨動系統(tǒng)的控制性能。本發(fā)明適用于懸吊漂浮物隨動系統(tǒng)領域。
【專利說明】一種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法及基于模 式選擇的控制方法
【技術領域】
[0001] 本發(fā)明屬于懸吊漂浮物隨動系統(tǒng)領域，涉及一種懸吊漂浮物隨動系統(tǒng)的加速度補 償控制方法。
【背景技術】
[0002] 懸吊法地面零重力環(huán)境模擬系統(tǒng)在航天員訓練和航天器動力學研宄中均有廣泛 的應用。該系統(tǒng)在豎直方向上懸吊某種能夠主動進行水平移動的目標體，通過恒張力控制 抵消目標體重力，實現(xiàn)零重力模擬。同時在水平方向上利用隨動系統(tǒng)控制懸吊裝置跟隨目 標體移動，并補償懸吊裝置對目標體水平方向運動所產(chǎn)生的影響。隨動系統(tǒng)的控制性能決 定了目標體模擬自身在空間中水平運動的精度，所以隨動控制器的設計在懸吊漂浮物隨動 系統(tǒng)中有著重要的地位。
[0003] 當前對于懸吊法水平隨動系統(tǒng)控制算法的研宄文獻較少，中國科學技術大學于 2006年發(fā)表的一篇名稱為《三維重力補償方法與空間浮游目標模擬實驗裝置研宄》的博士 論文，記載了利用轉動臂和移動小車實現(xiàn)目標體的運動，該方法通過測量目標體應該具有 的水平移動速度和路徑，規(guī)劃轉動臂和移動小車的路徑，使其牽引目標體按照規(guī)劃路徑運 動，該方法嚴格說來并不是閉環(huán)控制，而是一種人為引導。同時，電機驅動懸吊隨動系統(tǒng)的 控制算法多將驅動力作為控制項，少有將隨動系統(tǒng)運動速度或加速度作為控制項的。但是 驅動力控制對應的電機轉矩模式精度較差，而速度或加速度控制對應的電機轉速模式精度 較高，這就使得控制算法設計和實際工程應用之間產(chǎn)生了矛盾。
[0004] 哈爾濱工業(yè)大學學報于2009年發(fā)表的一篇名稱為《懸吊式重力補償系統(tǒng)精密跟 蹤方法》的文章，針對懸吊系統(tǒng)隨動控制問題，利用非線性規(guī)劃給出了一種最優(yōu)控制方法， 該方法直接將隨動系統(tǒng)運動的速度和加速度作為控制量，但是尋優(yōu)過程復雜，該方法屬于 一種規(guī)劃控制方法，不屬于閉環(huán)控制，其只能適用于某種固定工況，在隨動目標體改變期望 運動時，該方法需要重新調整參數(shù)，使用不靈活，效果欠佳。
【發(fā)明內(nèi)容】
[0005] 本發(fā)明是為了解決傳統(tǒng)方法針對懸吊漂浮物隨動系統(tǒng)中的隨動平臺驅動控制器 無法直接用于電機轉速控制模式，以及現(xiàn)有懸吊漂浮物隨動系統(tǒng)沒有閉環(huán)的基于速度和加 速度的控制方法的問題，現(xiàn)提供一種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法及基于模 式選擇的控制方法。
[0006] -種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法，該方法包括以下步驟：
[0007] 步驟一：設懸吊漂浮物隨動系統(tǒng)中目標體水平面上兩個相互垂直的方向分別為X 和Y，建立懸吊漂浮物隨動系統(tǒng)運動學和動力學方程；
[0008] 步驟二：將％和a ^為與比例系數(shù)結合的狀態(tài)量，將Θ ^ Θ y作為與微分系 數(shù)結合的狀態(tài)量，將J aJP J (!^乍為與積分系數(shù)結合的狀態(tài)量，將么和4作為與加速度 系數(shù)結合的狀態(tài)量；
[0009] 根據(jù)運動學和動力學方程獲得電機在轉速控制模式下基于速度和加速度的控制 器：
【權利要求】
1. 一種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法，其特征在于，該方法包括以下步 驟： 步驟一：設懸吊漂浮物隨動系統(tǒng)中目標體水平面上兩個相互垂直的方向分別為X和Y， 建立懸吊漂浮物隨動系統(tǒng)運動學和動力學方程； 步驟二：將αJPα ^乍為與比例系數(shù)結合的狀態(tài)量，將ΘJPΘy作為與微分系數(shù)結 合的狀態(tài)量，將JaJPJ(^作為與積分系數(shù)結合的狀態(tài)量，將4和么作為與加速度系數(shù) 結合的狀態(tài)量； 根據(jù)運動學和動力學方程獲得電機在轉速控制模式下基于速度和加速度的控制器：
其中，fPdPC&分別為轉速控制模式下X方向和Y方向的比例控制系數(shù)，fDx和fDy分別為轉速控制模式下X方向和Y方向的微分控制系數(shù)，C1!￡和1^ Iy分別為轉速 控制模式下X方向和Y方向的積分控制系數(shù)，fAx和fAy分別為轉速控制模式下X方向 和Y方向的加速度控制系數(shù)，t為目標體X方向移動的速度，i為目標體X方向移動的加速 度，j為目標體Y方向移動的速度，夕為目標體Y方向移動的加速度； 分別調節(jié)電機在轉速控制模式下基于速度的控制器中X方向和Y方向的參數(shù)，使得系 統(tǒng)能夠得到控制且隨動誤差收斂于零，實現(xiàn)加速度補償控制。
2. 根據(jù)權利要求1所述的一種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法，其特征在 于，步驟一所述的運動學和動力學方程為：
其中，m為目標體的質量，1為吊索長度，X為目標體X方向的位移，*為目標體X方向 移動的速度，i為目標體X方向移動的加速度，y為目標體Y方向的位移，夕為目標體Y方向 移動的速度，夕為目標體Y方向移動的加速度，MxS目標體X方向的平移質量，M目標體 Y方向的平移質量，Cx為X方向直線導軌的平移阻尼系數(shù)，CY方向直線導軌的平移阻尼 系數(shù)，X方向增廣狀態(tài)量，即X方向誤差量，aySY方向增廣狀態(tài)量，即Y方向誤差 量，上為目標體X方向上的驅動力，Jy為目標體Y方向上的驅動力，F(xiàn)x為隨動平臺X方向上 的驅動力，F(xiàn)y為隨動平臺Y方向上的驅動力，θX方向誤差量的一階導數(shù)，ΘY方向 誤差量的一階導數(shù)，4為X方向誤差量的二階導數(shù)，$為￥方向誤差量的二階導數(shù)，色為吊 索擺角X方向上的投影、4為吊索擺角X方向上的投影。
3. 根據(jù)權利要求1所述的一種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法，其特征在 于，步驟二中利用下述方法獲得電機在轉速控制模式下基于速度和加速度的控制器： 首先，將運動學和動力學方程程改寫為咚和關于i和j)的函數(shù)形式：
其中，m為目標體的質量，1為吊索長度，i為目標體X方向移動的加速度，f為目標體Y方向移動的加速度，Cx為X方向直線導軌的平移阻尼系數(shù)，C3Y方向直線導軌的平移阻 尼系數(shù)，MxS目標體X方向的平移質量，M目標體Y方向的平移質量，J,為目標體X方向 上的驅動力，1為目標體Y方向上的驅動力，F(xiàn)x為隨動平臺X方向上的驅動力，F(xiàn)隨動平 臺Y方向上的驅動力，θχ*X方向誤差量的一階導數(shù)，ΘY方向誤差量的一階導數(shù)，久 為吊索擺角X方向上的投影，4為吊索擺角X方向上的投影rad/s2,aX方向增廣狀態(tài) 量，即X方向誤差量，aY方向增廣狀態(tài)量，即Y方向誤差量； 然后，根據(jù)上式獲得電機在轉速控制模式下基于速度和加速度的控制器。
4. 根據(jù)權利要求1所述的一種懸吊漂浮物隨動系統(tǒng)的加速度補償控制方法，其特征在 于，步驟二中，所述分別調節(jié)X方向和Y方向的參數(shù)的方法如下： 將K'Dx、K'jPK'Ax置零，調節(jié)K'P!^系統(tǒng)輸出產(chǎn)生振蕩；然后逐漸調節(jié)K' Dx， 使系統(tǒng)振蕩減弱，誤差有收斂趨勢；再增大K'Ax，消除系統(tǒng)輸出量和狀態(tài)量的振蕩；最后調 節(jié)K'Ix，使隨動誤差收斂于零； 將K'Dy、K'jPK'Ay置零，調節(jié)K' ^使系統(tǒng)輸出產(chǎn)生振蕩；然后逐漸調節(jié)K' Dy， 使系統(tǒng)振蕩減弱，誤差有收斂趨勢；再增大K'Ay，消除系統(tǒng)輸出量和狀態(tài)量的振蕩；最后調 節(jié)K'Iy，使隨動誤差收斂于零。
5. -種懸吊漂浮物隨動系統(tǒng)基于模式選擇的控制方法，其特征在于，該方法包括以下 步驟： 步驟A:設懸吊漂浮物隨動系統(tǒng)中目標體水平面上兩個相互垂直的方向分別為X和Y， 建立懸吊漂浮物隨動系統(tǒng)運動學和動力學方程； 步驟B:確定懸吊漂浮物隨動系統(tǒng)的電機控制模式； 步驟C:將aJPα"乍為與比例系數(shù)結合的狀態(tài)量，將ΘJPΘy作為與微分系數(shù)結合 的狀態(tài)量，將JaJPJ(!^乍為與積分系數(shù)結合的狀態(tài)量，將A和&作為與加速度系數(shù)結 合的狀態(tài)量； 當懸吊漂浮物隨動系統(tǒng)的電機控制模式為轉矩控制模式時，根據(jù)運動學和動力學方程 獲得電機在轉矩控制模式下的基于作用力的控制器：
其中，KjpK 別為轉矩控制模式下X方向和Y方向的比例控制系數(shù)，KDx和KD，別 為轉矩控制模式下X方向和Y方向的微分控制系數(shù)，Klx和KIy分別為轉矩控制模式下X方 向和Y方向的積分控制系數(shù)，Kax和KAy分別為轉矩控制模式下X方向和Y方向的加速度控 制系數(shù)，F(xiàn)x為隨動平臺X方向上的驅動力，F(xiàn)y為隨動平臺Y方向上的驅動力； 分別調節(jié)電機在轉矩控制模式下的基于作用力的控制器中X方向和Y方向的參數(shù)，使 得系統(tǒng)能夠得到控制且隨動誤差收斂于零，實現(xiàn)加速度補償控制； 當懸吊漂浮物隨動系統(tǒng)的電機控制模式為轉速控制模式時，根據(jù)運動學和動力學方程 獲得電機在轉速控制模式下基于速度和加速度的控制器：
其中，fPdPC&分別為轉速控制模式下X方向和Y方向的比例控制系數(shù)，fDx和fDy分別為轉速控制模式下X方向和Y方向的微分控制系數(shù)，C1!￡和1^ Iy分別為轉速 控制模式下X方向和Y方向的積分控制系數(shù)，fAx和fAy分別為轉速控制模式下X方向 和Y方向的加速度控制系數(shù)，X為目標體X方向移動的速度，i為目標體X方向移動的加速 度，j為目標體Y方向移動的速度，·^為目標體Y方向移動的加速度； 分別調節(jié)電機在轉速控制模式下基于速度的控制器中X方向和Y方向的參數(shù)，使得系 統(tǒng)能夠得到控制且隨動誤差收斂于零，實現(xiàn)加速度補償控制。
6.根據(jù)權利要求5所述的一種懸吊漂浮物隨動系統(tǒng)基于模式選擇的控制方法，其特征 在于，步驟A所述的運動學和動力學方程為：
其中，m為目標體的質量，1為吊索長度，X為目標體X方向的位移，±為目標體X方向 移動的速度，i為目標體X方向移動的加速度，y為目標體Y方向的位移，夕為目標體Y方向 移動的速度，$為目標體Y方向移動的加速度，MxS目標體X方向的平移質量，M目標體 Y方向的平移質量，Cx為X方向直線導軌的平移阻尼系數(shù)，CY方向直線導軌的平移阻尼 系數(shù)，X方向增廣狀態(tài)量，即X方向誤差量，aySY方向增廣狀態(tài)量，即Y方向誤差 量，上為目標體X方向上的驅動力，Jy為目標體Y方向上的驅動力，F(xiàn)x為隨動平臺X方向上 的驅動力，F(xiàn)y為隨動平臺Y方向上的驅動力，θX方向誤差量的一階導數(shù)，ΘY方向 誤差量的一階導數(shù)，色為X方向誤差量的二階導數(shù)，~為￥方向誤差量的二階導數(shù)，I為吊 索擺角X方向上的投影、4為吊索擺角X方向上的投影。
7. 根據(jù)權利要求5所述的一種懸吊漂浮物隨動系統(tǒng)基于模式選擇的控制方法，其特征 在于，步驟C中利用下述方法獲得電機在轉速控制模式下基于速度和加速度的控制器： 首先，將運動學和動力學方程程改寫為民和4關于和的函數(shù)形式：
其中，m為目標體的質量，1為吊索長度，無為目標體X方向移動的加速度，J為目標體Y方向移動的加速度，Cx為X方向直線導軌的平移阻尼系數(shù)，C3Y方向直線導軌的平移阻 尼系數(shù)，MxS目標體X方向的平移質量，M目標體Y方向的平移質量，J,為目標體X方向 上的驅動力，1為目標體Y方向上的驅動力，F(xiàn)x為隨動平臺X方向上的驅動力，F(xiàn)隨動平 臺Y方向上的驅動力，θχ*X方向誤差量的一階導數(shù)，ΘY方向誤差量的一階導數(shù)，R 為吊索擺角X方向上的投影，A為吊索擺角X方向上的投影，α,為X方向增廣狀態(tài)量，即X 方向誤差量，aY方向增廣狀態(tài)量，即Y方向誤差量； 然后，根據(jù)上式獲得電機在轉速控制模式下基于速度和加速度的控制器。
8. 根據(jù)權利要求5所述的一種懸吊漂浮物隨動系統(tǒng)基于模式選擇的控制方法，其特征 在于，步驟C中，當懸吊漂浮物隨動系統(tǒng)的電機控制模式為轉矩控制模式時，所述分別調節(jié) X方向和Y方向的參數(shù)的方法如下： 將KDx、Klx和Kax置零，調節(jié)K!^使系統(tǒng)輸出產(chǎn)生振蕩；然后逐漸調節(jié)Kdx，使系統(tǒng)振蕩減 弱，誤差有收斂趨勢；再增大Kax，消除系統(tǒng)輸出量和狀態(tài)量的振蕩；最后調節(jié)Klx，使隨動誤 差收斂于零； 將KDy、Kly和KAy置零，調節(jié)K!^使系統(tǒng)輸出產(chǎn)生振蕩；然后逐漸調節(jié)KDy，使系統(tǒng)振蕩減 弱，誤差有收斂趨勢；再增大Kax，消除系統(tǒng)輸出量和狀態(tài)量的振蕩；最后調節(jié)Klx，使隨動誤 差收斂于零。
9. 根據(jù)權利要求5所述的一種懸吊漂浮物隨動系統(tǒng)基于模式選擇的控制方法，其特征 在于，步驟C中，當懸吊漂浮物隨動系統(tǒng)的電機控制模式為轉速控制模式時，所述分別調節(jié) X方向和Y方向的參數(shù)的方法如下： 將K'Dx、K'jPK'Ax置零，調節(jié)K'P!^系統(tǒng)輸出產(chǎn)生振蕩；然后逐漸調節(jié)K' Dx， 使系統(tǒng)振蕩減弱，誤差有收斂趨勢；再增大K'Ax，消除系統(tǒng)輸出量和狀態(tài)量的振蕩；最后調 節(jié)K'Ix，使隨動誤差收斂于零； 將K'Dy、K'jPK'Ay置零，調節(jié)K' ^使系統(tǒng)輸出產(chǎn)生振蕩；然后逐漸調節(jié)K' Dy， 使系統(tǒng)振蕩減弱，誤差有收斂趨勢；再增大K'Ay，消除系統(tǒng)輸出量和狀態(tài)量的振蕩；最后調 節(jié)K'Iy，使隨動誤差收斂于零。
【文檔編號】G05D13/58GK104460722SQ201410482326
【公開日】2015年3月25日 申請日期:2014年9月19日 優(yōu)先權日:2014年9月19日
【發(fā)明者】謝文博, 張健, 許家忠, 高海波, 劉振, 尤波, 黃玲 申請人:哈爾濱理工大學