胡 楠，張吉沐陽(yáng)，郭 健，吳益飛

(南京理工大學(xué) 自動(dòng)化學(xué)院，南京 210094)

?

配電房軌道式自動(dòng)巡檢機(jī)器人控制系統(tǒng)設(shè)計(jì)與實(shí)現(xiàn)

胡 楠，張吉沐陽(yáng)，郭 健，吳益飛

(南京理工大學(xué) 自動(dòng)化學(xué)院，南京 210094)

針對(duì)配電房等室內(nèi)電力系統(tǒng)供電設(shè)備自動(dòng)巡檢的需求，提出了以微控制器MSP430F5438為核心的自動(dòng)巡檢機(jī)器人控制系統(tǒng)總體設(shè)計(jì)方案；采用模塊化方法完成了控制系統(tǒng)硬件電路設(shè)計(jì)，主要包括：主控模塊、電源模塊、運(yùn)動(dòng)控制模塊、通信模塊和數(shù)據(jù)采集模塊；介紹了控制系統(tǒng)軟件的總體流程，完成了控制系統(tǒng)嵌入式軟件及其上位機(jī)監(jiān)控軟件的設(shè)計(jì)；實(shí)驗(yàn)結(jié)果表明，所設(shè)計(jì)的控制系統(tǒng)應(yīng)用于巡檢機(jī)器人可以實(shí)現(xiàn)對(duì)配電房供電設(shè)備的自動(dòng)巡檢，從而驗(yàn)證了控制系統(tǒng)的有效性與合理性，具有顯著的推廣應(yīng)用價(jià)值。

配電房;軌道式;自動(dòng)巡檢;機(jī)器人

0 引言

配電是電力系統(tǒng)中直接與用戶相連并向用戶分配電能的環(huán)節(jié)，配電設(shè)備的狀態(tài)是否正常直接關(guān)系到用戶用電質(zhì)量，保證配電設(shè)備的正常運(yùn)行至關(guān)重要。由于目前國(guó)內(nèi)配電房?jī)?nèi)的設(shè)備如進(jìn)線柜、出線柜、電容柜等均不自帶數(shù)據(jù)采集模塊，不能自動(dòng)向工作人員發(fā)送自身狀態(tài)信息，仍需要人工巡檢[1-2]。由于設(shè)備數(shù)量較多、巡檢工作量較大、工作人員的技術(shù)水平良莠不齊，因此人工日常巡檢維護(hù)不能得到充分的保障，有時(shí)甚至不能發(fā)現(xiàn)設(shè)備的異常狀況，無(wú)法及時(shí)處理問(wèn)題，造成錯(cuò)檢、漏檢等現(xiàn)象，帶來(lái)巨大的損失[3-4]。

本文提出一種配電房軌道式自動(dòng)巡檢機(jī)器人控制系統(tǒng)，在接收到放置在配電房?jī)?nèi)的上位機(jī)發(fā)送的控制命令后，可控制巡檢機(jī)器人本體基于軌道運(yùn)行，并精確運(yùn)行至待測(cè)位置，通過(guò)攜帶的多種檢測(cè)傳感器，完成對(duì)設(shè)備柜體號(hào)、指示燈、開(kāi)關(guān)按鈕、儀表讀數(shù)、柜體內(nèi)部溫度、柜體內(nèi)部局部放電現(xiàn)象和室內(nèi)環(huán)境溫濕度等信息的采集，同時(shí)將信息實(shí)時(shí)傳送至上位機(jī)分析處理，以便工作人員及時(shí)監(jiān)控設(shè)備狀態(tài)，大大提高了設(shè)備狀態(tài)檢測(cè)的準(zhǔn)確性、實(shí)時(shí)性以及自動(dòng)化水平，具有廣闊的應(yīng)用前景。

1 控制系統(tǒng)總體設(shè)計(jì)

機(jī)器人本體外形結(jié)構(gòu)如圖1所示，本體具有3個(gè)自由度，包括軌道小車、豎直機(jī)械手和水平機(jī)械手。機(jī)器人本體在軌道小車的帶動(dòng)下，基于懸掛在空中的軌道前后運(yùn)行，能適應(yīng)配電房?jī)?nèi)狹小的空間，避免對(duì)設(shè)備造成影響。兩軸機(jī)械手?jǐn)y帶檢測(cè)傳感器，以線性同步帶模組為傳動(dòng)機(jī)構(gòu)，豎直機(jī)械手上下運(yùn)動(dòng)，實(shí)現(xiàn)對(duì)不同高度設(shè)備信息的檢測(cè)；水平機(jī)械手左右運(yùn)動(dòng)，可以使傳感器緊貼柜體表面，完成柜體內(nèi)部局部放電現(xiàn)象的檢測(cè)。

圖1 巡檢機(jī)器人本體外形結(jié)構(gòu)圖

巡檢機(jī)器人控制系統(tǒng)總體結(jié)構(gòu)框圖如圖2所示?？刂葡到y(tǒng)由主控模塊、電源模塊、運(yùn)動(dòng)控制模塊、通信模塊和數(shù)據(jù)采集模塊組成[5]。主控模塊以微控制器MSP430F5438為核心；電源模塊包括1塊鋰電池，可為系統(tǒng)其他模塊提供電能；運(yùn)動(dòng)控制模塊包括1個(gè)軌道小車電機(jī)、1個(gè)豎直機(jī)械手電機(jī)和1個(gè)水平機(jī)械手電機(jī)，還包括電機(jī)驅(qū)動(dòng)器、編碼器和限位保護(hù)傳感器；通信模塊包括1個(gè)無(wú)線路由器和1個(gè)RS485轉(zhuǎn)TCP/IP協(xié)議轉(zhuǎn)換器，實(shí)現(xiàn)機(jī)器人與上位機(jī)的無(wú)線通信；數(shù)據(jù)采集模塊由相關(guān)檢測(cè)傳感器組成，包括：高清攝像機(jī)、紅外熱像儀、局部放電檢測(cè)器和溫濕度傳感器。

圖2 控制系統(tǒng)總體結(jié)構(gòu)框圖

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

2.1 主控模塊設(shè)計(jì)

主控模塊選用TI公司的微控制器MSP430F5438作為主控核心[6]。該主控芯片超低功耗，工作電壓1.8-3.6 V，適合工作于電池供電的系統(tǒng)；處理能力強(qiáng)，內(nèi)核為16位RISC處理器；片內(nèi)資源豐富，I/O口數(shù)量眾多。主要完成以下任務(wù)：與上位機(jī)通信；處理編碼器、限位開(kāi)關(guān)的反饋信號(hào)；產(chǎn)生三軸電機(jī)驅(qū)動(dòng)信號(hào)并實(shí)現(xiàn)調(diào)速；對(duì)局部放電檢測(cè)器和溫濕度傳感器信息進(jìn)行預(yù)處理。

主控芯片資源分配圖如圖3所示。通過(guò)USCI串口通信模塊UART模式實(shí)現(xiàn)異步串行通信和接收局部放電檢測(cè)器信息；通過(guò)帶中斷能力的P1和P2口接收編碼器、限位保護(hù)傳感器的反饋信號(hào)；通過(guò)具有捕獲/比較寄存器的16位定時(shí)器Timer_A和Timer_B產(chǎn)生3路電機(jī)驅(qū)動(dòng)信號(hào)，驅(qū)動(dòng)三軸電機(jī)；通過(guò)多路I/O口控制外部按鍵、繼電器等，并接收溫濕度傳感器信息。主控芯片和其外圍電路集成在1塊主控板上。

圖3 主控芯片資源分配圖

2.2 電源模塊設(shè)計(jì)

對(duì)于整個(gè)控制系統(tǒng)，電源模塊電路圖如圖4所示。電源模塊由電池、電源轉(zhuǎn)換模塊和充放電電路組成等[7]。電池選用24 V/20 Ah動(dòng)力鋰電池，具有可充電、高倍率、容量大的優(yōu)點(diǎn)。三軸電機(jī)驅(qū)動(dòng)器為24 V供電。檢測(cè)傳感器、無(wú)線路由器和協(xié)議轉(zhuǎn)換器等設(shè)備均為12 V供電，選用OU-24-12-120W型24 V轉(zhuǎn)12 V模塊將24 V轉(zhuǎn)換為12 V。采用TBV50AS24型霍爾電壓傳感器實(shí)時(shí)監(jiān)測(cè)鋰電池電壓。電機(jī)驅(qū)動(dòng)器供電電路和電池充電電路均采用MGR(JGX)-1 DD220D25型固態(tài)繼電器控制。

圖4 控制系統(tǒng)電源模塊電路圖

對(duì)于主控芯片，供電電壓為3.3 V，先由1個(gè)HZD10W-24S05型24 V轉(zhuǎn)5 V模塊將電池24 V轉(zhuǎn)換為5 V，再由1塊TPS7333芯片將5 V轉(zhuǎn)換為3.3 V供給主控芯片。主控芯片電源電路圖如圖5所示。

圖5 主控芯片電源電路圖

2.3 運(yùn)動(dòng)控制模塊設(shè)計(jì)

運(yùn)動(dòng)控制模塊組成結(jié)構(gòu)圖如圖6所示。

圖6 運(yùn)動(dòng)控制模塊組成結(jié)構(gòu)圖

軌道小車電機(jī)帶動(dòng)整個(gè)機(jī)器人本體運(yùn)動(dòng)，負(fù)載較大，需要較大力矩，且需要較好的調(diào)速效果，故采用直流電機(jī)驅(qū)動(dòng)。兩軸機(jī)械手需要實(shí)現(xiàn)精確移動(dòng)，定位精度要求較高，故采用步進(jìn)電機(jī)驅(qū)動(dòng)[8]。

機(jī)器人本體總質(zhì)量為m=80 kg，機(jī)器人最大速度為v=0.3 m/s，機(jī)器人最大加速度為a=1 m/s2，軌道小車車輪與軌道間摩擦系數(shù)為μ=0.2，軌道小車車輪半徑為r=0.03 m，直流電機(jī)所需功率：

(1)

直流電機(jī)所需轉(zhuǎn)矩：

(2)

直流電機(jī)所需額定轉(zhuǎn)速：

(3)

故直流電機(jī)選用24 V、90 W、100 r/min、5.4 N·m的Z62DP2490-30S型直流減速電機(jī)，減速比1:30。

直流電機(jī)采用脈寬調(diào)制控制，通過(guò)主控芯片的P4.1口產(chǎn)生PWM驅(qū)動(dòng)信號(hào)DCPWM，經(jīng)過(guò)SN74HCT245緩沖芯片后提供給STDQ2430型直流電機(jī)驅(qū)動(dòng)器。通過(guò)調(diào)節(jié)PWM信號(hào)的占空比實(shí)現(xiàn)調(diào)速，使軌道小車可以選擇低速、中速、高速等不同的速度。利用P4.2口產(chǎn)生電機(jī)方向控制信號(hào)DCDIR，實(shí)現(xiàn)電機(jī)的正反轉(zhuǎn)；利用P4.3口產(chǎn)生驅(qū)動(dòng)器使能信號(hào)DCEN。所有控制信號(hào)都經(jīng)過(guò)TLP521-1光耦隔離，以提高可靠性和抗干擾能力。

豎直機(jī)械手負(fù)載質(zhì)量為m1=40 kg，同步輪半徑r1=0.015 m，豎直機(jī)械手電機(jī)所需保持力矩：

T1=m1gr1=40×10×0.015=6N·m

(4)

故豎直機(jī)械手電機(jī)選用24 V、6.3 N·m的Y09-59D3-7538M型減速剎車步進(jìn)電機(jī)，步距角1.8°，減速比1:4，剎車起到安全保護(hù)作用，防止因系統(tǒng)突然斷電而導(dǎo)致負(fù)載跌落。水平機(jī)械手負(fù)載只有局部放電檢測(cè)器，質(zhì)量較輕，故水平機(jī)械手電機(jī)選用24 V、1.4 N·m的Y07-59D1-3074型步進(jìn)電機(jī)，步距角1.8°。

步進(jìn)電機(jī)采用脈沖控制，由主控芯片的P4.4、P4.5口產(chǎn)生兩路脈沖信號(hào)STEP1、STEP2，經(jīng)過(guò)SN74HCT245緩沖芯片后分別提供給2臺(tái)YARAK'SR Y2SSR型步進(jìn)電機(jī)驅(qū)動(dòng)器。通過(guò)調(diào)節(jié)脈沖信號(hào)的頻率實(shí)現(xiàn)調(diào)速，使兩軸機(jī)械手可以選擇低速、中速、高速等不同的速度。由P8.1-P8.4四個(gè)I/O口產(chǎn)生兩路方向信號(hào)DIR1、DIR2和兩路驅(qū)動(dòng)器使能信號(hào)EN1、EN2。所有控制信號(hào)都經(jīng)過(guò)TLP521-1光耦隔離，以提高可靠性和抗干擾能力。

當(dāng)3個(gè)電機(jī)中的1個(gè)運(yùn)行時(shí)，另外2個(gè)電機(jī)保持靜止?fàn)顟B(tài)。3個(gè)電機(jī)分別對(duì)應(yīng)3個(gè)2500線增量式編碼器，分別記錄各電機(jī)的運(yùn)行情況，將所記錄的脈沖數(shù)反饋給主控模塊。限位保護(hù)傳感器選用TR12-4DN型圓柱形接近開(kāi)關(guān)，可以限制三軸方向上的運(yùn)行范圍，在起到安全保護(hù)作用的同時(shí)，又可以作為零位開(kāi)關(guān)為3個(gè)編碼器提供清零信號(hào)。

2.4 通信模塊設(shè)計(jì)

通信模塊電路圖如圖7所示。通過(guò)主控芯片的USCI串行接口以RS485協(xié)議通信，用MAX3485芯片實(shí)現(xiàn)電平轉(zhuǎn)換，將主控芯片輸出的TTL電平轉(zhuǎn)換為RS485差分信號(hào)。

圖7 RS485通信電路圖

上位機(jī)為1臺(tái)PC終端計(jì)算機(jī)。機(jī)器人本體攜帶1臺(tái)NETGEAR JWNR2000v3型無(wú)線路由器，路由器共享一個(gè)專有WiFi網(wǎng)絡(luò)，PC終端計(jì)算機(jī)接入該網(wǎng)絡(luò)，通過(guò)5.8 GHz以太網(wǎng)的方式與機(jī)器人進(jìn)行通信。主控芯片不能直接接收以太網(wǎng)TCP/IP協(xié)議信息，需要進(jìn)行以太網(wǎng)協(xié)議和串口協(xié)議的相互轉(zhuǎn)換，故通信模塊還包括1臺(tái)C2000 N1AS型RS485轉(zhuǎn)TCP/IP協(xié)議轉(zhuǎn)換器。

2.5 數(shù)據(jù)采集模塊設(shè)計(jì)

數(shù)據(jù)采集模塊組成圖8如圖所示。

圖8 數(shù)據(jù)采集模塊組成圖

高清攝像機(jī)選用130萬(wàn)像素、20倍光學(xué)變焦的DS-2ZCN2006型，采集設(shè)備柜體號(hào)、指示燈、開(kāi)關(guān)按鈕、儀表讀數(shù)的圖像和視頻信息；紅外熱像儀選用MAG32HF型，通過(guò)紅外熱成像原理，采集設(shè)備柜體內(nèi)部溫度的圖像和視頻信息；局部放電檢測(cè)器通過(guò)超聲波和瞬態(tài)地電波檢測(cè)原理，采集設(shè)備柜體內(nèi)部局部放電信息；溫濕度傳感器選用AM2301型，采集室內(nèi)周圍環(huán)境的溫度和濕度信息。高清攝像機(jī)和紅外熱像儀均通過(guò)自帶的網(wǎng)口與無(wú)線路由器LAN口相連，無(wú)需本地處理，直接將圖像和視頻信息發(fā)送至上位機(jī)分析處理并顯示；局部放電檢測(cè)器信息和溫濕度傳感器信息經(jīng)過(guò)主控模塊預(yù)處理后再傳送至上位機(jī)顯示。

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

機(jī)器人控制系統(tǒng)嵌入式軟件使用C語(yǔ)言設(shè)計(jì)，基于IAR Embedded Workbench for MSP430開(kāi)發(fā)環(huán)境開(kāi)發(fā)，主要包括主程序、通信子程序和運(yùn)動(dòng)控制子程序[9]。

主程序主要包括MSP430F5438硬件系統(tǒng)初始化和對(duì)子程序的調(diào)用等。硬件系統(tǒng)初始化包括晶振、I/O口方向和功能、定時(shí)器、串口等的初始化。硬件系統(tǒng)初始化完成后，進(jìn)入while(1)循環(huán)，不斷等待上位機(jī)發(fā)送的控制命令，當(dāng)接收到控制命令后，解析命令并執(zhí)行相應(yīng)動(dòng)作，執(zhí)行完相應(yīng)動(dòng)作后繼續(xù)等待下一個(gè)命令。主程序流程圖如圖9所示。

圖9 主程序流程圖

通信子程序?qū)崿F(xiàn)了控制命令的解析和相關(guān)數(shù)據(jù)信息的發(fā)送。上位機(jī)控制命令通過(guò)數(shù)據(jù)幀的形式發(fā)送，協(xié)議長(zhǎng)度為6個(gè)字節(jié)，格式為：“幀頭+電機(jī)選擇+啟停+方向+速度+幀尾”，通信子程序?qū)γ钸M(jìn)行解析，從而得到應(yīng)執(zhí)行的動(dòng)作，具體協(xié)議如表1所示。

表1 控制命令協(xié)議

同時(shí)，電機(jī)運(yùn)動(dòng)狀態(tài)信息、局部放電和溫濕度預(yù)處理信息也通過(guò)數(shù)據(jù)幀形式發(fā)送，協(xié)議長(zhǎng)度為10個(gè)字節(jié)，格式為：“幀頭+X軸位置+Y軸位置+Z軸位置+X軸速度+Y軸速度+Z軸速度+局部放電信息+溫濕度信息+幀尾”，其中，幀頭為“0xFB”，幀尾為“0xBF”。狀態(tài)信息發(fā)送流程圖如圖10所示。

圖10 狀態(tài)信息發(fā)送流程圖

運(yùn)動(dòng)控制子程序產(chǎn)生三軸電機(jī)驅(qū)動(dòng)信號(hào)，控制三軸電機(jī)執(zhí)行具體動(dòng)作，并對(duì)編碼器和限位保護(hù)傳感器反饋信息進(jìn)行處理以實(shí)現(xiàn)轉(zhuǎn)速閉環(huán)控制。運(yùn)動(dòng)控制子程序流程圖如圖11所示。

圖11 運(yùn)動(dòng)控制子程序流程圖

機(jī)器人控制系統(tǒng)上位機(jī)監(jiān)控軟件基于Windows操作系統(tǒng)設(shè)計(jì)。軟件內(nèi)部集成有網(wǎng)絡(luò)通信、圖像識(shí)別、數(shù)據(jù)存儲(chǔ)、數(shù)據(jù)處理等功能。具有以下功能：發(fā)出控制命令對(duì)機(jī)器人運(yùn)動(dòng)進(jìn)行控制；處理機(jī)器人發(fā)送的運(yùn)行狀態(tài)信息，實(shí)時(shí)顯示當(dāng)前機(jī)器人的位置和速度；處理檢測(cè)傳感器發(fā)送的數(shù)據(jù)并實(shí)時(shí)顯示在軟件界面上。工作人員能清楚地從顯示界面上查看機(jī)器人當(dāng)前的巡檢情況。

4 控制系統(tǒng)實(shí)驗(yàn)

在配電房現(xiàn)場(chǎng)進(jìn)行巡檢實(shí)驗(yàn)，通過(guò)上位機(jī)向機(jī)器人發(fā)送控制命令：“0xFA 0x01 0xA0 0xC0 0x20 0xAF”，機(jī)器人開(kāi)始沿軌道運(yùn)行，到達(dá)指定位置后停止；接著發(fā)送控制命令：“0xFA 0x02 0xA00xC0 0x10 0xAF”，豎直機(jī)械手開(kāi)始運(yùn)動(dòng)，到達(dá)指定位置后停止，由高清攝像機(jī)、紅外熱像儀完成信息采集；繼續(xù)發(fā)送控制命令：“0xFA 0x03 0xA0 0xC0 0x10 0xAF”，水平機(jī)械手開(kāi)始運(yùn)動(dòng)，到達(dá)指定位置后停止，由局部放電檢測(cè)器完成信息采集。在所設(shè)計(jì)的上位機(jī)監(jiān)控軟件界面上實(shí)時(shí)監(jiān)控狀態(tài)信息。

上位機(jī)監(jiān)控軟件界面顯示有：傳感器檢測(cè)的實(shí)時(shí)信息：包括高清攝像機(jī)、紅外熱像儀拍攝的圖像和視頻，局部放電檢測(cè)器和溫濕度傳感器檢測(cè)信息；機(jī)器人當(dāng)前的運(yùn)動(dòng)狀態(tài)：包括三軸的運(yùn)動(dòng)位置和速度，通過(guò)模擬配電房設(shè)備分布圖反映機(jī)器人本體當(dāng)前在配電房?jī)?nèi)的具體位置。經(jīng)測(cè)量：機(jī)器人最大速度可達(dá)0.32 m/s，定位精度約為2 mm，連續(xù)工作時(shí)間可達(dá)8小時(shí)。

巡檢結(jié)果表明：機(jī)器人在所設(shè)計(jì)的控制系統(tǒng)控制下，能準(zhǔn)確、快速、可靠地采集到待測(cè)信息，并及時(shí)向上位機(jī)反饋。工作人員能清楚、及時(shí)地獲取配電房設(shè)備的實(shí)時(shí)狀態(tài)，以便對(duì)異常情況做出反應(yīng)。機(jī)器人較好地完成了巡檢任務(wù)，可代替人工完成配電房的巡檢工作。

5 結(jié)語(yǔ)

本文設(shè)計(jì)并實(shí)現(xiàn)了一種配電房軌道式自動(dòng)巡檢機(jī)器人控制系統(tǒng)，該控制系統(tǒng)主要運(yùn)用于控制三軸機(jī)器人本體沿軌道運(yùn)行，實(shí)現(xiàn)對(duì)配電房?jī)?nèi)供電設(shè)備的自動(dòng)巡檢。控制系統(tǒng)基于模塊化方法設(shè)計(jì)：包括主控模塊、電源模塊、運(yùn)動(dòng)控制模塊、通信模塊和數(shù)據(jù)采集模塊?？刂葡到y(tǒng)以微控制器MSP430F5438為核心，各模塊間相互配合，較好地完成了多種巡檢信息的采集并將結(jié)果實(shí)時(shí)反饋給工作人員。實(shí)際現(xiàn)場(chǎng)巡檢實(shí)驗(yàn)證明了所設(shè)計(jì)控制系統(tǒng)的有效性與合理性，控制系統(tǒng)具有顯著的推廣應(yīng)用價(jià)值。

[1] 韋 鵬,徐 攀,竇俊廷,等. 閥廳智能巡檢機(jī)器人系統(tǒng)[J]. 制造業(yè)自動(dòng)化,2015(7):45-48.[2] Mostashfi A, Fakhari A, Mohammad Ali Badri. A novel design of inspection robot for high-voltage power lines[J]. Industrial Robot: An International Journal,2014,41(2):166-175.

[3] 鄭盼龍,遲冬祥. 電力系統(tǒng)中機(jī)器人的研究現(xiàn)狀與展望[J]. 上海電機(jī)學(xué)院學(xué)報(bào),2013,16(6):347-353.

[4] 魯守銀,錢(qián)慶林,張 斌,等. 變電站設(shè)備巡檢機(jī)器人的研制[J]. 電力系統(tǒng)自動(dòng)化,2006,30(13):94-98.

[5] 馬 妍,宋愛(ài)國(guó). 基于STM32的力反饋型康復(fù)機(jī)器人控制系統(tǒng)設(shè)計(jì)[J]. 測(cè)控技術(shù),2014,33(1):74-78.

[6] 鄭 毅,朱紀(jì)洪. 采用MSP430的舵機(jī)控制系統(tǒng)設(shè)計(jì)及實(shí)現(xiàn)[J]. 計(jì)算機(jī)測(cè)量與控制,2014,22(10):3181-3182.

[7] 孟凡軍,李聲晉,盧 剛,等. 基于多DSP的輪腿式機(jī)器人控制系統(tǒng)設(shè)計(jì)[J]. 微特電機(jī),2011,39(6):59-62.

[8] 冒春艷,楊建飛,戴偉昊,等. 應(yīng)用于三維打印的運(yùn)動(dòng)控制系統(tǒng)設(shè)計(jì)[J]. 工業(yè)控制計(jì)算機(jī),2015,28(9):82-83.

[9] 馮新剛. 基于ARM豎井救援機(jī)器人設(shè)計(jì)和實(shí)現(xiàn)[J]. 計(jì)算機(jī)測(cè)量與控制,2015,23(9):3172-3173.

Design and Implementation of Control System for Power Distribution Room Orbital Automatic Inspection Robot

Hu Nan，Zhang Jimuyang，Guo Jian，Wu Yifei

(School of Automation, Nanjing University of Science and Technology, Nanjing 210094, China)

According to the demand of automatic inspection of the power equipment of indoor power system such as the power distribution room, an overall design scheme of an automatic inspection robot control system with MCU MSP430F5438 as the core is proposed. The control system hardware circuit is designed by a modular design method, including the main control module, the power module, the motion control module, the communication module and the data collection module. The overall flow of the control system software is introduced and the embedded software and the PC monitoring software of the control system are designed. Experiment results show that the designed control system applied to the inspection robot can implement the automatic inspection of the power equipment of power distribution room, which proves the effectiveness and rationality of the control system. The control system has significant application value.

power distribution room; orbital; automatic inspection; robot

2015-11-30；

2016-01-29。

胡 楠(1991-)，男，江蘇南京人，碩士研究生，主要從事機(jī)器人控制、嵌入式系統(tǒng)方向的研究。

1671-4598(2016)03-0095-04

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

TP3

A