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

        ?

        基于五次多項(xiàng)式的四足機(jī)器人軌跡規(guī)劃

        2021-04-02 07:02:24田俊郟云濤劉銘
        關(guān)鍵詞:足端單腿步態(tài)

        田俊,郟云濤,劉銘

        (200093 上海市 上海理工大學(xué))

        0 引言

        哺乳類動(dòng)物在經(jīng)過(guò)數(shù)萬(wàn)年的自然選擇和進(jìn)化過(guò)程中,已經(jīng)誕生了最優(yōu)的骨骼形態(tài)和最佳的運(yùn)動(dòng)性能。模仿動(dòng)物的骨骼形態(tài)來(lái)制造機(jī)器人從而達(dá)到良好的運(yùn)動(dòng)目標(biāo)則是現(xiàn)在很多科技領(lǐng)域研究的熱點(diǎn)。相比較雙足機(jī)器人而言,四足機(jī)器人比雙足機(jī)器人容易控制、更穩(wěn)定以及有更好的適應(yīng)性;相比六足機(jī)器人而言,四足機(jī)器人結(jié)構(gòu)更加簡(jiǎn)單,成本更低[2-4]。目前仿生領(lǐng)域研究四足機(jī)器人是焦點(diǎn)。美國(guó)一家高科技公司的BigDog 是真正讓四足機(jī)器人走入大眾視野的四足機(jī)器人,也激發(fā)了全球研究仿生機(jī)器人的浪潮[1]。國(guó)內(nèi)近些年也涌現(xiàn)出很多優(yōu)秀的四足機(jī)器人,例如山東大學(xué)的SCalf 四足機(jī)器人、浙江大學(xué)的“絕影”等等都是國(guó)內(nèi)的仿生機(jī)器人領(lǐng)頭羊。

        為達(dá)到四足機(jī)器人平穩(wěn)行走的目的,本文提出一種基于五次多項(xiàng)式的四足機(jī)器人walk 軌跡規(guī)劃方法,只對(duì)walk 步態(tài)進(jìn)行軌跡規(guī)劃,也就是對(duì)靜步態(tài)進(jìn)行軌跡規(guī)劃,主要原因是walk 步態(tài)行走時(shí),穩(wěn)定性好于受單純軌跡規(guī)劃對(duì)步態(tài)穩(wěn)定性影響較大的trot 步態(tài)[6]。

        1 四足機(jī)器人模型及參數(shù)

        本文搭建的四足機(jī)器人拓?fù)浣Y(jié)構(gòu)為前肘后膝式,由液壓驅(qū)動(dòng),4 條腿完全相同,前后對(duì)稱,用SolidWorks 創(chuàng)建四足機(jī)器人的三維模型。三維結(jié)構(gòu)圖如圖1 所示。

        四足機(jī)器人是通過(guò)液壓缸驅(qū)動(dòng)關(guān)節(jié)進(jìn)行運(yùn)動(dòng),因此可以將腿部看做是開鏈?zhǔn)浇Y(jié)構(gòu),軀干看做是基座,從而通過(guò)運(yùn)動(dòng)學(xué)分析來(lái)規(guī)劃腿的運(yùn)動(dòng)。機(jī)器人腿部有3 個(gè)自由度,采用D-H 法對(duì)四足機(jī)器人進(jìn)行建模,如圖2 所示。ω代表機(jī)器人的坐標(biāo)系,給4 條腿編號(hào)分別是RF,RB,LF,LB,分別代表右前、右后、左前和左后腿。下面將對(duì)右前腿進(jìn)行分析。

        圖1 四足機(jī)器人三維結(jié)構(gòu)圖Fig.1 Three-dimensional structure diagram of quadruped robot

        圖2 中,L1,L2,L3代表側(cè)擺、大腿、小腿的等效長(zhǎng)度;θ1,θ2,θ3代表側(cè)擺關(guān)節(jié)、髖關(guān)節(jié)和膝關(guān)節(jié)的角度。單腿的D-H 參數(shù)可根據(jù)圖2 四足機(jī)器人單腿運(yùn)動(dòng)學(xué)模型得到,詳細(xì)參數(shù)見(jiàn)表1。

        圖2 四足機(jī)器人單腿運(yùn)動(dòng)學(xué)模型Fig.2 Single-leg kinematics model of quadruped robot

        表1 四足機(jī)器人單腿D-H 參數(shù)Tab.1 Quadruped robot single-leg D-H parameters

        將表1 的參數(shù)代入D-H 參數(shù)變換矩陣,對(duì)每個(gè)參數(shù)進(jìn)行轉(zhuǎn)換,得到下列的變換矩陣:

        三角函數(shù)簡(jiǎn)化標(biāo)記,再由描述連桿位置和姿態(tài)的變換矩陣Tn,可得足端以機(jī)體坐標(biāo)系表示的變換矩陣如下:

        由此我們可以得出足端相對(duì)機(jī)體坐標(biāo)系的坐標(biāo)P3,即為機(jī)器人的正運(yùn)動(dòng)學(xué)求解。

        對(duì)正運(yùn)動(dòng)學(xué)方程求逆解可得逆運(yùn)動(dòng)學(xué)方程,即可以用機(jī)器人足端位置得到各個(gè)關(guān)節(jié)的角度。

        這里只求出RF 即右前腿的運(yùn)動(dòng)學(xué),用同樣的方法可以求出剩下3 條腿的運(yùn)動(dòng)學(xué)方程。

        2 軌跡規(guī)劃

        2.1 步態(tài)規(guī)劃

        四足機(jī)器人步態(tài)分為動(dòng)步態(tài)以及靜步態(tài),兩者區(qū)別就是,當(dāng)任何時(shí)刻支撐腿數(shù)量小于3條,則是動(dòng)步態(tài);反之,則為靜步態(tài)[9]。本文主要研究的是靜步態(tài)即walk 步態(tài),采用的步態(tài)順序?yàn)長(zhǎng)F、RB、RF、LB 即左前、右后、右前以及左后。這種步態(tài)的優(yōu)勢(shì)就是在不受外力的影響下四足機(jī)器人的重心永遠(yuǎn)落在四足機(jī)器人4 個(gè)地面支撐點(diǎn)組成的多邊形中,這樣可以實(shí)現(xiàn)機(jī)器人穩(wěn)定行走。

        2.2 軌跡規(guī)劃

        為了達(dá)到使四足機(jī)器人穩(wěn)定連續(xù)行走的目的,本文規(guī)劃一種基于五次多項(xiàng)式的零沖擊足端軌跡[5]。先列出足端軌跡約束方程,設(shè)X 方向?yàn)樗椒较?,Y方向?yàn)樨Q直方向,根據(jù)足端位置要求,位移、速度和加速度方程如下:

        根據(jù)上面得出的四足機(jī)器人擺動(dòng)相和支撐相軌跡方程,利用MATLAB 編程仿出軌跡曲線如圖3 所示。

        圖3 四足機(jī)器人足端軌跡曲線圖Fig.3 Trajectory curve of foot end of a quadruped robot

        3 仿真驗(yàn)證

        通過(guò)上面部分得出MATLAB 仿真的軌跡圖,為了驗(yàn)證算法的正確性,需要通過(guò)虛擬樣機(jī)軟件進(jìn)行仿真驗(yàn)證,本文利用ADAMS 軟件進(jìn)行仿真驗(yàn)證[7]。

        先進(jìn)行四足機(jī)器人結(jié)構(gòu)參數(shù)設(shè)置。表2 為四足機(jī)器人結(jié)構(gòu)參數(shù)表。

        表2 四足機(jī)器人結(jié)構(gòu)參數(shù)Tab.2 Structural parameters of quadruped robot

        通過(guò)上文的軌跡規(guī)劃,得到四足機(jī)器人的足端軌跡,再通過(guò)對(duì)軌跡方程求逆,得到各關(guān)節(jié)的角度,從而驅(qū)動(dòng)關(guān)節(jié)的運(yùn)動(dòng)。一個(gè)周期內(nèi)的仿真截圖如圖4 所示。從仿真結(jié)果來(lái)看,該條軌跡行走時(shí)穩(wěn)定連續(xù),符合我們的要求。大腿和小腿關(guān)節(jié)力矩圖如圖5 所示。

        圖4 四足機(jī)器人行走仿真截圖Fig.4 Quadruped robot walking simulation screenshot

        圖5 大腿和小腿關(guān)節(jié)力矩圖Fig.5 Thigh and calf joint torque diagram

        4 結(jié)論

        為實(shí)現(xiàn)四足機(jī)器人穩(wěn)定、連續(xù)行走,本文先用D-H 算法推導(dǎo)單腿的運(yùn)動(dòng)學(xué)方程,然后采用五次多項(xiàng)式進(jìn)行擺動(dòng)相和支撐相的足端軌跡規(guī)劃,并利用ADAMS 進(jìn)行樣機(jī)仿真分析,仿真結(jié)果驗(yàn)證了四足機(jī)器人可以通過(guò)該軌跡規(guī)劃方法進(jìn)行穩(wěn)定行走。

        猜你喜歡
        足端單腿步態(tài)
        小螞蟻與“三角步態(tài)”
        四足機(jī)器人足端復(fù)合軌跡運(yùn)動(dòng)特性研究*
        基于高階多項(xiàng)式的爬游機(jī)器人足端軌跡規(guī)劃
        四足機(jī)器人足端運(yùn)動(dòng)空間分析與軌跡規(guī)劃
        四足步行機(jī)動(dòng)平臺(tái)半圓柱形足端偏差分析
        基于面部和步態(tài)識(shí)別的兒童走失尋回系統(tǒng)
        電子制作(2018年18期)2018-11-14 01:48:04
        基于Kinect的學(xué)步期幼兒自然步態(tài)提取
        單腿蹦還是齊步走——淺談直銷產(chǎn)品導(dǎo)向和事業(yè)導(dǎo)向
        火烈鳥單腿站立更『節(jié)能』
        火烈鳥單腿站立更“節(jié)能”
        宅宅午夜无码一区二区三区| 天天夜碰日日摸日日澡| 人妻少妇av无码一区二区| 中文字幕亚洲好看有码| av免费在线播放一区二区| 色欲av永久无码精品无码蜜桃| 亚洲日韩成人av无码网站| 亚洲国产麻豆综合一区| 国产日韩乱码精品一区二区| 日韩女优av一区二区| 国产精品无码午夜福利| 亚洲国产一区在线二区三区| 亚洲综合天堂一二三区| 蜜桃视频免费进入观看| 亚洲成av人片一区二区| 国产人成亚洲第一网站在线播放| 日韩精品视频中文字幕播放| 欧洲美熟女乱av亚洲一区| 中国a级毛片免费观看| 一区二区三区福利在线视频| 国家一级内射高清视频| 真实国产乱子伦精品视频| 女同久久精品国产99国产精品 | 中文字幕亚洲综合久久综合| 一本色道久久88精品综合| 成人a在线观看| 一本色道久久88综合亚精品| 中文字幕一区二区三区四区五区| 亚洲成av人片在线观看无码| 亚洲九九夜夜| 99精品国产综合久久麻豆| 九色九九九老阿姨| 国产AV无码一区精品天堂| 日产一区一区三区区别| 欧美性猛交xxxx免费看蜜桃| 午夜亚洲www湿好大| 三级黄色片一区二区三区| 精品人妻一区二区三区久久| 欲色天天网综合久久| 欧美在线观看www| 国产一区二区三区在线大屁股 |