亚洲免费av电影一区二区三区,日韩爱爱视频,51精品视频一区二区三区,91视频爱爱,日韩欧美在线播放视频,中文字幕少妇AV,亚洲电影中文字幕,久久久久亚洲av成人网址,久久综合视频网站,国产在线不卡免费播放

        ?

        基于四旋翼無(wú)人機(jī)的二階PD積分滑??刂扑惴ㄑ芯?/h1>
        2018-03-29 07:20:30陳洪楷余義斌
        制造業(yè)自動(dòng)化 2018年3期
        關(guān)鍵詞:信號(hào)系統(tǒng)

        陳洪楷,滿 紅,余義斌

        (五邑大學(xué) 信息工程學(xué)院,江門 529030)

        0 引言

        近年來(lái),由于四旋翼無(wú)人機(jī)能夠替代人類完成危險(xiǎn)系數(shù)高、工作量大及操作困難等任務(wù),被廣泛應(yīng)用于質(zhì)量安全檢測(cè)、生命探測(cè)、城市安防、物流快遞業(yè)務(wù)等場(chǎng)合,對(duì)其控制方法的研究也備受關(guān)注。

        A moozgar M H等人使用模糊控制規(guī)則實(shí)時(shí)調(diào)整PID控制參數(shù)[1],但是規(guī)則的劃分具有一定的不確定性,因而影響了控制精度。趙振宇利用神經(jīng)網(wǎng)絡(luò)逼近飛行系統(tǒng)的不確定性,結(jié)合滑??刂瓶梢杂行p小系統(tǒng)的跟蹤誤差[2],但是存在復(fù)雜非線性導(dǎo)致神經(jīng)網(wǎng)絡(luò)計(jì)算量劇增實(shí)現(xiàn)困難的問(wèn)題。Rong Xu等人將四旋翼無(wú)人機(jī)系統(tǒng)分成全驅(qū)動(dòng)子系統(tǒng)和欠驅(qū)動(dòng)子系統(tǒng)[3],在全驅(qū)動(dòng)子系統(tǒng)卻采用常規(guī)的PD控制算法難以保證系統(tǒng)的控制精度和魯棒性。劉凱悅等人利用單位四元數(shù)法描述系統(tǒng)姿態(tài),設(shè)計(jì)了反演滑??刂破鞯玫搅己玫能壽E跟蹤效果[4],但忽略了滑??刂贫墩駟?wèn)題。因此,尋求一種抑制滑??刂贫墩竦姆椒ㄊ翘岣邿o(wú)人機(jī)飛行穩(wěn)定收斂速度的關(guān)鍵[5]。

        本文利用參考文獻(xiàn)[6,7]給出的四旋翼無(wú)人機(jī)簡(jiǎn)化動(dòng)力學(xué)模型,外環(huán)利用二階PD算法推算出控制律和內(nèi)環(huán)控制信號(hào),內(nèi)環(huán)使用飽和函數(shù)替代切換函數(shù),通過(guò)積分滑??刂破魉邮胀猸h(huán)的控制信號(hào)得出內(nèi)環(huán)的控制律。這樣可以有效抑制抖振效應(yīng),提高無(wú)人機(jī)飛行穩(wěn)定的收斂速度和跟蹤精度[1]。

        1 四旋翼無(wú)人機(jī)的數(shù)學(xué)模型描述

        四旋翼無(wú)人機(jī)簡(jiǎn)化結(jié)構(gòu)如圖1所示,機(jī)體中心為無(wú)人機(jī)的控制中心,四個(gè)旋翼由機(jī)臂末端的直流無(wú)刷電機(jī)驅(qū)動(dòng),相鄰兩個(gè)電機(jī)旋轉(zhuǎn)的方向相反,主要是用來(lái)平衡飛行器的總角動(dòng)量防止機(jī)身失衡而發(fā)生翻轉(zhuǎn)。另外,還包括兩個(gè)主要的坐標(biāo)系:地面慣性坐標(biāo)系;依附于飛行器的機(jī)體坐標(biāo)系。

        圖1 四旋翼無(wú)人機(jī)簡(jiǎn)化結(jié)構(gòu)圖

        假設(shè)忽略微小的空氣動(dòng)力學(xué)效應(yīng),四旋翼無(wú)人機(jī)的數(shù)學(xué)模型如下[6,7]:

        在圖1中,通過(guò)對(duì)電機(jī)2和電機(jī)4所施加的推力大小

        不同使機(jī)體繞著b1軸旋轉(zhuǎn),產(chǎn)生的角度為俯仰角θ;對(duì)電機(jī)1和電機(jī)3的推力大小差異使機(jī)體繞著b2軸旋轉(zhuǎn),產(chǎn)生的角度為滾轉(zhuǎn)角?;通過(guò)電動(dòng)機(jī)轉(zhuǎn)矩來(lái)改變施加在機(jī)體上的阻力矩來(lái)實(shí)現(xiàn)圍繞軸線b3的旋轉(zhuǎn),產(chǎn)生的角度為偏航角ψ。

        角速度矢量[p q r]T與慣性坐標(biāo)系下姿態(tài)角之間的轉(zhuǎn)化關(guān)系如下所示:

        2 二階PD積分滑??刂瓶刂破鞯脑O(shè)計(jì)

        根據(jù)所提算法的思想,設(shè)計(jì)四旋翼無(wú)人機(jī)二階PD積分滑??刂破鹘Y(jié)構(gòu)如圖2所示。

        圖2 控制器結(jié)構(gòu)圖

        位置控制環(huán)處于外環(huán),其中位置子系統(tǒng)控制器接收反饋回來(lái)的實(shí)際軌跡和航跡指令信號(hào)的期望軌跡,利用兩者的偏差,使用二階PD算法得到外環(huán)控制律u1以及姿態(tài)控制信號(hào)。內(nèi)環(huán)姿態(tài)環(huán)接收姿態(tài)控制信號(hào)以及反饋回來(lái)的實(shí)際姿態(tài)信號(hào)后,利用兩者的偏差,在姿態(tài)子系統(tǒng)控制器使用積分滑模控制得到內(nèi)環(huán)控制律u2。

        2.1 位置環(huán)二階PD控制器設(shè)計(jì)

        令期望軌跡為ξd,它由三個(gè)位置向量和一個(gè)滾轉(zhuǎn)角組成:

        位置環(huán)控制信號(hào)為:

        實(shí)際軌跡為:

        其中:

        由式(1)~式(6),推導(dǎo)得到控制信號(hào)加速度矢量與控制律u1的關(guān)系如下:

        由式(9)可得:

        則:

        由式(8)可得:

        為了防止式(11)左邊值超出[-1,+1],而造成θc不存在,用分段取值的思想來(lái)解決這個(gè)問(wèn)題:令。

        結(jié)合式(2)、式(5)、式(8)、式(10)、式(12),可以推導(dǎo)得到外環(huán)控制律u1:

        2.2 姿態(tài)環(huán)滑模控制器設(shè)計(jì)

        即:

        令:

        由式(14)和式(15)得到其一階微分:

        其中:

        趨近律v選擇指數(shù)趨近律,令:

        其中,K是滑模等速趨近律的增益矩陣,ε是指數(shù)趨近律的增益矩陣,K>0,ε>0。

        為抑制滑模控制的抖振效應(yīng),引入了積分滑模控制和指數(shù)趨近律之后,用飽和函數(shù)項(xiàng)代替切換函數(shù):

        ,則:

        綜合以上的分析,將式(14)、式(15)、式(16)代入式(19),得到內(nèi)環(huán)控制律u2為:

        其中:

        3 仿真分析

        為驗(yàn)證所提算法的有效性,現(xiàn)假設(shè)從有、無(wú)干擾兩個(gè)方面對(duì)無(wú)人機(jī)能否快速跟蹤給定軌跡展開(kāi)仿真研究。其中,采用的干擾模型可以模擬實(shí)際風(fēng)干擾,其速度模型如下[8]:

        仿真所需的四旋翼系統(tǒng)參數(shù)如表1所示。

        表1 四旋翼系統(tǒng)參數(shù)

        仿真各參數(shù)設(shè)置如下:

        當(dāng)系統(tǒng)沒(méi)有受到擾動(dòng)情況下,圖3至圖6分別給出仿真結(jié)果。圖3是給定的規(guī)劃航跡圖,圖4是無(wú)擾動(dòng)下的控制器輸出波形,圖5是各軸方向上矢量運(yùn)動(dòng)和姿態(tài)角隨時(shí)間變化的波形,從圖形中可以看出實(shí)際值和參考值的吻合程度很高,圖6是系統(tǒng)變量誤差變化曲線,可以看出誤差波動(dòng)的范圍較小。

        圖3 規(guī)劃航跡

        圖4 無(wú)擾動(dòng)下的控制器信號(hào)輸出

        圖5 各軸方向運(yùn)動(dòng)和姿態(tài)角變化

        圖6 各軸方向誤差和滾轉(zhuǎn)角誤差

        假設(shè)系統(tǒng)在t=25s時(shí)加入風(fēng)干擾,仿真結(jié)果如圖7到圖10所示。從下圖中可以看出當(dāng)系統(tǒng)受到干擾時(shí),波形和飛行軌跡都發(fā)生了跳變,大約經(jīng)過(guò)5s后波形和軌跡可以恢復(fù)正常狀態(tài)。

        圖7 干擾下飛行軌跡圖

        圖8 干擾下控制器輸出

        【】【】

        圖9 干擾下各軸矢量運(yùn)動(dòng)和姿態(tài)角變化

        圖10 干擾下各軸方向誤差和滾轉(zhuǎn)角誤差

        從圖4和圖8的仿真結(jié)果可以看出,使用飽和函數(shù)的積分滑??刂瓶刂屏縰2的各個(gè)分量無(wú)論有無(wú)干擾都能保持在-0.02到0.02的幅值之間抖動(dòng),有效地抑制了滑??刂票旧淼亩墩?。綜合分析以上仿真結(jié)果,可以看出所設(shè)計(jì)的控制算法能夠應(yīng)對(duì)突發(fā)干擾,使無(wú)人機(jī)可以快速收斂到預(yù)定的軌跡,同時(shí)也抑制了滑??刂茙?lái)的抖振現(xiàn)象,驗(yàn)證了所提方法的可行性和有效性。

        4 結(jié)論

        四旋翼無(wú)人機(jī)是具有6個(gè)輸出和4個(gè)輸入的欠驅(qū)動(dòng)系統(tǒng),為獲得更好的飛行穩(wěn)定的收斂速度,將整個(gè)系統(tǒng)分成外環(huán)的位置控制系統(tǒng)和內(nèi)環(huán)的姿態(tài)控制系統(tǒng),外環(huán)采用二階PD算法,內(nèi)環(huán)利用抑制抖振的飽和函數(shù)項(xiàng)的積分滑模控制算法。在有干擾和沒(méi)有干擾的情況下進(jìn)行仿真實(shí)驗(yàn),驗(yàn)證了所設(shè)計(jì)的控制器能夠使無(wú)人機(jī)有較好的跟蹤性能和收斂速度,說(shuō)明所提算法具有較好的魯棒性和可行性。

        [1]A moozgar M H,Chamseddine A,Zhang Y.Fault-tolerant fuzzy gain-scheduled PID for a quadrotor helicopter testbed in the presence of actuator faults[A].IFAC Conference on Advances in PID Control[C].Brescia,Italy,2012.

        [2]趙振宇,盧廣山.具有未知干擾的無(wú)人機(jī)魯棒滑模飛行控制[J].計(jì)算機(jī)仿真,2012,29(2):63-67.

        [3]Rong Xu and U mit O zgu ner. Sliding Mode Control of a Quadrotor Helicopter[A].Pr-oceedings of the 45th IEEE Conference on Decision & Control[C].Manchester Grand Hy-att Hotel San Diego, CA,USA,December 13-15,2006:4957-4962.

        [4]劉凱悅,冷建偉.基于滑??刂频乃男頍o(wú)人機(jī)的軌跡跟蹤控制[J].天津理工大學(xué)學(xué)報(bào),33(2):60-64.

        [5]陳志梅,王貞艷,張井崗.滑模變結(jié)構(gòu)控制理論及應(yīng)用[M].電子工業(yè)出版社,2012.8.

        [6]Robert Mahony,Vijay Kumar, Peter Corke.Modeling,Estimation,and Control of Quadrotor[Z].Digital Object Identif ier 10.1109/MRA.2012.2206474,2012,7.

        [7]Bambang SUMANTRI, Naoki UCHIYAMA, Shigenori SANO,Yuma KAWABATA. Robust Tracking Control of a Quad-Rotor Helicopter Utilizing Sliding Mode Control with a Nonlinear Sliding Surface[J].Journal of System Design and Dynamics,2013,7(2):226-241.

        [8]Oualid Araar, Nabil Aouf. Quadrotor Control for Trajectory Tracking in Presence of Wind Disturbances[A].2014 U KACC International Conference on Control[C].Loughborough,U.K,2014,7.

        猜你喜歡
        信號(hào)系統(tǒng)
        Smartflower POP 一體式光伏系統(tǒng)
        信號(hào)
        鴨綠江(2021年35期)2021-04-19 12:24:18
        WJ-700無(wú)人機(jī)系統(tǒng)
        ZC系列無(wú)人機(jī)遙感系統(tǒng)
        完形填空二則
        基于PowerPC+FPGA顯示系統(tǒng)
        半沸制皂系統(tǒng)(下)
        孩子停止長(zhǎng)個(gè)的信號(hào)
        連通與提升系統(tǒng)的最后一塊拼圖 Audiolab 傲立 M-DAC mini
        基于LabVIEW的力加載信號(hào)采集與PID控制

        免费人成无码大片在线观看 | 亚洲日韩精品A∨片无码加勒比| 97国产精品麻豆性色| 蜜桃视频在线观看网址| 亚洲欧美日韩中文字幕一区二区三区 | 国产精品久久国产三级国电话系列| 久久久亚洲女精品aa| 亚州终合人妖一区二区三区| 天天噜日日噜狠狠噜免费| 中文字幕无码免费久久| 国产成人精品蜜芽视频| 国产三区二区一区久久| 亚洲日韩av无码一区二区三区人| 乱子真实露脸刺激对白| 91色婷婷成人精品亚洲| 性色av色香蕉一区二区蜜桃| 青青青爽在线视频观看| 久久亚洲黄色| 女同av免费在线播放| 日韩人妻精品中文字幕专区 | 久久精品亚洲中文字幕无码网站| 久久久久久久综合日本| 国产精品日韩亚洲一区二区| 亚洲一区二区三区影院| 亚洲丁香五月激情综合| 国产精品久久一区性色a| 精品一区二区三区婷婷| 99国产精品人妻噜啊噜| 亚洲中文av一区二区三区| 日本一区二区三区免费| 成人免费a级毛片无码片2022| 中文字幕亚洲乱码熟女在线萌芽| 亚洲AⅤ乱码一区二区三区| 日本av天堂一区二区三区| 精品人妻中文无码av在线| 亚洲午夜无码久久yy6080| 国产一区二区杨幂在线观看性色| 少妇伦子伦情品无吗| 欧美在线三级艳情网站| 亚洲免费看三级黄网站| 日本孕妇潮喷高潮视频|