資料介紹
引言近年來各類軍用機(jī)器人在國防領(lǐng)域和地緣戰(zhàn)略中發(fā)揮著重要的作用。在我國廣大西部地區(qū),由于地形復(fù)雜、道路崎嶇,傳統(tǒng)的輪式或履帶式機(jī)器人無法滿足地形通過性要求,而仿生四足機(jī)器人能夠較好地滿足在非結(jié)構(gòu)化地形條件下可靠行進(jìn)的任務(wù)需求。液壓驅(qū)動的仿生四足機(jī)器人是近年國內(nèi)外的研究熱點(diǎn)與主攻項目,在其關(guān)鍵技術(shù)群中,電液伺服控制技術(shù)則是保障仿生液壓四足機(jī)器人實現(xiàn)穩(wěn)定行進(jìn)功能的核心技術(shù)。1總體設(shè)計1.1控制對象分析本文依托北京理工大學(xué)特種機(jī)器人技術(shù)創(chuàng)新中心正在研發(fā)的一款仿生液壓四足機(jī)器人展開研究,機(jī)器人每條腿具有3個主動自由度和1個被動自由度,分別為髖側(cè)擺關(guān)節(jié)、髖正擺關(guān)節(jié)、膝關(guān)節(jié)和足部二階彈簧減震器,全部12個主動關(guān)節(jié)均由液壓缸驅(qū)動。機(jī)器人的結(jié)構(gòu)尺寸長為120 cm,寬為50 cm,大腿腿節(jié)桿件等效長度(髖關(guān)節(jié)軸到膝關(guān)節(jié)軸距離)為40cm,小腿腿節(jié)桿件等效長度(膝關(guān)節(jié)軸到足端包絡(luò)圓心距離)為40 cm。在未集成機(jī)載液壓油源的實驗條件下自重118.5 kg。四足仿生機(jī)器人整體結(jié)構(gòu)如圖1所示。圖1 四足仿生機(jī)器人整體結(jié)構(gòu)1.2系統(tǒng)架構(gòu)設(shè)計綜合考慮伺服控制任務(wù)可以發(fā)現(xiàn),系統(tǒng)性能要求有若干矛盾,如多通道并行伺服控制和單一通道伺服控制精度的時間資源沖突以及多輸入/輸出接口設(shè)計的硬件資源沖突。使用單一控制器的集中式控制系統(tǒng)很難在時間資源與硬件資源的分配上實現(xiàn)平衡,從而無法達(dá)到任務(wù)指標(biāo)要求?;谏鲜瞿繕?biāo),本系統(tǒng)采用一種分布式系統(tǒng)架構(gòu)進(jìn)行電液伺服控制系統(tǒng)的設(shè)計工作。本系統(tǒng)在運(yùn)動控制器下設(shè)計4個伺服控制器,如圖2所示,并通過伺服總線連接構(gòu)成分布式電液伺服控制系統(tǒng)。圖2 電液伺服控制系統(tǒng)結(jié)構(gòu)框圖4個伺服控制器分別負(fù)責(zé)機(jī)器人一條腿上3個液壓伺服單元的伺服控制。通過分布式系統(tǒng)架構(gòu)設(shè)計,一方面,拆分簡化了控制任務(wù),使得單個控制器的任務(wù)時序更加具有規(guī)律性,提高了軟件系統(tǒng)的穩(wěn)定性;另一方面實現(xiàn)了控制系統(tǒng)和機(jī)械結(jié)構(gòu)相對應(yīng)的模塊化設(shè)計。該設(shè)計兼顧了系統(tǒng)任務(wù)中對精度和實時性的要求。2伺服總線接口設(shè)計伺服總線接口是位于運(yùn)動控制器與4個伺服控制器之間的總線接口,負(fù)責(zé)傳遞下行的各液壓伺服單元伺服指令和反饋上行的各液壓伺服單元工作狀態(tài),需要具備網(wǎng)絡(luò)特性。常用的總線主要包括RS422/485串行通信總線、以太網(wǎng)、I2C總線、SPI總線和CAN總線。CAN總線拓?fù)浣Y(jié)構(gòu)靈活多變,無主從特性。網(wǎng)絡(luò)上任何一個處于工作狀態(tài)的節(jié)點(diǎn)都可以隨時發(fā)送數(shù)據(jù),實現(xiàn)點(diǎn)對點(diǎn)、點(diǎn)對多的數(shù)據(jù)傳輸。采用非破壞性仲裁技術(shù),郵箱和ID決定了節(jié)點(diǎn)數(shù)據(jù)的優(yōu)先級,ID越小,優(yōu)先級越高。采用短幀結(jié)構(gòu)傳輸時,每幀8個有效字節(jié),傳輸時間短,抗干擾能力強(qiáng)[1]。本設(shè)計選擇CAN總線作為系統(tǒng)的伺服總線,拓?fù)浣Y(jié)構(gòu)如圖3所示。圖3 CAN總線結(jié)構(gòu)簡圖伺服總線更新頻率為200 Hz,伺服指令幀長度為每軸6字節(jié),可以使用CAN協(xié)議設(shè)計單幀伺服指令,單周期指令總長為72字節(jié),每周期吞吐量計算如下所示:156bpf×12f×200 Hz=374.4 kbps(1)其中,bpf是位每幀,f為幀,可計算得總線波特率為374.4 kbps,CAN總線在40 m內(nèi)通信波特率可達(dá)1 Mbps,能夠滿足總線通信速率要求??紤]到伺服指令的高實時性要求,需要考慮避免反饋信息數(shù)據(jù)包占用總線影響數(shù)據(jù)時效性的問題,因此在設(shè)計時使用雙線設(shè)計,CAN1只用于運(yùn)動控制器對伺服控制器下發(fā)指令數(shù)據(jù)包,CAN2用于伺服控制向運(yùn)動控制器返回傳感反饋信息。CAN收發(fā)器電路原理圖如圖4所示。圖4 CAN收發(fā)器電路原理圖選擇SN65HVD232 CAN總線收發(fā)器。圖4中R1為CAN總線的端負(fù)載電阻,按照伺服控制器所處總線位置決定是否短接跳線JP1。當(dāng)對應(yīng)伺服控制器位于總線端點(diǎn)時,為了防止信號反射,短接跳線JP1,將端接負(fù)載電阻傳入差分信號環(huán)路,抑制信號反射干擾。CAN總線控制器使用STM32F4系列MCU的片內(nèi)外設(shè)bxCAN,兩個bxCAN外設(shè)分別控制指令總線和傳感反饋總線。伺服控制器總線驅(qū)動設(shè)計如圖5所示。圖5 伺服總線驅(qū)動流程圖3伺服閥控制接口設(shè)計常用的輸出級設(shè)計包括模擬直驅(qū)、DAC功率放大半數(shù)字驅(qū)動、數(shù)字功率驅(qū)動[2]。本文使用PWM驅(qū)動MOSFET全橋的方式實現(xiàn)數(shù)字功率驅(qū)動,使用MOSFET SI4405P和SI4404N搭建功率驅(qū)動全橋。使用STM32F405內(nèi)部定時器產(chǎn)生互補(bǔ)PWM驅(qū)動對應(yīng)橋臂,這種控制方式首先實現(xiàn)了直接的數(shù)字控制,沒有使用模擬器件;其次使用單電源供電實現(xiàn)雙極性控制,簡化了電源和電路設(shè)計,并且可以通過對PWM載波頻率的調(diào)整,來實現(xiàn)伺服閥驅(qū)動信號中顫振信號的疊加[3]。4傳感反饋接口設(shè)計機(jī)器人液壓驅(qū)動單元使用的位置傳感器和壓力傳感器均使用電壓信號輸出形式 ,STM32F405集成有2個16通道的12位高性能內(nèi)部ADC,單通道采樣頻率可達(dá)2.4 Msps,6通道輪詢采樣最快可保證每通道400 ksps,可以滿足1 kHz伺服頻率以及精度要求,因此本設(shè)計不使用獨(dú)立的外部ADC,直接使用內(nèi)部外設(shè)。傳感器輸出信號為0~10 V,調(diào)理電路如圖6所示。圖6無源增益?zhèn)鞲行盘栒{(diào)理電路原理圖圖6 功率全橋PWM驅(qū)動調(diào)試電路原理ADC使用STM32F405內(nèi)部外設(shè),單通道采樣頻率設(shè)置為16 ksps,通過DMA寫入16字節(jié)滾筒緩存,進(jìn)行數(shù)字濾波。軟件流程如圖7所示。圖7 傳感反饋接口驅(qū)動設(shè)計5伺服總線指令協(xié)議設(shè)計配置CAN總線通信ID為標(biāo)準(zhǔn)11位ID。通過對11位ID的配置,設(shè)計伺服指令I(lǐng)D格式如下所示。ID0、ID1位為伺服控制器編號編碼位,按照左前腿0號、右前腿1號、左后腿2號、右后腿3號的順序進(jìn)行編碼。ID2、ID3位為關(guān)節(jié)編號編碼位,對單腿自上而下的髖側(cè)擺、髖正擺和膝關(guān)節(jié)分別編碼為0、1和2。具體編碼如表1所列。ID5~9位用于指令編碼,因為伺服總線和反饋總線相互獨(dú)立,所以對伺服控制和狀態(tài)反饋分別進(jìn)行設(shè)計。ID4位為廣播標(biāo)志位,該位置為1時,對應(yīng)指令以廣播的形式發(fā)給每個通道。ID10位為伺服總線的讀寫標(biāo)志位,該位置為0時,控制指令代表對相應(yīng)控制量的讀指令,伺服控制器通過CAN2發(fā)出回包數(shù)據(jù)。5.1伺服控制總線指令協(xié)議伺服控制指令由運(yùn)動控制器通過CAN1下發(fā),按照CAN總線對ID的響應(yīng)機(jī)制進(jìn)行設(shè)計,高優(yōu)先級指令控制字較小,總線仲裁優(yōu)先級較高。設(shè)計的控制指令略——編者注。5.2狀態(tài)反饋總線指令協(xié)議狀態(tài)反饋指令用于通過CAN2反饋?zhàn)詸z信息和回傳工作狀態(tài)略——編者注。6非對稱前饋補(bǔ)償模糊自適應(yīng)PID算法設(shè)計仿生液壓四足機(jī)器人的運(yùn)動由液壓執(zhí)行機(jī)構(gòu)系統(tǒng)驅(qū)動,而機(jī)器人自身具有負(fù)載可變、環(huán)境時變的特點(diǎn),因此控制對象是一個非線性、參數(shù)時變的系統(tǒng)。模糊PID控制在這種系統(tǒng)控制方面有很大優(yōu)勢,可提高控制性能[5]。為了降低模糊控制器的復(fù)雜度,本系統(tǒng)使用了一種誤差分段智能控制算法,其控制方案的原理如圖8所示。圖中的辨識開關(guān)通過判斷誤差閾值,選擇BangBang控制或模糊自適應(yīng)PID控制。當(dāng)誤差大于設(shè)定閾值時,進(jìn)行BangBang控制;當(dāng)誤差小于設(shè)定閾值時,進(jìn)行模糊自適應(yīng)PID控制。模糊推理專家?guī)斓膮?shù)通過自整定系統(tǒng)在調(diào)試模式獲取[6]。圖8非對稱前饋補(bǔ)償模糊自適應(yīng)PID控制器結(jié)構(gòu)圖針對液壓控制系統(tǒng)的非對稱性和滯環(huán)特性,在以上控制器設(shè)計基礎(chǔ)上加入速度和加速度前饋控制參數(shù),以補(bǔ)償系統(tǒng)的滯環(huán),提高響應(yīng)速度。通過對兩個運(yùn)動方向設(shè)置不同的前饋參數(shù),實現(xiàn)對有桿腔和無桿腔運(yùn)動方向的非對稱補(bǔ)償。具體的實現(xiàn)方式是,由一個方向判斷開關(guān)來選擇兩個運(yùn)動方向的補(bǔ)償參數(shù),從而實現(xiàn)控制,同時,液壓缸控制參數(shù)的非對稱性在模糊策略表中體現(xiàn)。7實驗將液壓缸一端固定在實驗平臺上,另一端空載或者串聯(lián)10 kg負(fù)載,使用具有功率冗余的21 MPa大功率外油源供油。7.1正弦位置控制實驗對于85 mm行程液壓伺服系統(tǒng),輸入20 mm幅值、4.5 Hz正弦波激勵所獲得的響應(yīng)結(jié)果略——編者注。其表現(xiàn)了性能對稱、位置速度跟蹤情況良好的伺服控制效果。7.2階躍響應(yīng)實驗對膝關(guān)節(jié)100 mm行程液壓伺服系統(tǒng)施加幅值30 mm的方波激勵,實現(xiàn)正反雙向60 mm行程的階躍信號。能在三次震蕩之內(nèi)達(dá)到0.01mm的穩(wěn)態(tài)誤差,實驗響應(yīng)曲線略——編者注。記錄實驗數(shù)據(jù)表略——編者注。結(jié)語本文基于STM32F405設(shè)計了分布式電液伺服控制架構(gòu),使用CAN總線搭建了伺服總線,并對電液伺服輸入和輸出接口進(jìn)行了有針對性的設(shè)計,引入了具有非對稱前饋補(bǔ)償?shù)哪:赃m應(yīng)控制算法。經(jīng)過實驗檢驗,控制器伺服控制水平滿足性能指標(biāo)要求,達(dá)到了良好的控制效果。(mbbeetchina)
下載該資料的人也在下載
下載該資料的人還在閱讀
更多 >
- 六足仿生巡檢機(jī)器人的設(shè)計方案 43次下載
- 六足機(jī)器人SolidWorks的模型資料合集免費(fèi)下載 47次下載
- 如何實現(xiàn)雙足步行機(jī)器人系統(tǒng)設(shè)計與運(yùn)動控制及虛擬現(xiàn)實的仿真研究 20次下載
- 雙足機(jī)器人遠(yuǎn)程體感控制系統(tǒng)的研究 28次下載
- 平面液壓雙足機(jī)器人步態(tài)規(guī)劃及阻抗控制研究說明 15次下載
- 基于ZMP的雙足機(jī)器人動態(tài)步行控制研究 31次下載
- 四足機(jī)器人仿生關(guān)節(jié)的研究現(xiàn)狀詳細(xì)概述 8次下載
- 四足仿生機(jī)器人控制理論的發(fā)展詳細(xì)概述 0次下載
- 使用51單片機(jī)設(shè)計六足仿生機(jī)器人的詳細(xì)資料說明
- 基于ADAMS的四足仿生機(jī)器人單腿結(jié)構(gòu)設(shè)計 3次下載
- 仿生四足機(jī)器人設(shè)計及運(yùn)動學(xué)足端受力分析 2次下載
- 新型仿生六足機(jī)器人步行足運(yùn)動學(xué)分析與研究 25次下載
- 液壓驅(qū)動四足機(jī)器人運(yùn)動控制方法研究 0次下載
- 四足機(jī)器人測試視頻下載 130次下載
- 基于SOPC的機(jī)器人伺服控制器的研究 55次下載
- 在NVIDIA Isaac Lab中訓(xùn)練四足機(jī)器人運(yùn)動 124次閱讀
- 如何使用PLC控制機(jī)器人 795次閱讀
- 一文了解機(jī)器人伺服系統(tǒng) 845次閱讀
- 使用XR806聯(lián)調(diào)控制四足馬術(shù)機(jī)器人 707次閱讀
- 如何制作一個六足機(jī)器人 936次閱讀
- 基于LPC2114處理器實現(xiàn)人形機(jī)器人控制系統(tǒng)的設(shè)計 3335次閱讀
- dfrobotArcBotics 六足機(jī)器人套件簡介 1873次閱讀
- dfrobot32路舵機(jī)控制器安裝支架簡介 1268次閱讀
- 焊接機(jī)器人控制器的作用 6070次閱讀
- 機(jī)器人控制器有哪些類型_機(jī)器人控制器發(fā)展 1.1w次閱讀
- 關(guān)于工業(yè)機(jī)器人智能控制的四種控制方式 6336次閱讀
- 機(jī)器人視覺伺服系統(tǒng)技術(shù)的介紹及發(fā)展歷程的詳細(xì)資料說明 3700次閱讀
- 基于PLC的機(jī)器人伺服運(yùn)動控制系統(tǒng)設(shè)計詳解 1.5w次閱讀
- 如何提升機(jī)器人伺服電機(jī)的響應(yīng)性能 1944次閱讀
- 一種實用的機(jī)器人控制器力/位混合控制技術(shù) 5905次閱讀
下載排行
本周
- 1Keysight B1500A 半導(dǎo)體器件分析儀用戶手冊、說明書 (中文)
- 19.00 MB | 4次下載 | 免費(fèi)
- 204-01-02-CBM317線性穩(wěn)壓器(LDO)
- 2.01 MB | 2次下載 | 免費(fèi)
- 3BT134雙向可控硅手冊
- 1.74 MB | 2次下載 | 1 積分
- 4使用TL431設(shè)計電源
- 0.67 MB | 1次下載 | 免費(fèi)
- 5LabVIEW環(huán)形控件
- 0.01 MB | 1次下載 | 1 積分
- 651單片機(jī)核心板原理圖
- 0.12 MB | 1次下載 | 5 積分
- 7BP2879DB支持調(diào)光調(diào)滅的非隔離低 PF LED 驅(qū)動器
- 1.44 MB | 1次下載 | 免費(fèi)
- 8CBM1001A-Q
- 1.52 MB | 次下載 | 免費(fèi)
本月
- 1開關(guān)電源設(shè)計原理手冊
- 1.83 MB | 50次下載 | 免費(fèi)
- 2FS5080E 5V升壓充電兩串鋰電池充電管理IC中文手冊
- 8.45 MB | 23次下載 | 免費(fèi)
- 3DMT0660數(shù)字萬用表產(chǎn)品說明書
- 0.70 MB | 13次下載 | 免費(fèi)
- 4UC3842/3/4/5電源管理芯片中文手冊
- 1.75 MB | 12次下載 | 免費(fèi)
- 5ST7789V2單芯片控制器/驅(qū)動器英文手冊
- 3.07 MB | 11次下載 | 1 積分
- 6慧榮SM2263XT開卡軟件-B16_B17_FW_S0614B0_RDT_S0617A
- 3.03 MB | 10次下載 | 5 積分
- 7TPS54202H降壓轉(zhuǎn)換器評估模塊用戶指南
- 1.02MB | 8次下載 | 免費(fèi)
- 8STM32F101x8/STM32F101xB手冊
- 1.69 MB | 8次下載 | 1 積分
總榜
- 1matlab軟件下載入口
- 未知 | 935119次下載 | 10 積分
- 2開源硬件-PMP21529.1-4 開關(guān)降壓/升壓雙向直流/直流轉(zhuǎn)換器 PCB layout 設(shè)計
- 1.48MB | 420061次下載 | 10 積分
- 3Altium DXP2002下載入口
- 未知 | 233084次下載 | 10 積分
- 4電路仿真軟件multisim 10.0免費(fèi)下載
- 340992 | 191367次下載 | 10 積分
- 5十天學(xué)會AVR單片機(jī)與C語言視頻教程 下載
- 158M | 183335次下載 | 10 積分
- 6labview8.5下載
- 未知 | 81581次下載 | 10 積分
- 7Keil工具M(jìn)DK-Arm免費(fèi)下載
- 0.02 MB | 73807次下載 | 10 積分
- 8LabVIEW 8.6下載
- 未知 | 65987次下載 | 10 積分
評論
查看更多