朱亞榮，姜樹(shù)海

（南京林業(yè)大學(xué)　智能控制與機(jī)器人技術(shù)研究所，南京　210037）

基于PLC的收餐機(jī)器人控制系統(tǒng)設(shè)計(jì)

朱亞榮，姜樹(shù)海

（南京林業(yè)大學(xué)智能控制與機(jī)器人技術(shù)研究所，南京210037）

針對(duì)當(dāng)前餐廳收餐自動(dòng)化水平低下的現(xiàn)狀，提出了自動(dòng)化收餐流水線的概念，設(shè)計(jì)了一款收餐機(jī)器人；在分析收餐機(jī)器人整機(jī)結(jié)構(gòu)和運(yùn)動(dòng)要求的基礎(chǔ)上，進(jìn)一步設(shè)計(jì)了一種基于PLC的收餐機(jī)器人控制系統(tǒng)；系統(tǒng)主要由餐盤翻轉(zhuǎn)模塊、篩選模塊、餐具輸運(yùn)模塊、餐盤堆疊模塊和殘?jiān)占K組成；根據(jù)不同模塊的工作流程和作業(yè)需求，以西門子S7-200為控制系統(tǒng)核心，完成了系統(tǒng)的軟硬件設(shè)計(jì)，并分別對(duì)各模塊進(jìn)行了編程調(diào)試，可實(shí)現(xiàn)精確的位置控制，符合實(shí)際控制要求，達(dá)到自動(dòng)收餐的目的。

收餐機(jī)器人；PLC；控制系統(tǒng)；位置控制

0　引言

在經(jīng)濟(jì)飛速發(fā)展和科技不斷進(jìn)步的時(shí)代，自動(dòng)化生產(chǎn)和管理已滲入到各大行業(yè)，作為現(xiàn)代先進(jìn)科學(xué)技術(shù)核心的工業(yè)自動(dòng)化正在不斷地被廣泛運(yùn)用到經(jīng)濟(jì)發(fā)展的各領(lǐng)域［1］。餐飲業(yè)在我國(guó)第三產(chǎn)業(yè)中占有重要地位，是服務(wù)經(jīng)濟(jì)繁榮程度的標(biāo)志［2］，其自動(dòng)化水平的提高對(duì)國(guó)民而言意義重大。

為控制人工成本和改善就餐環(huán)境，國(guó)內(nèi)餐廳開(kāi)始將自動(dòng)化技術(shù)、信息技術(shù)應(yīng)用于其中的作業(yè)環(huán)節(jié)，讓機(jī)器代替手工或幫助手工進(jìn)行工作，市場(chǎng)上也不斷涌現(xiàn)出相關(guān)的科技產(chǎn)品，使餐廳運(yùn)營(yíng)不斷朝著信息化和自動(dòng)化發(fā)展［3］。目前的餐飲行業(yè)已普遍開(kāi)始應(yīng)用一些信息化的科技產(chǎn)品，比如點(diǎn)菜系統(tǒng)，可快速通過(guò)觸摸屏或手持器點(diǎn)餐，自動(dòng)將菜單傳至收銀臺(tái)和廚房［4］。杭州雄偉科技開(kāi)發(fā)有限公司設(shè)計(jì)的一種自助式餐飲結(jié)算臺(tái)［5］，用以幫助餐廳實(shí)現(xiàn)不同部門間的信息流通，方便營(yíng)業(yè)管理。自動(dòng)化層面上的科技產(chǎn)品目前來(lái)看還不成熟，盡管相繼出現(xiàn)了不少代替人工的機(jī)器，用以實(shí)現(xiàn)餐飲服務(wù)中某些流程的自動(dòng)化，比如食堂自動(dòng)打飯機(jī)、餐廳服務(wù)機(jī)器人［6］、蛋炒飯機(jī)器人［7］等，但是，后續(xù)的收餐環(huán)節(jié)依舊主要靠人工完成，暫時(shí)還沒(méi)有出現(xiàn)成熟、可推廣的技術(shù)。在就餐高峰時(shí)期，人工收餐勞動(dòng)量大，效率低下，常常出現(xiàn)餐盤來(lái)不及收集的狀況，尤其是在學(xué)校食堂、企業(yè)員工餐廳等就餐人員眾多的場(chǎng)合，這種狀況更為明顯，嚴(yán)重影響就餐環(huán)境?；谧詣?dòng)化水平不斷發(fā)展、傳統(tǒng)產(chǎn)業(yè)相繼升級(jí)和收餐環(huán)節(jié)科技滯后的問(wèn)題，我們提出了自動(dòng)化餐飲流水線中收餐機(jī)器人的課題。

在機(jī)器人控制中，多采用基于微機(jī)的控制器或基于DSP（digital signal processing，數(shù)字信息處理器）的控制器作為機(jī)器人的控制系統(tǒng)硬件，即“運(yùn)動(dòng)控制器+PC”結(jié)構(gòu)形式的控制系統(tǒng)。這種控制系統(tǒng)以PC為上位機(jī)，運(yùn)動(dòng)控制器為下位機(jī)，可快速對(duì)運(yùn)動(dòng)軸，尤其是多軸的系統(tǒng)加以控制。雖然上下位結(jié)構(gòu)清楚，但系統(tǒng)穩(wěn)定性不夠、難以擴(kuò)展、兼容性不強(qiáng)、維護(hù)困難。PLC（programmable logic controller，可編程邏輯控制器）由于其可靠性高、結(jié)構(gòu)簡(jiǎn)單、編程方便、功能完善、性價(jià)比高等優(yōu)點(diǎn)，在工業(yè)控制系統(tǒng)中有著重要地位，且隨著PLC技術(shù)的成熟，尤其是在運(yùn)動(dòng)控制方面，可驅(qū)動(dòng)步進(jìn)電機(jī)或伺服電機(jī)的單軸或多軸位置控制模塊，用于圓周運(yùn)動(dòng)或直線運(yùn)動(dòng)的控制［10］。目前，機(jī)器人控制多采用PLC控制器對(duì)機(jī)器人各軸運(yùn)動(dòng)進(jìn)行規(guī)劃和編程，使機(jī)器人按照既定的程序依次動(dòng)作，在工作過(guò)程中，借助傳感器判斷工作狀態(tài)、感知工作環(huán)境，不斷調(diào)節(jié)運(yùn)動(dòng)狀態(tài)，機(jī)器人可即按照預(yù)定的動(dòng)作和路線有序工作［11］。基于PLC能實(shí)現(xiàn)控制系統(tǒng)功能要求且性價(jià)比高的特性，我們開(kāi)展了基于PLC的收餐機(jī)器人控制系統(tǒng)設(shè)計(jì)的研究。

1　系統(tǒng)總體框架

為達(dá)到以機(jī)械替代人工進(jìn)行餐盤清潔與殘?jiān)斶\(yùn)的目的，收餐機(jī)器人采用五大模塊來(lái)對(duì)餐盤、餐具和殘?jiān)M(jìn)行處理，此五大模塊分別為餐盤翻轉(zhuǎn)模塊、篩選模塊、餐具輸運(yùn)模塊、餐盤堆疊模塊和殘?jiān)占K，如圖1所示。

圖1　收餐機(jī)器人機(jī)械示意圖

收餐機(jī)器人采用模塊化的控制系統(tǒng)，各控制模塊可自由組合，適應(yīng)不同的工作條件，以滿足不同的控制系統(tǒng)運(yùn)行要求。具體工作流程：首先，帶有殘?jiān)牟捅P和其他餐具送至餐盤翻轉(zhuǎn)模塊后，餐盤翻轉(zhuǎn)模塊開(kāi)始運(yùn)轉(zhuǎn)，將餐盤、餐具和殘?jiān)蛛x，而后餐具和殘?jiān)珊Y選裝置進(jìn)行篩選，餐具將進(jìn)入餐具輸運(yùn)裝置，并被輸運(yùn)到指定位置，而殘?jiān)鼘⑦M(jìn)入殘?jiān)占K，餐盤將進(jìn)一步跟隨旋轉(zhuǎn)架運(yùn)動(dòng)到餐盤堆疊模塊，整個(gè)處理過(guò)程結(jié)束。模塊間的關(guān)系和工作流程如圖2所示。

圖2　收餐機(jī)器人系統(tǒng)工作流程圖

1.1餐盤翻轉(zhuǎn)模塊

餐盤翻轉(zhuǎn)模塊采用旋轉(zhuǎn)架結(jié)構(gòu)，旋轉(zhuǎn)架由伺服電機(jī)驅(qū)動(dòng)，上面安裝機(jī)械手。其中，機(jī)械手上安裝光電傳感器和電磁鐵，并且可做水平方向和上下方向運(yùn)動(dòng)。在實(shí)際運(yùn)動(dòng)中，旋轉(zhuǎn)架運(yùn)轉(zhuǎn)流程如圖3所示：1）啟動(dòng)時(shí)，機(jī)械手處于水平位置，當(dāng)餐盤擺放到機(jī)械手上時(shí)，機(jī)械手上的光電傳感器感知，PLC收到信號(hào)并讓電磁鐵通電吸住餐盤；2）接著旋轉(zhuǎn)架開(kāi)始轉(zhuǎn)動(dòng)；3）在旋轉(zhuǎn)過(guò)程中，由于其他餐具未被吸住，因而受慣性作用掉落到下面的篩選模塊上，達(dá)到分離的目的；4）旋轉(zhuǎn)架旋轉(zhuǎn)180°后停止，電磁鐵斷電失去磁性并放下餐盤，等待下一個(gè)餐盤的到來(lái)。

圖3　旋轉(zhuǎn)架運(yùn)轉(zhuǎn)過(guò)程

1.2餐具輸送模塊

為將餐具運(yùn)送到更寬闊的地方統(tǒng)一收集，如圖4所示，餐具和殘?jiān)袈浜?，?jīng)濾網(wǎng)式輸送帶篩選后，殘?jiān)袈涞綒堅(jiān)占?，餐具則跟隨輸送帶向前運(yùn)動(dòng)，將餐具運(yùn)到指定位置后停止，餐具由于慣性掉落在餐具收集處。餐具輸送模塊運(yùn)動(dòng)流程如圖所示：在餐具和殘?jiān)袈涮幇惭b光電傳感器，當(dāng)餐具滑落時(shí)，傳感器檢測(cè)到物體，此時(shí)輸送帶開(kāi)始運(yùn)行，運(yùn)行一個(gè)工作長(zhǎng)度后，輸送帶停止運(yùn)行直到下一個(gè)餐具掉落。

圖4　輸送帶運(yùn)行過(guò)程

1.3餐盤堆疊模塊

餐盤堆疊模塊由做直線運(yùn)動(dòng)的手臂和用于夾緊餐盤的機(jī)械手爪組成。手臂由旋轉(zhuǎn)伺服電機(jī)驅(qū)動(dòng)，經(jīng)滾珠絲杠傳動(dòng)，可做前進(jìn)、后退、上升、下降運(yùn)動(dòng)并返回原點(diǎn)。機(jī)械手爪上安裝光電傳感器和電磁鐵，通過(guò)控制電磁鐵的通斷電，改變電磁鐵磁性，實(shí)現(xiàn)餐盤的夾緊和放下。機(jī)械手運(yùn)動(dòng)過(guò)程如圖5所示，當(dāng)餐盤在A側(cè)放于機(jī)械手上后，機(jī)械手上的光電傳感器感知，將信號(hào)傳給PLC控制器，PLC再控制電磁鐵通電吸取餐盤。機(jī)械手隨旋轉(zhuǎn)架旋轉(zhuǎn)180°后，到達(dá)B側(cè)。接著，手臂向前前進(jìn)一個(gè)工作長(zhǎng)度，到達(dá)C側(cè)，即餐盤堆疊位置，使電磁鐵斷電并放下餐盤，手臂再原路返回到原位置，如此循環(huán)。

圖5　餐盤堆疊運(yùn)動(dòng)過(guò)程

當(dāng)系統(tǒng)啟動(dòng)后，可通過(guò)手動(dòng)/自動(dòng)轉(zhuǎn)換開(kāi)關(guān)選擇運(yùn)行模式。在手動(dòng)運(yùn)行時(shí)，可以對(duì)各模塊運(yùn)動(dòng)進(jìn)行調(diào)試，實(shí)現(xiàn)點(diǎn)動(dòng)或一個(gè)工作單位的運(yùn)動(dòng)，保證系統(tǒng)運(yùn)行的安全和精確性。在自動(dòng)模式時(shí)，系統(tǒng)可自動(dòng)完成各模塊的運(yùn)動(dòng)，并實(shí)現(xiàn)模塊間的協(xié)調(diào)和順序控制，保證收餐的整個(gè)流程有序完成，大大解放人力，也可提高就餐高峰時(shí)期的收餐效率。

2　系統(tǒng)硬件配置

控制系統(tǒng)由CPU226、3個(gè)位控模塊EM253、4個(gè)伺服驅(qū)動(dòng)器和4個(gè)伺服電機(jī)組成。由于西門子CPU226內(nèi)置脈沖輸出器，如脈沖串輸出（PTO）模式［12］，為節(jié)省位控模塊數(shù)量，餐具輸送模塊采用PTO控制方式；而餐盤翻轉(zhuǎn)模塊、餐盤堆疊模塊由于位置精度要求較高，則利用EM253進(jìn)行位置控制?？刂葡到y(tǒng)結(jié)構(gòu)示意圖如圖6所示。

2.1PLC

西門子S7-200系列PLC具有可靠、易操作、靈活等優(yōu)點(diǎn)，在工業(yè)控制中被廣泛應(yīng)用，并且能夠滿足收餐機(jī)器人的性能需求，所以PLC選擇西門子S7-200系列?？刂葡到y(tǒng)需要較多的輸入輸出端口，總計(jì)17個(gè)數(shù)字量輸入，8個(gè)數(shù)字量輸出，同時(shí)連接有3個(gè)EM253位控模塊，故只能選擇CPU226型號(hào)。

2.1.1數(shù)字量輸入部分

圖6　收餐機(jī)器人控制系統(tǒng)結(jié)構(gòu)示意圖

控制系統(tǒng)輸入部分可分為轉(zhuǎn)換開(kāi)關(guān)、按鈕、光電傳感器和限位開(kāi)關(guān)，共有17個(gè)數(shù)字輸入量。具體分配如表1所示。

表1　輸入變量地址分配表

2.1.2數(shù)字量輸出部分

控制系統(tǒng)主要輸出控制的設(shè)備有伺服電機(jī)驅(qū)動(dòng)器，電磁鐵和指示燈，共有8個(gè)數(shù)字輸出量。具體分配如表2所示。

2.2伺服電機(jī)

在此控制系統(tǒng)中，共有4個(gè)伺服電機(jī)，分別控制旋轉(zhuǎn)架、機(jī)械手前進(jìn)后退、機(jī)械手上升下降、餐盤輸送帶的運(yùn)行。伺服電機(jī)接收伺服驅(qū)動(dòng)器發(fā)出的電信號(hào)，在電動(dòng)機(jī)軸上以角位移或角速度的形式輸出，精確控制電機(jī)運(yùn)行的速度，經(jīng)滾珠絲杠傳動(dòng)，實(shí)現(xiàn)精準(zhǔn)的直線運(yùn)動(dòng)［13］。

表2　輸出變量地址分配表

由于設(shè)計(jì)在餐盤翻轉(zhuǎn)模塊、餐具運(yùn)輸模塊、餐盤堆疊模塊均需要實(shí)現(xiàn)精確的定位控制，并且需要電機(jī)能快速反應(yīng)、不產(chǎn)生噪聲以營(yíng)造餐廳良好環(huán)境，故選用伺服電機(jī)。

此控制系統(tǒng)中，有4個(gè)伺服電機(jī)，相應(yīng)地，每個(gè)伺服電機(jī)需配備一個(gè)伺服驅(qū)動(dòng)器來(lái)控制電機(jī)，接收來(lái)自PLC的脈沖，以改變伺服電機(jī)的轉(zhuǎn)速、轉(zhuǎn)向、扭矩等，達(dá)到精確控制伺服電機(jī)的目的［14］。

2.3位置控制模塊

定位模塊EM253通過(guò)產(chǎn)生高速脈沖來(lái)實(shí)現(xiàn)對(duì)單軸步進(jìn)電機(jī)的開(kāi)環(huán)速度、位置控制。通過(guò)S7-200PLC的擴(kuò)展接口，實(shí)現(xiàn)與CPU間通訊控制。在此系統(tǒng)中，共使用了3個(gè)EM253位控模塊，實(shí)現(xiàn)對(duì)機(jī)械手兩個(gè)方向和旋轉(zhuǎn)架正反轉(zhuǎn)伺服電機(jī)的位置控制。由于機(jī)械手做直線運(yùn)動(dòng)，故采用工程單位（如：毫米、英尺）作為控制系統(tǒng)的測(cè)量單位。EM253位控模塊安裝、拆卸簡(jiǎn)單方便，易于靈活控制各個(gè)運(yùn)動(dòng)模塊。

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

根據(jù)控制系統(tǒng)的功能要求，收餐機(jī)器人的控制過(guò)程分為手動(dòng)控制模式和自動(dòng)控制模式。在手動(dòng)控制模式時(shí)，各設(shè)備可以單獨(dú)運(yùn)行，相互之間沒(méi)有順序，互不干擾。模式選擇流程圖如圖7所示。

圖7　收餐機(jī)器人模式選擇流程圖

3.1手動(dòng)控制模式

在手動(dòng)模式時(shí)，可以通過(guò)按鈕單獨(dú)控制各設(shè)備的運(yùn)行，包括：旋轉(zhuǎn)架的正反轉(zhuǎn)，機(jī)械手的前進(jìn)后退、上升下降，輸送帶的前進(jìn)后退，電磁鐵的通斷電。在運(yùn)行允許范圍內(nèi)，各設(shè)備可任意移動(dòng)，便于控制系統(tǒng)的調(diào)試和檢測(cè)。手動(dòng)控制流程圖如圖8所示。

圖8　手動(dòng)控制運(yùn)行流程圖

3.2自動(dòng)控制模式

在自動(dòng)控制模式時(shí)，系統(tǒng)通電后，按下啟動(dòng)按鈕，各設(shè)備開(kāi)始按照順序運(yùn)行，具體運(yùn)行流程如圖9所示。

圖9　自動(dòng)控制運(yùn)行流程圖

3.3編程用數(shù)據(jù)地址分配

控制系統(tǒng)中有多個(gè)模塊，輸送帶采用PTO控制方式，旋轉(zhuǎn)架和機(jī)械手采用EM253進(jìn)行控制。在程序設(shè)計(jì)時(shí)，為使編程清晰明了、易于修改，對(duì)各模塊地址進(jìn)行分配，如表3所示。

3.4程序的編寫

利用西門子公司專門為S7-200 PLC設(shè)計(jì)開(kāi)發(fā)的STEP7-Micro/WIN，該軟件基于Windows，功能十分強(qiáng)大，主要用于開(kāi)發(fā)程序，也可實(shí)時(shí)監(jiān)控程序執(zhí)行的狀態(tài)。

控制系統(tǒng)主程序利用梯形圖進(jìn)行編程，在了解系統(tǒng)總體流程后，細(xì)化各模塊，按照不同的功能要求編寫不同模塊的相應(yīng)程序。其中旋轉(zhuǎn)架、機(jī)械手和輸送帶的位置控制部分借助STEP7-Micro/WIN中的“位置控制向?qū)А惫ぞ?，進(jìn)行各模塊位置控制參數(shù)的設(shè)置，生成子程序，在編寫主程序時(shí)直接調(diào)用，如圖10所示。

表3　模塊地址分配表

4　實(shí)驗(yàn)結(jié)果與分析

選用東元經(jīng)濟(jì)型TSTE30C驅(qū)動(dòng)器（最大功率1KW）和TSB13102B3NLA001系列伺服電機(jī)，根據(jù)驅(qū)動(dòng)器手冊(cè)完成PLC控制器、EM253模塊和伺服驅(qū)動(dòng)器的接線，如圖11所示。

圖10　機(jī)械手自動(dòng)向上運(yùn)行程序子程序

圖11　硬件接線圖

接線檢查無(wú)誤后，建立PLC與上位機(jī)的通訊，將程序下載到PLC，對(duì)PLC的輸出進(jìn)行監(jiān)控。最終調(diào)試結(jié)果如下：1）手動(dòng)模式時(shí)，依次按下啟動(dòng)、電磁鐵通斷電、旋轉(zhuǎn)架正反轉(zhuǎn)、機(jī)械手前進(jìn)后退、機(jī)械手上升下降各按鈕，電源指示燈亮起，同時(shí)各模塊的伺服電機(jī)點(diǎn)動(dòng)正反轉(zhuǎn)均可實(shí)現(xiàn)。2）撥動(dòng)轉(zhuǎn)換開(kāi)關(guān)，切換到自動(dòng)模式，按下啟動(dòng)按鈕，電源指示燈亮起，接著，分別觸發(fā)機(jī)械手光電傳感器和輸送帶光電傳感器，對(duì)垂直方向和水平方向的限位開(kāi)關(guān)進(jìn)行強(qiáng)制輸入，試驗(yàn)發(fā)現(xiàn)驅(qū)動(dòng)餐盤翻轉(zhuǎn)模塊、餐具輸送模塊、餐盤堆疊模塊的伺服電機(jī)可以按照控制要求順序動(dòng)作，實(shí)現(xiàn)了一定條件下的自動(dòng)控制，基本滿足收餐需求。因此，在實(shí)際應(yīng)用中，根據(jù)不同的收餐環(huán)境，可以相應(yīng)地調(diào)整電機(jī)的運(yùn)行速度，實(shí)現(xiàn)系統(tǒng)的最優(yōu)化。

5　結(jié)論

收餐機(jī)器人控制系統(tǒng)運(yùn)用PLC技術(shù)，實(shí)現(xiàn)了收餐流程的自動(dòng)化控制，可以使簡(jiǎn)單重復(fù)的人工收餐方式由機(jī)器操作代替，有效解決了就餐高峰時(shí)期大量餐盤堆積無(wú)法清理的問(wèn)題。系統(tǒng)采用西門子S7-200 PLC作為控制器，驅(qū)動(dòng)伺服電機(jī)單軸運(yùn)動(dòng)控制模塊，控制餐盤翻轉(zhuǎn)模塊的圓周運(yùn)動(dòng)、餐具輸送模塊和餐盤堆疊模塊的直線運(yùn)動(dòng)，使得各模塊運(yùn)動(dòng)協(xié)調(diào)有序。收餐機(jī)器人控制系統(tǒng)的設(shè)計(jì)簡(jiǎn)單穩(wěn)定，易于操作，經(jīng)過(guò)調(diào)試達(dá)到設(shè)計(jì)要求，未來(lái)可廣泛應(yīng)用于學(xué)校食堂、員工餐廳、大型快餐店等餐飲流水線中的收餐環(huán)節(jié)。未來(lái)我們將結(jié)合收餐機(jī)器人的應(yīng)用實(shí)際，進(jìn)一步完善整機(jī)的性能。

［1］郭孟榕.我國(guó)工業(yè)自動(dòng)化市場(chǎng)的發(fā)展?fàn)顩r及前景展望［J］.中國(guó)科技信息，2003，42（3）：95.程鋼.中國(guó)餐飲業(yè)管理模式研究［D］.長(zhǎng)沙：湖南師范大學(xué)，2010.

［2］Doug Doran.Restaurants and Technology-Past，Present and Fu-ture：a Practitioner's Viewpoint［J］.Worldwide Hospitality and Tourism Themes，2010，2（1），94-99.

［3］郭春鵬.餐飲信息化的多元化發(fā)展［J］.信息與電腦，2013 （7）：61-62.

［4］杭州雄偉科技開(kāi)發(fā)有限公司.一種自助式餐飲結(jié)算臺(tái)：中國(guó)，CN201220121989.8 ［P］.2012 12-05.

［5］Yu Q X，Yuan C，F(xiàn)u Z，et al.An autonomous restaurant service robot with high positioning accuracy［J］.Industrial Robot：2012，39（3），271-281.

［6］南京大五教育科技有限公司.蛋炒飯機(jī)器人：中國(guó)，CN102848397A［P］.2013 01-02.

［7］卞洪元.基于PLC控制的工業(yè)機(jī)器人系統(tǒng)的研究與實(shí)現(xiàn)［D］.南京：東南大學(xué)，2005.

［8］張豐華，韓寶玲，羅慶生，等.基于PLC的新型工業(yè)碼垛機(jī)器人控制系統(tǒng)設(shè)計(jì)［J］.計(jì)算機(jī)測(cè)量與控制，2009，11 （17）：2191-2196.

［9］劉衛(wèi)平，王明泉.PLC的發(fā)展及應(yīng)用前景［J］.機(jī)械管理開(kāi)發(fā)，2009，10 （110）：78-80.

［10］陳保帆，韓亞軍.基于PLC控制產(chǎn)線機(jī)器人系統(tǒng)設(shè)計(jì)與研究［J］.數(shù)字技術(shù)與應(yīng)用，2014 （3）：7-8.

［11］王翔.S7 200 PLC在數(shù)字伺服電機(jī)控制中的應(yīng)用［J］.自動(dòng)化技術(shù)與應(yīng)用，2006，25 （6）：29-31.

［12］耿洪興，張樂(lè)年，譚堅(jiān)紅，等.基于STC單片機(jī)的機(jī)械手運(yùn)動(dòng)控制研究［J］.機(jī)械制造與自動(dòng)化，2010 （5）：150-152.

［13］胡佳麗，閏寶瑞，張安震，等.S7-200PLC在伺服電機(jī)位置控制中的作用［J］.自動(dòng)化儀表，2009，30（12）：38-41.

Control System Design for Catering Collecting Robot Based on PLC

Zhu Yarong，Jiang Shuhai
（Institute of Intelligent Control and Robotics，Nanjing Forestry University，Nanjing210037，China）

As present catering collecting automation level is low，a notion of automated catering collecting assembly line is put forward and a catering collection robot is designed.After analyzing the whole structure and motion requirements，a further control system for catering collecting robot based on PLC is designed.It is mainly divided into serving tray rotating module，filtering module，tableware conveying module，serving tray stacking module and residues collecting module.Considering different working process and control requirements between modules，this paper applied Siemens S7-200 as the core of control system，finished hardware and software design，made programs and debugged for each module，and achieved accurate position control，which meets actual control requirements and can collect serving tray automatically.

catering collecting robot；PLC；control system；position control

1671-4598（2016）05-0084-05

10.16526/j.cnki.11-4762/tp.2016.05.025

TP241

B

2015-10-23；

2015-12-07。

江蘇省高校優(yōu)勢(shì)學(xué)科建設(shè)工程資助項(xiàng)目（PDPA）；南京林業(yè)大學(xué)引進(jìn)高層次歸國(guó)人員及高層次人才基金項(xiàng)目（G2003-01）。

朱亞榮（1991-），女，江蘇省如皋市人，碩士研究生，主要從事機(jī)器人技術(shù)方向的研究。

姜樹(shù)海（1964-），男，吉林省德惠市人，工學(xué)博士，副教授，碩士研究生導(dǎo)師，主要從事機(jī)器人技術(shù)、智能控制技術(shù)方向的研究。