呂毅　戚志東

摘 要： 為設(shè)計(jì)一種低成本、抗干擾、穩(wěn)定可靠的AGV，提出一種基于磁帶導(dǎo)航的AGV系統(tǒng)。采用Megawin公司的80C51單片機(jī)為控制核心，以并排對稱設(shè)計(jì)的霍爾傳感器實(shí)現(xiàn)循跡和糾偏，紅外光電傳感器實(shí)現(xiàn)避障，并采用上位機(jī)對其進(jìn)行監(jiān)控。為達(dá)到AGV電機(jī)調(diào)速的穩(wěn)定性與實(shí)時(shí)性，采用分?jǐn)?shù)階PID算法進(jìn)行控制，通過Matlab軟件進(jìn)行建模與仿真，驗(yàn)證其可行性。最后，經(jīng)實(shí)際應(yīng)用場合驗(yàn)證，AGV小車具有抗干擾能力強(qiáng)，避障精度高，運(yùn)行穩(wěn)定安全等優(yōu)點(diǎn)。

關(guān)鍵詞： AGV； 電磁導(dǎo)航； 紅外避障； 分?jǐn)?shù)階PID

中圖分類號： TN919?34； TP2 文獻(xiàn)標(biāo)識碼： A 文章編號： 1004?373X（2017）03?0127?04

AGV control system for DC motor speed control based on fractional order PID

L? Yi， QI Zhidong

（School of Automation， Nanjing University of Science and Technology， Nanjing 210094， China）

Abstract： In order to design a low?cost， anti?interference， stable and reliable AGV， an AGV system based on magnetic navigation is proposed. The singlechip 80C51 made by Megawin Company is taken as the control core of the system. The Hall sensor with symmetrical design is used to realize the tracking and deviation rectification. The infrared photoelectric sensor is adopted to avoid the obstacles. The host computer is employed to monitor the system. In order to realize the stability and real?time performance of the AGV motor speed control， the fractional order PID algorithm is used to control the speed. The controller was modeled and simulated with Matlab software to verify its feasibility. The AGV has the advantages of strong anti?interference ability， high precision of obstacle avoidance， stable and safe operation， which were verified by the actual application.

Keywords： AGV； electromagnetic navigation； infrared obstacle avoidance； fractional order PID

0 引 言

AGV（自動導(dǎo)引運(yùn)輸車）是指裝有電、磁、聲、光等導(dǎo)引傳感裝置，能夠按照設(shè)定的導(dǎo)引路徑自動行駛，并根據(jù)實(shí)際應(yīng)用配備有移載、視頻監(jiān)控等功能的運(yùn)輸車[1]。AGV具有運(yùn)輸效率高、節(jié)能、工作可靠、能實(shí)現(xiàn)柔性運(yùn)輸、使用靈活、無公害等許多優(yōu)點(diǎn)，已廣泛應(yīng)用于許多領(lǐng)域[2]。

AGV的導(dǎo)引傳感裝置被稱為AGV之“眼”，是AGV能夠完成精確導(dǎo)引的基石。常用的導(dǎo)引方式有電磁導(dǎo)引、紅外導(dǎo)引、磁帶導(dǎo)引、光學(xué)導(dǎo)引、激光導(dǎo)引、圖像識別導(dǎo)引、GPS導(dǎo)引等[3]?？紤]到光學(xué)引導(dǎo)傳感器對周圍的光線環(huán)境要求較高以及光帶易磨損，易落灰等因素，本設(shè)計(jì)采用磁帶導(dǎo)引。

AGV的驅(qū)動電機(jī)是其運(yùn)動的基石。AGV運(yùn)動的穩(wěn)定性和響應(yīng)的及時(shí)性是衡量其質(zhì)量好壞的重要標(biāo)志，所以對其調(diào)速控制的研究具有重要意義。傳統(tǒng)PID由于結(jié)構(gòu)簡單，控制效果及穩(wěn)定性好，在工業(yè)控制中得到廣泛應(yīng)用。但是隨著智能車的發(fā)展，在高速情況下要求快速跟蹤目標(biāo)軌跡，傳統(tǒng)PID的控制效果也并不理想。分?jǐn)?shù)階PID控制將傳統(tǒng)PID控制擴(kuò)展到了分?jǐn)?shù)階領(lǐng)域，比傳統(tǒng)PID控制器多2個自由度，即積分和微分項(xiàng)的階次，因而它具有更大的調(diào)節(jié)范圍[4]。文獻(xiàn)[5]建立了系統(tǒng)的分?jǐn)?shù)階數(shù)學(xué)模型并設(shè)計(jì)了分?jǐn)?shù)階PID控制器，取得了比整數(shù)階數(shù)學(xué)模型和控制器好的系統(tǒng)性能。文獻(xiàn)[6]將分?jǐn)?shù)階PID控制器用于伺服電機(jī)控制中，取得了良好的效果。因此本文將采用分?jǐn)?shù)階PID實(shí)現(xiàn)AGV電機(jī)調(diào)速。

1 系統(tǒng)結(jié)構(gòu)

AGV小車的系統(tǒng)結(jié)構(gòu)如圖1所示，其可劃分為8個模塊，分別為MCU、RFID讀卡模塊、磁導(dǎo)航傳感器模塊、數(shù)碼管顯示模塊、光電與機(jī)械避障模塊、電機(jī)驅(qū)動模塊、WiFi模塊、上位機(jī)。

圖1中各個模塊的功能分別如下：

MCU：該模塊是整個系統(tǒng)的核心，主要完成處理RFID讀卡模塊、磁導(dǎo)航傳感器模塊、光電與機(jī)械避障模塊上傳的信息，輸出信息給數(shù)碼管顯示模塊顯示，同時(shí)控制電機(jī)的轉(zhuǎn)速以及轉(zhuǎn)向，并且通過WiFi模塊和上位機(jī)進(jìn)行信息的交換等。

RFID讀卡模塊：讀取地標(biāo)卡的信息，并上傳給MCU，用于控制AGV的起停。

磁導(dǎo)航傳感器模塊：主要利用霍爾傳感器檢測小車運(yùn)行的實(shí)際線路，并將處理后的信息發(fā)送給MCU。

數(shù)碼管顯示模塊：用6位7段數(shù)碼管并排顯示AGV的運(yùn)行狀況（車速，出軌），電池電量。

光電與機(jī)械避障模塊：主要檢測AGV是否遇到障礙物。

電機(jī)驅(qū)動模塊：主要為電機(jī)工作提供足夠的功率，并控制其轉(zhuǎn)速、轉(zhuǎn)向等。

WiFi模塊：實(shí)現(xiàn)上位機(jī)和AGV的無線通信。

2 系統(tǒng)硬件設(shè)計(jì)

2.1 MCU

本設(shè)計(jì)采用的微控單元（MCU）是Megawin公司的MA805?24系列的單片機(jī)。其在與標(biāo)準(zhǔn)8051 MCU有同樣處理能力的情況下，只需要非常低的運(yùn)行速度，因此可以很大程度地減少耗電量，同時(shí)擁有低成本，高性能的優(yōu)點(diǎn)[7]。

MA805?24擁有24 KB的內(nèi)置FLASH存儲器用于保存代碼和數(shù)據(jù)，擁有ISP和IAP能力。

MA805?24除保留了標(biāo)準(zhǔn)80C52的所有功能外，還增加了許多其他功能。接口豐富，包括PCA，SPI，UART，SCI，I2C等，可以實(shí)現(xiàn)和各種傳感器模塊的連接。

2.2 磁導(dǎo)航模塊

本設(shè)計(jì)采用磁條和并排對稱設(shè)計(jì)的7組霍爾傳感器實(shí)現(xiàn)對AGV的導(dǎo)航。

其原理是利用通電霍爾元件在磁場中產(chǎn)生一個輸出電壓，通過一系列的跟隨，放大之后給單片機(jī)一個信號，實(shí)現(xiàn)AGV的導(dǎo)引，其原理圖如圖2所示。主控板給三端穩(wěn)壓芯片LM317一個5 V電壓，輸出電壓[Vout]（即CH11的電位）可以通過電位器RWC1調(diào)節(jié)，同時(shí)RWC1可以調(diào)節(jié)LM324的14腳輸出電壓，即改變CH13的電位，這樣就可以給霍爾傳感器HW?101A一個恒定的輸入電壓1.25 V?；魻杺鞲衅鞯妮敵鲭妷褐挥?22～370 mV（CH12和CH14為其輸出端），這里通過跟隨、放大之后輸出一個高電平，并通過RC18限流，使得三極管QC1導(dǎo)通，OUT1輸出一個低電平信號給單片機(jī)，實(shí)現(xiàn)導(dǎo)航控制。

2.3 數(shù)碼管顯示模塊

本設(shè)計(jì)采用6位7段數(shù)碼管作為顯示模塊，在降低成本的同時(shí)，有效地實(shí)現(xiàn)了顯示功能。它主要用來顯示小車的運(yùn)行狀況，比如小車運(yùn)行時(shí)顯示車速大??；出軌時(shí)顯示OFF?Ln；啟動時(shí)顯示運(yùn)行方向；停車時(shí)先顯示停靠時(shí)間再顯示電池電量。電池電量主要通過電阻分壓模式來檢測，并通過單片機(jī)A/D采樣，從而顯示出來。其中RB6和CB1的作用是RC濾波，RB7的作用是限流。檢測電路如圖3所示。

2.4 光電與機(jī)械避障模塊

AGV避障模塊主要使用的是SUNX光電傳感器[8]PX?22。PX?22擁有2個檢測區(qū)域，即近距離區(qū)域OUT1和遠(yuǎn)距離區(qū)域OUT2，最大檢測距離是3 m。通過靈敏度調(diào)節(jié)可以設(shè)置其檢測距離。本系統(tǒng)中，設(shè)定OUT2檢測距離為1 m，OUT1檢測距離為0.3 m。當(dāng)小車在1 m處檢測到障礙物時(shí)，需減速行駛；當(dāng)障礙物離小車的距離為0.3 m時(shí)，小車則停止。

由于PX?22傳感器的檢測區(qū)域?yàn)樯刃螀^(qū)域，存在盲區(qū)，本系統(tǒng)裝有2個光電開關(guān)在PX?22左右兩側(cè)來減小盲區(qū)。另外，在小車的前面還安裝有行程開關(guān)（機(jī)械避障），用于防撞檢測。

2.5 WiFi模塊

為了實(shí)現(xiàn)更加快捷方便地控制AGV小車，本設(shè)計(jì)采用USR?WiFi232?602串口轉(zhuǎn)WiFi模塊，將MCU的SCI信號轉(zhuǎn)化成WiFi信號，并通過WiFi網(wǎng)絡(luò)和上位機(jī)相連，與上位機(jī)實(shí)現(xiàn)數(shù)據(jù)交換和通信。USR?WiFi232?602模塊支持TCP Server，TCP Client，UDP Server，UDP Client四種工作模式，TCP Server模式時(shí)可以支持多達(dá)32個Client連接。此模塊擁有AP和STA兩個應(yīng)用模式，作為AP時(shí)，其他無線設(shè)備可以作為STA與其連接通信；作為STA時(shí)，可以通過路由器與其他設(shè)備實(shí)現(xiàn)組網(wǎng)。實(shí)際應(yīng)用中，其具有傳輸距離遠(yuǎn)，可靠性高，組網(wǎng)靈活等特點(diǎn)。

3 系統(tǒng)軟件設(shè)計(jì)

3.1 分?jǐn)?shù)階PID控制算法

對于整個系統(tǒng)來說，軟件設(shè)計(jì)的核心在于控制算法。

分?jǐn)?shù)階[PIλDμ]是由I.Podlubny教授提出的。分?jǐn)?shù)階[PIλDμ]除了[KP，][KI]和[KD]外，還引入了積分階次[λ]和微分階次[μ，]其中[λ]和[μ]可以是任意實(shí)數(shù)。其傳遞函數(shù)為：

[C（s）=KP+KIsλ+KDsμ]

可以看出，分?jǐn)?shù)階比例?積分?微分是常規(guī)比例?積分?微分控制律的一般形式，整數(shù)階PID是分?jǐn)?shù)階[PIλDμ]在[λ=μ=1]時(shí)的特例。由于分?jǐn)?shù)階[PIλDμ]比整數(shù)階PID多了兩個可調(diào)參數(shù)[λ]和[μ，]因而具有更大的調(diào)節(jié)自由度[9]。分?jǐn)?shù)階PID控制器的閉環(huán)系統(tǒng)結(jié)構(gòu)如圖4所示。

本設(shè)計(jì)采用中大直流電機(jī)，電動機(jī)的額定參數(shù)為：[UN=12]V，[IN=5.2]A，[nN=]2 800 r/min，[Ra=]0.52 Ω。通過Matlab對其整數(shù)階和分?jǐn)?shù)階建模和仿真，并且通過時(shí)間乘以誤差絕對值積分（ITAE）的性能指標(biāo)來參數(shù)整定，尋求最優(yōu)的[KP，][KI]和[KD]值以及[λ]和[μ]的值，得到電機(jī)轉(zhuǎn)速[n]和時(shí)間[t]的關(guān)系曲線，其中[KP=1.08，][KI=5.28，][KD=0.056，][λ=0.9]和[μ=0.1。]整數(shù)階PID控制器的仿真結(jié)果如圖5所示，分?jǐn)?shù)階PID控制器的仿真結(jié)果如圖6所示。

由圖5和圖6的仿真結(jié)果可知，整數(shù)階PID控制的上升時(shí)間[tr=]0.13 s，峰值時(shí)間[tm=]0.31 s，調(diào)節(jié)時(shí)間[ts=]0.82 s，超調(diào)量[σ%=8.6%；]分?jǐn)?shù)階PID控制的上升時(shí)間[tr=0.06 s，]峰值時(shí)間[tm=0.14 s，]調(diào)節(jié)時(shí)間[ts=0.4 s，]超調(diào)量[σ%=3.6%；]可見分?jǐn)?shù)階控制器比整數(shù)階控制器的控制能力要強(qiáng)很多，能夠縮短53.8%的上升時(shí)間，54.8%的峰值時(shí)間，51.2%的調(diào)節(jié)時(shí)間，減小58.1%的超調(diào)量；其調(diào)速的穩(wěn)定性和快速性更強(qiáng)。

要在單片機(jī)控制系統(tǒng)中實(shí)現(xiàn)分?jǐn)?shù)階PID控制器，需要將時(shí)域中的微分方程離散化。然后就可以在嵌入式程序中設(shè)置變量，編寫程序，找到控制參數(shù)，從而調(diào)節(jié)輸出PWM的占空比，達(dá)到調(diào)節(jié)電機(jī)轉(zhuǎn)速，控制小車穩(wěn)定運(yùn)動的目標(biāo)。

3.2 上位機(jī)軟件設(shè)計(jì)

上位機(jī)主要用來實(shí)現(xiàn)對AGV小車的控制和數(shù)據(jù)交換。本設(shè)計(jì)的上位機(jī)軟件采用C#編寫，主要分為基本設(shè)置、運(yùn)行狀態(tài)、數(shù)據(jù)顯示三個部分。上位機(jī)界面如圖7所示。

基本設(shè)置部分主要用來給小車發(fā)送指令，設(shè)置其運(yùn)行速度、方向以及目標(biāo)站點(diǎn)。而小車的障礙物報(bào)警、脫軌、故障等情況則由運(yùn)行狀態(tài)部分來顯示。數(shù)據(jù)顯示部分用來采集小車的電池電量以便及時(shí)充電，同時(shí)用來監(jiān)控小車的運(yùn)行速度。

4 結(jié) 語

對于AGV而言，保證其運(yùn)動的可靠性、穩(wěn)定性至關(guān)重要。它涉及到硬件電路設(shè)計(jì)的兼容性以及軟件控制算法的優(yōu)化性等很多方面內(nèi)容。在本設(shè)計(jì)中，利用霍爾傳感技術(shù)配合優(yōu)化的硬件電路設(shè)計(jì)了磁導(dǎo)航傳感器，保證其循跡的精度和可靠性，受外界干擾??；此外，通過分?jǐn)?shù)階PID控制算法調(diào)節(jié)電機(jī)轉(zhuǎn)速，減小過沖，控制小車平穩(wěn)運(yùn)行。在實(shí)際運(yùn)用中，該車表現(xiàn)了良好的可靠性和穩(wěn)定性，受外界干擾小，達(dá)到了設(shè)計(jì)的目的，具有廣闊的應(yīng)用前景。

參考文獻(xiàn)

[1] 李強(qiáng)，胡澤，葛亮.利用電磁導(dǎo)航的AGV設(shè)計(jì)[J].現(xiàn)代電子技術(shù)，2012，35（12）：79?81.

[2] 黃祥源.自動導(dǎo)向小車控制系統(tǒng)[J].輕工機(jī)械，2012，30（2）：38?41.

[3] 潘麗杰，徐本亮，雷蕾，等.一種紅外超聲相結(jié)合的AGV導(dǎo)航系統(tǒng)[J].現(xiàn)代電子技術(shù)，2015，38（7）：127?130.

[4] 吳振宇，趙亮，馮林.基于分?jǐn)?shù)階PID控制器的智能車控制[J].控制工程，2011，18（3）：401?404.

[5] 鄧立為，宋申民，龐慧.控制系統(tǒng)的分?jǐn)?shù)階建模及分?jǐn)?shù)階PIλDμ控制器設(shè)計(jì)[J].電機(jī)與控制學(xué)報(bào)，2014，18（3）：85?91.

[6] TAHAMI F， MOGHADAM B E. Speed control of servo drives with a flexible couplings using fractional order state feedback [C]// Proceedings of 2014 the 5th Power Electronics， Drive Systems and Technologies Conference. Tehran： IEEE， 2014： 25?30.

[7] 笙泉科技股份有限公司.MA805?24數(shù)據(jù)手冊[EB/OL].[2012?01?29].http：//www.doc88.com/p?906996978022.html.

[8] SUNX Limited.PX?2系列使用說明書[EB/OL].[2007?08?15].http：//www.chem17.com/offer_sale/detail/4145051.html.

[9] 王瑞萍.基于分?jǐn)?shù)階控制器的永磁同步電動機(jī)速度控制研究[D].廣州：華南理工大學(xué)，2012.

[10] 蔣達(dá)，梁慶輝，蔣清豐.無刷直流電機(jī)PWM調(diào)速控制系統(tǒng)的建模與仿真[J].數(shù)字技術(shù)應(yīng)用，2012（2）：27?28.

[11] 懷紅旗.基于分?jǐn)?shù)階PID控制的交流伺服系統(tǒng)研究[J].自動化博覽，2015（5）：100?102.

[12] 趙為.太陽能光伏并網(wǎng)發(fā)電系統(tǒng)的研究[D].合肥：合肥工業(yè)大學(xué)，2003.

[13] 鄭炳坤，賴乙宗，葉峰.磁導(dǎo)航AGV控制系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)[J].自動化與儀表，2014（3）：6?10.

[14] 毛書軍.基于計(jì)算智能的分?jǐn)?shù)階PID控制器研究[D].大連：大連理工大學(xué)，2014.