旋翼無(wú)人機(jī)交互作業(yè)動(dòng)力學(xué)建模研究進(jìn)展綜述

丁希侖, 金雪瑩

北京航空航天大學(xué) 機(jī)器人研究所, 北京 100191

近年來(lái)，旋翼無(wú)人機(jī)由于具有結(jié)構(gòu)簡(jiǎn)單、機(jī)動(dòng)性強(qiáng)、可在空中懸停和豎直起降等諸多優(yōu)勢(shì)而在各大領(lǐng)域中被廣泛應(yīng)用[1]，重點(diǎn)需求領(lǐng)域包括但不限于對(duì)基礎(chǔ)設(shè)施的監(jiān)測(cè)和檢查、自然災(zāi)害的智能響應(yīng)、農(nóng)業(yè)生產(chǎn)中的植物保護(hù)和氣象調(diào)節(jié)中的人工降雨等[2]，旋翼無(wú)人機(jī)在各界受到的重視和在各領(lǐng)域中的廣泛應(yīng)用表明其相關(guān)技術(shù)的研究正處于黃金時(shí)期[3]。隨著交互作業(yè)環(huán)境的復(fù)雜性和不確定性逐漸提高，盡管旋翼無(wú)人機(jī)在檢查、巡視、遙感等應(yīng)用中具有一定優(yōu)勢(shì)，但在接觸、抓持、運(yùn)輸?shù)热蝿?wù)中受到極大限制。為擴(kuò)展旋翼無(wú)人機(jī)的應(yīng)用范圍并使其具備與環(huán)境的交互作業(yè)能力，作業(yè)型旋翼無(wú)人機(jī)應(yīng)運(yùn)而生。作業(yè)型旋翼無(wú)人機(jī)是由旋翼無(wú)人機(jī)與作業(yè)裝置組成的具有主動(dòng)交互作業(yè)能力的一種新型無(wú)人機(jī)系統(tǒng)[4]。作業(yè)型旋翼無(wú)人機(jī)可以在日常情況下協(xié)助人類(lèi)或在危險(xiǎn)環(huán)境中代替人類(lèi)完成工作：在面對(duì)新冠肺炎等疫情中，作業(yè)型旋翼無(wú)人機(jī)可以進(jìn)行物資運(yùn)輸以大大減少人與人之間的接觸頻率；在突發(fā)公共安全事件中，作業(yè)型旋翼無(wú)人機(jī)可以進(jìn)入危險(xiǎn)區(qū)域進(jìn)行滅火、拆爆等操作以有效降低人員傷亡。因此，作業(yè)型旋翼無(wú)人機(jī)有著非常廣闊的應(yīng)用前景。

對(duì)旋翼無(wú)人機(jī)進(jìn)行動(dòng)力學(xué)研究可以提升飛行穩(wěn)定性和機(jī)動(dòng)性，旋翼無(wú)人機(jī)的飛行動(dòng)力學(xué)建模已具有較為成熟的研究成果，但作業(yè)型旋翼無(wú)人機(jī)因作業(yè)裝置的加入使其動(dòng)力學(xué)模型呈現(xiàn)出更加復(fù)雜的非線(xiàn)性、強(qiáng)耦合等特征[5]，交互作業(yè)過(guò)程中整體系統(tǒng)的動(dòng)力學(xué)模型亦會(huì)發(fā)生多次突變。因此建立能準(zhǔn)確描述出作業(yè)型旋翼無(wú)人機(jī)與環(huán)境交互作業(yè)的全過(guò)程動(dòng)力學(xué)模型還對(duì)其交互作業(yè)任務(wù)的完成效果與操作精度的提升具有重要意義，該領(lǐng)域也成為研究熱點(diǎn)與難點(diǎn)。

結(jié)合作者在該領(lǐng)域的研究工作，首先，從多體系統(tǒng)動(dòng)力學(xué)中的約束概念對(duì)作業(yè)型旋翼無(wú)人機(jī)的交互作業(yè)任務(wù)進(jìn)行分類(lèi)與說(shuō)明，并對(duì)其動(dòng)力學(xué)建模問(wèn)題進(jìn)行介紹；然后，對(duì)不同交互作業(yè)模式下的動(dòng)力學(xué)建模研究現(xiàn)狀進(jìn)行調(diào)研分析；最后，給出作業(yè)型旋翼無(wú)人機(jī)動(dòng)力學(xué)建模未來(lái)面臨的挑戰(zhàn)并對(duì)該領(lǐng)域進(jìn)行總結(jié)。

1 問(wèn)題來(lái)源

作業(yè)型旋翼無(wú)人機(jī)從旋翼無(wú)人機(jī)發(fā)展而來(lái)，其動(dòng)力學(xué)需考慮作業(yè)裝置與旋翼無(wú)人機(jī)之間的耦合特征還需考慮交互作業(yè)模式下外界給系統(tǒng)施加的干擾。對(duì)于旋翼無(wú)人機(jī)的動(dòng)力學(xué)建模已有較為成熟的研究成果，而作業(yè)型旋翼無(wú)人機(jī)的動(dòng)力學(xué)建模技術(shù)仍處于發(fā)展時(shí)期。作業(yè)型旋翼無(wú)人機(jī)以交互作業(yè)任務(wù)為導(dǎo)向?qū)ζ渥鳂I(yè)裝置進(jìn)行設(shè)計(jì)，不同交互作業(yè)任務(wù)對(duì)應(yīng)不同約束類(lèi)型，因此可針對(duì)無(wú)人機(jī)與交互對(duì)象所受到的不同約束情況對(duì)交互作業(yè)任務(wù)進(jìn)行分類(lèi)和說(shuō)明。

1.1 作業(yè)型旋翼無(wú)人機(jī)動(dòng)力學(xué)建模方法

對(duì)于旋翼無(wú)人機(jī)的動(dòng)力學(xué)建模，通常將其視作剛體，飛行動(dòng)力學(xué)方程由位置動(dòng)力學(xué)方程和姿態(tài)動(dòng)力學(xué)方程組成[6-7]，姿態(tài)描述的傳統(tǒng)方法有歐拉角、旋轉(zhuǎn)矩陣、四元數(shù)等，動(dòng)力學(xué)建模方法多采取Newton-Euler法、Lagrange法、Kane法等傳統(tǒng)方法，這幾種方法建立的動(dòng)力學(xué)模型表達(dá)形式各不相同，但最后得到的所描述對(duì)象的動(dòng)態(tài)特性結(jié)果是相同的[8]。對(duì)旋翼無(wú)人機(jī)從早期的自由飛行[9]到特效機(jī)動(dòng)飛行[10]都進(jìn)行過(guò)大量動(dòng)力學(xué)建模研究以提高其控制效果和動(dòng)態(tài)響應(yīng)。

如圖1所示，作業(yè)型旋翼無(wú)人機(jī)在交互作業(yè)模式下涉及到的結(jié)構(gòu)有旋翼無(wú)人機(jī)本體、作業(yè)裝置和交互對(duì)象。其中，交互對(duì)象可以是各種表面、物體等。

對(duì)于作業(yè)型旋翼無(wú)人機(jī)的動(dòng)力學(xué)建模，當(dāng)作業(yè)裝置質(zhì)量與體積較小時(shí)，其在作業(yè)過(guò)程中的運(yùn)動(dòng)與無(wú)人機(jī)機(jī)體的耦合效應(yīng)較小，此時(shí)可將整體系統(tǒng)的動(dòng)力學(xué)看作旋翼無(wú)人機(jī)本體的動(dòng)力學(xué)。然而，吊掛系統(tǒng)以及機(jī)械臂等作業(yè)裝置在飛行作業(yè)過(guò)程中會(huì)對(duì)無(wú)人機(jī)機(jī)體產(chǎn)生強(qiáng)烈的動(dòng)力學(xué)耦合效應(yīng)，整體系統(tǒng)的質(zhì)量、質(zhì)心、慣性參數(shù)等會(huì)發(fā)生變化。

對(duì)于描述多剛體之間的相對(duì)運(yùn)動(dòng)近年來(lái)新興的一種方法是約束法[11]，最早且最具代表性的研究領(lǐng)域是飛行器的級(jí)間分離[12-13]。在作業(yè)型旋翼無(wú)人機(jī)的交互作業(yè)過(guò)程中，交互對(duì)象給作業(yè)型旋翼無(wú)人機(jī)系統(tǒng)帶來(lái)的影響表現(xiàn)為力/力矩形式，而交互對(duì)象對(duì)作業(yè)型旋翼無(wú)人機(jī)的影響可通過(guò)二者之間的相對(duì)約束關(guān)系和交互對(duì)象的動(dòng)力學(xué)模型得到[14]。

現(xiàn)階段對(duì)作業(yè)型旋翼無(wú)人機(jī)動(dòng)力學(xué)模型的處理可分為以下兩類(lèi)：獨(dú)立建模法將旋翼無(wú)人機(jī)與作業(yè)裝置視作兩個(gè)獨(dú)立的系統(tǒng)，二者之間的力/力矩耦合被視為干擾，對(duì)二者獨(dú)立控制的同時(shí)試圖拒絕來(lái)自其它系統(tǒng)施加的干擾，這種方法較易實(shí)現(xiàn)卻因?qū)δＰ突谝欢ǖ暮?jiǎn)化會(huì)影響后續(xù)控制效果；整體建模法將旋翼無(wú)人機(jī)與作業(yè)裝置視作一個(gè)整體，耦合效應(yīng)當(dāng)作內(nèi)部因素進(jìn)行處理，以整體作為研究對(duì)象考慮外界環(huán)境給系統(tǒng)帶來(lái)的影響，通過(guò)作業(yè)裝置的動(dòng)力學(xué)特性以描述其在運(yùn)動(dòng)過(guò)程中的慣性變化，從而改善整體系統(tǒng)的控制效果[15-16]，這種方法更加精確卻不易實(shí)施控制器的設(shè)計(jì)。

1.2 交互作業(yè)模式分類(lèi)

從作業(yè)型旋翼無(wú)人機(jī)交互作業(yè)模式的約束特征來(lái)看，可以將作業(yè)型旋翼無(wú)人機(jī)的應(yīng)用場(chǎng)景主要分為接觸和運(yùn)輸。其中接觸作業(yè)可劃分為固定點(diǎn)接觸、拉/推、滑動(dòng)接觸三類(lèi)，運(yùn)輸作業(yè)可劃分為吊掛、抓持兩類(lèi)，其余交互作業(yè)模式多針對(duì)具體特定的需求且對(duì)作業(yè)裝置的操作精度和靈巧性均具有較高要求。以下根據(jù)各交互作業(yè)模式在動(dòng)力學(xué)建模中的約束類(lèi)型進(jìn)行劃分，如表1所示。

固定點(diǎn)接觸：將作業(yè)裝置的末端執(zhí)行器和交互對(duì)象之間的接觸始終保持在一個(gè)靜態(tài)點(diǎn)上，交互表面通常為空間中的靜止表面。當(dāng)無(wú)人機(jī)進(jìn)行接觸作業(yè)時(shí)，末端執(zhí)行器的位置應(yīng)約束在接觸點(diǎn)上，為保證末端執(zhí)行器與表面發(fā)生接觸的同時(shí)不損毀表面還應(yīng)對(duì)接觸力進(jìn)行約束。

滑動(dòng)接觸：維持末端執(zhí)行器和靜態(tài)表面之間的連續(xù)、平穩(wěn)接觸，此時(shí)還需考慮靜態(tài)和動(dòng)態(tài)摩擦以避免打滑，確保末端執(zhí)行器沿所需軌跡移動(dòng)。經(jīng)典應(yīng)用包括大型容器/貯水池[17]、石油天然氣管道[18]和其他表面的連續(xù)接觸檢查。

拉/推：通過(guò)作業(yè)裝置可以拉/推一個(gè)物體并使其按照預(yù)設(shè)的軌跡產(chǎn)生運(yùn)動(dòng)。這項(xiàng)任務(wù)與固定點(diǎn)接觸的區(qū)別在于接觸點(diǎn)是非靜態(tài)的，交互對(duì)象不完全受約束，可在空間中沿某些方向平動(dòng)或轉(zhuǎn)動(dòng)。當(dāng)旋翼無(wú)人機(jī)拉一個(gè)物體時(shí)，需控制末端執(zhí)行器的位置和姿態(tài)以保證其可以始終約束在接觸點(diǎn)上。當(dāng)旋翼無(wú)人機(jī)推一個(gè)物體時(shí)，只要二者之間的接觸力位于摩擦錐內(nèi)，就不需要末端執(zhí)行器和物體之間的約束。

吊掛：旋翼無(wú)人機(jī)攜帶物體運(yùn)輸至指定位置在運(yùn)輸物體過(guò)程中，都會(huì)受到來(lái)自物體的重力和干擾。吊掛作業(yè)中通常會(huì)使用線(xiàn)繩將需運(yùn)輸?shù)奈矬w預(yù)先在旋翼無(wú)人機(jī)下方固連并攜帶物體起飛，運(yùn)輸至指定位置降落后再解開(kāi)線(xiàn)繩。在整個(gè)吊掛作業(yè)過(guò)程中物體都會(huì)受到來(lái)自作業(yè)裝置的約束。

抓持：旋翼無(wú)人機(jī)在飛行過(guò)程中抓持/釋放一個(gè)不受環(huán)境約束的物體[19-20]并將其放置到指定位置處。這項(xiàng)任務(wù)與吊掛作業(yè)的區(qū)別在于旋翼無(wú)人機(jī)通常在飛行過(guò)程中抓持/釋放物體，而旋翼無(wú)人機(jī)系統(tǒng)與物體之間的接觸沖擊效應(yīng)只在抓持/釋放中起作用，這個(gè)過(guò)程很短，以往研究中通常忽略不計(jì)。

其余交互作業(yè)模式利用的是作業(yè)裝置的高精度操作能力和物理交互能力，主要集中在如何提供足夠的、特定的操作力/力矩。例如開(kāi)/關(guān)閥門(mén)[21]、樹(shù)腔檢查[22]或腐蝕修復(fù)[23]等特定任務(wù)。

1.3 作業(yè)裝置分類(lèi)

根據(jù)具體的交互作業(yè)模式，旋翼無(wú)人機(jī)會(huì)配備不同的作業(yè)裝置，如表2所示，較常見(jiàn)的作業(yè)裝置主要有剛性桿[24-25]、抓持器[26]、機(jī)械臂[15,27-28]等類(lèi)型。接觸作業(yè)中為便于提供特定方向的接觸力通常采用線(xiàn)驅(qū)動(dòng)類(lèi)型的剛性桿[29-30]，吊掛作業(yè)中基本采用線(xiàn)繩[31]，抓持作業(yè)中歐洲國(guó)家的科研機(jī)構(gòu)多采用機(jī)械臂而美國(guó)的科研機(jī)構(gòu)多采用抓持器[32]。

表2 不同交互作業(yè)模式所對(duì)應(yīng)的作業(yè)裝置Table 2 Manipulators for different interactive manipulation modes

配備不同作業(yè)裝置的作業(yè)型旋翼無(wú)人機(jī)具有不同的動(dòng)力學(xué)建模思路，因此可通過(guò)不同交互作業(yè)模式分別闡述國(guó)內(nèi)外在作業(yè)型旋翼無(wú)人機(jī)動(dòng)力學(xué)建模領(lǐng)域的研究現(xiàn)狀。這3類(lèi)交互作業(yè)模式對(duì)作業(yè)型旋翼無(wú)人機(jī)整體系統(tǒng)造成不同的動(dòng)態(tài)效應(yīng)影響：接觸作業(yè)主要對(duì)系統(tǒng)產(chǎn)生了碰撞沖擊效應(yīng)；吊掛作業(yè)下作業(yè)裝置、物體與無(wú)人機(jī)系統(tǒng)的耦合動(dòng)力學(xué)效應(yīng)往往不可忽視；抓持作業(yè)不僅需考慮抓持/釋放物體時(shí)的碰撞沖擊效應(yīng)還需重點(diǎn)考慮抓取物體后形成一個(gè)新的“組合體”系統(tǒng)時(shí)，載荷、質(zhì)心與慣性參數(shù)的突變給旋翼無(wú)人機(jī)系統(tǒng)帶來(lái)的干擾。

首先，從旋翼無(wú)人機(jī)引申至作業(yè)型旋翼無(wú)人機(jī)，介紹了二者的區(qū)別與動(dòng)力學(xué)建模方法。此后，首次基于動(dòng)力學(xué)約束概念將交互作業(yè)模式進(jìn)行劃分和闡明，不同交互作業(yè)模式對(duì)應(yīng)不同類(lèi)型的作業(yè)裝置。后續(xù)章節(jié)將根據(jù)作業(yè)型旋翼無(wú)人機(jī)在不同交互作業(yè)模式下的動(dòng)力學(xué)建模方法進(jìn)行調(diào)研與歸納，給出每種交互作業(yè)模式的通用性動(dòng)力學(xué)建模方法并介紹國(guó)內(nèi)外研究現(xiàn)狀。

2 接觸作業(yè)

在作業(yè)型旋翼無(wú)人機(jī)的接觸作業(yè)中會(huì)受到來(lái)自交互對(duì)象施加的力/力矩等擾動(dòng)，導(dǎo)致系統(tǒng)的整體穩(wěn)定性受到不可忽視的影響。因此在接觸作業(yè)中，了解作用在作業(yè)型旋翼無(wú)人機(jī)上的外力/力矩對(duì)于有效控制作業(yè)型旋翼無(wú)人機(jī)與交互對(duì)象的物理交互作用至關(guān)重要，計(jì)及接觸碰撞帶給整體系統(tǒng)的碰撞沖擊效應(yīng)對(duì)其穩(wěn)定性的提升具有重要意義[33]。

2.1 通用性動(dòng)力學(xué)建模

在接觸作業(yè)中，常用動(dòng)力學(xué)建模方法有Newton-Euler法、Lagrange法等。接觸過(guò)程通常被劃分為“接觸前-接觸中-接觸后”三階段進(jìn)行考慮，三階段系統(tǒng)的動(dòng)力學(xué)模型顯然不同。常用接觸力建模方法有沖量-動(dòng)量法[34]、連續(xù)接觸力法[35]和附加約束法[36]。沖量-動(dòng)量法假定的前提是發(fā)生接觸的時(shí)間極短，以碰撞前后沖量的變化來(lái)決定系統(tǒng)運(yùn)動(dòng)狀態(tài)的改變[33]。連續(xù)接觸力模型能夠求解接觸力隨時(shí)間變化歷程，認(rèn)為碰撞力由局部接觸變形引起，并假定變形限制在接觸區(qū)的鄰域，是一種以彈性或彈塑性力元代替接觸區(qū)域復(fù)雜變形的近似方法[37]。附加約束法的實(shí)質(zhì)是將接觸作用視為一種物理約束，當(dāng)兩物體發(fā)生接觸時(shí)相對(duì)距離為0，在對(duì)整體系統(tǒng)的動(dòng)力學(xué)方程求解中得到碰撞力和碰撞動(dòng)力學(xué)響應(yīng)的同時(shí)引入碰撞檢測(cè)環(huán)節(jié)[36,38-39]。

在文獻(xiàn)[40]中，Bodie等首先采用Newton-Euler法建立了旋翼無(wú)人機(jī)本體的動(dòng)力學(xué)模型，在此基礎(chǔ)上基于Lagrange法建立了作業(yè)型旋翼無(wú)人機(jī)的動(dòng)力學(xué)模型[41]。該樣機(jī)被應(yīng)用于混凝土基礎(chǔ)設(shè)施的無(wú)損檢測(cè)，可與曲面滑動(dòng)接觸。如圖2[41]所示為接觸作業(yè)模型示意圖，表3[41]為接觸作業(yè)模型坐標(biāo)系。

表3 接觸作業(yè)模型坐標(biāo)系[41]Table 3 Contact manipulation model coordinate frame[41]

動(dòng)力學(xué)模型的建立基于以下假設(shè)：作業(yè)裝置與旋翼無(wú)人機(jī)本體是剛性連接，工具坐標(biāo)系的原點(diǎn)建立在作業(yè)裝置頂端；相機(jī)與作業(yè)裝置同樣假設(shè)為剛性連接。接觸作業(yè)下整體系統(tǒng)的動(dòng)力學(xué)模型為

(1)

式中：v∈6×1與6×1分別為旋翼無(wú)人機(jī)的廣義速度與廣義加速度；M∈6×6為慣性矩陣且對(duì)稱(chēng)正定；C∈6×6為離心力與科氏力矩陣；g∈6×1為重力項(xiàng)；τa∈6×1與τe∈6×1分別為由旋翼無(wú)人機(jī)自身產(chǎn)生的力/力矩和外界施加給整體系統(tǒng)的力/力矩(接觸/陣風(fēng)效應(yīng)等)。需要注意的是，接觸力僅在作業(yè)型旋翼無(wú)人機(jī)與交互對(duì)象發(fā)生接觸時(shí)存在。

此后，基于廣義動(dòng)量法[42]采用一個(gè)外力矩估計(jì)器來(lái)估算接觸力對(duì)整體系統(tǒng)帶來(lái)的影響，因此在動(dòng)力學(xué)建模中并未給出接觸力模型的具體形式。類(lèi)似地，還有采取自主規(guī)劃和物理交互控制算法為作業(yè)型旋翼無(wú)人機(jī)提供參考軌跡的方法來(lái)解決其與環(huán)境進(jìn)行物理交互的問(wèn)題[43-44]。

2.2 動(dòng)力學(xué)建模研究現(xiàn)狀

2012年，筆者團(tuán)隊(duì)設(shè)計(jì)并研制了一種加裝雙機(jī)械臂的具備在任務(wù)空間內(nèi)與環(huán)境交互接觸能力的新型多功能飛行機(jī)器人MMAR，完成了MMAR的飛行、爬壁行走等多仿真任務(wù)，該構(gòu)想提高了旋翼無(wú)人機(jī)與環(huán)境的交互能力和作業(yè)區(qū)域范圍[45]。首先運(yùn)用Lagrange方程建立MMAR自身的動(dòng)力學(xué)模型，同時(shí)考慮了旋翼無(wú)人機(jī)本體與機(jī)械臂之間的動(dòng)力學(xué)耦合效應(yīng)，并將整體系統(tǒng)的動(dòng)力學(xué)模型分解為具有明確物理意義的旋翼無(wú)人機(jī)本體動(dòng)力學(xué)、機(jī)械臂動(dòng)力學(xué)以及無(wú)人機(jī)本體與機(jī)械臂之間的耦合動(dòng)力學(xué)[46]。如圖3所示，為該樣機(jī)的抓取與爬壁作業(yè)仿真。

2012年，意大利那不勒斯菲里德里克第二大學(xué)的Lippiello和Ruggiero對(duì)加裝3自由度串聯(lián)機(jī)械臂的四旋翼無(wú)人機(jī)采用Lagrange方程進(jìn)行系統(tǒng)動(dòng)力學(xué)建模，同時(shí)發(fā)現(xiàn)依據(jù)配置情況四旋翼無(wú)人機(jī)與機(jī)械臂之間會(huì)存在冗余，可利用冗余調(diào)節(jié)配置參數(shù)[16]，如圖4所示，為該樣機(jī)的動(dòng)力學(xué)建模示意圖。2014年，考慮了完整的耦合動(dòng)力學(xué)并基于動(dòng)力學(xué)模型使用反步積分法設(shè)計(jì)控制器對(duì)無(wú)人機(jī)進(jìn)行速度控制[47]。

2012年，韓國(guó)國(guó)立首爾大學(xué)的Lee和Ha在四旋翼無(wú)人機(jī)上固定一輕質(zhì)作業(yè)工具并對(duì)工具末端進(jìn)行控制，建立了四旋翼無(wú)人機(jī)的質(zhì)心動(dòng)力學(xué)模型并將作業(yè)工具末端運(yùn)動(dòng)分解為平動(dòng)與轉(zhuǎn)動(dòng)并在接觸力的y軸方向?qū)ζ溥M(jìn)行控制[48]。2014年，如圖5所示，將作業(yè)型旋翼無(wú)人機(jī)系統(tǒng)的Lagrange動(dòng)力學(xué)模型完全解耦為E(3)中的質(zhì)心動(dòng)力學(xué)、旋翼無(wú)人機(jī)本體轉(zhuǎn)動(dòng)與作業(yè)裝置構(gòu)型的“內(nèi)部旋轉(zhuǎn)動(dòng)力學(xué)”，這種方法具有標(biāo)準(zhǔn)的Lagrange動(dòng)力學(xué)形式[49]。

2013年，筆者團(tuán)隊(duì)對(duì)新型多功能飛行機(jī)器人MMAR開(kāi)展了其與環(huán)境接觸下的動(dòng)力學(xué)分析。針對(duì)飛行-行走混合運(yùn)動(dòng)過(guò)程，借鑒混雜系統(tǒng)理論將整個(gè)運(yùn)動(dòng)過(guò)程劃分為不同階段。針對(duì)MMAR的雙足與地面接觸所產(chǎn)生的接觸沖擊效應(yīng)通過(guò)聯(lián)立接觸約束方程和帶有Lagrange乘子的動(dòng)力學(xué)方程形成封閉的系統(tǒng)動(dòng)力學(xué)方程，求解方程組得到了系統(tǒng)的運(yùn)動(dòng)學(xué)變量和接觸力[50]，圖6所示為MMAR的飛行試驗(yàn)。

2013年，蘇黎世聯(lián)邦理工學(xué)院的Alexis等研制了一種共軸反槳無(wú)人機(jī)ACX[51]，該無(wú)人機(jī)通過(guò)在外圍安裝桁架等機(jī)械結(jié)構(gòu)與支持面進(jìn)行接觸，實(shí)現(xiàn)了與墻壁接觸、在墻壁上滑行等動(dòng)作。采取混雜動(dòng)力學(xué)模型描述了該無(wú)人機(jī)系統(tǒng)全過(guò)程的運(yùn)動(dòng)，在此模型基礎(chǔ)上采用模型預(yù)測(cè)控制方法進(jìn)行了后續(xù)控制器的設(shè)計(jì)，該系統(tǒng)模型涵蓋了從自由飛行到接觸(單點(diǎn)接觸、兩點(diǎn)接觸)的所有機(jī)體狀態(tài)。2014年，研制出一種可以對(duì)基礎(chǔ)設(shè)施進(jìn)行接觸檢測(cè)的多旋翼無(wú)人機(jī)ASLquad[52]，基于此項(xiàng)研究提出一種使無(wú)人機(jī)能夠與環(huán)境實(shí)現(xiàn)穩(wěn)定物理交互的混合模型預(yù)測(cè)控制框架并能在環(huán)境表面上實(shí)現(xiàn)精確的軌跡跟蹤，且只需進(jìn)行較小的結(jié)構(gòu)調(diào)整即可實(shí)現(xiàn)力控制。試驗(yàn)表明，該樣機(jī)可以完成復(fù)雜的空中書(shū)寫(xiě)任務(wù)且展現(xiàn)了該方法的效率和其與環(huán)境進(jìn)行物理交互的巨大潛力。ACX與ASLquad的樣機(jī)試驗(yàn)如圖7所示。

2014年，荷蘭特溫特大學(xué)的Fumagalli等研究了作業(yè)型旋翼無(wú)人機(jī)與墻壁的接觸問(wèn)題，將飛行作業(yè)動(dòng)力學(xué)建模劃分為旋翼無(wú)人機(jī)、作業(yè)裝置和環(huán)境三部分，面向自由飛行和與墻壁接觸懸停兩種運(yùn)動(dòng)模式建立了整體系統(tǒng)的動(dòng)力學(xué)模型，同時(shí)分析了作業(yè)裝置與墻壁接觸時(shí)對(duì)旋翼無(wú)人機(jī)系統(tǒng)動(dòng)力學(xué)產(chǎn)生的影響[53-54]，圖8所示為該樣機(jī)與墻壁的接觸試驗(yàn)[55]。

2015年，德國(guó)馬斯克普朗克研究所的Yüksel等研制了一種可實(shí)現(xiàn)錘擊或投擲等動(dòng)作的加裝柔性臂的作業(yè)型無(wú)人機(jī)[56]。在動(dòng)力學(xué)建模中特意指出彈性臂的物理參數(shù)多數(shù)是未知的，因此推導(dǎo)出這些動(dòng)力學(xué)參數(shù)并將其用于控制柔性臂的運(yùn)動(dòng)。與此同時(shí)，還推導(dǎo)出了連桿和電機(jī)的動(dòng)力學(xué)模型以評(píng)估系統(tǒng)在快速運(yùn)動(dòng)中的動(dòng)態(tài)行為。將柔性臂安裝在四旋翼無(wú)人機(jī)上用于空中物理交互任務(wù)意味著柔性部件也可以用于穩(wěn)定交互以吸收可能對(duì)飛行系統(tǒng)及其硬件造成損害的交互干擾。最終成功獲得機(jī)器人與環(huán)境之間期望的交互行為，并展示了這種方法在處理表面任務(wù)上的優(yōu)勢(shì)，該樣機(jī)可以完成給天花板刷油漆、清潔或各種表面檢查等任務(wù)[57-58]，如圖9所示，該樣機(jī)實(shí)現(xiàn)了與曲面平穩(wěn)地滑動(dòng)接觸。

2015年，韓國(guó)首爾國(guó)立大學(xué)的Kim等采用Lagrange法對(duì)一架裝有3自由度機(jī)械臂的四旋翼無(wú)人機(jī)進(jìn)行動(dòng)力學(xué)建模并設(shè)計(jì)了一種可以根據(jù)無(wú)人機(jī)狀態(tài)實(shí)時(shí)估計(jì)負(fù)載質(zhì)量以及相對(duì)慣量的自適應(yīng)滑?？刂破鱽?lái)完成無(wú)人機(jī)的開(kāi)關(guān)抽屜操作[59]，圖10所示為該樣機(jī)的基于視覺(jué)伺服的開(kāi)關(guān)抽屜試驗(yàn)。

2018年，筆者團(tuán)隊(duì)提出了一種可用于多旋翼無(wú)人機(jī)與地面目標(biāo)對(duì)接的傳動(dòng)機(jī)構(gòu)，針對(duì)對(duì)接機(jī)構(gòu)的結(jié)構(gòu)設(shè)計(jì)和優(yōu)化進(jìn)行了詳細(xì)介紹并考慮了對(duì)接過(guò)程的容錯(cuò)性問(wèn)題，將對(duì)接過(guò)程分階段進(jìn)行動(dòng)力學(xué)分析。最終實(shí)驗(yàn)結(jié)果表明，旋翼無(wú)人機(jī)與地面目標(biāo)物體順利對(duì)接[60]，圖11所示為安裝對(duì)接機(jī)構(gòu)的樣機(jī)。

通過(guò)以上調(diào)研可以看出，國(guó)內(nèi)外研究人員已對(duì)接觸作業(yè)旋翼無(wú)人機(jī)的動(dòng)力學(xué)建模進(jìn)行過(guò)大量研究，接觸作業(yè)旋翼無(wú)人機(jī)在工業(yè)中的表面檢測(cè)等領(lǐng)域的應(yīng)用優(yōu)勢(shì)突出。但是，對(duì)于旋翼無(wú)人機(jī)與交互對(duì)象接觸時(shí)二者之間產(chǎn)生的接觸力進(jìn)行精確建模和深入研究的成果還較為少見(jiàn)。

3 吊掛作業(yè)

在早期，作業(yè)型旋翼無(wú)人機(jī)的吊掛作業(yè)主要用于運(yùn)輸物資[61]、森林滅火等救援場(chǎng)景[62]，以及在野外將動(dòng)物運(yùn)輸至安全區(qū)域以躲避盜獵者的襲擊，其通常會(huì)使用線(xiàn)繩等作業(yè)裝置將需要運(yùn)輸?shù)奈矬w懸掛于機(jī)體下方，但研究人員發(fā)現(xiàn)吊掛系統(tǒng)因與旋翼無(wú)人機(jī)本體存在強(qiáng)烈的動(dòng)力學(xué)耦合效應(yīng)所以總會(huì)受困于整體系統(tǒng)的穩(wěn)定性和操縱性問(wèn)題[63]。

3.1 通用性動(dòng)力學(xué)建模

在吊掛作業(yè)中，常用動(dòng)力學(xué)建模方法有Newton-Euler法、Lagrange法、Kane法等。吊掛系統(tǒng)帶給旋翼無(wú)人機(jī)本體較強(qiáng)的動(dòng)力學(xué)耦合效應(yīng)一直是吊掛作業(yè)面臨的難點(diǎn)，然而，動(dòng)力學(xué)耦合建模需基于整體系統(tǒng)的動(dòng)力學(xué)建模。對(duì)于作業(yè)型旋翼無(wú)人機(jī)吊掛作業(yè)的動(dòng)力學(xué)建模，首先需建立旋翼無(wú)人機(jī)本體的動(dòng)力學(xué)模型，其次建立吊掛系統(tǒng)的動(dòng)力學(xué)模型，最后通過(guò)二者之間的約束關(guān)系建立整體系統(tǒng)的動(dòng)力學(xué)模型。

在文獻(xiàn)[64]中，焦海林首先對(duì)旋翼無(wú)人機(jī)本體采用Newton-Euler法建立動(dòng)力學(xué)模型，此后采用Lagrange法建立整體系統(tǒng)的動(dòng)力學(xué)方程。如圖12所示為吊掛作業(yè)模型示意圖，表4為吊掛作業(yè)模型坐標(biāo)系。

表4 吊掛作業(yè)模型坐標(biāo)系Table 4 Suspending manipulation model coordinate frame

動(dòng)力學(xué)模型的建立基于以下假設(shè)：線(xiàn)繩懸掛點(diǎn)位于旋翼無(wú)人機(jī)本體質(zhì)心處，機(jī)體坐標(biāo)系原點(diǎn)亦設(shè)置在此處；忽略線(xiàn)繩質(zhì)量且假設(shè)線(xiàn)繩始終張緊；忽略線(xiàn)繩與吊掛系統(tǒng)所受到的氣動(dòng)干擾。旋翼無(wú)人機(jī)與吊掛系統(tǒng)所構(gòu)成的整體系統(tǒng)的動(dòng)力學(xué)模型為

(2)

式中：M(q)∈5×5為慣性矩陣；5×5為離心力與科氏力矩陣；G(q)∈5×1為重力項(xiàng)；q∈5×1為系統(tǒng)的廣義坐標(biāo)向量；Fext∈5×1為系統(tǒng)受到的廣義力。

3.2 動(dòng)力學(xué)建模研究現(xiàn)狀

2013年，美國(guó)賓夕法尼亞大學(xué)的Jiang和Kumar使用多個(gè)四旋翼無(wú)人機(jī)通過(guò)線(xiàn)繩協(xié)調(diào)驅(qū)動(dòng)對(duì)物體進(jìn)行負(fù)載。根據(jù)線(xiàn)繩張力采用混雜系統(tǒng)模型描述整體系統(tǒng)[65]，在此基礎(chǔ)上基于微分平坦理論規(guī)劃出攜帶負(fù)載時(shí)能夠進(jìn)行大幅度擺動(dòng)的運(yùn)動(dòng)軌跡，此后又利用Lagrange法對(duì)四旋翼無(wú)人機(jī)吊掛系統(tǒng)的機(jī)動(dòng)軌跡規(guī)劃[66]和控制方法，以解決攜帶負(fù)載使四旋翼無(wú)人機(jī)飛行的機(jī)動(dòng)性能減弱問(wèn)題，圖13所示為該樣機(jī)的飛行試驗(yàn)。

2015年，美國(guó)喬治華盛頓大學(xué)的Goodarzi和Lee在SO(3)上采用Lagrange法研究了四旋翼無(wú)人機(jī)加裝軟繩運(yùn)輸物體的動(dòng)力學(xué)與控制問(wèn)題，在動(dòng)力學(xué)建模過(guò)程中將軟繩模型視作若干個(gè)由球關(guān)節(jié)串聯(lián)起來(lái)的連桿，在此基礎(chǔ)上考慮了“四旋翼-軟繩-負(fù)載”之間的耦合作用[67]。此后又將這一方法用于多機(jī)吊掛作業(yè)問(wèn)題中，大大提升了負(fù)載運(yùn)輸能力[68]，如圖14所示為動(dòng)力學(xué)建模的示意圖。

2016年，北京航空航天大學(xué)的萬(wàn)紹峰等采用Kane法對(duì)直升機(jī)吊掛作業(yè)進(jìn)行動(dòng)力學(xué)建模，將整體系統(tǒng)分為直升機(jī)本體、吊掛繩索和吊掛負(fù)載三部分，直升機(jī)本體視作六自由度剛體，吊掛繩索模擬為集中質(zhì)點(diǎn)模型, 質(zhì)點(diǎn)間用彈簧連接，吊掛負(fù)載模擬為三自由度質(zhì)點(diǎn)，此外還考慮了重力、氣動(dòng)力和彈性力的影響[69]。

2017年，加拿大蒙特利爾大學(xué)的Laliberté和Saussié等采用Newton-Euler法對(duì)作業(yè)型旋翼無(wú)人機(jī)的吊掛作業(yè)進(jìn)行動(dòng)力學(xué)建模，研究了不同負(fù)載對(duì)整體系統(tǒng)質(zhì)量中心和慣性參數(shù)的影響[70]。

2017年，瑞士蘇黎世大學(xué)的Falanga等采用Lagrange法對(duì)四旋翼無(wú)人機(jī)吊掛系統(tǒng)創(chuàng)新性地提出了一種表述方法：系統(tǒng)模型被看作為四旋翼無(wú)人機(jī)下方固連1個(gè)包括兩個(gè)被動(dòng)轉(zhuǎn)動(dòng)副和一個(gè)被動(dòng)移動(dòng)副的被動(dòng)臂，在此基礎(chǔ)上，針對(duì)吊掛系統(tǒng)在飛行中的動(dòng)態(tài)行為為其設(shè)計(jì)了一種快速軌跡優(yōu)化方法[71]，如圖15所示為該樣機(jī)在空中進(jìn)行飛行試驗(yàn)。

2019年，南開(kāi)大學(xué)的Liang等針對(duì)四旋翼吊掛系統(tǒng)在實(shí)際應(yīng)用中存在雙擺現(xiàn)象指出現(xiàn)有的控制方法通?；谶^(guò)多的假設(shè)與簡(jiǎn)化，通過(guò)Lagrange法建立了無(wú)人機(jī)系統(tǒng)的動(dòng)力學(xué)方程，然后根據(jù)動(dòng)力學(xué)模型分析了系統(tǒng)的主要特征，并對(duì)兩種控制方案進(jìn)行了數(shù)值模擬以揭示旋翼無(wú)人機(jī)吊掛系統(tǒng)的特性[72]，圖16為動(dòng)力學(xué)建模示意圖。

通過(guò)以上調(diào)研可以看出，國(guó)內(nèi)外已存在大量關(guān)于作業(yè)型旋翼無(wú)人機(jī)吊掛作業(yè)動(dòng)力學(xué)建模[73-74]、耦合動(dòng)力學(xué)建模[75-76]的研究成果。吊掛作業(yè)實(shí)施起來(lái)方便高效、成本低廉，在物資運(yùn)輸應(yīng)用中具有較強(qiáng)優(yōu)勢(shì)。但是，現(xiàn)有成果的研究對(duì)象多為單旋翼大型無(wú)人機(jī)，對(duì)于小型多旋翼無(wú)人機(jī)，吊掛作業(yè)動(dòng)力學(xué)方面的研究成果還未達(dá)到與單旋翼大型無(wú)人機(jī)相同的水平。

4 抓持作業(yè)

作業(yè)型旋翼無(wú)人機(jī)的抓持作業(yè)可實(shí)現(xiàn)棲息功能[77-78]，提高續(xù)航能力的同時(shí)還具備對(duì)機(jī)體的隱蔽作用，同時(shí)還可實(shí)現(xiàn)抓取物體[79]或采樣[80-81]等操作。對(duì)物體進(jìn)行抓持作業(yè)時(shí)，不僅會(huì)產(chǎn)生碰撞沖擊效應(yīng)，還會(huì)使整體系統(tǒng)的負(fù)載進(jìn)一步增大，質(zhì)心和慣性參數(shù)發(fā)生瞬時(shí)突變。因此，抓持作業(yè)經(jīng)常受困于抓持精度不高和旋翼無(wú)人機(jī)本體姿態(tài)失穩(wěn)等問(wèn)題。

4.1 通用性動(dòng)力學(xué)建模

在抓持作業(yè)中，常用動(dòng)力學(xué)建模方法有Newton-Euler法、Lagrange法等。在作業(yè)裝置抓取物體后，其與物體所構(gòu)成的運(yùn)動(dòng)學(xué)約束體現(xiàn)于相對(duì)等距、相對(duì)速度為0，即位置約束與速度約束[82]；動(dòng)力學(xué)約束體現(xiàn)于作業(yè)裝置能否提供合適的接觸力，既保證能牢固抓住物體又不會(huì)因接觸力過(guò)大而損壞物體，即力約束。

在文獻(xiàn)[83]中，Jafarinasab和Sirouspour用Newton-Euler法建立了安裝n連桿單機(jī)械臂的作業(yè)型旋翼無(wú)人機(jī)的動(dòng)力學(xué)模型。圖17所示為抓持作業(yè)模型示意圖，表5為抓持作業(yè)模型坐標(biāo)系。

表5 抓持作業(yè)模型坐標(biāo)系Table 5 Grasp manipulation model coordinate frame

采用Newton-Euler法從所抓持的物體開(kāi)始推導(dǎo)整體系統(tǒng)的后向動(dòng)力學(xué)方程，確定所有剛體之間的相互作用力/力矩，得到整體系統(tǒng)的動(dòng)力學(xué)方程為

(3)

式中：M∈6×6為慣性矩陣；C∈6×6為離心力與科氏力矩陣；G∈6×1為重力項(xiàng)；F∈3×1表示螺旋槳產(chǎn)生的升力/力矩；τ∈3×1為n連桿機(jī)械臂中電機(jī)所產(chǎn)生的驅(qū)動(dòng)力/力矩。

4.2 動(dòng)力學(xué)建模研究現(xiàn)狀

2014年，意大利那不勒斯菲里德里克第二大學(xué)的Lippiello等設(shè)計(jì)了加裝5自由度機(jī)械臂的作業(yè)型旋翼無(wú)人機(jī)，考慮整體系統(tǒng)的完整耦合動(dòng)力學(xué)后基于視覺(jué)圖像生成的速度指令使其完成抓持作業(yè)[47,84]；在交互作業(yè)過(guò)程中，建立相機(jī)視野、手爪位姿、關(guān)節(jié)極限位置等任務(wù)的雅可比矩陣作為系統(tǒng)的子任務(wù)，同時(shí)也滿(mǎn)足了總?cè)蝿?wù)需求[85]，圖18所示為該樣機(jī)進(jìn)行空中抓持作業(yè)試驗(yàn)。

2014年，美國(guó)賓夕法尼亞大學(xué)的Thomas等模仿老鷹捕獵為旋翼無(wú)人機(jī)設(shè)計(jì)了一個(gè)抓持作業(yè)裝置，圖19所示為該樣機(jī)模仿老鷹捕獵全過(guò)程實(shí)驗(yàn)的靜態(tài)圖。采用Lagrange法建立耦合系統(tǒng)的動(dòng)力學(xué)模型并將其用于后續(xù)控制器的設(shè)計(jì)中，為規(guī)劃出高速動(dòng)態(tài)軌跡，還證明了該耦合系統(tǒng)是微分平坦的[86]。

2014年，西班牙塞維利亞大學(xué)的Ollero等設(shè)計(jì)了加裝3自由度機(jī)械臂的作業(yè)型旋翼無(wú)人機(jī)QARM1，發(fā)現(xiàn)機(jī)械臂的運(yùn)動(dòng)會(huì)引起QARM1的質(zhì)心和慣性參數(shù)的變化，因此額外設(shè)計(jì)了機(jī)械臂的控制器以減弱機(jī)械臂對(duì)四旋翼產(chǎn)生的振動(dòng)影響，同時(shí)也提高了機(jī)械臂的操作精度[87]。2015年，設(shè)計(jì)了一種具有8個(gè)電機(jī)且攜帶7自由度機(jī)械臂的AMUSE無(wú)人機(jī)，在控制算法中計(jì)及耦合動(dòng)力學(xué)的影響控制機(jī)械臂末端執(zhí)行器的位置[88]。QARM1與AMUSE樣機(jī)如圖20所示。

2014年，美國(guó)約翰霍普金斯大學(xué)的Kobilarov 以旋轉(zhuǎn)矩陣和歐拉角兩種姿態(tài)表示方法對(duì)加裝操作臂的共軸三旋翼無(wú)人機(jī)進(jìn)行動(dòng)力學(xué)建模和解耦[89]。此后，又在Lie群空間里將無(wú)人機(jī)系統(tǒng)看作多剛體系統(tǒng)并生成最優(yōu)軌跡，這種方法的優(yōu)勢(shì)在于標(biāo)準(zhǔn)軌跡優(yōu)化方法可以很容易地?cái)U(kuò)展到Lie群空間中而不損失無(wú)人機(jī)的飛行控制效率[90]。

2015年，哈爾濱工業(yè)大學(xué)的李選聰利用Lagrange法建立四旋翼飛行作業(yè)無(wú)人機(jī)的動(dòng)力學(xué)模型，利用迭代線(xiàn)性二次調(diào)節(jié)法設(shè)計(jì)了一種復(fù)合軌跡規(guī)劃器，在仿真環(huán)境下對(duì)抓取任務(wù)進(jìn)行了模擬[91]。

2018年，Brescianini和D’andrea等從多旋翼無(wú)人機(jī)的動(dòng)力學(xué)和其輸入約束在SO(3)上以Newton-Euler法建立無(wú)人機(jī)整體系統(tǒng)的動(dòng)力學(xué)模型，該方法計(jì)算了平移和旋轉(zhuǎn)運(yùn)動(dòng)基元，由位置、速度與姿態(tài)定義無(wú)人機(jī)的狀態(tài)，可在指定時(shí)間內(nèi)引導(dǎo)其從任意初始狀態(tài)到任意最終狀態(tài)。提出了存在閉合形式解決方案的輕量級(jí)運(yùn)動(dòng)基元，并得出了測(cè)試其可行性的有效方法[92]。

2019—2021年，筆者團(tuán)隊(duì)為適應(yīng)不同任務(wù)需求為多旋翼無(wú)人機(jī)研制了多種不同操作臂，分別為：被動(dòng)臂、主動(dòng)臂、固連操作臂。針對(duì)加裝被動(dòng)臂的無(wú)人機(jī)交互作業(yè)全過(guò)程，利用混雜模型、切換矩陣和被動(dòng)解耦的方法著重解決了動(dòng)力學(xué)模型的變化問(wèn)題，交互作業(yè)全過(guò)程的劃分示意圖如圖21所示，將全過(guò)程的動(dòng)力學(xué)模型進(jìn)行劃分并采用切換模式作為模型過(guò)渡[93]。針對(duì)安裝帶主動(dòng)臂的無(wú)人機(jī)交互作業(yè)全過(guò)程，計(jì)算了整體系統(tǒng)的慣性中心并基于慣性中心推導(dǎo)得到了SE(3)上的跟蹤誤差動(dòng)力學(xué)模型。針對(duì)加裝固連操作臂的無(wú)人機(jī)，基于強(qiáng)化學(xué)習(xí)理論克服了交互作業(yè)過(guò)程中動(dòng)力學(xué)模型不精確和動(dòng)力學(xué)模型變化問(wèn)題[94]。

2021年，美國(guó)斯坦福大學(xué)的Cutkosky等針對(duì)目前無(wú)人機(jī)在動(dòng)態(tài)抓取不規(guī)則物體能力的局限性問(wèn)題設(shè)計(jì)了一種仿生鳥(niǎo)爪SNAG[95]，其模仿鳥(niǎo)類(lèi)降落在樹(shù)枝上的全過(guò)程示意圖如圖22所示，SNAG使無(wú)人機(jī)可以動(dòng)態(tài)棲息在復(fù)雜表面上并靈活抓取多種不規(guī)則物體。為適應(yīng)高速碰撞，兩條腿可被動(dòng)地將撞擊能量轉(zhuǎn)化為抓取力，而欠驅(qū)動(dòng)的抓取機(jī)構(gòu)在不到0.05 s的時(shí)間內(nèi)就能將不規(guī)則形狀的物體包裹起來(lái)，同時(shí)SNAG還能完成空中抓取。此種設(shè)計(jì)解決了旋翼無(wú)人機(jī)長(zhǎng)期以來(lái)受續(xù)航時(shí)間所困的情形，同時(shí)也顯示了其在野外搜索及援救等領(lǐng)域的巨大應(yīng)用潛力。該課題組自2013年起通過(guò)與美國(guó)賓夕法尼亞大學(xué)的Kumar課題組合作，一直為旋翼無(wú)人機(jī)研制仿生手爪，通過(guò)仿壁虎定向粘附實(shí)現(xiàn)了貼附動(dòng)作的動(dòng)能吸收使機(jī)器人可以在物體表面安全粘附[96]，并建立粘附動(dòng)力學(xué)模型，測(cè)試了在不同摩擦系數(shù)表面的粘附結(jié)果[97-98]，此后在粘附的基礎(chǔ)上又實(shí)現(xiàn)了爬墻操作[99]。

通過(guò)以上調(diào)研可以看出，國(guó)內(nèi)外在作業(yè)型旋翼無(wú)人機(jī)的抓持作業(yè)中對(duì)作業(yè)裝置的機(jī)械結(jié)構(gòu)設(shè)計(jì)、整體系統(tǒng)動(dòng)力學(xué)建模等領(lǐng)域已開(kāi)展多項(xiàng)研究。抓持作業(yè)具備效率高、可輔助或代替人類(lèi)進(jìn)行工作甚至可模仿生物行為等巨大潛力。但是，多數(shù)研究?jī)A向于從控制算法、軌跡規(guī)劃等領(lǐng)域來(lái)保證飛行品質(zhì)與操作精度，對(duì)抓持/釋放瞬間交互對(duì)象對(duì)整體系統(tǒng)造成的沖擊效應(yīng)忽略不計(jì)，這導(dǎo)致整體系統(tǒng)的建模缺乏精確模型支撐。

5 總結(jié)與展望

作業(yè)型旋翼無(wú)人機(jī)擴(kuò)展了旋翼無(wú)人機(jī)的功能和應(yīng)用，本文進(jìn)行了作業(yè)型旋翼無(wú)人機(jī)動(dòng)力學(xué)建模領(lǐng)域的文獻(xiàn)回顧，從多體系統(tǒng)動(dòng)力學(xué)約束概念的角度將交互作業(yè)模式劃分為接觸、吊掛、抓持三類(lèi)并進(jìn)行詳細(xì)說(shuō)明。針對(duì)國(guó)內(nèi)外近10年在該領(lǐng)域的研究，首先給出每種交互作業(yè)模式的通用性動(dòng)力學(xué)建模方法，此后對(duì)該領(lǐng)域的研究現(xiàn)狀進(jìn)行介紹。從以上調(diào)研中不難看出，隨著任務(wù)需求與作業(yè)環(huán)境的愈加復(fù)雜，作業(yè)型旋翼無(wú)人機(jī)在交互作業(yè)過(guò)程中的動(dòng)力學(xué)建模研究還存在一些亟待解決的問(wèn)題。

1) 首先，作業(yè)型旋翼無(wú)人機(jī)是一個(gè)具有強(qiáng)欠驅(qū)動(dòng)性的系統(tǒng)。無(wú)論螺旋槳的數(shù)量是多少，由于單向升力的作用，其在2個(gè)自由度下的平移運(yùn)動(dòng)都為欠驅(qū)動(dòng)[100]，這等同于對(duì)系統(tǒng)的運(yùn)動(dòng)施加了兩個(gè)二階非完整約束且減少了獨(dú)立可控自由度的數(shù)量；其次，基于動(dòng)力學(xué)模型的控制方法可以實(shí)現(xiàn)高性能的精確控制，因此對(duì)于動(dòng)力學(xué)建模過(guò)程中所考慮的因素在完整準(zhǔn)確的同時(shí)還需考慮整體系統(tǒng)的完整耦合非線(xiàn)性動(dòng)力學(xué)模型，由于計(jì)算過(guò)程復(fù)雜，實(shí)時(shí)實(shí)現(xiàn)此種控制算法十分困難。

2) 對(duì)于接觸作業(yè)，作業(yè)型旋翼無(wú)人機(jī)會(huì)受到來(lái)自環(huán)境的擾動(dòng)，從而表現(xiàn)出與未發(fā)生接觸時(shí)相異的動(dòng)力學(xué)模型，同時(shí)接觸碰撞效應(yīng)可能會(huì)破壞整體系統(tǒng)的穩(wěn)定性甚至發(fā)生墜機(jī)事故，此外需在動(dòng)力學(xué)建模中考慮整體系統(tǒng)從無(wú)接觸到發(fā)生接觸的過(guò)渡環(huán)節(jié)的處理。

在定點(diǎn)接觸中，通常需要約束末端執(zhí)行器的位置并控制接觸力的強(qiáng)度和方向[101]。若末端執(zhí)行器可自由移動(dòng)，則需確保在作業(yè)任務(wù)中有足夠的法向力施加于交互對(duì)象以保證末端執(zhí)行器與交互表面能夠持續(xù)接觸；并保持摩擦錐中的相互作用力，否則末端執(zhí)行器可能發(fā)生打滑。在拉/推任務(wù)中，因交互對(duì)象在空間中是移動(dòng)的，還需考慮交互對(duì)象的運(yùn)動(dòng)學(xué)和動(dòng)力學(xué)約束。在滑動(dòng)接觸任務(wù)中，必須考慮如何控制末端執(zhí)行器的靜態(tài)和動(dòng)態(tài)摩擦以避免發(fā)生打滑并使末端執(zhí)行器沿所需軌跡移動(dòng)。

3) 對(duì)于吊掛作業(yè)，吊掛系統(tǒng)通常會(huì)為旋翼無(wú)人機(jī)本體帶來(lái)強(qiáng)烈的動(dòng)力學(xué)耦合效應(yīng)，而動(dòng)力學(xué)耦合建模需基于整體系統(tǒng)的動(dòng)力學(xué)建模。此前多數(shù)研究成果采用系統(tǒng)辨識(shí)的建模方法基于大量實(shí)驗(yàn)數(shù)據(jù)提取等價(jià)數(shù)學(xué)模型來(lái)對(duì)整體系統(tǒng)進(jìn)行分析，此種方法具有較強(qiáng)的不確定性并缺乏可靠的理論依據(jù)。因此，對(duì)于吊掛作業(yè)的動(dòng)力學(xué)研究應(yīng)從動(dòng)力學(xué)原理出發(fā)，通過(guò)對(duì)系統(tǒng)各機(jī)械結(jié)構(gòu)的分析建立動(dòng)力學(xué)理論模型，并對(duì)動(dòng)力學(xué)模型進(jìn)行合理簡(jiǎn)化與處理，得到具有明確物理意義的關(guān)于旋翼無(wú)人機(jī)本體與吊掛系統(tǒng)的解耦動(dòng)力學(xué)模型。因此，研究旋翼無(wú)人機(jī)與吊掛系統(tǒng)的耦合動(dòng)力學(xué)建模對(duì)改善吊掛作業(yè)安全具有重要意義。

4) 對(duì)于抓持作業(yè)，在抓持/釋放瞬間作業(yè)裝置的末端執(zhí)行器與物體之間同樣存在著接觸碰撞效應(yīng)，但現(xiàn)階段多數(shù)研究成果通常將其忽略不計(jì)，或采用智能控制算法規(guī)避交互作業(yè)過(guò)程中物體給旋翼無(wú)人機(jī)帶來(lái)的瞬時(shí)沖擊效應(yīng)，因此并未進(jìn)行精確計(jì)算與評(píng)估。此外，通常把旋翼無(wú)人機(jī)和作業(yè)裝置拆分開(kāi)，只對(duì)旋翼無(wú)人機(jī)本體進(jìn)行運(yùn)動(dòng)控制，將抓取物體看作擾動(dòng)，這種方法基于過(guò)多理想化的假設(shè)，同樣存在著影響旋翼無(wú)人機(jī)的飛行品質(zhì)或抓持精度不高等問(wèn)題。要想實(shí)現(xiàn)精確抓取就要準(zhǔn)確分析抓持作業(yè)全過(guò)程給整體系統(tǒng)帶來(lái)的擾動(dòng)，建立抓持作業(yè)全過(guò)程的系統(tǒng)動(dòng)力學(xué)模型對(duì)后續(xù)的飛行控制效果具有重要意義。

綜上所述，作業(yè)裝置的加入為旋翼無(wú)人機(jī)提供了巨大的物理交互能力。然而，到目前為止所做的大多數(shù)實(shí)驗(yàn)工作都是在結(jié)構(gòu)化的室內(nèi)環(huán)境中進(jìn)行的。為提高作業(yè)型旋翼無(wú)人機(jī)的操作精度和穩(wěn)定性并將其應(yīng)用于戶(hù)外實(shí)驗(yàn)中，所面臨的挑戰(zhàn)還在于戶(hù)外條件的不確定性(如陣風(fēng)、地形等)影響因素，這些因素都會(huì)極大地影響旋翼無(wú)人機(jī)的性能。在動(dòng)力學(xué)建模中計(jì)及這些干擾因素，在此基礎(chǔ)上采用合適的數(shù)值分析處理方法對(duì)所建立的動(dòng)力學(xué)模型進(jìn)行后處理，得到簡(jiǎn)潔準(zhǔn)確且具有良好控制效果的動(dòng)力學(xué)模型具有重要價(jià)值。

同時(shí)，作業(yè)型旋翼無(wú)人機(jī)的動(dòng)力學(xué)建模技術(shù)仍處于發(fā)展階段。在整個(gè)作業(yè)過(guò)程中，無(wú)人機(jī)系統(tǒng)動(dòng)力學(xué)模型將會(huì)發(fā)生多次顯著突變，這在多體系統(tǒng)動(dòng)力學(xué)領(lǐng)域被稱(chēng)為“非連續(xù)過(guò)程動(dòng)力學(xué)”[102]。此外，為使動(dòng)力學(xué)模型具有通用性，還可采用拓?fù)浞椒▉?lái)描述多剛體間全過(guò)程的相對(duì)構(gòu)型[103-105]。因此，全過(guò)程各階段的動(dòng)力學(xué)模型合理切換問(wèn)題還需繼續(xù)探索。

最后，作業(yè)型旋翼無(wú)人機(jī)動(dòng)力學(xué)建模研究機(jī)遇與挑戰(zhàn)兼具。一方面，作業(yè)型旋翼無(wú)人機(jī)具有作業(yè)能力強(qiáng)、可達(dá)區(qū)域范圍廣、可代替人類(lèi)進(jìn)入危險(xiǎn)區(qū)域高效完成任務(wù)等諸多優(yōu)點(diǎn)，其所適應(yīng)的環(huán)境和所能完成的交互作業(yè)模式越來(lái)越多，這引起了不同領(lǐng)域?qū)W者的關(guān)注與研究，有力促進(jìn)了動(dòng)力學(xué)建模技術(shù)的進(jìn)步；另一方面，作業(yè)型旋翼無(wú)人機(jī)系統(tǒng)在交互作業(yè)過(guò)程中所受到的干擾與約束類(lèi)型呈現(xiàn)出越來(lái)越復(fù)雜的特征，旋翼無(wú)人機(jī)飛行模式下動(dòng)力學(xué)模型的非線(xiàn)性、欠驅(qū)動(dòng)、強(qiáng)耦合等特性也在加入作業(yè)裝置后進(jìn)一步加強(qiáng)，這同時(shí)極大增加了作業(yè)型旋翼無(wú)人機(jī)系統(tǒng)發(fā)生碰撞事故或姿態(tài)失穩(wěn)的可能性，給高效精確完成交互作業(yè)任務(wù)帶來(lái)了難度與挑戰(zhàn)。