技術(shù)交流報(bào)告書 AGV 小車設(shè)計(jì)及應(yīng)用 1 AGV 小車的發(fā)展背景 在現(xiàn)代化工業(yè)的發(fā)展中 提倡高效 快速 可靠 提倡將人從 簡(jiǎn)單的工作中解放出來 機(jī)器人逐漸替代了人出現(xiàn)在各個(gè)工作崗位 上 機(jī)器人具有可編程 可協(xié)調(diào)作業(yè)和基于傳感器控制等特點(diǎn) 自 動(dòng)導(dǎo)向小車 Automated Guided Vehicle 簡(jiǎn)稱 AGV 便是移動(dòng)機(jī)器人 的一種 是現(xiàn)代化工業(yè)物流系統(tǒng)中的重要設(shè)備 主要為儲(chǔ)運(yùn)各類物 料 為系統(tǒng)柔性化 集成化 高效運(yùn)行提供了重要保證 AGV 小車構(gòu)成系統(tǒng)圖 AGV 小車有三個(gè)關(guān)鍵系統(tǒng) 運(yùn)行系統(tǒng) 導(dǎo)引系統(tǒng) 控制系統(tǒng) 其它還包括有路線系統(tǒng)及安全保護(hù)系統(tǒng)等 本文著重介紹 AGV 小車 的三個(gè)關(guān)鍵系統(tǒng) 技術(shù)交流報(bào)告書 2 AGV 小車運(yùn)行系統(tǒng) AGV 小車運(yùn)行系統(tǒng)是由車輪 減速器 制動(dòng)器 電機(jī)及速度控 制器等部分組成 AGV 小車常設(shè)計(jì)成三種運(yùn)動(dòng)方式 只能向前 能 向前與向后 能縱向 橫向 斜向及回轉(zhuǎn)全方位運(yùn)動(dòng) 本次研究的 AGV 小車是能夠前進(jìn) 后退及回轉(zhuǎn)全方位運(yùn)動(dòng) AGV 小車能夠進(jìn)行 回轉(zhuǎn)運(yùn)動(dòng)需要有轉(zhuǎn)向裝置 轉(zhuǎn)向裝置的結(jié)構(gòu)也有三種 1 前輪轉(zhuǎn)向后輪驅(qū)動(dòng)三輪車型 車的轉(zhuǎn)向和驅(qū)動(dòng)分別由兩個(gè) 不同的電動(dòng)機(jī)帶動(dòng) 車體的前部為轉(zhuǎn)向車輪 車體后部為驅(qū)動(dòng)電機(jī) 驅(qū)動(dòng)的兩個(gè)輪 其結(jié)構(gòu)簡(jiǎn)單 成本低 但定位精度較低 前輪轉(zhuǎn)向后輪驅(qū)動(dòng)三輪車型 2 差速轉(zhuǎn)向式四輪車型 車體的中部有兩個(gè)驅(qū)動(dòng)輪 由兩個(gè) 電機(jī)分別驅(qū)動(dòng) 前后部各有一個(gè)轉(zhuǎn)向輪 自由輪 通過控制中部?jī)蓚€(gè) 輪的速度比可實(shí)現(xiàn)車體的轉(zhuǎn)向 并實(shí)現(xiàn)前后雙向行駛和轉(zhuǎn)向 這種 方式結(jié)構(gòu)簡(jiǎn)單 定位精度較高 技術(shù)交流報(bào)告書 差速轉(zhuǎn)向式四輪車型 3 全輪轉(zhuǎn)向式四輪車型 車體的前后部各有兩個(gè)驅(qū)動(dòng)和轉(zhuǎn)向 一體化車輪 每個(gè)車輪分別由各自的電動(dòng)機(jī)驅(qū)動(dòng) 可實(shí)現(xiàn)沿縱向 橫向 斜向和回轉(zhuǎn)方向任意路線行走 控制較復(fù)雜 全輪轉(zhuǎn)向式四輪車型 從成本及系統(tǒng)應(yīng)用考慮 本文著重介紹差速轉(zhuǎn)向式四輪車型 兩驅(qū)動(dòng)車輪由兩伺服驅(qū)動(dòng)器控制 伺服驅(qū)動(dòng)器通過改變兩車輪的速 度大小 方向 實(shí)現(xiàn) AGV 小車的前進(jìn) 后退 加減速及轉(zhuǎn)向動(dòng)作 AGV 小車通過伺服控制 很容易實(shí)現(xiàn)前進(jìn) 后退及加減速 但 如何通過改變兩驅(qū)動(dòng)輪的速度差 實(shí)現(xiàn) AGV 小車的轉(zhuǎn)向及糾偏 下 面 我們首先了解一下差速轉(zhuǎn)向式四輪車的運(yùn)動(dòng)模型 技術(shù)交流報(bào)告書 AGV 小車運(yùn)動(dòng)狀態(tài)及偏差示意圖 圖中虛線表示的車體為初始位姿 實(shí)線表示的車體是在和初始 時(shí)差為 t 時(shí)的位姿 AGV 車子的左輪運(yùn)行速度為 Vr 右輪為 Vl AGV 小車沿著 A 點(diǎn)作圓弧運(yùn)動(dòng) 轉(zhuǎn)彎半徑為 d 可以得 rlVRd 2 AGV 小車運(yùn)動(dòng)偏移弧度為 容易得 trl 由 式可得 AGV 小車運(yùn)動(dòng)偏移弧度 與左右輪的速度關(guān) 系式 tRVrl AGV 小車在做圓弧運(yùn)動(dòng)時(shí) 在 X 軸上的變化量是 X 在 Y 軸 上的變化量是 Y X Y 與轉(zhuǎn)彎半徑 d 的關(guān)系為 sindX Vl Vr 技術(shù)交流報(bào)告書 cos1 dY 將 式代入 式 可以得出 X Y 與左右輪運(yùn)行速度的 關(guān)系式 sin2rlVRX co1 rlY 所以 通過改變 Vr 及 Vl 可以實(shí)現(xiàn) AGV 小車糾偏 轉(zhuǎn)向等運(yùn)動(dòng)控 制 驅(qū)動(dòng)輪的變速控制 有多種方法可選擇 包括變頻器控制 步 進(jìn)控制 伺服控制等 其中變頻器控制及伺服控制除了有高精度的 速度控制外 還能提供靈活的轉(zhuǎn)矩控制 在 AGV 小車的運(yùn)動(dòng)模型中 其有干摩擦力矩 慣性轉(zhuǎn)矩 粘性摩擦力矩 重力力矩 彈性力矩 等 所以 AGV 小車在運(yùn)行過程中 驅(qū)動(dòng)器需要提供不同的力矩 AGV 小車才能運(yùn)行得更穩(wěn)定 而伺服控制比變頻器擁有更高的速度 控制精度 更小的安裝位置 更高的 IP 防護(hù)等級(jí)以及更好的停車制 動(dòng)功能 所以 伺服控制器作為 AGV 小車的運(yùn)動(dòng)控制系統(tǒng)使用是更 為適合 3 AGV 小車導(dǎo)引系統(tǒng) AGV小車能自動(dòng)運(yùn)行 需要有導(dǎo)引裝置 常用的導(dǎo)引方式分為 兩大類 車外預(yù)定路徑和非預(yù)定路徑方式 下面對(duì)兩種方式分別作 介紹 1 車外預(yù)定路徑導(dǎo)引方式是指在行駛的路徑上設(shè)置導(dǎo)引用的 信息媒介物 AGV通過檢測(cè)出它的信息而得到導(dǎo)向的導(dǎo)引方式 如 電磁導(dǎo)引 色帶導(dǎo)引 磁帶導(dǎo)引 又稱磁性導(dǎo)引 等 技術(shù)交流報(bào)告書 色帶導(dǎo)引示意圖 上圖為光學(xué)導(dǎo)引示意圖 這種導(dǎo)引方式是在地面上連續(xù)敷設(shè)一 條帶顏色的帶子 在車輛的底部中央安裝光源以及在兩邊安裝相同 的色標(biāo)傳感器 如歐姆龍產(chǎn)品E3X DA AN S 它們同時(shí)檢測(cè)色帶反 射回來的色度值 并將色度值轉(zhuǎn)換成模擬量傳送給AGV小車的中央 控制系統(tǒng) PLC 當(dāng)AGV 小車運(yùn)行在正確的運(yùn)行軌道上時(shí) 兩放大器 反饋給PLC模擬量的值相同 當(dāng) AGV小車偏離軌道時(shí) 兩放大器反饋 給PLC的值便有差別 PLC根據(jù)兩模擬量的差值便能判斷出 AGV小車 偏離運(yùn)行軌道的程度及方向 并通過控制運(yùn)動(dòng)控制器使AGV小車往 正確的軌道運(yùn)行 色帶導(dǎo)引靈活性較好 地面路線設(shè)置簡(jiǎn)單易行 但對(duì)色帶的污 染和機(jī)械磨損十分敏感 對(duì)環(huán)境要求高 導(dǎo)引可靠性較差 精度較 低 在預(yù)定路徑導(dǎo)引方式中 還有電磁導(dǎo)引等 電磁導(dǎo)引是較為傳 統(tǒng)的導(dǎo)引方式之一 目前仍被許多系統(tǒng)采用 它是在 AGV 的行駛路 徑上埋設(shè)磁條 并在磁條上加載導(dǎo)引頻率 磁導(dǎo)航傳感器通過檢測(cè) 技術(shù)交流報(bào)告書 磁條上的磁場(chǎng) 便能判斷出 AGV 小車的運(yùn)行是否偏離軌道 磁導(dǎo)航傳感器工作原理圖 上圖為磁導(dǎo)航傳感器的工作原理圖 磁導(dǎo)航傳感器可安裝在 AGV 小車的底部中央 距離磁條表面 20 40mm 磁條寬度為 30 50mm 厚度 1mm 磁導(dǎo)航傳感器內(nèi)部每隔 10mm 排布一個(gè)采樣點(diǎn) 共排布 16 個(gè)采樣點(diǎn) 能夠檢測(cè)出磁條上方的磁場(chǎng) 每一個(gè)采樣點(diǎn)都 有一路對(duì)應(yīng)輸出 AGV 運(yùn)行時(shí) 磁導(dǎo)航傳感器內(nèi)部垂直于磁條上方 的連續(xù) 3 5 個(gè)采樣點(diǎn)會(huì)輸出信號(hào) 如圖中磁導(dǎo)航傳感器上黃色條為 檢測(cè)到磁場(chǎng)信號(hào)的采樣點(diǎn) 藍(lán)色條為未能檢測(cè)出磁場(chǎng)的采樣點(diǎn) AGV 小車的控制系統(tǒng)便能依靠 16 路通道中輸出的 3 5 路信號(hào) 可以 判斷磁條相對(duì)于磁導(dǎo)航傳感器的偏離位置 自動(dòng)作出調(diào)整 確保沿 磁條前行 擁有了運(yùn)行路徑后 還需要在每個(gè)工位及節(jié)點(diǎn)設(shè)置位置標(biāo)簽 使 AGV 小車在運(yùn)行到特定位置時(shí) 能做出加速 減速 停車 拐彎 等動(dòng)作 如在每個(gè)工位敷設(shè)不同顏色的色條 當(dāng)色標(biāo)傳感器檢測(cè)出 到顏色信號(hào)時(shí) 小車控制系統(tǒng)便能掌握小車運(yùn)行的位置 色條作為 磁導(dǎo)航傳感器 磁條 技術(shù)交流報(bào)告書 位置標(biāo)簽 使用簡(jiǎn)單 方便 但對(duì)外部環(huán)境要求較高 容易產(chǎn)生誤 檢測(cè) 可靠性差 AGV 小車系統(tǒng)還可以使用 RFID 標(biāo)簽作為位置標(biāo)簽 RFID 標(biāo)簽 能存儲(chǔ)大量的位置信息 并能多次讀寫 RFID 標(biāo)簽的體積較小安裝 方便 抗干擾能力強(qiáng) RFID 讀寫器安裝在 AGV 小車前方底部 對(duì)標(biāo) 簽信息進(jìn)行讀取 并通過控制系統(tǒng)控制小車的下一步動(dòng)作 歐姆龍公司擁有成熟的 RFID 系列產(chǎn)品 RFID 主推產(chǎn)品有 V680 系列 包括有讀寫器 V680 CA5D01 V2 能讀寫 ID 標(biāo)簽 可通過 RS232 485 接口與 PLC 通訊 天線 V680 HS63 天線的讀寫距離為 7 0 30 0mm ID 標(biāo)簽 V680 D2KF67M 使用 FRAM 用來作為存儲(chǔ)器 不需要電池 外殼材質(zhì)為填充樹脂 形狀為 40 40 4 5mm 下圖 為 AGV 小車 RFID 系統(tǒng)工作原理圖 AGV 小車 RFID 系統(tǒng)工作原理圖 電磁導(dǎo)引引線隱蔽 不易污染和破損 便于控制 對(duì)聲光無干 技術(shù)交流報(bào)告書 擾 制造成本低 但所有車外預(yù)定路徑導(dǎo)引方式都存在共同缺點(diǎn)是 路徑難以更改擴(kuò)展 對(duì)復(fù)雜路徑的局限性大 與車外預(yù)定路徑導(dǎo)引 相反 非預(yù)定路徑導(dǎo)引方式?jīng)]有固定路徑 其自主性更高 2 非預(yù)定路徑導(dǎo)引方式是指 AGV 小車在運(yùn)行中沒有固定的路 徑 其通過激光 視覺 GPS 等方式 掌握運(yùn)行中所處的位置 并 自主地決定行駛路徑的導(dǎo)引方式 其中 較常用的是激光導(dǎo)引方式 激光導(dǎo)引是在 AGV 行駛路徑的周圍安裝位置精確的激光反射板 AGV 通過激光掃描器發(fā)射激光束 同時(shí)采集由反射板反射的激光束 來確定其當(dāng)前的位置和航向 并通過連續(xù)的三角幾何運(yùn)算來實(shí)現(xiàn) AGV 的導(dǎo)引 激光掃描器工作示意圖 非預(yù)定路徑導(dǎo)引方式優(yōu)點(diǎn)是 AGV 定位精確 地面無需其他定 位設(shè)施 行駛路徑靈活多變 適合多種現(xiàn)場(chǎng)環(huán)境 但它有一個(gè)很大 的缺點(diǎn)是制造成本高 所以在本文不作重點(diǎn)討論 4 AGV 小車控制系統(tǒng) AGV 小車系統(tǒng)除了上文提及的運(yùn)行系統(tǒng)及導(dǎo)引系統(tǒng)外 還需要 技術(shù)交流報(bào)告書 有中央控制系統(tǒng) 它能采集導(dǎo)引系統(tǒng)返回的位置信息 通過運(yùn)算轉(zhuǎn) 換 反作用于運(yùn)行系統(tǒng) 使 AGV 小車能做出需要的動(dòng)作 歐姆龍 CP1H 系列 PLC 便可以作為 AGV 小車的中央控制器 它 可以接收導(dǎo)引系統(tǒng)返回的模擬信號(hào)或開關(guān)量信號(hào) 它可以安裝 RS232 RS422 485 接插件 通過串行通訊方式與 RFID 控制器通訊 采集 ID 標(biāo)簽的位置信息 它能輸出控制伺服運(yùn)行的脈沖信號(hào)或模擬 量信號(hào) CP1H 的編程命令較簡(jiǎn)單 程序修改方便 而且還自帶有 AGV 小車運(yùn)行中需用到的 PID 等高級(jí)命令 所以 CP1H 非常適合用于 AGV 小車的中央控制器 小結(jié) AGV 小車系統(tǒng)是一個(gè)較復(fù)雜 跨學(xué)科 多系統(tǒng)的運(yùn)動(dòng)控制課題 因?yàn)楸救酥R(shí)底子較淺 本文對(duì) AGV 各系統(tǒng)的介紹都是很表面及簡(jiǎn) 單 離實(shí)現(xiàn) AGV 小車控制還有很遠(yuǎn)的距離 以后我還需要研究 如 何通過模糊 PID 控制 AGV 小車兩輪的速度差 使 AGV 小車的運(yùn)行更 穩(wěn)定 AGV 小車在各運(yùn)行狀態(tài)時(shí)的力矩情況 如何使用梯形圖 編寫 AGV 小車運(yùn)行程序 等課題 使 AGV 小車設(shè)計(jì)及應(yīng)用更趨完善