自動(dòng)裝卸AGV小車設(shè)計(jì),自動(dòng)裝卸AGV小車設(shè)計(jì),自動(dòng),裝卸,agv,小車,設(shè)計(jì) 摘 要 本次畢業(yè)設(shè)計(jì)為解決當(dāng)下國內(nèi)外AGV小車價(jià)格高居不下及其并不適合基礎(chǔ)工業(yè)不完善的我國的問題，并且目前大部分AGV采用電磁或軌道引導(dǎo)，路線固定，局限性較大，不適用于柔性化制造系統(tǒng)。 為解決上述問題，在目前AGV的基礎(chǔ)上，創(chuàng)新性的使用機(jī)械手聯(lián)動(dòng)的的裝卸方式，避免了為了滿足各工況需求而覆蓋的各種移載機(jī)構(gòu)，驅(qū)動(dòng)模式和導(dǎo)引方式，降低了成本。同時(shí)又不同于AGC需要完善的基礎(chǔ)設(shè)施配合，三只靈巧機(jī)械手足夠完成裝卸工作，極大地發(fā)揮了AGV本身的自主性和工作容積。搭配四個(gè)麥克納姆輪極大地縮小了轉(zhuǎn)向半徑可在更狹小空間內(nèi)作業(yè)。同時(shí)仿照無人駕駛汽車運(yùn)行原理采用激光測距雷達(dá)配接近傳感器能夠滿足各種復(fù)雜路徑的使用要求，自動(dòng)化程度更高。同時(shí)定位精度主要由雷達(dá)的精度決定，便于用戶靈活調(diào)整型號(hào)以適應(yīng)場所并控制成本（定位精度為±10mm到±5mm）。 關(guān)鍵詞：AGV；工業(yè)機(jī)器人；物流搬運(yùn)；無人駕駛技術(shù) I ABSTRACT The graduation design in order to solve the present high prices for AGV car at home and abroad and is not suitable for basic industry is not perfect in our country, and at present most of the AGV by electromagnetic or track guide, fixed route, limitations, is not suitable for the flexible manufacturing system. To solve the above problems, on the basis of the AGV, the use of innovative way of loading and unloading manipulator linkage, avoided in order to meet the demand of working condition of the institution, and cover a variety of transfer of driving mode and direct way, reduce the cost. At the same time, it is different from the basic facilities that AGC needs to perfect, and the three dexterous manipulators are enough to complete the loading and unloading work, which greatly exerts the autonomy and working capacity of AGV itself. With four McNams, the steering radius is greatly reduced to work in smaller Spaces. At the same time, the operation principle of the self-driving car adopts laser ranging radar and proximity sensors to meet the requirements of various complex paths, and the automation level is higher. At the same time, the positioning accuracy is mainly determined by the accuracy of the radar, so that the user can adjust the model flexibly to fit the site and control the cost (the positioning accuracy is plus or minus 10mm to plus or minus 5mm). Key Words：AGV ;Industrial robots; Logistics transport; Unmanned technology III 目 錄 1.緒論 1 1.1 AGV概述 1 1.2 背景技術(shù) 1 1.3 國內(nèi)外機(jī)械能越障小車的發(fā)展概況 1 2.機(jī)械結(jié)構(gòu)設(shè)計(jì) 2 2.1自動(dòng)裝卸AGV技術(shù)參數(shù) 2 2.2 直流伺服電動(dòng)機(jī)的選擇 2 3.控制系統(tǒng)的設(shè)計(jì) 9 3.1 控制系統(tǒng)總體方案 9 3.2 電機(jī)驅(qū)動(dòng)芯片的選擇 9 4.運(yùn)動(dòng)學(xué)分析 12 4.1 單個(gè)輪子動(dòng)力學(xué)模型 12 4.2 運(yùn)動(dòng)學(xué)方程 13 5. 系統(tǒng)的拓展 15 5.1 軟件結(jié)構(gòu) 15 5.2 基于行為的軟件特征 15 5.3 行為選擇 15 5.4 AGV環(huán)境中的行為與選擇機(jī)制 16 6. 定位與導(dǎo)航 17 6.1 定位 17 6.2 概率定位 17 6.3 AGV的可信度 18 6.4 坐標(biāo)系 21 6.5 導(dǎo)航功能 21 7. 機(jī)械手設(shè)計(jì) 25 7.1 機(jī)械手腕部設(shè)計(jì) 25 7.2 自由度計(jì)算 25 8. AGV路徑仿真 28 9. 結(jié)論 30 參 考 文 獻(xiàn) 31 致 謝 32 自動(dòng)裝卸AGV設(shè)計(jì) 1.緒論 1.1 AGV概述 本畢業(yè)設(shè)計(jì)課題來源于第十屆全國3D大賽，命題與高校工程訓(xùn)練教學(xué)內(nèi)容相銜接，體現(xiàn)綜合性工程能力。命題內(nèi)容體現(xiàn)“創(chuàng)新設(shè)計(jì)能力、制造工藝能力、實(shí)際操作能力和工程管理能力”四個(gè)方面的要求。現(xiàn)代工業(yè)的發(fā)展不僅要求產(chǎn)品高質(zhì)量、高性能，而且為實(shí)現(xiàn)可持續(xù)發(fā)展，產(chǎn)品的生產(chǎn)工藝必須高效率、低成本。 根據(jù)美國物流協(xié)會(huì)定義，AGV是無人搬運(yùn)車（Automated Guided Vehicle）的英文縮寫。是指裝備有電磁或光學(xué)等自動(dòng)導(dǎo)引裝置，能夠沿規(guī)定的導(dǎo)引路徑行駛，具有安全保護(hù)以及各種移載功能的運(yùn)輸車。 目前AVG應(yīng)用領(lǐng)域主要集中在倉儲(chǔ)業(yè)，制造業(yè)，港口碼頭及特種行業(yè)。其中工業(yè)領(lǐng)域里的制造業(yè)需要很多內(nèi)部運(yùn)輸，以及很多不同的物料處理。AGV的自動(dòng)導(dǎo)引運(yùn)輸車系統(tǒng)可以滿足這類需求。比如：工具，托盤，成品，半成品，原材料，卷式產(chǎn)品，物料供應(yīng)等的搬運(yùn)。AGV在制造業(yè)的其他應(yīng)用包括支持高層儲(chǔ)架的托盤檢索，生產(chǎn)區(qū)的物品和零部件的運(yùn)輸，以及生產(chǎn)區(qū)和存儲(chǔ)區(qū)之間的物品運(yùn)輸。制造業(yè)每天物流的典型特點(diǎn)是高吞吐量，空間和靈活性很重要。AGV的自動(dòng)物料處理系統(tǒng)可以很好地滿足此類需求，比如把物品從輸送帶，托盤堆垛機(jī)以及天車上轉(zhuǎn)移到倉庫，生產(chǎn)車間，裝配區(qū)和發(fā)貨區(qū)等。 1.2 背景技術(shù) 目前國內(nèi)AGV主要采用的是以日本為代表的簡易型AGV技術(shù)，稱為AGC（Automated Guided Cart）該技術(shù)追求的是簡單實(shí)用，讓用戶在最短時(shí)間內(nèi)收回投資成本，但AGC只用來搬運(yùn)，并不強(qiáng)調(diào)自動(dòng)裝卸功能，雖然價(jià)格低廉但不適合基礎(chǔ)工業(yè)并不十分完善的我國。 同時(shí)當(dāng)下大部分AGV采用電磁或軌道引導(dǎo)，路線固定，局限性較大，不適用于柔性化制造系統(tǒng)。 1.3 國內(nèi)外機(jī)械能越障小車的發(fā)展概況 根據(jù)美國物流協(xié)會(huì)定義，AGV是無人搬運(yùn)車（Automated Guided Vehicle）的英文縮寫。是指裝備有電磁或光學(xué)等自動(dòng)導(dǎo)引裝置，能夠沿規(guī)定的導(dǎo)引路徑行駛，具有安全保護(hù)以及各種移載功能的運(yùn)輸車。 目前AVG應(yīng)用領(lǐng)域主要集中在倉儲(chǔ)業(yè)，制造業(yè)，港口碼頭及特種行業(yè)。其中工業(yè)領(lǐng)域里的制造業(yè)需要很多內(nèi)部運(yùn)輸，以及很多不同的物料處理。AGV的自動(dòng)導(dǎo)引運(yùn)輸車系統(tǒng)可以滿足這類需求。比如：工具，托盤，成品，半成品，原材料，卷式產(chǎn)品，物料供應(yīng)等的搬運(yùn)。AGV在制造業(yè)的其他應(yīng)用包括支持高層儲(chǔ)架的托盤檢索，生產(chǎn)區(qū)的 2 物品和零部件的運(yùn)輸，以及生產(chǎn)區(qū)和存儲(chǔ)區(qū)之間的物品運(yùn)輸。制造業(yè)每天物流的典型特點(diǎn)是高吞吐量，空間和靈活性很重要。AGV的自動(dòng)物料處理系統(tǒng)可以很好地滿足此類需求，比如把物品從輸送帶，托盤堆垛機(jī)以及天車上轉(zhuǎn)移到倉庫，生產(chǎn)車間，裝配區(qū)和發(fā)貨區(qū)等。 1.4 設(shè)計(jì)內(nèi)容 本設(shè)計(jì)在目前AGV的基礎(chǔ)上，創(chuàng)新性的使用機(jī)械手聯(lián)動(dòng)的的裝卸方式，避免了為了滿足各工況需求而覆蓋的各種移載機(jī)構(gòu)，驅(qū)動(dòng)模式和導(dǎo)引方式，降低了成本。同時(shí)又不同于AGC需要完善的基礎(chǔ)設(shè)施配合，三只靈巧機(jī)械手足夠完成裝卸工作，極大地發(fā)揮了AGV本身的自主性和工作容積。搭配四個(gè)麥克納姆輪極大地縮小了轉(zhuǎn)向半徑可在更狹小空間內(nèi)作業(yè)。同時(shí)仿照無人駕駛汽車運(yùn)行原理采用激光測距雷達(dá)配接近傳感器能夠滿足各種復(fù)雜路徑的使用要求，自動(dòng)化程度更高。同時(shí)定位精度主要由雷達(dá)的精度決定，便于用戶靈活調(diào)整型號(hào)以適應(yīng)場所并控制成本（定位精度為±10mm到±5mm）。 1.5 基本方案 設(shè)計(jì)過程中需要完成：各機(jī)構(gòu)機(jī)械方面選擇、加工工藝方案的選擇和優(yōu)化和加工成本及材料分析選擇等。在此其中，機(jī)械加工成本，原材料的選擇等都會(huì)對(duì)最終性能產(chǎn)生影響，因此，需要多方面思量這些問題，合理選擇，設(shè)計(jì)出最優(yōu)的方案。 本設(shè)計(jì)為一種新型的AGV如圖1.1所示，采用四個(gè)Mecanum輪驅(qū)動(dòng)的結(jié)構(gòu)形式，通過直流伺服電動(dòng)機(jī)驅(qū)動(dòng)車輪行駛，當(dāng)兩輪轉(zhuǎn)速不同或轉(zhuǎn)向相反時(shí)就可以實(shí)現(xiàn)轉(zhuǎn)向。 四輪結(jié)構(gòu)加四套減速器相對(duì)來講有較大的負(fù)載能力和較好的平穩(wěn)性，與兩輪驅(qū)動(dòng)和安裝差速器及轉(zhuǎn)向機(jī)構(gòu)的設(shè)計(jì)相比雖然成本較高但傳動(dòng)誤差小，轉(zhuǎn)向靈活，故采用此方案。 圖1.1 AGV三維預(yù)覽圖 2.機(jī)械結(jié)構(gòu)設(shè)計(jì) 2.1自動(dòng)裝卸AGV技術(shù)參數(shù) 自動(dòng)搬運(yùn)小車的長度 1.3m 自動(dòng)搬運(yùn)小車的寬度 1.3m 自動(dòng)搬運(yùn)小車的高度 1m 自動(dòng)搬運(yùn)小車的重量 160kg 持續(xù)運(yùn)行時(shí)間 8～10h 充電方式 自動(dòng)/手動(dòng) 定位精度 ±10mm 剎車距離 ≤0.1m 負(fù)載 ≤500kg 小車轉(zhuǎn)彎半徑 ≥0.6m（可原地差動(dòng)旋轉(zhuǎn)） 小車最大速度 ≤1.2m/s 行走定位點(diǎn)數(shù) 可行走任意多個(gè)設(shè)備位置 抗干擾能力 對(duì)路面打滑具有較強(qiáng)抗干擾能力 蓄電池 免維護(hù)充電電池，連續(xù)放電次數(shù)＞300次 安全感應(yīng)范圍 ≤3mm可調(diào)，緊急制動(dòng)距離＜20mm 人機(jī)交互 觸屏人機(jī)交互，方便設(shè)置參數(shù)，設(shè)置站點(diǎn)及報(bào)警位置 設(shè)計(jì)壽命 ＞10年 2.2 直流伺服電動(dòng)機(jī)的選擇 直流伺服電機(jī)的選擇關(guān)系著控制系統(tǒng)的靜、動(dòng)態(tài)特性和運(yùn)動(dòng)精度，所以在選擇直流伺服電機(jī)的時(shí)候，主要應(yīng)該參考以下幾點(diǎn)要求： ①調(diào)速范圍廣闊而且平滑。 ②機(jī)械特性較硬而且動(dòng)態(tài)/靜態(tài)調(diào)節(jié)特性良好。 ③響應(yīng)時(shí)間較短，可適用于要求快速啟停的控制場合。 ④體積小，重量輕，控制特性成線性。 伺服電動(dòng)機(jī)主要根據(jù)下面三個(gè)因素選擇 運(yùn)行速度：AGV行走的速度為1.2m/s，車輪的轉(zhuǎn)速為 （2.1） 選擇減速比為i=5的減速器 （2.2） 小車自重為P （2.3） 為方便抓取將小車重心放在整體靠前的位置，負(fù)載的重心后置保證了運(yùn)行中具有更高的穩(wěn)定性和可操控性，整體重心仍落在車體幾何中心。 小車的載荷為G （2.4） 自動(dòng)搬運(yùn)小車的受力分析如圖2.1所示。 圖2.1 車輪受力簡圖 取坐標(biāo)系OXYZ如圖所示，列出平衡方程 由于由于前后車輪相對(duì)于y軸呈對(duì)稱分布，有 （2.5） （2.6） 解得 Mecanum輪的受力情況很復(fù)雜，見圖2.2。本小車采用的45°Mecanum輪在旋轉(zhuǎn)時(shí)產(chǎn)生的力通過與地面接觸的滾輪作用于地面，使力可以分解為一個(gè)垂直于滾輪軸的矢量和一個(gè)與軸平行的矢量。垂直于滾輪的力會(huì)隨著小滾輪轉(zhuǎn)動(dòng)產(chǎn)生的動(dòng)能釋放，而平行于滾柱軸的力將產(chǎn)生一個(gè)施加到輪子上的力并且作用到小車上，使小車向前移動(dòng)。 圖2.2 Mecanum原理，向量分解 由于Mecanum輪不會(huì)單獨(dú)出現(xiàn)，對(duì)于這種四輪組合的形式，需要將每一個(gè)輪子在45°時(shí)產(chǎn)生的力結(jié)合起來以分析小車的運(yùn)動(dòng)，左右兩個(gè)45°的力矢量可分解為向前力矢量和側(cè)向力矢量，兩個(gè)向前力矢量相疊加而兩個(gè)側(cè)向矢量（一個(gè)向左一個(gè)向右）則相互抵消，此處僅分析直線運(yùn)動(dòng)，因?yàn)榍拜喫茌d荷較大，故僅分析前輪受力狀態(tài)，前輪受力狀態(tài)如圖2.3所示（更詳細(xì)的Mecanum輪受力分析見4.1單個(gè)輪子動(dòng)力學(xué)模型）。 圖2.3 前輪受力 滾動(dòng)摩阻力偶矩應(yīng)該處于零與最大值之間，即 （2.7） （2.8） 上式中δ為滾動(dòng)摩阻系數(shù)，查閱書中常用材料的滑動(dòng)摩擦系數(shù)與滾動(dòng)摩阻系數(shù)一表得到δ=2～10，取δ=6mm。 牽引力F為 （2.9） （1）電動(dòng)機(jī)軸上所承受的的轉(zhuǎn)矩為 （2.10） 傳遞效率η取0.7，摩擦系數(shù)μ取0.15 （2）電動(dòng)機(jī)軸上的負(fù)荷慣性為 （2.11） 上式中是車輪的質(zhì)量慣性矩，是傳動(dòng)裝置部件轉(zhuǎn)動(dòng)慣量 （3）電機(jī)的選定 根據(jù)以上計(jì)算，在負(fù)載慣性已知情況下可以根據(jù)要求的運(yùn)動(dòng)特性分析電機(jī)的輸出轉(zhuǎn)矩，選擇直流伺服電動(dòng)機(jī)。 電機(jī)型號(hào)及參數(shù)：MOVING YZ-57BLS120 120W 伺服電機(jī)轉(zhuǎn)子慣量 匹配條件為 即0.25＜0.729＜1 （2.12） （2.13） 故電機(jī)滿足要求。 （4）快移時(shí)的加速性能 伺服電機(jī)的最大輸出轉(zhuǎn)矩是AGV工作時(shí)，電動(dòng)機(jī)運(yùn)行到最高轉(zhuǎn)速時(shí)，輸出到車輪的最大扭轉(zhuǎn)力矩 （2.14） 加速時(shí)間 （2.15） 其中機(jī)械時(shí)間常數(shù) 2.3 驅(qū)動(dòng)輪系的設(shè)計(jì) 驅(qū)動(dòng)輪系的設(shè)計(jì)應(yīng)滿足如下要求： ①尺寸符合AGV的要求。 ②結(jié)構(gòu)簡單、合理，拆裝方便。 ③強(qiáng)度及剛度符合要求。 ④扭矩的有效傳遞。 為了與傳動(dòng)部件相聯(lián)結(jié)，輸出軸一端被做成扁平頭形狀，參考現(xiàn)有參數(shù)選取直徑為φ8的電機(jī)軸與直徑為φ12的聯(lián)接部分，故其結(jié)構(gòu)設(shè)計(jì)圖2.4所示。 圖2.4 聯(lián)軸器機(jī)構(gòu)圖 銷釘直徑d可按剪切強(qiáng)度公式計(jì)算，即 （2.16） 選用45鋼作為銷定材料，翻閱書后表格得優(yōu)質(zhì)碳素結(jié)構(gòu)鋼（GB 699-88）45 硬度36～42HRC 銷釘?shù)脑S用切應(yīng)力為 （2.17） 過載限制系數(shù)K查表取K=1.6,T=0.587N·m （2.18） 根據(jù)上述強(qiáng)度計(jì)算，取銷釘直徑d=5mm。 2.4 軸的設(shè)計(jì) 由于前輪所受載荷大于后輪，故對(duì)前輪進(jìn)行校核，前輪軸結(jié)構(gòu)如圖2.5。 圖2.5 前輪軸結(jié)構(gòu) （1）求前輪軸上的功率，轉(zhuǎn)速,功率 取傳動(dòng)裝置的效率，則 （2.19） （2.20） （2.21） （2）初步確定軸的最小直徑 選用45鋼作為軸的材料，經(jīng)過調(diào)質(zhì)處理，取得,于是有 （2.22） 法蘭所處位置的輪軸直徑最小，由于法蘭與軸采用雙頂絲聯(lián)結(jié)，故軸的直徑取10mm 該Mecanum輪的輪轂使用鋁合金材料，大輪軸使用45鋼，剛度和強(qiáng)度都比較好，小輪軸使用普通碳鋼，因?yàn)檎麄€(gè)輪子的最大應(yīng)力處恰好出現(xiàn)在小輪軸上，因此需要更高的強(qiáng)度。小輪使用橡膠材料，摩擦系數(shù)比較大，能給AGV提供較好的抓地力和加速性能。 （3）確定軸上倒角尺寸 取軸端倒角為1×45°。 3.控制系統(tǒng)的設(shè)計(jì) 3.1 控制系統(tǒng)總體方案 本系統(tǒng)的核心的控制運(yùn)算部分采用的是AT89S51單片機(jī)。數(shù)字編碼器在電機(jī)運(yùn)轉(zhuǎn)時(shí)發(fā)出的脈沖信號(hào)，經(jīng)過自行設(shè)計(jì)和制作的脈沖鑒向電路，可以得到電機(jī)的運(yùn)轉(zhuǎn)方向[8]；來自鑒向電路的正反方向的脈沖信號(hào)進(jìn)入到電機(jī)專用驅(qū)動(dòng)模塊，單個(gè)模塊可同時(shí)驅(qū)動(dòng)多個(gè)電機(jī)，調(diào)節(jié)轉(zhuǎn)速時(shí)，相應(yīng)的I/O口輸出不同的PWM（Pulse Width Modulation，脈沖寬度調(diào)制）波形，通過H橋開關(guān)放大器，作為執(zhí)行機(jī)構(gòu)的速度或者力矩給定，再通過總線與電機(jī)控制器連接就可以控制電機(jī)的運(yùn)轉(zhuǎn)，使整個(gè)AGV自動(dòng)引導(dǎo)小車能夠完成所設(shè)計(jì)的控制任務(wù)[8]。 整個(gè)控制系統(tǒng)的組成框圖如圖3.1所示。 圖3.1 系統(tǒng)硬件框圖 3.2 電機(jī)驅(qū)動(dòng)芯片的選擇 伺服驅(qū)動(dòng)器所提供的最大電流不能小于電機(jī)的峰值電流，調(diào)整時(shí)的輸入電流不得大于伺服電機(jī)的消磁電流。電機(jī)和負(fù)載的慣量之和小于驅(qū)動(dòng)伺服電機(jī)所允許的最大慣量。采用PWM功率放大器作為驅(qū)動(dòng)元件驅(qū)動(dòng)直流伺服電機(jī)。PWM的選擇可以參考以下原則： 開關(guān)頻率應(yīng)能使電機(jī)軸產(chǎn)生微小振動(dòng)，能夠克服靜摩擦，改善運(yùn)行特性。即： （3.1） ,K為力矩常數(shù)，為PWM電源電壓，L為電感，T為電機(jī)靜摩擦力矩。 微小振動(dòng)的最大角位移應(yīng)小于設(shè)定的位置誤差。即： （3.2） 其中J為轉(zhuǎn)動(dòng)慣量，Δ為設(shè)定的位置誤差。 盡量減少電機(jī)產(chǎn)生的高頻功率損耗。即應(yīng)使得[8]： （3.3） 其中為內(nèi)阻。 選用UC3637和H橋放大電路來驅(qū)動(dòng)伺服電機(jī)，由于一般伺服電機(jī)電感較小，切換頻率過低會(huì)導(dǎo)致交流分量很大并損害功率晶體管功能，因此選擇30KHz的切換頻率。 ①單電源或雙電源工作，±2.5～±20V ②限流保護(hù) ③欠電壓封鎖 ④溫度補(bǔ)償，2.5V閾值的關(guān)機(jī)控制 UC3637的三角波產(chǎn)生電路如圖3.2所示。 圖3.2 恒幅三角波產(chǎn)生電路 三角波參數(shù)的計(jì)算： 取PWM定時(shí)電路充電電流為0.5MPa，則有 （3.4） （3.5） 其中，為PWM頻率。由允許電機(jī)最大電流決定[8]。 （3.6） 對(duì)于圖3.10所示的控制系統(tǒng)，要求： 取a=1，計(jì)算得 （3.7） （3.8） （3.9） （3.10） 其中是三角波峰值的閾值電壓。 4.運(yùn)動(dòng)學(xué)分析 4.1 單個(gè)輪子動(dòng)力學(xué)模型 在電機(jī)的選擇部分，車輪被設(shè)定為剛體和未變形的圓盤，并且車輪與地面的相互作用被認(rèn)為是點(diǎn)接觸。實(shí)際Mecanum輪上的小輪是由橡膠制成，所以相互作用是面接觸。假設(shè)自動(dòng)搬運(yùn)小車的重心不高，因此當(dāng)AGV加速時(shí)，由高重心引起的對(duì)地壓力的改變被忽略。 基于車輛動(dòng)力學(xué)理論，當(dāng)AGV加速運(yùn)動(dòng)時(shí)，驅(qū)動(dòng)輪與地面的接觸變形產(chǎn)生的切向力是AGV運(yùn)動(dòng)的牽引驅(qū)動(dòng)力。只要車輪和地面間的接觸區(qū)域，即車輪接地印記上承受切向力，就會(huì)有不同程度的滑移，所以嚴(yán)格地說，理想的純滾動(dòng)假設(shè)與實(shí)際情況不符[9]。在加速過程中最大限度地減小車輪滑移是AGV運(yùn)動(dòng)控制的目標(biāo)，其前提是對(duì)單個(gè)車輪的運(yùn)動(dòng)進(jìn)行分析。 當(dāng)車輪在地面上滾動(dòng)時(shí)，所有的相互作用力以及由車輪和接觸區(qū)的地面產(chǎn)生的相應(yīng)變形都伴隨著能量損失，這是滾動(dòng)阻力的根本原因。為了提高AGV的加速性能[9]所以小輪采用橡膠輪。這種彈性變形引起的彈性遲滯損失形成了阻礙車輪滾動(dòng)的一種阻力偶，當(dāng)車輪僅受徑向載荷而不滾動(dòng)時(shí)，在地面上的正常反作用力在前后方對(duì)稱分布，其合力與法向載荷P重合于法線方向，如圖4.1（a）所示。車輪滾動(dòng)時(shí)，變形前后對(duì)應(yīng)點(diǎn)的法線是相同的，但由于彈性遲滯的現(xiàn)象，地面法向反作用力在前部的加載壓縮過程就會(huì)大于后部的卸載恢復(fù)過程。在這種情況下，地面法向反作用力前后的分布并不對(duì)稱，使其合力相對(duì)于法線向前移了一個(gè)距離e[9]，如圖4.1（b）。 圖4.1 輪子受力情況 輪子靜止時(shí)受力情況；（b）輪子滾動(dòng)時(shí)受力情況 如果將法向反作用力向后平移至通過輪子中心，與其垂線重合，那么車輪在地面上滾動(dòng)時(shí)的應(yīng)激狀態(tài)如圖4.2所示，一個(gè)額外的力偶矩出現(xiàn)阻礙車輪的滾動(dòng)，被稱為滾動(dòng)阻力偶矩[9]。由圖4.2可知，為了使車輪在地面上以恒定的速度滾動(dòng)，有必要增加一個(gè)驅(qū)動(dòng)力矩或推力到軸上，從而克服上述滾動(dòng)阻力矩。相關(guān)的數(shù)學(xué)關(guān)系如下： （4.1） （4.2） （4.3） （4.4） （4.5） 上式中，是滾動(dòng)阻力系數(shù)，從上面的公式可以看出，滾動(dòng)阻力系數(shù)是指單位車重所需之推力。因此，車輪的徑向垂直載荷和滾動(dòng)阻力系數(shù)的乘積就是車輪的滾動(dòng)阻力，如式（4.5）所示。在車輪上驅(qū)動(dòng)AGV移動(dòng)的真正力量是地面對(duì)車輪的切向反應(yīng)力。 圖4.2 滾動(dòng)阻力偶的形成 4.2 運(yùn)動(dòng)學(xué)方程 （1）基于Mecanum的自動(dòng)搬運(yùn)小車的移動(dòng)方向（線速度沿小車中軸方向，垂直于中軸方向）和旋轉(zhuǎn)速度的矩陣方程為 （4.1） 其中等為每個(gè)輪的轉(zhuǎn)速（r/s），r為輪子半徑，d為左右輪之間距離，e為前后輪之間距離，為小車的向前速度，為小車的側(cè)向速度，ω為小車的旋轉(zhuǎn)速度。 （2）基于Mecanum的自動(dòng)搬運(yùn)小車給定的的期望線速度和角速度與每個(gè)輪子速度的矩陣方程為 （4.2） 其中為期望線速度和角速度。 5. 系統(tǒng)的拓展 上面的控制方法需要構(gòu)建一個(gè)世界模型，然后計(jì)劃行動(dòng)，最后在一個(gè)真實(shí)的環(huán)境中執(zhí)行這些計(jì)劃。然而，構(gòu)建世界模型和計(jì)劃行動(dòng)需要花費(fèi)大量的時(shí)間，這將對(duì)AGV的性能產(chǎn)生重大影響。此外，規(guī)劃模型與實(shí)際環(huán)境之間的偏差會(huì)導(dǎo)致AGV運(yùn)動(dòng)無法達(dá)到預(yù)期的效果。 5.1 軟件結(jié)構(gòu) 目前AGV使用的軟件模型即標(biāo)準(zhǔn)模型（層次模型），是一種從上而下執(zhí)行的可預(yù)測軟件結(jié)構(gòu)。傳感器獲得數(shù)據(jù)預(yù)處理的兩層,然后交付給高的“智能”層做出行動(dòng)的決定，實(shí)際駕駛(如導(dǎo)航和底層驅(qū)動(dòng)函數(shù))交由低級(jí)層執(zhí)行，最低層為小車的接口，將駕駛指令發(fā)送給AGV執(zhí)行器。 為了解決經(jīng)典模型演算時(shí)間長，動(dòng)作完成度不夠等問題，使用一種基于行為的模型，不編寫整段的代碼，而是將每一個(gè)AGV的功能封裝成一個(gè)個(gè)小而獨(dú)立的模塊，即一個(gè)“行為”。所有的行為都是并行執(zhí)行，所以不需要設(shè)置優(yōu)先級(jí)。此種設(shè)計(jì)易于擴(kuò)展，如增加一個(gè)新的傳感器或向AGV程序里增加一個(gè)新的行為特征。 5.2 基于行為的軟件特征 （1）感應(yīng)與動(dòng)作緊密耦合 基于行為的AGV的動(dòng)作是對(duì)刺激的反應(yīng)而不是依賴于有意識(shí)的規(guī)劃。避免考慮計(jì)劃，用小的計(jì)算負(fù)載（模塊）來替換它，以實(shí)現(xiàn)從輸入到動(dòng)作的映射，這有利于快速響應(yīng)。 （2）避開知識(shí)的符號(hào)表示 不需要構(gòu)造一個(gè)內(nèi)部模型用來處理環(huán)境信息與規(guī)劃任務(wù)。AGV從觀測中直接產(chǎn)生未來的行為，而非試圖產(chǎn)生一個(gè)可內(nèi)部操作的世界抽象并以此作為規(guī)劃未來行動(dòng)的基礎(chǔ)。 （3）分解成具有因果意義的單元 （4）并發(fā)關(guān)聯(lián)行的時(shí)變激活等級(jí)調(diào)整 5.3 行為選擇 由于在軟件系統(tǒng)中有一定數(shù)量的行為作為并行進(jìn)程運(yùn)行，每個(gè)行為都可以作為讀取所有的傳感器（讀動(dòng)作），但只有一個(gè)行為可獲得AGV執(zhí)行器或者行駛機(jī)構(gòu)的控制權(quán)（寫動(dòng)作）。因此為了達(dá)到預(yù)期目的需要一個(gè)全局控制器在恰當(dāng)時(shí)機(jī)來協(xié)助行為選擇。 如果采用固定優(yōu)先級(jí)行為，這樣一種僵硬的系統(tǒng)使其能力受到了極大地限制，并難以應(yīng)付日益復(fù)雜的系統(tǒng)。期望的目標(biāo)是能設(shè)計(jì)并制作一個(gè)采用自適應(yīng)控制器的基于隱藏在系統(tǒng)內(nèi)部的“智能”，在任何特定的時(shí)間根據(jù)感知和狀態(tài)輸入決定激活哪一個(gè)行為。反應(yīng)和規(guī)劃（自適應(yīng)控制器）組件的結(jié)合形成了一個(gè)混合系統(tǒng)，其結(jié)合了思考和反應(yīng)結(jié)構(gòu)的要素，在傳感器和電機(jī)輸出間有多個(gè)混合方案來協(xié)調(diào)完成任務(wù)。系統(tǒng)只需要從有利于完成任務(wù)的標(biāo)準(zhǔn)定義進(jìn)行學(xué)習(xí)以完成任務(wù)。這將設(shè)計(jì)系統(tǒng)時(shí)的主要工作，從描述系統(tǒng)本身轉(zhuǎn)變成定義一個(gè)正常工作的輸出系統(tǒng)上來。介于定義任務(wù)告竣的評(píng)價(jià)標(biāo)準(zhǔn)要比完整的系統(tǒng)描述簡單，這將極大地減少系統(tǒng)設(shè)計(jì)的工作量。 5.4 AGV環(huán)境中的行為與選擇機(jī)制 神經(jīng)網(wǎng)絡(luò)用于接收所有來自傳感器（包括預(yù)處理過的高層傳感器數(shù)據(jù)）、一個(gè)時(shí)鐘以及每一個(gè)行為狀態(tài)的輸出，并生成輸出以選擇當(dāng)前活動(dòng)的行為，然后生成一個(gè)動(dòng)作。這種網(wǎng)絡(luò)結(jié)構(gòu)是通過遺傳算法的進(jìn)化而來的，它被用來優(yōu)化描述任務(wù)評(píng)估標(biāo)準(zhǔn)的適應(yīng)度函數(shù)，如圖5.1所示。使用神經(jīng)網(wǎng)絡(luò)路徑規(guī)劃可以把環(huán)境障礙等作為神經(jīng)網(wǎng)絡(luò)的輸入層信息,通過神經(jīng)網(wǎng)絡(luò)并行處理,神經(jīng)網(wǎng)絡(luò)的輸出層輸出所需的方向和速度,引導(dǎo)機(jī)器人避免障礙行駛,直到到達(dá)目的地。該方法具有處理效率高、學(xué)習(xí)能力強(qiáng)[10]、收斂性好等特點(diǎn)。 圖5.1 AGV環(huán)境中的行為及選擇機(jī)制 6. 定位與導(dǎo)航 我們需要獲知當(dāng)前位置，并且具有制定到達(dá)目的地的規(guī)劃能力，準(zhǔn)確的定位是建立精確全局地圖的先決條件，也是AGV實(shí)現(xiàn)正確路徑規(guī)劃的保證?；谝曈X的自我定位過程是對(duì)視覺傳感器捕捉到的環(huán)境特征進(jìn)行提取和分析的過程，并根據(jù)具體的標(biāo)準(zhǔn)建立觀察與環(huán)境數(shù)據(jù)庫的對(duì)應(yīng)關(guān)系，從而確定AGV自身的姿態(tài)[10]，如圖6.1所示。 圖6.1 基于視覺的AGV自定位 6.1 定位 由于行駛環(huán)境多變，所以本設(shè)計(jì)并沒有使用全局傳感器，而且它也限制了AGV的自主能力；作為替換選擇使用本體傳感系統(tǒng)。本設(shè)計(jì)將激光雷達(dá)安裝在AGV上，這樣就得到了使用本體傳感器的AGV。 6.2 概率定位 所有的AGV移動(dòng)和傳感器測量都會(huì)受到一定程度的噪聲干擾。概率定位的目的是在以前所有數(shù)據(jù)和其他相關(guān)分布函數(shù)的基礎(chǔ)上，能夠最好地估計(jì)AGV當(dāng)前的狀態(tài)。由于其固有的不確定性，最終的估計(jì)將是一個(gè)概率分布。 假定AGV從x=0，y=0處開始沿直線（如沿x軸）行駛，執(zhí)行移動(dòng)距離d的指令，d從板載（絕對(duì)）定位系統(tǒng)（GPS接收器）接受傳感器數(shù)據(jù)s。數(shù)值d和（用當(dāng)前的位置測量值減去在執(zhí)行行駛命令前的位置測量值），就可能會(huì)偏離真實(shí)位置。 必須通過大量的實(shí)驗(yàn)來測量機(jī)器人從任意的起始位置的行駛精度，然后由一個(gè)PMF（概率密度函數(shù)）表示出來，例如： （6.1） 需要注意的是，此處只能加上或減去一個(gè)單位（如cm）來變更AGV的真實(shí)位置。在可以表示為一個(gè)PMF之前，必須以類似的方式通過測量得到AGV位置傳感器的精度。 （6.2） 假設(shè)AGV執(zhí)行的行駛命令并且完成后，本體傳感器報(bào)告其位置為。實(shí)際位置x的概率如下，其中n作為歸一化因子： （6.3） （6.4） （6.5） 由于PMF對(duì)于所有偏差值大于1（加或減）的概率為0，因此AGV執(zhí)行行駛距離為的命令后，位置只有可能是位置、位置、位置。因此，這三個(gè)概率加起來應(yīng)當(dāng)?shù)扔?，我們可以根據(jù)這個(gè)事實(shí)來確定歸一化因子n： （6.6） 6.3 AGV的可信度 根據(jù)5.1.1的計(jì)算可以求出三個(gè)位置的概率，它反映了AGV的可信度 因此，概率最大的位置就是AGV最可能出現(xiàn)的位置，但它仍會(huì)記住這個(gè)階段所有的概率。 當(dāng)AGV執(zhí)行第二個(gè)行駛命令，假設(shè)這一次使,但執(zhí)行指令后其傳感器仍然報(bào)告。AGV將根據(jù)條件概率重新計(jì)算其位置的可信度，用x表示AGV行駛后的真實(shí)位置，用表示行駛前的位置。 （6.7） （6.8） （6.9） 由于AGV的真實(shí)位置與傳感器的讀數(shù)偏差只能為1，因此只能計(jì)算出 的情形來。之后，將概率歸一化 （6.10） 這些最終的概率是合理的，因?yàn)锳GV的傳感器比其推算結(jié)果更加準(zhǔn)確。另外，通常AGV在的位置的可能性很小，而這正是它在可信度上的表現(xiàn)。 這個(gè)方法最大的問題是所工作的空間必須是離散的，即AGV的位置只能離散的表示?？梢酝ㄟ^將離散值設(shè)置為行駛命令和傳感器的最小分辨值。在本設(shè)計(jì)中，我們期望的行駛和傳感器精度不能超過10mm，可以通過讓所有的距離以10mm遞增。但同時(shí)，也會(huì)產(chǎn)生大量的測量值和大量的使用個(gè)別概率的離散距離值。 為了解決這個(gè)問題，可以使用一種稱為粒子濾波器的技術(shù)，它允許使用非離散的配置空間。它可以將AGV的位置的可信度表示為為N個(gè)粒子的集合M，每個(gè)粒子包含有一個(gè)AGV的配置x與權(quán)重。 行駛后，AGV借助第一次采樣得到的PDF（probability density function，概率密度函數(shù)）更新第j個(gè)粒子的構(gòu)型，典型的是高斯分布。在此之后，AGV為第j個(gè)粒子賦予一個(gè)新的權(quán)重。然后，權(quán)重歸一化使得權(quán)重總和為1。最后，重新采樣并保留最有可能的粒子。標(biāo)準(zhǔn)的重新采樣算法如下： M={} R=rand(0,1/N) c=w[0] i=0 for j=0 to N-1 do u=R+j/N while u>c do i=i+1 c=c+w[i] end while M=M+{x{i},1/N}/*add particle to set*/ end for 6.4 坐標(biāo)系 與一般AGV不同，本設(shè)計(jì)具有相當(dāng)?shù)淖杂赡芰?，并沒有采用固定路線引導(dǎo)，故首先，在未知環(huán)境中建立一個(gè)地圖或者在已知環(huán)境中規(guī)劃路徑是很重要的，而這需要在全局或者世界坐標(biāo)下進(jìn)行定義。 將AGV的本體坐標(biāo)系轉(zhuǎn)化成全局坐標(biāo)是一個(gè)二維坐標(biāo)轉(zhuǎn)換，為了匹配兩個(gè)坐標(biāo)系，需要一個(gè)平移和一個(gè)旋轉(zhuǎn)變換。 設(shè)本AGV具有全局位置坐標(biāo)和全局方向。其本體坐標(biāo)是,然后按照如下的公式可以計(jì)算其全局坐標(biāo): （6.11） 6.5 導(dǎo)航功能 6.5.1 感知 感知所處環(huán)境是AGV應(yīng)用中最重要的部分之一，本設(shè)計(jì)采用了以下傳感器： （1）軸編碼器 電機(jī)內(nèi)置的軸編碼器生成最為基本的反饋。此數(shù)據(jù)有三個(gè)用途： ①PI控制器使每個(gè)車輪保持恒定的轉(zhuǎn)速。 ②PI控制器用以保持期望的路線（如直線）。 ③航位推算用以更新AGV的位置和方向。 用控制器專用的計(jì)時(shí)處理器單元（TPU）在后臺(tái)處理軸編碼器的反饋信號(hào)。 （2）紅外測距傳感器 AGV配有三個(gè)紅外測距傳感器，可以測量前、左、右（PSD）的距離。這些數(shù)據(jù)可用于： ①避免與障礙物相撞。 ②在未知環(huán)境中導(dǎo)航，創(chuàng)建地圖。 ③在已知環(huán)境中更新在其內(nèi)的位置。 （3）羅盤模塊 在AGV中，使用航位推算法進(jìn)行位置和方向估計(jì)的最大問題是：隨著時(shí)間的推移，除非在特定的參考點(diǎn)上進(jìn)行更新，否則估計(jì)精度會(huì)不斷變差。邊界墻配合距離傳感器可以作為AGV位置的一個(gè)參考點(diǎn)；但是如果沒有額外的傳感器，想要更新機(jī)器人的方向是十分困難的。 在這些情況下，使用能夠感知地球磁場的羅盤模塊就是很有必要的了。 （4）激光雷達(dá) （5）接近開關(guān) 6.5.2 圖像處理 視覺是本設(shè)計(jì)AGV的一項(xiàng)重要能力，通過不斷分析板載的激光雷達(dá)的視覺輸入，來檢測工作環(huán)境中的物體，使用基于形狀的物體檢測。 基于形狀的地圖生成算法，結(jié)合了構(gòu)形空間（configuration space）（給定環(huán)境維數(shù)和所有障礙墻的坐標(biāo)，如線段表示）和柵格法（occupancy grid）（按照一定的分辨率使用單個(gè)像素來描述環(huán)境，每個(gè)像素要么代表自由空間（白色像素），要么是一個(gè)障礙（黑色像素））兩種方法，并加入了距離圖作為輸入。距離圖是對(duì)環(huán)境的一個(gè)更高層級(jí)的描述。雖然不包含完整的環(huán)境信息，但它可以實(shí)現(xiàn)有效的的初始路徑規(guī)劃。 距離圖中需要包含環(huán)境中部分標(biāo)識(shí)的節(jié)點(diǎn)以及它們之間的相對(duì)距離。而上述兩個(gè)基本環(huán)境格式都不能直接應(yīng)用距離圖，因此需要自動(dòng)獲得距離圖的算法。 如果給定的環(huán)境是構(gòu)型空間格式，通過將所需分辨率直接“打印”在畫布上，可以很容易的轉(zhuǎn)化成柵格。在平面柵格地圖的基礎(chǔ)上，將其高度方向上離散化，實(shí)現(xiàn)3D柵格地圖。在2D柵格地圖的基礎(chǔ)上，將環(huán)境的最大高度或平均高度保存在每個(gè)網(wǎng)格中。這種做法不僅可以達(dá)到立體地圖的性能效果，同時(shí)還可以極大地減少儲(chǔ)存在地圖中的數(shù)據(jù)量。 6.5.3 軌跡規(guī)劃 一旦確定了工件的位置，AGV就要靠近工件--移動(dòng)到任意一個(gè)位置取下工件，并將工件轉(zhuǎn)移到下一個(gè)位置。因此，有必要進(jìn)行軌跡規(guī)劃。通過航位推測法，AGV可以知道它的位姿和方向；通過局部搜索行為，或者與控制室的通信可以確定工件的位置。 首先根據(jù)現(xiàn)有環(huán)境信息，AGV通過路徑規(guī)劃得到一條出發(fā)點(diǎn)與目標(biāo)點(diǎn)之間的合理路徑；AGV沿路徑前進(jìn)，并根據(jù)傳感器在前進(jìn)過程中的實(shí)時(shí)反饋更新環(huán)境信息；如果AGV達(dá)到目標(biāo)點(diǎn)，導(dǎo)航將結(jié)束，否則，將判斷AGV是否需要根據(jù)更新的環(huán)境信息重新規(guī)劃路徑，直到到達(dá)目標(biāo)點(diǎn)。路徑規(guī)劃方法得到的路徑是空間中一系列連續(xù)的線段。通過在搜索過程中優(yōu)化啟發(fā)式函數(shù)的設(shè)計(jì)，可以提高在環(huán)境的路徑規(guī)劃效率。該路徑由一系列網(wǎng)格組成，分別是需要轉(zhuǎn)向的中繼點(diǎn)與中繼點(diǎn)之間的連線。在AGV從所處位置到下一個(gè)中繼點(diǎn)的移動(dòng)過程中，傳感器系統(tǒng)不斷的實(shí)時(shí)更新環(huán)境信息，并對(duì)可通過性進(jìn)行快速分析。如果在前進(jìn)的方向上沒有障礙，它將繼續(xù)移動(dòng)到下一個(gè)路徑點(diǎn)。如果檢測到前方路徑無法通過，立刻啟動(dòng)自主規(guī)避障礙功能，重新規(guī)劃路徑（如添加新的中繼點(diǎn)）繞過障礙物。如果避障失敗，則根據(jù)更新后的環(huán)境信息，回顧路徑規(guī)劃函數(shù)，獲得當(dāng)前位置的新路徑。 6.5.4 直線和圓弧行駛 軌跡的起始位置和方向由AGV的當(dāng)前位置決定，終點(diǎn)就是工件的位置，并且最終的方向是沿著工件與下一存放地點(diǎn)的連線方向。對(duì)于給定且有方向的起點(diǎn)終點(diǎn)條件下，生成光滑路徑的一個(gè)快捷方法是埃爾米特樣條曲線（Hermite Spines）。然而，為了將工件搬到下一指定位置，AGV必須移動(dòng)到工件的附近，通過使用事件區(qū)分的方式在軌跡上增加“中繼點(diǎn)”。這些點(diǎn)將引導(dǎo)AGV移動(dòng)到工件的附近，使它不致離工件太近，同時(shí)保持移動(dòng)曲線的平滑。 在該算法中，直接移動(dòng)意味著AGV接近工件的路徑中沒有中繼點(diǎn)。如果這樣的軌跡是不可行的（例如AGV與工件間有障礙物），算法會(huì)插入一個(gè)中繼點(diǎn)以避開障礙物。這使得AGV通過特定路徑后才能將工件搬到下一指定位置。 6.5.5 軟件系統(tǒng)框架 AGV自動(dòng)導(dǎo)航功能的軟件系統(tǒng)由路徑規(guī)劃模塊、信息采集模塊、自主定位模塊、自主避障模塊、地圖創(chuàng)建模塊、人機(jī)界面模塊等部分組成，如圖6.2所示。 圖6.2 AGV自主導(dǎo)航功能軟件系統(tǒng) 如果沒有指定的全局坐標(biāo)系的定義，全局坐標(biāo)系將在導(dǎo)航任務(wù)開始時(shí)以AGV的姿態(tài)作為原點(diǎn)初始化。AGV的導(dǎo)航是在兩層結(jié)構(gòu)中實(shí)現(xiàn)的。首先，用戶通過人機(jī)交互界面設(shè)置導(dǎo)航任務(wù)的目標(biāo)點(diǎn)，然后根據(jù)傳感器實(shí)時(shí)采集的環(huán)境信息規(guī)劃路徑，由路徑規(guī)劃函數(shù)提供當(dāng)前位置與目標(biāo)點(diǎn)之間的合理路徑，由此得到一系列離散的中繼點(diǎn)，并將其發(fā)送到自動(dòng)避障函數(shù)。在移動(dòng)到路徑點(diǎn)的過程中，AGV可以依靠自動(dòng)避障函數(shù)快速的分辨與識(shí)別預(yù)設(shè)路徑上的障礙物，并在控制軟件的控制下繞過障礙物。在避障過程中，AGV采集的環(huán)境障礙物信息是由初始創(chuàng)建的地圖與可通過性分析功能提供的。 6.5.6 地圖創(chuàng)建 地圖創(chuàng)建過程如圖6.3所示。 圖6.3 地圖創(chuàng)建 通過視覺傳感器的標(biāo)定結(jié)果，恢復(fù)了視覺采集得到的環(huán)境圖像，在俯視圖線性插值恢復(fù)后，根據(jù)均值偏移算法的圖像分割結(jié)果建立了二維柵格圖。在每個(gè)平面網(wǎng)格記錄高度上形成一個(gè)離散表示的2.5網(wǎng)絡(luò)圖。 通過圖像分割技術(shù)恢復(fù)立體視覺成像圖以后，一系列離散點(diǎn)用以描述環(huán)境表面輪廓，構(gòu)成的點(diǎn)云描述目標(biāo)地形三維輪廓，點(diǎn)的坐標(biāo)描述了點(diǎn)相對(duì)于視覺傳感器的位置。由于立體視覺系統(tǒng)獲得的三維點(diǎn)信息基于攝像機(jī)坐標(biāo)系，因此在建立三維地圖過程中， 有必要首先將立體視覺傳感器獲得的三維點(diǎn)云描述的環(huán)境從視覺傳感器坐標(biāo)系（CCS）轉(zhuǎn)化到機(jī)器人坐標(biāo)系（RCS），形成局部環(huán)境描述。然后，利用AGV的自主定位信息，根據(jù)AGV的位姿將局部環(huán)境描述轉(zhuǎn)化為世界坐標(biāo)系（WCS），從而創(chuàng)建一個(gè)全局環(huán)境圖[10]。 7. 機(jī)械手設(shè)計(jì) 7.1 機(jī)械手腕部設(shè)計(jì) 腕部存在兩類裝配偏差：零件與孔不對(duì)中時(shí)有移動(dòng)偏差，零件與孔不平行時(shí)有轉(zhuǎn)動(dòng)偏差。為了避免該偏差，采用如圖所示遠(yuǎn)軸心柔性配合裝置如圖7.1可以借助柱銷插入孔內(nèi)所產(chǎn)生的摩擦力，來轉(zhuǎn)動(dòng)或移動(dòng)柱銷以對(duì)準(zhǔn)孔眼。該裝置存在兩套連桿機(jī)構(gòu)，每套可縮小一類偏差。本作品采用的是其商品化的結(jié)構(gòu)，兩類機(jī)構(gòu)套裝在一起形成了一個(gè)堅(jiān)固且靈活的構(gòu)造。 圖7.1 遠(yuǎn)軸心柔性配合裝置 7.2 自由度計(jì)算 首先確定指數(shù)和自由度，對(duì)于手和物體組成的系統(tǒng)，其自由度可由下面公式計(jì)算： (7.1) 式中 ：第i個(gè)關(guān)節(jié)的自由度，這里設(shè)為1； ：第j個(gè)接觸點(diǎn)允許的自由度，=1～5； L：系統(tǒng)中獨(dú)立的回路數(shù)。 當(dāng)手指關(guān)節(jié)固定時(shí)，由式（1-1）可以得到： （7.2） ＞0意味著物體在手指約束下仍有一定程度的自由，所以它可以在外力的干擾下移動(dòng)，這表明靈巧的機(jī)械手無法穩(wěn)定地固定工件。自由度≤0意味著工件受到機(jī)械手約束后，失去了所有的自由度，因此該機(jī)械手具備了穩(wěn)定抓持物體的必要條件。 上述分析表明只有那些滿足（M≥6和≤0）的機(jī)構(gòu)才擁有靈巧手的特點(diǎn)，所以設(shè)計(jì)的目標(biāo)是找出滿足這個(gè)條件的機(jī)構(gòu)。 首先，考慮手指的數(shù)量，為了便于分析情況，考慮手指與物體接觸的簡單情況。假設(shè)手指和物體都是剛體，當(dāng)只有兩個(gè)手指時(shí)，接觸約束不能限制接觸點(diǎn)連接線附近的運(yùn)動(dòng)，物體可能在外力的干擾下移動(dòng)。所以，考慮到多數(shù)情況，靈巧手至少需要三根手指來實(shí)現(xiàn)固定工件的功能。具體到每個(gè)手指上需要的自由度，假設(shè)每個(gè)機(jī)械手有三根手指，每個(gè)手指有三個(gè)旋轉(zhuǎn)關(guān)節(jié)（三個(gè)伺服電機(jī)帶動(dòng)）。在這些條件下，可以確定： （7.3） 則 M=6，=﹣3 此計(jì)算結(jié)果表明，當(dāng)手指在指端接觸物體，手指運(yùn)動(dòng)可以使物體產(chǎn)生任意運(yùn)動(dòng)。當(dāng)手指固定時(shí)，可以穩(wěn)定的握住物體。不改變接觸約束條件，即不改變的情況下，如果關(guān)節(jié)數(shù)量減少，就會(huì)導(dǎo)致M＜6。因此，要實(shí)現(xiàn)穩(wěn)定抓取的功能，至少需要有9個(gè)自由度。 根據(jù)以上的計(jì)算結(jié)果，列舉所有可能的接觸狀態(tài)，再利用Salisbury對(duì)靈巧手提出的兩個(gè)基本條件進(jìn)行討論： ①當(dāng)手指關(guān)節(jié)運(yùn)動(dòng)時(shí)，能夠使物體產(chǎn)生任意運(yùn)動(dòng)； ②當(dāng)手指關(guān)節(jié)固定時(shí)，能夠完全限制物體的運(yùn)動(dòng)。 最終的設(shè)計(jì)方案是三根手指，每根手指有三個(gè)關(guān)節(jié)，總共九個(gè)自由度。同時(shí)考慮到工作容積和夾緊物體的大小等因素,三根手指分別安裝在車身的上方與左右側(cè),這不僅增加了工作容積,也避免了手指集中，重心偏高導(dǎo)致的不穩(wěn)定現(xiàn)象。 7.3 機(jī)械手結(jié)構(gòu) 機(jī)械手由底座，回轉(zhuǎn)臺(tái)，連桿，大臂，小臂，直流電機(jī)手爪等總共13個(gè)部件組成，工作原理與工業(yè)機(jī)械手類似。 底座起連接及支撐回轉(zhuǎn)臺(tái)的作用，采用螺栓與車殼連接，回轉(zhuǎn)臺(tái)傳遞扭矩帶動(dòng)大臂運(yùn)動(dòng)由直流電機(jī)提供動(dòng)力，桿起連接小臂和大臂的作用，傳遞動(dòng)力并帶動(dòng)小臂相對(duì)于大臂擺動(dòng)，手爪負(fù)責(zé)裝夾工件。 圖7.2 機(jī)械手工程圖 機(jī)械手明細(xì)表 零件號(hào) 零件名 材質(zhì) 數(shù)量 1 底座 HT30 1 2 回轉(zhuǎn)臺(tái) HT40 1 3 電機(jī) 3 4 連桿配件 2024 1 5 連桿 2024 1 6 大臂配件 HT33 1 7 大臂 2024 1 8 小臂 2024 1 9 小臂配件 HT20 1 10 機(jī)械手腕部 HT33 1 11 手爪 QT450-10 1 12 底座聯(lián)結(jié)件 YG6 1 在機(jī)械手末端，安裝有觸覺，壓覺，滑覺，力覺傳感器用來輔助實(shí)時(shí)監(jiān)測和修正動(dòng)作，以保證更好的夾持工件。 8. AGV路徑仿真 假設(shè)現(xiàn)在有一金屬鍛造工廠，內(nèi)部有8個(gè)不同的作業(yè)區(qū)域，分布在三個(gè)車間內(nèi)。8個(gè)作業(yè)區(qū)域間有運(yùn)輸網(wǎng)絡(luò)，每條運(yùn)輸線路為圖8.1中的邊，其中全自動(dòng)水箱裝配機(jī)與鍛壓成型機(jī)之間有傳送帶連接，所以兩個(gè)區(qū)域之間不需要額外的運(yùn)輸路線，邊上的權(quán)數(shù)表示通過該運(yùn)輸路線所需的時(shí)間（數(shù)值僅表示相互的比例，不代表實(shí)際時(shí)間）。設(shè)現(xiàn)處在任一工作區(qū)域，那么AGV需要考慮的是從該工作區(qū)域到其他各工作區(qū)域，應(yīng)該選擇什么運(yùn)動(dòng)路徑才能使所需的時(shí)間最少。 解：這是一個(gè)無向網(wǎng)絡(luò)，根據(jù)所面臨的情況是要求一條從某區(qū)域到其他各區(qū)域的最短路徑，求解如下： function[D,path,min1,path1]=floyd(a,start,terminal) D=a;n=size(D,1);path=zeros(n,n); for i=1:n for j=i:n if D(i,j)~=inf path(i,j)=j; end,end,end for k=1:n for i=1:n for j=1:n if D(i,k)+D(k,j)

收藏