欧美在线观看视频网站,亚洲熟妇色自偷自拍另类,啪啪伊人网,中文字幕第13亚洲另类,中文成人久久久久影院免费观看 ,精品人妻人人做人人爽,亚洲a视频

一種基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng)的制作方法

文檔序號:12440499閱讀:來源:國知局

技術(shù)特征:

1.一種基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng),其特征在于,包括傳感器測量模塊、主控芯片、速度手柄和電機(jī)系統(tǒng),其中,所述主控芯片與所述傳感器測量模塊、速度手柄和電機(jī)系統(tǒng)相連接,通過所述速度手柄獲取望速度通過所述傳感器測量模塊獲取實(shí)際速度實(shí)際角度θ和角速度

所述主控芯片內(nèi)設(shè)置控制器,所述控制器根據(jù)所采集的自平衡機(jī)器人的運(yùn)動參數(shù)進(jìn)行信號處理并控制輸出電壓U驅(qū)動電機(jī)系統(tǒng)運(yùn)動;

所述控制器至少包括角度魯棒控制器、角度滑??刂破?、速度魯棒控制器和速度滑??刂破鳎渲?,所述速度魯棒控制器和速度滑??刂破鞲鶕?jù)速度誤差ev獲取期望角度θr;

角度魯棒控制器和角度滑??刂破鞲鶕?jù)角度誤差eθ調(diào)節(jié)輸出電壓U;

其中,所述控制器的輸出方程為:

其中,U0為角度滑模控制器的輸出量,U1為角度魯棒控制器的輸出量;

所述角度魯棒控制器的輸出方程為:

<mrow> <msub> <mi>U</mi> <mn>1</mn> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>a</mi> <mn>430</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>&theta;</mi> <mi>r</mi> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>11</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>e</mi> <mi>&theta;</mi> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>12</mn> </msub> <mo>&CenterDot;</mo> <msub> <mover> <mi>e</mi> <mo>&CenterDot;</mo> </mover> <mi>&theta;</mi> </msub> <mo>;</mo> </mrow>

所述角度滑模控制器的輸出方程為:

<mrow> <msub> <mi>U</mi> <mn>0</mn> </msub> <mo>=</mo> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>s</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>&CenterDot;</mo> <mrow> <mo>(</mo> <mo>|</mo> <msub> <mi>k</mi> <mn>11</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>e</mi> <mi>&theta;</mi> </msub> <mo>|</mo> <mo>+</mo> <mo>|</mo> <msub> <mi>k</mi> <mn>12</mn> </msub> <mo>&CenterDot;</mo> <msub> <mover> <mi>e</mi> <mo>&CenterDot;</mo> </mover> <mi>&theta;</mi> </msub> <mo>|</mo> <mo>+</mo> <msubsup> <mover> <mi>P</mi> <mo>&OverBar;</mo> </mover> <mn>1</mn> <mo>&prime;</mo> </msubsup> <mo>+</mo> <mo>|</mo> <msub> <mi>a</mi> <mn>430</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>e</mi> <mi>&theta;</mi> </msub> <mo>|</mo> <mo>+</mo> <mo>|</mo> <mi>&lambda;</mi> <msub> <mover> <mi>e</mi> <mo>&CenterDot;</mo> </mover> <mi>&theta;</mi> </msub> <mo>|</mo> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

其中,期望角度θr滿足為速度滑??刂破鞯妮敵隽?,為速度魯棒控制器的輸出量;

所述速度魯棒控制器的輸出方程為:

<mrow> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>=</mo> <mi>&beta;</mi> <mo>&CenterDot;</mo> <msub> <mi>a</mi> <mn>230</mn> </msub> <mo>&CenterDot;</mo> <mi>&theta;</mi> <mo>+</mo> <mi>&beta;</mi> <mo>&CenterDot;</mo> <msub> <mi>b</mi> <mn>10</mn> </msub> <mo>&CenterDot;</mo> <mi>U</mi> <mo>+</mo> <msub> <mi>k</mi> <mn>21</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>e</mi> <mrow> <mi>i</mi> <mi>v</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>k</mi> <mn>22</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>e</mi> <mi>v</mi> </msub> <mo>;</mo> </mrow>

所述速度滑模控制器的輸出方程為:

<mrow> <msub> <mover> <mi>&theta;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>r</mi> <mn>0</mn> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mi>&beta;</mi> <mo>&CenterDot;</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>s</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>&CenterDot;</mo> <mrow> <mo>(</mo> <mo>|</mo> <msub> <mi>a</mi> <mn>230</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>e</mi> <mi>v</mi> </msub> <mo>|</mo> <mo>+</mo> <mo>|</mo> <msub> <mi>k</mi> <mn>21</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>e</mi> <mrow> <mi>i</mi> <mi>v</mi> </mrow> </msub> <mo>/</mo> <mi>&beta;</mi> <mo>|</mo> <mo>+</mo> <mo>|</mo> <msub> <mi>k</mi> <mn>22</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>e</mi> <mi>v</mi> </msub> <mo>/</mo> <mi>&beta;</mi> <mo>|</mo> <mo>+</mo> <mo>|</mo> <msubsup> <mover> <mi>P</mi> <mo>&OverBar;</mo> </mover> <mn>2</mn> <mo>&prime;</mo> </msubsup> <mo>/</mo> <mi>&beta;</mi> <mo>|</mo> <mo>)</mo> </mrow> <mo>.</mo> </mrow>

2.根據(jù)權(quán)利要求1所述的基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng),其特征在于,所述速度手柄用于輸出線性霍爾信號并發(fā)送給所述主控芯片。

3.根據(jù)權(quán)利要求1所述的基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng),其特征在于,傳感器測量模塊至少包括陀螺儀、加速度計(jì)和編碼器,所述陀螺儀、加速度計(jì)和編碼器與所述主控芯片相連接,所述編碼器用于采集速度信號;所述陀螺儀用于采集角速度信號,所述加速度計(jì)用于采集加速度信號和地磁信號,所述主控芯片接收速度信號、角速度信號加速度信號和地磁信號,并進(jìn)行信號處理后獲取實(shí)際速度實(shí)際角度θ和角速度

4.根據(jù)權(quán)利要求3所述的基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng),其特征在于,所述陀螺儀的型號為L3G420D。

5.根據(jù)權(quán)利要求3所述的基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng),其特征在于,所述加速度計(jì)的型號為LSM303D。

6.根據(jù)權(quán)利要求1所述的基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng),其特征在于,還包括通訊模塊,所述通訊模塊用于實(shí)現(xiàn)自平衡機(jī)器人與外部設(shè)備進(jìn)行數(shù)據(jù)通訊。

7.根據(jù)權(quán)利要求1所述的基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng),其特征在于,還設(shè)置轉(zhuǎn)向桿線性霍爾傳感器,所述轉(zhuǎn)向桿線性霍爾傳感器用于實(shí)現(xiàn)自平衡機(jī)器人轉(zhuǎn)向控制。

8.根據(jù)權(quán)利要求1所述的基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng),其特征在于,所述主控芯片采用DSP芯片。

9.根據(jù)權(quán)利要求6所述的基于部分已知參數(shù)的兩輪自平衡機(jī)器人控制系統(tǒng),其特征在于,所述通訊模塊采用無線數(shù)據(jù)傳輸模塊。

當(dāng)前第2頁1 2 3 
網(wǎng)友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點(diǎn)贊!
1
论坛| 务川| 汉沽区| 芜湖市| 柳江县| 昌邑市| 通榆县| 绥滨县| 铜山县| 麻栗坡县| 海宁市| 大竹县| 拉萨市| 麻江县| 利川市| 兴文县| 瑞金市| 邯郸市| 中阳县| 济源市| 娱乐| 南丰县| 分宜县| 阿巴嘎旗| 宣化县| 泰兴市| 突泉县| 那坡县| 阳泉市| 茶陵县| 手游| 长沙县| 长武县| 阳朔县| 顺昌县| 博罗县| 隆德县| 尉犁县| 赤水市| 霞浦县| 湘潭市|