郝 帥，祁宇明，周旺發(fā)

（1.天津職業(yè)技術(shù)師范大學機器人及智能裝備研究所，天津300222；2.天津博諾智創(chuàng)機器人技術(shù)有限公司，天津 300353）

基于PLC的履帶式機器人控制系統(tǒng)設(shè)計

郝 帥1，祁宇明1，周旺發(fā)2

（1.天津職業(yè)技術(shù)師范大學機器人及智能裝備研究所，天津300222；2.天津博諾智創(chuàng)機器人技術(shù)有限公司，天津 300353）

本文將基于PLC的履帶式機器人控制系統(tǒng)作為主要研究方向。根據(jù)機器人的功能要求確定控制方案，由控制方案選擇合適的控制元件并對元件進行參數(shù)分析，最終應(yīng)用到機器人控制系統(tǒng)。通過PLC在履帶機器人上的應(yīng)用，提高了機器人對復(fù)雜環(huán)境的適應(yīng)性和穩(wěn)定性，取得了很好的結(jié)果。

履帶機器人；PLC；控制系統(tǒng)

對于履帶式機器人的研究，國內(nèi)起步比較晚，技術(shù)也相對落后，在實踐中表現(xiàn)出來的問題也很多，例如不穩(wěn)定的控制方式帶來的機器人運轉(zhuǎn)可靠性極低、工作誤差大頻頻出現(xiàn)?，F(xiàn)階段對于可編程控制器的應(yīng)用已經(jīng)非常普遍，充分的事實證明可編程控制器對于惡劣環(huán)境的適應(yīng)性和可靠性優(yōu)勢明顯，本文以可編程控制器（PLC）為核心進行履帶式機器人控制系統(tǒng)的設(shè)計研究，為機器人本體構(gòu)建了一個功能可靠并且強大的自動控制系統(tǒng)。

1 控制系統(tǒng)的方案研究

機器人控制系統(tǒng)的作用就像人類的大腦，它是機器人最重要的部分，控制著機器人執(zhí)行不同的指令?？刂葡到y(tǒng)的優(yōu)劣會影響機器人的可靠性及工作性能，先進的控制系統(tǒng)決定了機器人運用的便利程度[1]。

機器人控制系統(tǒng)所需包含的功能有：

1）移動：能夠靈活的實現(xiàn)前進、后退、轉(zhuǎn)彎等一系列常規(guī)動作。

2）導航：能夠?qū)崿F(xiàn)結(jié)構(gòu)環(huán)境中的自主導航，并一定程度下實現(xiàn)非結(jié)構(gòu)性導航。

3）載重：一般工作環(huán)境下不低于80 kg.

4）人機交互：擁有人性化的人機交互系統(tǒng)，人機交互界面中能夠輕松實現(xiàn)機器人不同的運動控制、數(shù)據(jù)傳輸?shù)炔僮鳌?/p>

5）系統(tǒng)自動檢測：開始工作時，控制系統(tǒng)需首先檢測各個模塊的運行狀況，確保履帶機器人能夠安全正常運行。

6）系統(tǒng)可擴展性：控制系統(tǒng)在實現(xiàn)基本功能的基礎(chǔ)上，系統(tǒng)應(yīng)擁有可擴展性，控制系統(tǒng)可通過集成更多的外部模塊來提高相關(guān)的執(zhí)行能力[2]。

（2）控制系統(tǒng)方案概述

針對控制系統(tǒng)，核心控制既是控制安裝在機器人尾部的兩個電動機，為了實現(xiàn)控制的精準，需要加入反饋系統(tǒng)進行控制精度的修正。同時，為了避免復(fù)雜的控制界面帶來的可操作性降低，需設(shè)計簡單直觀的人機交互界面，提高機器人的可操作性，因此應(yīng)選擇常見的用戶熟悉的軟件環(huán)境。

圍繞機械本體對控制系統(tǒng)進行設(shè)計，首先將控制要求中需要達到的要求作為首要的研發(fā)對象，把機器人控制系統(tǒng)分為五個核心模塊：人機交互模塊、核心控制模塊、驅(qū)動控制執(zhí)行模塊、供電模塊和傳感裝置模塊[3]。具體控制策略如圖1所示。

圖1 控制系統(tǒng)的整體方案

機器人運行的程序是在個人計算機上編寫完成的，然后通過RS232接口將編寫的程序傳輸至一體機，一體機接收到程序后通過控制外部硬件完成對電動機的控制；另一種控制方式將無線遙控上的不同按鈕定義為相應(yīng)的動作命令，當按下按鈕后，遙控會發(fā)出對應(yīng)信號，無線模塊接收到該信號后，對信號進行識別和處理，最后將處理后的信號傳輸?shù)揭惑w機，由一體機識別處理并完成后續(xù)的控制。由于驅(qū)動器對電動機的驅(qū)動只能是單向驅(qū)動，根據(jù)控制要求，需要外加繼電器完成電機的反向轉(zhuǎn)動控制。

結(jié)合以上分析，機器人采用圖1所示的控制方式，此方式既能滿足控制方案的要求，又能使控制邏輯簡單合理，具體方案如下：

1）通過VC++開發(fā)上位機的工作界面，解決上位機與控制器的通訊問題；

2）一體機需要完成整個機器人運動的控制及與上位機交換數(shù)據(jù)等工作；

3）控制系統(tǒng)主要由PLC、驅(qū)動器、電動機和編碼器等組成，有效的形成一個循環(huán)反饋控制回路。

4）電動機動作采用非數(shù)字量的方式控制。

（3）控制系統(tǒng)的詳細思路

根據(jù)具體方案所述的要點及所包含的硬件結(jié)構(gòu)，設(shè)計如圖2所示的履帶機器人整體運動控制方案框圖。整體的控制方案最核心的部分即是對于履帶機器人本體運動的控制，使其能夠精準快速的完成不同的指令，這便對硬件系統(tǒng)提出了很高的要求。機器人運動的執(zhí)行機構(gòu)采用差速方式進行控制。

圖2 運動控制方案

2 控制器及元器件選型

（1）控制器選擇

所選PLC的型號為EX2N-70H-27/23MRT-8DA4AD，此控制器模擬量輸入精度為12位，模擬量寄存器中的數(shù)據(jù)能夠直接被讀取，滿足控制要求并節(jié)省控制反應(yīng)計算時間，但是在數(shù)據(jù)讀取過程中會存在一些誤差，這便需要對數(shù)據(jù)進行修正，下面以模擬量AD0的獲取為例進行分析說明。誤差的修正見表1.

表1 誤差修正表

將溫度傳感器與控制器的AD0連接，在系統(tǒng)工作狀態(tài)下，D8030中所存的數(shù)據(jù)將傳送到D0中，控制器對D0進行分析計算，并將計算的結(jié)果存入D10中，D10中存儲的數(shù)據(jù)即為對應(yīng)的溫度值。見圖3.

圖3 工作程序圖

例如所測量溫度是47℃，而真實溫度是29℃，則誤差為18℃，這便需要對數(shù)據(jù)進行修正，操作如圖4.

圖4 模擬量的修正1

接通M0，D8220中存入的數(shù)據(jù)是-180，通過最后的運算監(jiān)控可見D10中存儲的數(shù)據(jù)與真實溫度一致。見圖5.

圖5 模擬量的修正2

（2）驅(qū)動器選型

所選用的驅(qū)動器型號為YKC2608M-H。驅(qū)動器的控制數(shù)據(jù)由輸入和輸出兩種信號組成[4]。

1）輸入信號

若輸入信號的電壓高于5V時，必須串聯(lián)一個電阻達到給電路限流的作用，所串聯(lián)電阻的大小以R來表示[5]。

阻值R選型依據(jù)為：當控制器輸出電壓為+5 V時，則 R1=0 Ω，R2=0 Ω；當控制器輸出電壓為+12 V 時，則 R1=510 Ω，R2=820 Ω；當控制器輸出電壓為+24 V時，R1=1.2 KΩ，R2=1.8 KΩ.

2）輸出信號

驅(qū)動器有 S4，S5，V1，V2，V3 五個接口，當由 S4和S5控制時，M+，M-會立即停止輸出，跨接至V2（+）V1（-）.

（3）傳感器選型

傳感器主要用于檢測機器人本身的工作狀況以及所處環(huán)境的情況，將檢測的信號傳輸回控制器，為控制提供可靠的安全保障。選擇合適的傳感器有助于提升機器人的整體性能，使機器人在面臨復(fù)雜環(huán)境時能夠快速響應(yīng)，執(zhí)行對應(yīng)的指令。

1）紅外傳感器

機器人底盤安裝了八個紅外傳感器，均布在四個方向上。主要作用是檢測機器人工作時周圍環(huán)境是否有障礙物，若檢測到障礙物，及時將信號傳輸給控制器，由控制器發(fā)出響應(yīng)的指令，控制機器人的后續(xù)動作。所選的紅外傳感器型號為SB03-1K，該傳感器可調(diào)節(jié)的感應(yīng)距離為0～30 cm，額定電流為200 mA，滿足控制系統(tǒng)的功能要求。

2）光電編碼器

編碼器安裝在機器人旋轉(zhuǎn)輪上，并且與旋轉(zhuǎn)輪在同一軸線上，因此二者的轉(zhuǎn)速是相同的，這便可利用編碼器有規(guī)律的發(fā)出脈沖，進而可計算出機器人旋轉(zhuǎn)輪的旋轉(zhuǎn)速度。通過一個過程中編碼器所發(fā)出的脈沖數(shù)量來計算機器人的運動路程。設(shè)定L為機器人旋轉(zhuǎn)輪的圓周長度，Rn為編碼器轉(zhuǎn)動一周所發(fā)出的脈沖數(shù)量，N是Δt時間段內(nèi)編碼器發(fā)出的脈沖數(shù)量，Δt時間段內(nèi)機器人運動路程是Δs，則：

由上式可見，由于編碼器發(fā)出脈沖數(shù)量和機器人旋轉(zhuǎn)輪周長為固定值，要想精確計算機器人旋轉(zhuǎn)輪所行走的路程關(guān)鍵是精確記錄編碼器發(fā)出脈沖的數(shù)量。

所選編碼器的型號為E6B2-CWZ3E，主要參數(shù)如下：

工作電壓為DC5V-5%-24+15%；分辨率為600（脈沖/旋轉(zhuǎn)）；最高響應(yīng)頻率100 KHz；允許最高旋轉(zhuǎn)轉(zhuǎn)速6 000 r/min.則定位精度：

式（2）中d為機器人旋轉(zhuǎn)輪的直徑，為達到控制精度要求，定位精度必須控制在1 mm之內(nèi)；則所能達到的最大速度為：

根據(jù)以上公式的計算，所選的編碼器滿足技術(shù)要求，能夠達到所需的精度，對機器人的精準定位有非常積極的作用。

3 結(jié)論

本文以PLC為核心并結(jié)合繼電器電路構(gòu)建了機器人自動控制系統(tǒng)，可以有效地改善傳統(tǒng)線路的眾多弊端線，使機器人經(jīng)常出現(xiàn)的故障得到解決，整個自動控制系統(tǒng)擁有很強的穩(wěn)定性，經(jīng)過幾次復(fù)雜環(huán)境的試驗，機器人能夠很好的適應(yīng)不同的路面，機器人的工作效率也有了顯著的提升。

[1]徐 德，鄒 偉.室內(nèi)移動式服務(wù)機器人的感知、定位與控制[M]．北京：科學出版社，2008.

[2]馬傳翔.單輪機器人運動機理機器控制方法的研究[D]．哈爾濱工業(yè)大學，2010.

[3]程二亭.災(zāi)害環(huán)境救援用履帶式機器人關(guān)鍵技術(shù)研究[D]．天津職業(yè)技術(shù)師范大學，2016.

[4]王仲民.移動機器人路徑規(guī)劃及軌跡跟蹤問題研究[D]．河北工業(yè)大學，2006.

[5]朱 俊.移動機器人操作機械手設(shè)計與分析[D]．南京理工大學，2006.

Design of tracked robot control system based on PLC

HAO Shuai1，QI Yu-ming1，ZHOU Wang-fa2
（1.Institute of Robotics and Intelligent Equipment，Tianjin Vocational and Technical Normal University，Tianjin 300222，China；2.Tianjin Bono Intelligent Robot Technology Co.，Ltd.，Tianjin 300353，China）

This paper will be based on programmable logic controller as the main research direction of crawler robot control system.Determine the control plan according to the requirement of the function of the robot control system.Select the appropriate control component according to the control plan and analyze the component，and finally apply to the robot control system.Through the application of programmable logic controller，the reliability and stability of the robot are improved，and good results are obtained.

crawler robot；programmable logic controller；control system

TL503.6

A

1672-545X（2017）08-0225-03

2017-05-11

國家科技支撐計劃課題（2015BAK06B04） 天津市智能制造科技重大專項（15ZXZNGX00260）天津職業(yè)技術(shù)師范大學科技成果轉(zhuǎn)化培育類項目（ZHPY1602）

郝 帥（1990-），男，河北張北人，碩士研究生，研究方向為智能機器人及其應(yīng)用技術(shù)；祁宇明（1979-），男，湖北潛江人，工學博士，副教授，研究方向為機器人技術(shù)及應(yīng)用；周旺發(fā)（1988-），男，安徽東至人，本科，學士，研究方向為機器人技術(shù)及應(yīng)用。