玻璃幕墻清洗機(jī)器人爬壁運(yùn)動(dòng)控制系統(tǒng)設(shè)計(jì)

劉永平，張世一，藺卡賓

（蘭州理工大學(xué)機(jī)電工程學(xué)院，甘肅蘭州 730050）

玻璃幕墻清洗機(jī)器人爬壁運(yùn)動(dòng)控制系統(tǒng)設(shè)計(jì)

劉永平，張世一，藺卡賓

（蘭州理工大學(xué)機(jī)電工程學(xué)院，甘肅蘭州 730050）

針對(duì)高層建筑玻璃幕墻清洗問(wèn)題，開(kāi)發(fā)了一種雙層結(jié)構(gòu)玻璃幕墻清洗機(jī)器人，對(duì)機(jī)械人本體結(jié)構(gòu)及爬壁運(yùn)動(dòng)控制系統(tǒng)進(jìn)行設(shè)計(jì)，以FPGA芯片為核心，對(duì)控制系統(tǒng)各部分硬件進(jìn)行設(shè)計(jì)選型，并編寫(xiě)上位機(jī)控制軟件。采用模糊PID算法對(duì)步進(jìn)電機(jī)實(shí)現(xiàn)閉環(huán)控制，利用Matlab軟件對(duì)步進(jìn)電機(jī)進(jìn)行了仿真分析。仿真結(jié)果表明，機(jī)器人運(yùn)行狀態(tài)穩(wěn)定，具有較高的實(shí)用性。

機(jī)械結(jié)構(gòu)；硬件設(shè)計(jì)；模糊PID；仿真分析；軟件編程

0 引言

玻璃幕墻是現(xiàn)代高層建筑的主要裝飾方法之一，但其清洗問(wèn)題一直是困擾人們的一大難題，利用機(jī)器人清洗已經(jīng)成為發(fā)展的必然趨勢(shì)。

設(shè)計(jì)了一種玻璃幕墻清洗機(jī)器人［1］。機(jī)械本體采用雙層交替運(yùn)動(dòng)的結(jié)構(gòu)，可完成前進(jìn)、后退、轉(zhuǎn)彎動(dòng)作。根據(jù)玻璃表面平整光滑的特點(diǎn)，采用真空吸附方式作為機(jī)器人在玻璃墻面的附著手段，利用步進(jìn)電機(jī)作為機(jī)器人的驅(qū)動(dòng)裝置?？刂葡到y(tǒng)選用FPGA作為控制核心，構(gòu)建帶有模糊PID算法的閉環(huán)控制系統(tǒng)，利用Lab VIEW軟件編寫(xiě)上位控制程序，實(shí)現(xiàn)對(duì)機(jī)械本體運(yùn)動(dòng)的實(shí)時(shí)控制。

1 機(jī)器人機(jī)械結(jié)構(gòu)設(shè)計(jì)

1.1 機(jī)械本體結(jié)構(gòu)

高樓玻璃幕墻清洗機(jī)器人機(jī)械結(jié)構(gòu)［2］如圖1所示，在機(jī)器人作業(yè)過(guò)程中，通過(guò)吸盤(pán)組交替吸附墻面，實(shí)現(xiàn)上、下兩層協(xié)調(diào)動(dòng)作。當(dāng)下層吸住時(shí)，上層向前移動(dòng)，移動(dòng)完成之后，上層吸住，下層脫離墻面向前移動(dòng)，這樣循環(huán)往復(fù)實(shí)現(xiàn)機(jī)械本體的直線運(yùn)動(dòng)。需要轉(zhuǎn)彎時(shí)，上層吸盤(pán)吸住，下層相對(duì)上層旋轉(zhuǎn)，隨后下層吸住，上層旋轉(zhuǎn)。通過(guò)前進(jìn)、轉(zhuǎn)彎2種運(yùn)動(dòng)的配合實(shí)現(xiàn)全方位移動(dòng)。

圖1 玻璃幕墻機(jī)器人機(jī)械結(jié)構(gòu)

1.2 各部分組成及功能

機(jī)械結(jié)構(gòu)主要由吸附系統(tǒng)、移動(dòng)系統(tǒng)、上下層切換系統(tǒng)和旋轉(zhuǎn)系統(tǒng)4部分組成。吸附機(jī)構(gòu)由真空吸盤(pán)、真空泵和電磁閥組成。通過(guò)真空泵抽氣，使吸盤(pán)產(chǎn)生負(fù)壓，機(jī)械本體吸附于玻璃幕墻表面。移動(dòng)系統(tǒng)主要由上下層支架、移動(dòng)導(dǎo)軌和步進(jìn)電機(jī)等構(gòu)成，移動(dòng)時(shí)通過(guò)電機(jī)旋轉(zhuǎn)帶動(dòng)機(jī)器人前、后運(yùn)動(dòng)。上下層切換機(jī)構(gòu)主要由移動(dòng)滑塊、齒條導(dǎo)軌和步進(jìn)電機(jī)等構(gòu)成，通過(guò)電機(jī)正反轉(zhuǎn)實(shí)現(xiàn)上、下層切換。旋轉(zhuǎn)機(jī)構(gòu)主要由旋轉(zhuǎn)中心柱、旋轉(zhuǎn)齒盤(pán)導(dǎo)軌、齒輪和步進(jìn)電機(jī)等構(gòu)成。實(shí)現(xiàn)上、下兩層相對(duì)旋轉(zhuǎn)。

2 機(jī)器人控制系統(tǒng)硬件設(shè)計(jì)

2.1 控制系統(tǒng)整體結(jié)構(gòu)

根據(jù)機(jī)器人本體結(jié)構(gòu)和控制性能的要求，玻璃幕墻機(jī)器人控制系統(tǒng)主要由檢測(cè)機(jī)構(gòu)、執(zhí)行機(jī)構(gòu)、核心控制板和帶算法的上位控制程序4個(gè)部分組成，整個(gè)控制系統(tǒng)組成如圖2所示。

圖2 控制系統(tǒng)結(jié)構(gòu)組成

2.2 控制系統(tǒng)硬件組成

控制系統(tǒng)硬件包括檢測(cè)裝置、執(zhí)行裝置和核心控制板。

檢測(cè)裝置由STEDELE ME8104限位開(kāi)關(guān)、壓力傳感器和3個(gè)KZP3808光電編碼器構(gòu)成，實(shí)現(xiàn)機(jī)器人運(yùn)動(dòng)過(guò)程中的數(shù)據(jù)采集處理［3］及反饋上位程序顯示。限位開(kāi)關(guān)和壓力傳感器均屬于保護(hù)裝置，當(dāng)本體運(yùn)動(dòng)至極限位或墻面附著力過(guò)小時(shí)，保護(hù)裝置被觸發(fā)，機(jī)械本體立即鎖定在墻面。編碼器分別采集3個(gè)步進(jìn)電機(jī)輸出信號(hào)，并將信號(hào)反饋至控制板完成閉環(huán)控制。

執(zhí)行裝置由57BYGH78系列步進(jìn)電機(jī)［4］和電磁閥構(gòu)成。4個(gè)步進(jìn)電機(jī)分別完成上層前進(jìn)、下層前進(jìn)、轉(zhuǎn)彎和上下層切換的功能，其中上、下層前進(jìn)及轉(zhuǎn)彎電機(jī)配光電編碼器。2個(gè)電磁閥負(fù)責(zé)完成上下2層氣路的切換。

核心控制板需要具有模擬信號(hào)采集處理、任意頻率TTL輸出、數(shù)字IO和總線通訊等功能。FPGA芯片集成內(nèi)嵌乘法器［5］和運(yùn)算電路，是作為核心處理元件的最佳選擇。故根據(jù)設(shè)計(jì)需求搭建控制電路，F(xiàn)PGA控制板整體結(jié)構(gòu)如圖3所示。

圖3 FPGA控制板結(jié)構(gòu)

2.3 控制板功能

控制板并行采集3個(gè)光電編碼器和1個(gè)壓力傳感器的4路模擬信號(hào)，經(jīng)放大和A／D轉(zhuǎn)換后存入靜態(tài)隨機(jī)存儲(chǔ)器SRAM，可根據(jù)需要延時(shí)讀取。輸出部分在基準(zhǔn)時(shí)鐘作用下于DDS內(nèi)部合成所需頻率的數(shù)字波形［6］，經(jīng)過(guò)D／A轉(zhuǎn)換和濾波器處理生成所需的TTL開(kāi)關(guān)信號(hào)，信號(hào)放大后用于驅(qū)動(dòng)步進(jìn)電機(jī)。DIO數(shù)字接口中限位開(kāi)關(guān)信號(hào)通過(guò)DI輸入，電磁閥開(kāi)關(guān)信號(hào)通過(guò)DO輸出。由于4個(gè)步進(jìn)電機(jī)共用1個(gè)驅(qū)動(dòng)器，DO口根據(jù)上位程序命令把即將動(dòng)作的步進(jìn)電機(jī)接入驅(qū)動(dòng)器電路，完成電機(jī)驅(qū)動(dòng)信號(hào)的切換。控制板FPGA芯片內(nèi)部集成總線通訊模塊，通過(guò)總線連接完成與上位程序的指令信息傳遞。

3 閉環(huán)控制部分建模仿真

機(jī)器人主要?jiǎng)幼魇怯刹竭M(jìn)電機(jī)驅(qū)動(dòng)，要實(shí)現(xiàn)對(duì)機(jī)械運(yùn)動(dòng)的精確控制，必須保證步進(jìn)電機(jī)的運(yùn)行精度，因此，設(shè)計(jì)帶算法的步進(jìn)電機(jī)閉環(huán)控制系統(tǒng)，并對(duì)其仿真分析。

3.1 步進(jìn)電機(jī)數(shù)學(xué)模型

控制系統(tǒng)選用二相混合式步進(jìn)電機(jī)，不計(jì)永磁體回路漏磁、定子極間和端部的漏磁，忽略磁滯和渦流的影響，忽略飽和的影響，兩相混合式步進(jìn)電機(jī)的電壓平衡方程［7］為：

UA，UB為施加在兩相繞組上的電壓；rA，rB為兩相繞組的內(nèi)部繞組；wr為電機(jī)轉(zhuǎn)子的機(jī)械角；ke為電機(jī)運(yùn)行時(shí)的反電動(dòng)勢(shì)；L0，L2分別為電機(jī)繞組自感的平均分量和基波分量。

兩相混合式步進(jìn)電機(jī)的轉(zhuǎn)矩方程為：

J為轉(zhuǎn)動(dòng)慣量；B為粘滯摩擦系數(shù)；TL為負(fù)載轉(zhuǎn)矩。

根據(jù)式（1）～式（3），在Matlab／Simulink中搭建步進(jìn)電機(jī)仿真模型。輸入電機(jī)兩相電壓UA、UB與負(fù)載轉(zhuǎn)矩TL后，經(jīng)過(guò)計(jì)算可得到電機(jī)的輸出轉(zhuǎn)矩Te，兩相電流iA、iB，轉(zhuǎn)速wr，轉(zhuǎn)角θ。

3.2 模糊PID控制模型建立

從數(shù)學(xué)模型可以看出，步進(jìn)電機(jī)是高度非線性對(duì)象，因此運(yùn)算部分將模糊控制和常規(guī)PID控制結(jié)合起來(lái)，構(gòu)建模糊PID控制［8］算法。在模糊控制器中，將偏差和偏差變化率作為輸入量，然后對(duì)其模糊化處理，并按照電機(jī)特點(diǎn)設(shè)定的模糊控制規(guī)則進(jìn)行模糊決策，最后經(jīng)過(guò)解模糊處理和比例變換，得到PID控制器相關(guān)參數(shù)，從而獲得模糊PID控制器輸出量。Matlab／Simulink中建立模糊PID模型如圖4所示。

圖4 模糊PID仿真模型

3.3 建模仿真與結(jié)果分析

混合式步進(jìn)電機(jī)本身具有低頻振蕩問(wèn)題，為保證運(yùn)行精度，只能通過(guò)細(xì)分控制減小每步前進(jìn)角度的方法解決。系統(tǒng)選用2HSS57步進(jìn)電機(jī)驅(qū)動(dòng)器，驅(qū)動(dòng)器擁有2、4、8、16等級(jí)別的細(xì)分控制功能，由于細(xì)分控制采用電流閉環(huán)實(shí)現(xiàn)，故將其視為內(nèi)閉環(huán)加入到控制系統(tǒng)中。步進(jìn)電機(jī)模糊PID控制系統(tǒng)整體結(jié)構(gòu)如圖5所示。

圖5 步進(jìn)電機(jī)模糊PID控制系統(tǒng)結(jié)構(gòu)

在Matlab／Simulink模塊中，將建立的模糊PID模塊和步進(jìn)電機(jī)模塊連接，給定電機(jī)相關(guān)參數(shù)為：二相電機(jī)的電感為0.008 H、繞組電阻為2Ω、步距角為1.8°、最大磁鏈為0.01 Wb、轉(zhuǎn)矩為2 N· m、轉(zhuǎn)動(dòng)慣量為1.6×10－4kg·m2，負(fù)載為1 N·m，驅(qū)動(dòng)電壓為24 V，采用8細(xì)分控制，設(shè)定步進(jìn)脈沖頻率為1.3 k Hz。經(jīng)仿真運(yùn)算，步進(jìn)電機(jī)的輸出轉(zhuǎn)矩與轉(zhuǎn)速如圖6、圖7所示。

圖6 模糊PID控制轉(zhuǎn)矩響應(yīng)曲線

圖7 模糊PID控制轉(zhuǎn)速響應(yīng)曲線

仿真結(jié)果表明，控制系統(tǒng)具有良好的穩(wěn)定性和響應(yīng)速度，開(kāi)始階段僅用0.05 s達(dá)到穩(wěn)定，0.2 s負(fù)載加入后出現(xiàn)小幅震蕩，整體變化平滑，在驅(qū)動(dòng)機(jī)器人本體運(yùn)動(dòng)時(shí)能夠滿足精度的要求。

4 控制系統(tǒng)軟件編程

4.1 控制程序整體結(jié)構(gòu)

為保證良好的人機(jī)操作性，控制系統(tǒng)軟件界面采用Lab VIEW編寫(xiě)，總體流程如圖8所示。底層程序采用C語(yǔ)言［9］開(kāi)發(fā)，各部分功能對(duì)應(yīng)不同的函數(shù)命令，包括板卡初始化函數(shù)、參數(shù)寫(xiě)入函數(shù)、數(shù)據(jù)采集功能函數(shù)和模糊PID算法函數(shù)等。同時(shí)，將板卡的驅(qū)動(dòng)協(xié)議和總線通訊協(xié)議也嵌入底層程序中，建立了完整的底層命令。將底層命令封裝在動(dòng)態(tài)鏈接庫(kù)DLL中，需要完成某功能時(shí)，通過(guò)Lab-VIEW鏈接庫(kù)［10］調(diào)用功能直接調(diào)用所需的函數(shù)命令。

圖8 控制程序流程

4.2 控制程序功能和特點(diǎn)

上位控制界面能夠控制機(jī)械人完成前、后運(yùn)動(dòng)和左、右轉(zhuǎn)彎動(dòng)作，并有鎖定功能?？刂瓢宓母鞣N參數(shù)都在后臺(tái)程序中設(shè)置了固定值，避免因參數(shù)設(shè)定不當(dāng)引起故障。界面中前、后運(yùn)行按鈕為單擊轉(zhuǎn)化模式，左、右轉(zhuǎn)彎按鈕為單擊觸發(fā)模式，以上4個(gè)按鈕為單項(xiàng)選擇執(zhí)行，任一按鈕觸發(fā)時(shí)，另外的按鈕均無(wú)效。鎖死按鈕在程序執(zhí)行中擁有最高優(yōu)先級(jí)，可在意外突發(fā)時(shí)鎖定機(jī)器人。正常情況下點(diǎn)擊終止運(yùn)行按鈕，機(jī)械本體鎖定后軟件占用內(nèi)存釋放，程序結(jié)束。

控制程序采用多個(gè)子程序（VI）獨(dú)立運(yùn)行的方式，不同的子VI實(shí)現(xiàn)不同的功能，每個(gè)子VI中語(yǔ)句數(shù)量很小，保證了運(yùn)行速率最大化。主程序?qū)⑺械淖覸I集合調(diào)用，執(zhí)行時(shí)后臺(tái)僅運(yùn)行需要的子VI，這樣大大減少主程序運(yùn)行時(shí)內(nèi)存的占用，實(shí)現(xiàn)了各個(gè)功能的模塊化，使程序修改調(diào)整時(shí)更加便捷。

5 結(jié)束語(yǔ)

在玻璃幕墻機(jī)器人機(jī)械結(jié)構(gòu)設(shè)計(jì)的基礎(chǔ)上，完成了控制系統(tǒng)硬件部分的選型和搭建，并編寫(xiě)了相應(yīng)的控制程序，采用模糊PID算法對(duì)步進(jìn)電機(jī)進(jìn)行精確的閉環(huán)控制，提高了機(jī)械本體運(yùn)動(dòng)的穩(wěn)定性。在玻璃幕墻表面進(jìn)行爬行實(shí)驗(yàn)，驗(yàn)證了本機(jī)械系統(tǒng)可在玻璃表面沿直線穩(wěn)定運(yùn)行，轉(zhuǎn)彎時(shí)角度同樣精確，具有較高的可靠性。

［1］ Choi H，Park Y.Development of a biped walking robot actuated bya closed-chain mechanism［J］.Education and Research in Robotics and Artificial Intelligence，2006，24（1）：31-37.

［2］ 劉淑霞，王炎.爬壁機(jī)器人技術(shù)的應(yīng)用［J］.機(jī)器人，1999，21（2）：148-154.

［3］ 蘭州山海環(huán)?？萍加邢薰?吸附式雙層全轉(zhuǎn)角高樓玻璃幕墻自動(dòng)清洗機(jī)：中國(guó)，201320161349［P］.2013-10-16.

［4］ 史敬灼.步進(jìn)電機(jī)伺服控制技術(shù)［M］.西安：西北工業(yè)大學(xué)出版社，1999.

［5］ 孔利東.基于FPGA的數(shù)據(jù)采集與處理技術(shù)研究［D］.武漢：武漢理工大學(xué)，2007.

［6］ Kurazume R，Hirose S.Development of a cleaning robot system with cooperative positioning system［J］.Autonomous Robots，2000，9（3）：237-246.

［7］ 劉川，劉景林.基于Simulink仿真的步進(jìn)電機(jī)閉環(huán)控制系統(tǒng)分析［J］.測(cè)控技術(shù)，2009，28（1）：44-49.

［8］ 段英紅，楊碩.步進(jìn)電機(jī)的模糊PID控制［J］.計(jì)算機(jī)仿真，2006，23（2）：290-293.

［9］ 趙憶文，談大龍.多移動(dòng)機(jī)器人合作系統(tǒng)中的單機(jī)控制體系結(jié)構(gòu)研究［J］.機(jī)器人，1999，21（6）：421-425.

［10］ 陳福彬，柴海莉，高晶敏.基于Lab VIEW的自動(dòng)化測(cè)試平臺(tái)的設(shè)計(jì)［J］.國(guó)外電子測(cè)量技術(shù)，2012，31（11）：9-14.

Design of Control System for High-rise Buildings Glass-wall Cleaning Robot

LIU Yongping，ZHANG Shiyi，LIN Kabin
（School of Mechanical and Electronical Engineering，Lanzhou University of Technology，Lanzhou 730050，China）

To solve the problem of glass wall cleaning for high-rise buildings，this research developed a kind of glass curtain wall cleaning robot with a double layer structure，and designed the robot structure and wall climbing motion control system.The various hardware components of the control system are designed with FPGA chip at the core，and the host control software is written at the same time.Fuzzy PID algorithm is used to achieve closed-loop control of the stepper motor，and the motor is analyzed with Matlab.Simulation results indicates that the robot’s running status is stable and has high practicability.

mechanical structure；hardware design；fuzzy PID；simulation analysis；software programming

TP242

A

1001-2257（2015）09-0072-04

劉永平 （1973－），男，甘肅白銀人，教授，碩士研究生導(dǎo)師，研究方向?yàn)閿?shù)控技術(shù)、精密測(cè)控等。

版權(quán)聲明

機(jī)械與電子雜志社

2015-04-17

各位作者：來(lái)稿凡經(jīng)本刊錄用，如無(wú)特殊聲明，即視作投稿者同意授權(quán)本刊及本刊合作媒體復(fù)制、發(fā)行及進(jìn)行信息網(wǎng)絡(luò)傳播。著作權(quán)使用費(fèi)已包含在本刊所支付的稿酬中。