基于可編程控制器的機械手設計說明

1、 . . . 目 錄摘要1關鍵詞1Abstract1Keywords11 引言21.1 課題提出與研究意義21.2 工業(yè)機械手發(fā)展現(xiàn)狀21.3 本設計的主要工作22 可編程控制器概述32.1 PLC的應用與發(fā)展32.1.1 PLC的工作原理和應用領域32.1.2 PLC的的發(fā)展趨勢32.2 PLC的工作原理與功能特點42.2.1 PLC的基本結(jié)構(gòu)42.2.2 PLC工作原理42.3 施耐德Twido系列PLC介紹52.3.1 Twido PLC的功能概述52.3.2 Twido PLC的工作模式62.4 TwidoSoft編程環(huán)境72.4.1 安裝TwidoSoft軟件72.4.2 編程界面和

2、硬件配置82.4.3 PLC與PC的通信83 機械手實物模型設計93.1 系統(tǒng)概述93.1.1 技術(shù)性能103.1.2 設計原理103.2 控制要求133.3 接線設置133.4 程序設計144 控制系統(tǒng)組態(tài)174.1組態(tài)王簡介174.2控制系統(tǒng)組態(tài)程序184.2.1 組態(tài)界面184.2.2 數(shù)據(jù)詞典214.2.3 程序命令語言22總結(jié)與展望22致22參考文獻23附錄A：PLC程序24附錄B：組態(tài)程序27基 于 可 編 程 控 制 器 的 機 械 手 設 計自動化專業(yè)學生玉建指導教師 坤摘要：機械手是在自動化生產(chǎn)過程中發(fā)展起來的一種新型裝置，廣泛應用于工業(yè)生產(chǎn)和其他領域?？删幊炭刂破鳎≒LC）

3、已在工業(yè)生產(chǎn)過程中得到廣泛的應用。組態(tài)軟件的應用，極輔助了PLC的應用圍的推廣。應用可編程控制器控制機械手能實現(xiàn)各種規(guī)定的工序動作，對生產(chǎn)過程有著十分重要的意義。論文以施耐德TWDLCAADRF40型PLC為基礎，介紹PLC在機械手搬運控制中的應用，設計了一套可行的機械手控制系統(tǒng)，并給出了詳細的PLC程序、組態(tài)王組態(tài)設計過程。設計完成的機械手可以在空間抓、放、搬運物體等，動作靈活多樣。關鍵詞：可編程控制器；機械手；控制；組態(tài)王Manipulator System Design Based On PLCStudent majoring in Automation Liu YujianTutor

4、Li KunAbstract:The manipulator is a new device developed in the automatic production process. It is widely used in industrial producing and other fields. Programmable Logic Controller (PLC), has been widely used in industrial producing as well. With the application of Configuration Software,its appl

5、ication range is greatly enlarged. Manipulator with PLC control can complete various specified proceduralactions,which has very vital significance to the production process. Based on the PLC of Schneider TWDLCAADRF40 type,this paper introduces PLC application in manipulator transportation control sy

6、stem, and design a available manipulator control system,with provideing PLC programming process and configuration process in detail. The manipulator designed by this paper,can grap,put and carry object,etc.in the space.Keywords:PLC;Manipulator;Control;KingView1 引言1.1 課題提出與研究意義隨著工業(yè)生產(chǎn)自動化規(guī)模的擴大，生產(chǎn)過程日趨復雜

7、。生產(chǎn)工況也有趨于惡劣的態(tài)勢，這對一線工人的操作技能也提出了更高的要求，同時操作工人的工作安全也受到了相應的威脅。在自動化生產(chǎn)領域中，工業(yè)機械手是近幾十年發(fā)展起來的。工業(yè)機械手的是從工業(yè)機器人中分支出來的。其特點是可通過編程來完成各種預期的作業(yè)任務，在構(gòu)造和性能上兼有人和機器各自的優(yōu)點，尤其體現(xiàn)了人的智能和適應性。機械手作業(yè)具有準確性和各種環(huán)境中完成作業(yè)的能力。借助PLC強大的工業(yè)處理能力，很容易實現(xiàn)工業(yè)生產(chǎn)的自動化?；诖怂悸吩O計的機械手，在實現(xiàn)各種要求的工序前提下，大大提高了工業(yè)過程的質(zhì)量，而且大大解放了生產(chǎn)力，改善了工作環(huán)境，減輕了勞動強度，節(jié)約了成本，提高了生產(chǎn)效率，具有十分重要的意義

8、。同時，借助組態(tài)軟件的輔助作用，大大提高了系統(tǒng)的工作效率。1.2 工業(yè)機械手發(fā)展現(xiàn)狀機械手是一種能自動化定位控制并可重新編程序以變動的多功能機器，它有多個自由度，可用來搬運物體以完成在各個不同環(huán)境中工作。機械手由執(zhí)行機構(gòu)、驅(qū)動-傳動機構(gòu)、控制系統(tǒng)、智能系統(tǒng)、遠程診斷監(jiān)控系統(tǒng)五部分組成。驅(qū)動-傳動機構(gòu)與執(zhí)行機構(gòu)是相輔相成的，在驅(qū)動系統(tǒng)中可以分：機械式、電氣式、液壓式和復合式，其中液壓操作力最大。簡易機械手在各類全自動化和半自動化生產(chǎn)線上應用的十分廣泛，主要用于零部件或成品在固定位置之間的移動，代替人工作業(yè)，實現(xiàn)生產(chǎn)自動化。本設計中的機械手采用上下升降加平面轉(zhuǎn)動式結(jié)構(gòu)，各動作由PLC控制相關電機和

9、啟動執(zhí)行元件完成。能十分方便的嵌入到各類生產(chǎn)工業(yè)生產(chǎn)線中。日益復雜的工業(yè)過程促進了機械手在工業(yè)生產(chǎn)中的應用。對相應的控制精度、控制穩(wěn)定性也提出了更高的要求。其現(xiàn)狀是在性能不斷提高（高速度、高精度、高可靠性、便于操作和維修）的同時，單機價格不斷下降。機械結(jié)構(gòu)向模塊化、可重構(gòu)化發(fā)展。器件集成度、系統(tǒng)的可靠性、易操作性和可維護性提高。伴隨科學技術(shù)的不斷進步，機器人與工業(yè)自動化技術(shù)的迅猛發(fā)展 ,尤其是移動機械手(Mobile Manipulator)系統(tǒng)的不斷進步，為危險品的安全處理提供了新的思路。1.3 本設計的主要工作針對工業(yè)現(xiàn)場的控制要求，本文將詳細介紹以可編程控制器為處理單元的機械手過程控制系

10、統(tǒng)設計與實現(xiàn)。首先，在本文的第二部分闡述可編程控制器的概況，施耐德PLC與其編程環(huán)境-TwidoSoft，PC與PLC的通信。其次，在本文的第三部分闡述機械手系統(tǒng)的基本組成與控制原理。包括PLC輸入輸出點的分配，機械手步進電機的驅(qū)動，以與相關的位置檢測電路，以與確立系統(tǒng)的軟件的整體框架，進行相關的軟件設計。最后對系統(tǒng)設計進行總結(jié)。最后，針對本設計，完成相關的組態(tài)工作，直觀的顯示系統(tǒng)的動態(tài)運動過程，所用平臺為亞控公司的組態(tài)王6.5.1版。本文對設計的每一部分都給出了較詳細的的設計步驟，并對系統(tǒng)搭建的結(jié)果進行了實物驗證，取得了很好的效果。2 可編程控制器概述2.1 PLC的應用與發(fā)展可編程控制器（

11、Programmable Logic Controller）是計算機家族中的一員，是為工業(yè)控制應用而設計制造的。早期的可編程控制器主要用來代替繼電器實現(xiàn)邏輯控制，稱可編程邏輯控制器（Programmable Logic Controller），簡稱PLC。隨著技術(shù)的發(fā)展，這種裝置的功能已經(jīng)大大超過了邏輯控制的圍，不僅具有邏輯控制功能，而且還能實現(xiàn)數(shù)據(jù)運算、數(shù)據(jù)傳輸和處理等功能，使其真正成為一種電子計算機工業(yè)控制設備，因此，今天這種裝置稱作可編程序控制器，簡稱PC。但是為了避免與個人計算機（Personal Computer）的簡稱PC混淆，所以仍將可編程序控制器簡稱PLC。1987年，國際電工

12、委員會（IEC）頒布了新的PLC標準與其標準定義：“可編程控制器是一種數(shù)字運算操作的電子系統(tǒng)，專為在工業(yè)環(huán)境而設計。它采用可編程序的存儲器，用來在其部存儲執(zhí)行邏輯運算、順序控制、定時、計數(shù)和算術(shù)運算等操作指令，并通過數(shù)字模式或模擬模式的輸入、輸出，控制各種類型的機械或生產(chǎn)過程。而有關外圍設備，都應按照易于與工業(yè)系統(tǒng)聯(lián)成一個整體，易于擴充其功能的原則設計”。PLC就是使用一系列指令構(gòu)成的程序來操作、控制相關工業(yè)控制機械，使其形成一個完整的工業(yè)控制系統(tǒng)，以完成各種各樣的控制功能。12.1.1 PLC的工作原理和應用領域隨著微電子技術(shù)、計算機技術(shù)和數(shù)字通信技術(shù)的高速發(fā)展，PLC產(chǎn)品高度融合了計算機產(chǎn)

13、業(yè)最先進的技術(shù)與工業(yè)自動控制的經(jīng)典理論，在其功能與性能指標上得以豐富和完善，從而突破了傳統(tǒng)PLC的概念，在中、小型控制領域極擴展了其應用圍。在特定的圍，高性能價格比已成為新型PLC的最突出的特點。PLC以其高可靠性、適應性強和使用方便等突出特點在自動化控制領域應用廣泛。另外PLC的制造成本不斷降低，而其功能卻不斷增強。目前在先進工業(yè)國家中PLC已成為工業(yè)控制的標準設備，應用面幾乎覆蓋了所有工業(yè)企業(yè)，諸如鋼鐵、冶金、水泥、石油、化工、電力、機械制造、汽車、造紙、紡織、環(huán)保、交通、建筑等各行各業(yè)。特別是在輕工業(yè)行業(yè)中，生產(chǎn)門類多、加工方式多變、產(chǎn)品更新?lián)Q代快，PLC廣泛應用在組合機床自動化生產(chǎn)線、

14、專用機床、塑料機械、包裝機械、電梯等電氣設備中。PLC已躍居現(xiàn)代工業(yè)自動化三大支柱（PLC、ROBOT、CAD/CAM）的主導地位。PLC廣泛的應用在以下領域1）邏輯控制領域2）運動控制領域3）過程控制領域4）數(shù)據(jù)處理領域5）多級控制領域2.1.2 PLC的的發(fā)展趨勢目前，PLC技術(shù)發(fā)展的總體趨勢是系列化、通用化和高性能化，主要表現(xiàn)在以下方面：1）在系統(tǒng)構(gòu)成規(guī)模上向大小兩個方向發(fā)展發(fā)展小型（超小型）化、專業(yè)化、模塊化、低成本、高性能PLC，以真正代替最小的繼電器控制系統(tǒng)；發(fā)展大容量、高速度（超高速）、多功能、高性價比的PLC，已滿足現(xiàn)代企業(yè)中那些大規(guī)模、復雜系統(tǒng)自動化的需要。2）功能不斷增強，

15、各種應用模塊不斷推出大力加強過程控制和數(shù)據(jù)處理功能，提高組網(wǎng)和通信能力，開發(fā)多種高性能模塊，以使各種模塊的自動控制系統(tǒng)更加強大、更加可靠、組成和維護更加靈活方便，使PLC的應用更加廣泛。3）產(chǎn)品更加規(guī)化、標準化PLC廠家在使硬件與編程工具換代頻繁、豐富多樣、功能提高的同時，日益向MAP（制造自動化協(xié)議）靠攏，并使PLC基本部件，如輸入輸出模塊、聯(lián)網(wǎng)通信模塊、接線端子、通信協(xié)議、編程語言和工具方面的技術(shù)規(guī)格規(guī)化、標準化，使不同的產(chǎn)品間能夠相互的兼容、易于組網(wǎng)，以方便用戶，擴大產(chǎn)品的應用領域。2.2 PLC的工作原理與功能特點為了介紹PLC的工作原理我們首先在本節(jié)介紹PLC的基本結(jié)構(gòu)，然后介紹PL

16、C的工作原理，最后簡單介紹一下PLC的主要功能和特點。2.2.1 PLC的基本結(jié)構(gòu)可編程控制器的基本結(jié)構(gòu)框圖如圖2.1示?？删幊绦蚩刂破髦饕蠧PU模塊、輸入模塊、輸出模塊、編程裝置和電源組成。圖2.1 PLC的基本結(jié)構(gòu)2.2.2 PLC工作原理當PLC投入運行后，其工作過程一般分成三個階段，即輸入采樣、用戶程序執(zhí)行和輸出刷新三個階段。完成上述三個階段稱作一個掃描周期。在整個運行期間，PLC的CPU以一定的掃描速度重復執(zhí)行上述三個階段，如圖2.2所示。圖2.2 PLC的掃描周期1）輸入采樣階段在輸入采樣階段，PLC以掃描方式依次地讀入所有輸入狀態(tài)和數(shù)據(jù)，并將它們存入I/O映像區(qū)中的相應單元。輸

17、入采樣結(jié)束后，轉(zhuǎn)入用戶程序執(zhí)行和輸出刷新階段。在這兩個階段中，即使輸入狀態(tài)和數(shù)據(jù)發(fā)生變化，I/O映像區(qū)中的相應單元的狀態(tài)和數(shù)據(jù)也不會改變。因此，如果輸入是脈沖信號，則該脈沖信號的寬度必須大于一個掃描周期，才能保證在任何情況下，該輸入均能被讀入。2）用戶程序執(zhí)行階段在用戶程序執(zhí)行階段，PLC總是按由上而下的順序依次地掃描用戶程序（梯形圖）。在掃描每一條梯形圖時，又總是先掃描梯形圖左邊的由各觸點構(gòu)成的控制線路，并按照先左后右、先上后下的順序?qū)τ捎|點構(gòu)成的控制線路進行邏輯運算，然后根據(jù)邏輯運算的結(jié)果，刷新該邏輯線圈在系統(tǒng)RAM存儲區(qū)中對應位的狀態(tài)；或者刷新該輸出線圈在I/O映像區(qū)中對應位的狀態(tài)；或者

18、確定是否要執(zhí)行該梯形圖所規(guī)定的特殊功能指令。3）輸出刷新階段當掃描用戶程序結(jié)束后，PLC就進入輸出刷新階段。在此期間，CPU按照I/O映像區(qū)對應的狀態(tài)和數(shù)據(jù)刷新所有的輸出鎖存電路，再經(jīng)過輸出電路驅(qū)動相應的外設。這時才是PLC的真正輸出。為了提高工作的可靠性，與時接受外來的控制命令，PLC在每次掃描期間，除完成上述三步操作外，通常還要進行故障自診斷，完成通訊處理要求。每次掃描開始，先執(zhí)行依次自診斷程序，對各輸入輸出點，存儲器和CPU等進行診斷，診斷的方法通常是測試出各部分是否工作正常，若不一致則認為有故障。此時，PLC立即啟動關機程序，保留現(xiàn)行工作狀態(tài)并關斷所有輸出點，然后停機。診斷結(jié)束后，如沒

19、發(fā)現(xiàn)故障，PLC將繼續(xù)往下掃描，檢查是否有編程器等的通信請求。如果沒有則進行相應的處理，比如，接受編程器發(fā)來的命令，把要顯示的狀態(tài)數(shù)據(jù)，出錯信息送給編程器顯示等。處理完通信后，PLC繼續(xù)掃描，輸入現(xiàn)場信息，順序執(zhí)行用戶程序，輸出控制信號，完成一個掃描周期。然后又從自診斷開始，進行第二輪掃描。PLC就是這樣不停反復循環(huán)，實現(xiàn)對機器的連續(xù)控制，直到接收到用戶停機命令，或因停電、出現(xiàn)故障等原因才停止工作。3）PLC的主要功能和特點PLC的主要功能有：邏輯控制、定時控制、計數(shù)控制、步進（順序）控制、PID控制、數(shù)據(jù)控制（PLC具有數(shù)據(jù)處理能力）、遠程I/O功能、通信和聯(lián)網(wǎng)；另外，有些PLC還有很多特殊

20、功能模塊，適用于各種特殊控制的要求，諸如定位控制模塊，CRT模塊等。可編程控制器（PLC）的主要特點如下：1） 高可靠性2） 豐富的I/O接口模塊3） 采用模塊化結(jié)構(gòu)4） 編程簡單易學5） 安裝簡單，維修方便2.3 施耐德Twido系列PLC介紹本設計中使用的可編程序控制器為施耐德公司的TWDLCAADRF40型PLC，隸屬于Twido系列。Twido PLC是緊湊型可編程序控制器，可應用于各種設備的自動化控制系統(tǒng)中。Twido系列小型PLC具有靈活的配置、緊湊的結(jié)構(gòu)、強大的功能、豐富的通信方式、完善的編程軟件、CPU的FIRMWARE可不斷升級等特點，因此性價比較高。2.3.1 Twido

21、PLC的功能概述Twido是小型PLC，由本體和擴展模塊組成，能夠滿足各種設備的自動化控制需要。應用領域極為廣泛，覆蓋所有與自動檢測、自動化控制相關的工業(yè)與民用領域，包括各種機床、機械、電力設施、民用設施、環(huán)境保護設備、汽車、機器人等等。如沖壓機床、印刷機械、中央空調(diào)、電梯控制、運動系統(tǒng)等等。Twido PLC除了具有PLC的基本控制功能以外，還有以下特點：1） 靈活的配置多種CPU模塊、數(shù)字量、模擬量擴展模塊、通信模塊以與多種可選件，使得控制系統(tǒng)的硬件架構(gòu)更適合用戶的應用要求。2） 緊湊的結(jié)構(gòu)體積小巧，多種接線方式，易于安裝。如附帶40點I/O的CPU模塊的正面面積只有名片大小。3）強大的功

22、能除具有PLC基本的控制和運算功能之外，還有雙字、浮點數(shù)、三角函數(shù)、PID等的運算指令。單機的控制點數(shù)高達264點，用戶程序容量達64KB。4） 豐富的通訊方式Twido PLC支持多種通訊方式，如Twido PLC之間的Remote I/O和對等PLC的通信方式、與其他智能設備的自由ASCII通信方式、Modbus的主站和從站通信方式、通過以太網(wǎng)的通信方式，甚至有一些PLC已置以太網(wǎng)接口。眾多的通信功能使Twido PLC與其他電氣設備的配合更加完美。5） 完善的編程軟件全中文的Windows編程界面和在線幫助文檔使用戶編程更加方便、更高效、支持多種編程接口，如串口、USB口、以太網(wǎng)口，甚至

23、是遠程有線、無線接口方式。6） CPU的FIRMWARE可不斷升級在不改變?nèi)魏斡布那闆r下，只需要更新CPU的FIRMWARE，就能使CPU的功能不斷地升級，滿足用戶新的需求。（就像升級計算機的BIOS一樣）22.3.2 Twido PLC的工作模式Twido PLC具有兩種工作模式，分別是：運行（RUN）模式和停止（STOP）模式。在運行模式下，通過執(zhí)行反映控制要求的用戶程序來實現(xiàn)控制功能；在停止模式下，Twido PLC不執(zhí)行用戶程序，此時可設置CPU的硬件功能，并將用戶程序、數(shù)據(jù)以與硬件設置信息下載到PLC的CPU中?？梢酝ㄟ^TwidoSoft編程軟件控制Twido PLC的運行與停止。

24、PLC前面板的LED顯示當前的工作模式。Twido PLC通電后，需要對硬件和軟件做一些初始化的工作。初始化后，Twido PLC按照循環(huán)掃描的方式，完成包括執(zhí)行用戶程序在的各項不同的任務，周而復始地分階段執(zhí)行一系列任務。任務執(zhí)行一次成為一個掃描周期，在一個掃描周期，CPU工作流程如圖2.3。1） 讀輸入2） 執(zhí)行用戶程序3） 處理通訊任務4） 執(zhí)行自診斷5） 寫輸出6） 中斷程序的處理圖2.3 Twido PLC的掃描過程示意圖2.4 TwidoSoft編程環(huán)境2.4.1 安裝TwidoSoft軟件本文中所有的容是基于TwidoSoft3.5版本。安裝界面如圖2.4。圖2.4 程序安裝Twi

25、doSoft是一個用于Twido可編程控制器的配置、編寫和維護應用程序的圖形化開發(fā)環(huán)境。TwidoSoft是一款32位的基于Windows的程序，是標準的Windows界面，有應用程序瀏覽器和多窗口瀏覽。支持編程、調(diào)試和配置，可與控制器進行多種方式的通信，如串行口、USB、以太網(wǎng)、MODEM撥號等。2.4.2 編程界面和硬件配置TwidoSoft運行，新建立程序后，用戶需要根據(jù)自己的需要進行CPU型號的更改，操作方式為：右鍵單擊原來的CPU，選中“更改控制器類型”，選擇所需的CPU類型，點擊“更改”，完成相關操作，本文所用CPU為TWDLCAA40DRF，如圖2.5。圖2.5 控制器類型2.4

26、.3 PLC與PC的通信TwidoSoft軟件與Twido PLC連接時可采用多種通訊方式，如串行口、USB、以太網(wǎng)、MODEM+線，因此在TwidoSoft與Twido PLC連接前，用戶需根據(jù)實際使用的硬件連接方式，在TwidoSoft的連接管理菜單中做相應的設定。在“文件”菜單中，點擊“首選項”，顯示“首選設置”，可對通訊方式做相關設定，本文采用USB方式，如圖2.6。圖2.6通訊方式設定3 機械手實物模型設計本設計的系統(tǒng)全貌如圖3.1。圖3.1 系統(tǒng)全貌圖3.1 系統(tǒng)概述機械手實物模型的機械結(jié)構(gòu)采用滾珠絲桿、滑桿、氣缸、氣夾等機械部件組成；電氣方面有步進電機、步進電機驅(qū)動器、傳感器、開

27、關電源、電磁閥等電子器件組成；該模型是涵蓋了PLC技術(shù)，位置控制技術(shù)、氣動技術(shù)有機結(jié)合成一體的控制儀器。本設計中采用的機械手，可在三維空間運動。水平（X）軸、垂直（Y）軸采用步進電機控制，底盤的旋轉(zhuǎn)采用直流電機控制，抓取物體的電磁閥采用氣動形式。步進電機的控制，由對應的步進電機驅(qū)動器電路完成。完成本設計需要的實驗設備有：1）機械手模型2）計算機3）導線4）氣泵5）晶體管輸出型可編程控制器(帶編程電纜) 機械手的控制面板分以下幾個模塊（1）步進電機驅(qū)動與步進電機驅(qū)動器電流設定為0.63A，細分設定為8細分。將24V電源接入驅(qū)動器，此時驅(qū)動器的電源指示燈應點亮。將24V與OPTO端（驅(qū)動器使能端）

28、連接起來。PUL端是脈沖輸入端。DIR是方向控制輸入端。（2）直流電機本模型用的氣夾電機和底座電機均是24V直流電機，PLC控制兩個直流繼電器的吸合來控制電機的正轉(zhuǎn)和反轉(zhuǎn)。（3）旋轉(zhuǎn)編碼盤在本模型底座上有一個旋轉(zhuǎn)編碼盤，在底座旋轉(zhuǎn)時，在此產(chǎn)生一個VP-P為24V的方波信號，可以提供給PLC的高速計數(shù)器，用于機械手的定位控制。（4）接近開關在本模型中底座和氣夾的限位通過4個電感式接近開關來完成。接近開關與觸頭接近時接近指示燈點亮、輸出低電平，否則為高電平。（5）行程開關在本模型中兩個滾珠絲桿的限位通過4個滾軸式行程開關來完成。當行程開關壓下時，常開觸點閉合，給PLC一個控制信號。（6）電磁閥與平

29、行氣夾本模型使用的電磁閥動作時平行氣夾夾緊，動作則開。3.1.1 技術(shù)性能1）輸入電源：單相三線220V±10% 50Hz 2）工作環(huán)境：溫度-10+40 相對濕度85%(25) 海拔4000m3）絕緣電阻：大于3M4）外形尺寸：80×50×120cm33.1.2 設計原理1步進電機用二相八拍混合式步進電機，主要特點：體積小，具有較高的起動和運行頻率，有定位轉(zhuǎn)矩等優(yōu)點。本模型中采用串聯(lián)型接法，其電氣圖如圖3.2所示： 3.2步進電機電氣圖2步進電機驅(qū)動器步進電機驅(qū)動器主要有電源輸入部分、信號輸入部分、輸出部分等。驅(qū)動器參數(shù)如下列圖表所示：（1）電氣規(guī)格說明最小值典

30、型值最大值單位供電電壓182440V均值輸出電流0.2111.50A邏輯輸入電流61530mA步進脈沖響應頻率100kHz脈沖低電平時間51s（2）電流設定電流值SW1SW2SW30.21AOFFONON0.42AONOFFON0.63AOFFOFFON0.84AONONOFF1.05A0FFONOFF1.26AONOFFOFF1.50AOFFOFFOFF（3）細分設定細分倍數(shù)步數(shù)/圈（1.8°整步）SW4SW5SW61200ONONON2400OFFONON4800ONOFFON81600OFFOFFON163200ONONOFF326400OFFONOFF6412800OFFON

31、OFF由外部確定動態(tài)改細分/禁止工作OFFOFFOFF（4）接線信號描述信 號功 能PUL脈沖信號：上升沿有效，每當脈沖由低變高時電機走一步DIR方向信號：用于改變電機轉(zhuǎn)向，TTL平驅(qū)動OPTO光耦驅(qū)動電源ENA使能信號：禁止或允許驅(qū)動器工作，低電平禁止GND直流電源地+V直流電源正極，典型值+24VA+電機A相A-電機A相B+電機B相B-電機B相（5）PLC控制器與步進電機驅(qū)動器連接的工作原理如圖所示：驅(qū)動器電源由面板上電源模塊提供，注意正負極性，驅(qū)動器信號端采用+24V供電，需加1.5K限流電阻（見圖3.3中1.5K電阻）。驅(qū)動器輸入端為低電平有效，在使用不同廠家的PLC產(chǎn)品配套此模型使用

32、時，要選擇相應的輸出方式，或者加入合適的電平轉(zhuǎn)換板進行電平轉(zhuǎn)換。圖3.3控制驅(qū)動電路3傳感器：(1)接近開關：接近開關有三根連接線（棕、蘭、黑）棕色接電源的正極、藍色接電源的負極、黑色為輸出信號，當與檔塊接近時輸出電平為低電平，否則為高電平。與PLC之間的接線圖如下，當傳感器動作時，輸出端對地接通。PLC部光耦與傳感器電源構(gòu)成回路，PLC信號輸入有效。電氣示意圖如圖3.4。圖3.4傳感器電氣示意圖(2)行程開關：當檔塊碰到開關時，常開點閉合。4本裝置需采用晶體管輸出型可編程控制器，可同時輸出兩路脈沖到步進電機驅(qū)動器，控制步進電機運行。5旋轉(zhuǎn)碼盤：本裝置中機械手每旋轉(zhuǎn)3°編碼盤發(fā)出一個

33、脈沖。6直流電機驅(qū)動單元：本裝置中直流電機驅(qū)動模塊是有兩個繼電器的吸合與斷開來控制電機的轉(zhuǎn)動方向的。3.2 控制要求本設計中，機械手模型的執(zhí)行順序為：1.開機復位 2.橫軸前升 3.手旋轉(zhuǎn)到位 4.電磁閥動作，手開 5.豎軸下降 6.電磁閥動作，手夾緊 7.豎軸上升 8.橫軸縮回 9.底盤旋轉(zhuǎn)到位 10.橫軸前伸 11.手旋轉(zhuǎn) 12.豎軸下降 13.電磁閥動作，手開 14.豎軸上升 15.復位氣夾在電磁閥未通電動作時為夾緊狀態(tài)，通電后變?yōu)殚_狀態(tài)。在上述步驟中，4-5和13-15之間為電磁閥通電狀態(tài)。3.3 接線設置1主機輸入輸出配置表類型端子功能主機輸入氣夾正轉(zhuǎn)限位I0.0氣夾反轉(zhuǎn)限位I0.1

34、基座正轉(zhuǎn)限位I0.2基座反轉(zhuǎn)限位I0.3基座旋轉(zhuǎn)脈沖I0.4X軸前限位 VI+I0.5X軸后限位 VI+I0.6Y軸上限位 VI+I0.7Y軸下限位 VI+I0.8輸出驅(qū)動器一PULQ0.0驅(qū)動器二PULQ0.1驅(qū)動器一DIRQ0.2驅(qū)動器二DIRQ0.3氣夾電機正轉(zhuǎn)MLQ0.4氣夾電機反轉(zhuǎn)MRQ0.5基座電機正轉(zhuǎn)MLQ0.6基座電機反轉(zhuǎn)MRQ0.7氣夾電磁閥 YV-Q0.8注:主機輸入公共端COM0接電源+24V,主機繼電器輸出公共端COM2、COM3、COM4、COM5接電源“GND”端,主機晶體管端“V0+”、“V1+”接電源+24V, “V0-”、“V1-”接電源“GND”端.2.面板

35、接線 1）兩個步進電機驅(qū)動器的電源由24V電源提供，將步進電機的OPTO端與本驅(qū)動器的+24V相連。2）兩個直流電機的電源由24V電源提供，MC為公共端，接24V端。ML和MR為正轉(zhuǎn)和反轉(zhuǎn)端，按PLC或電平轉(zhuǎn)換板的輸出端。3）限位信號模塊電源由24V電源提供，本模塊的VI-接模塊電源的地。4）電磁閥的YV+端接電源輸出的24V端。5）主機接線方法參照輸入輸出分配表，用下載線將計算機的USB口與PLC主機的通訊口相連，打開PLC電源。運行編程軟件，打開實驗程序，設置好通信參數(shù)后下載程序到PLC中。3.4 程序設計本節(jié)摘選控制程序的核心部分，針對各個步驟，進行相關的分析。程序中對應的部寄存器（%M

36、）的容，最后輸出到輸出緩沖映像區(qū)（%Q），部寄存器起到輔助控制輸出的作用。1） 系統(tǒng)復位上電初始化：X軸右行、Y軸上行、氣夾正轉(zhuǎn)、底座正轉(zhuǎn)，到達系統(tǒng)原點。程序圖如圖3.5。圖3.5 上電初始化說明：在相應的限位開關沒有導通時，設置相應的輸出，完成初始化任務。2）抓取物體機械手X軸右行、Y軸下行、氣夾轉(zhuǎn)到要求位置并打開，完成抓取動作，程序如圖3.6。圖3.6 抓取過程3）移動物體抓取到物體后，機械手移動到要求的位置。本階段，X軸左行、Y軸上行、氣夾正轉(zhuǎn)、底座反轉(zhuǎn)，程序如圖3.7。圖3.7 移動過程4）放下物體在把物體移動到要求位置后，放下物體，完成動作。本階段X軸右行、Y軸下行，達到底部后，氣夾

37、打開，放下物體，程序如圖3.8。圖3.8 下放過程5）%M區(qū)與%Q區(qū)的對應部寄存器區(qū)與輸出映像寄存器的最終具體對應關系如圖3.9-3.15。圖3.9 Q0.2的控制邏輯圖3.10 Q0.3的控制邏輯圖3.11 Q0.4的控制邏輯圖3.12 Q0.5的控制邏輯圖3.13 Q0.6的控制邏輯圖3.14 Q0.7的控制邏輯圖3.15 Q0.8的控制邏輯6）步進電機控制步進電機的脈沖由PLC的兩個晶體管輸出口%Q0.0與%Q0.1發(fā)出，輸出 %Q0.0 和 %Q0.1 專用于 %PLS 或 %PWM 功能塊。配置 %PLS0/%PWM0 需要專用輸出 %Q0.0。如果已使用 %Q0.0，則不能配置 %

38、PLS0/%PWM0。反之，如果已配置 %PLS0/%PWM0，則不能在其他地方使用 %Q0.0。對于需要專用輸出 %Q0.1 的 %PLS1/%PWM1 同樣如此。每個計數(shù)器使用的輸出將顯示在 %PLS/%PWM 對話框的專用輸出框中。%PLS/%PWM 脈沖發(fā)生器充當方波生成器，并具有以下特性：1）%PLS：50% 占空比（開通時間等于斷開時間）。2）%PWM：占空比可能因程序的不同而異。本例中高速脈沖電路的發(fā)生程序如圖3.16。選擇0.142ms的時基，發(fā)出高速脈沖，在%Q0.0和%Q0.1輸出高速脈沖，驅(qū)動步進電機運動。圖3.16 步進電機脈沖發(fā)生發(fā)生程序4 控制系統(tǒng)組態(tài)工業(yè)控制組態(tài)軟

39、件在工業(yè)界有著相當廣泛的應用，此類軟件允許用戶在圖形界面下對控制系統(tǒng)的各種采樣點、過程輸出點、設備、生產(chǎn)車間、控制回路、文件報警、生產(chǎn)報表、控制策略、網(wǎng)絡設備和生產(chǎn)工業(yè)畫面進行定義和組態(tài)。4.1組態(tài)王簡介組態(tài)王軟件是一種通用的工業(yè)控制軟件，它融過程控制設計、現(xiàn)場操作以與工廠資源管理于一體，將一個企業(yè)部的各種生產(chǎn)系統(tǒng)和應用以與信息交流匯集在一起，實現(xiàn)最優(yōu)化管理。用戶可以在企業(yè)網(wǎng)絡的所有層次的各個位置上都可以與時獲得系統(tǒng)的實時信息。采用組態(tài)王軟件開發(fā)工業(yè)監(jiān)控工程，可以極增強用戶生產(chǎn)控制能力、提高工廠的生產(chǎn)力和效率、提高產(chǎn)品的質(zhì)量、減少成本與原材料的消耗。它適用于從單一設備的生產(chǎn)運營管理和故障診斷，

40、到網(wǎng)絡結(jié)構(gòu)分布式大型監(jiān)控管理系統(tǒng)的開發(fā)。組態(tài)王軟件結(jié)構(gòu)由工程管理器、工程瀏覽器與運行系統(tǒng)三部分構(gòu)成。工程管理器：工程管理器用于新工程的創(chuàng)建和已有工程的管理，對已有工程進行搜索、添加、備份、恢復以與實現(xiàn)數(shù)據(jù)詞典的導入和導出等功能。工程瀏覽器：工程瀏覽器是一個工程開發(fā)設計工具，用于創(chuàng)建監(jiān)控畫面、監(jiān)控的設備與相關變量、動畫連接、命令語言以與設定運行系統(tǒng)配置等系統(tǒng)組態(tài)工具。運行系統(tǒng)：工程運行界面，從采集設備中獲得通訊數(shù)據(jù)，并依據(jù)工程瀏覽器的動畫設計顯示動態(tài)畫面，實現(xiàn)人與控制設備的交互操作。4.2控制系統(tǒng)組態(tài)程序4.2.1 組態(tài)界面本設計組態(tài)界面分為四部分：登錄界面、全貌圖、PLC一覽、作者信息等。n

41、登錄界面在組態(tài)王工程瀏覽器中，定義一個新的用戶，使具有管理員權(quán)限，優(yōu)先級設在900以上，例如本例中默認的999，是具有高用戶權(quán)限，如圖4.1。圖4.1 管理員用戶定義定義完用戶后，制作登錄畫面，如圖4.2。圖4.2 登錄界面的制作在界面中“登錄系統(tǒng)”文字上設置“彈起時”命令語言連接，輸入登錄函數(shù)“LogOn();”；在“ENTER”文字上設置其優(yōu)先級為“900”，即只有用戶權(quán)限大于900時，才允許用戶點擊“ENTER”，進入系統(tǒng)?！癊NTER”對應的“彈起時”命令語言為“ShowPicture("全貌圖");”。并將此畫面定義為系統(tǒng)啟動畫面，如此設置后，優(yōu)先級大于900的用

42、戶可以選擇進入系統(tǒng)，查看系統(tǒng)運行狀態(tài)。n 全貌圖系統(tǒng)全貌圖顯示系統(tǒng)的基本運行狀態(tài)。全貌圖中共分為以下幾個主要部分：（1）系統(tǒng)啟動：點擊系統(tǒng)界面下方中央的開啟按鈕，系統(tǒng)啟動，開始工作。再次點擊，系統(tǒng)將停止運行。開啟按鈕的功能為模仿PLC上電與停電的工作狀態(tài)。重新上電后，系統(tǒng)將重新自復位狀態(tài)開始運行。（2）系統(tǒng)狀態(tài)：顯示系統(tǒng)當前的狀態(tài)。狀態(tài)共分為：系統(tǒng)復位、抓取物體、移動物體、放下物體。用來指示當前機械手控制系統(tǒng)的狀態(tài)。（3）氣夾狀態(tài)：顯示氣夾當前狀態(tài)，分為開啟、關閉兩種。（4）底座指示：顯示底座的轉(zhuǎn)動。由左右限位開關的擺放位置，限制底座的轉(zhuǎn)動圍。（5）機械手運動軌跡：顯示X、Y兩軸具體的移動。點

43、擊圖中“顯示PLC”按鈕，將顯示“PLC一覽”圖，可觀察輸入輸出點狀態(tài)。系統(tǒng)全貌圖如圖4.3。圖4.3 系統(tǒng)全貌圖圖4.4 PLC一覽圖n PLC一覽PLC一覽頁面顯示PLC直觀顯示輸入輸出點的狀態(tài)。當對應點為“0”時，相應的指示燈為黃色；當對應點為“1”時，對應指示燈為綠色。畫面右側(cè)為PLC輸入輸出對應表。點擊“監(jiān)控中心”，則回到“全貌圖”，觀察系統(tǒng)運行狀態(tài)，PLC一覽圖如圖4.4。n 作者信息頁面作者信息如圖4.5。圖4.5 作者信息4.2.2 數(shù)據(jù)詞典組態(tài)王將組態(tài)程序中所設計的數(shù)據(jù)變量以數(shù)據(jù)詞典的形式加以保存。本設計中所使用的全部變量如圖4.5。圖4.5 數(shù)據(jù)詞典注：由于組態(tài)王中沒有施耐

44、德PLC對應的驅(qū)動程序，故無法實現(xiàn)實際的系統(tǒng)連接。在真實的硬件組態(tài)中，以上部分變量應為I/O變量，而非存變量。4.2.3 程序命令語言為了顯示實際的動態(tài)效果，組態(tài)的命令語言部分中，編輯應用程序命令語言，編輯界面如圖4.6。圖4.6 程序編輯界面總結(jié)與展望本文重點介紹了施耐德Twido系列可編程控制器的功能特點、工作原理、編程環(huán)境TwidoSoft的使用，以與與PLC的通訊等。概述了機械手平臺的組成結(jié)構(gòu)與工作原理，介紹了系統(tǒng)軟件設計的過程，搭建了系統(tǒng)構(gòu)架。設計了基于可編程控制器的機械手控制系統(tǒng)，具體研究了機械手控制系統(tǒng)中所涉與的關鍵技術(shù)，成功編寫了基于Twido PLC的控制程序，進行了相關的組

45、態(tài)工作，實現(xiàn)了機械手運動控制的直觀化。程序下載后，如期運行。實踐證明控制系統(tǒng)設計可行性高，系統(tǒng)運行可靠，適用工業(yè)現(xiàn)場應用。本文涉與的基于可編程控制器的機械手控制系統(tǒng)，已在工業(yè)過程中普遍適用，相信隨著技術(shù)的日臻完善，成本的逐漸降低，其適用圍必然會更加廣泛。致本論文是在坤老師的精心指導下完成的，從課題的立項、開題與課題的開發(fā)研究到論文的審稿、定稿，每一步都凝集著老師的心血。而且，在整個課題的創(chuàng)作過程中，老師給予了我極大的支持，不僅向我提供了理論知識上的支持，而且更重要的是向我提供了實驗系統(tǒng)上的支持，使我不僅能在理論上有所收獲，而且，能結(jié)合具體的實驗系統(tǒng)進行實踐上的提升，這一切都將使我受益匪淺。我還

46、要特別感許其義老師，在整個過程中，遇到了許多軟件與硬件上的問題，很多問題都難以從課本中所學知識進行解決，正是許老師給我的悉心指導才使我能一步步克服困難，樹立信心，實現(xiàn)課題的最終完稿。同時，在設計過程中，參考了部分天煌教儀的部分資料，在此表示感。最后，衷心感大學四年里所有給予我教誨以與幫助過我的老師與同學們，！參考文獻1許其義.基于可編程控制器網(wǎng)絡的智能控制系統(tǒng)與開發(fā)D.，曲阜師大學，2007：1-182儲云峰.施耐德電氣可編程序控制器原理與應用M.，機械工業(yè)，2007：58-903亞控科技發(fā)展公司技術(shù)部.6.5初級培訓教程M，亞控公司，2007：14笑紅.工業(yè)機器人技術(shù)與應用M.，煤炭工業(yè),2004：26-3