孟慶仙

（云南機(jī)電職業(yè)技術(shù)學(xué)院，云南 昆明 650203）

0 引言

機(jī)器人是一種自動控制的裝置，它能夠接受來自人類的語音或者按鍵的指揮，也可以去運(yùn)行一系列我們輸入的編寫好的程序。它目前主要是服務(wù)于人類的車間生產(chǎn)、建筑行業(yè)，還有一些非常危險(xiǎn)消防這些工作。所以它對人類起到了至關(guān)重要的作用。近幾年國內(nèi)外涌現(xiàn)的控制系統(tǒng)大多數(shù)都是采用分散控制，沒有統(tǒng)一的主控系統(tǒng)，但是機(jī)器人作為一個(gè)類人的產(chǎn)品，它必須能夠保證每個(gè)關(guān)節(jié)之間的信息傳遞，那么該系統(tǒng)的控制就需要大量的I/O口，并且對數(shù)據(jù)采集的實(shí)時(shí)性要求非常高。由于FPGA具有豐富的I/O接口，高速的數(shù)據(jù)處理能力，所以采用當(dāng)下比較流行的FPGA作為中央主控系統(tǒng)的主控板，可以高速、準(zhǔn)確地傳遞信息，并且開啟舵機(jī)等待及運(yùn)行模式，控制舵機(jī)的實(shí)時(shí)角度，本文主要是制定一系列動作編排的策略，編寫相應(yīng)的程序，讓機(jī)器人能夠按照指定的動作平穩(wěn)運(yùn)行[1]。

1 機(jī)器人的主控系統(tǒng)組成

本文所使用的機(jī)器人是一個(gè)具有多自由度的類似人體的組織結(jié)構(gòu)，那么這種機(jī)器人在運(yùn)動過程中就需要多個(gè)關(guān)節(jié)同時(shí)運(yùn)動，那么也就需要大量I/O口來控制。在控制方面有機(jī)械控制和手持設(shè)備兩種控制方式，該實(shí)驗(yàn)使用手持設(shè)備通過無線裝置來控制機(jī)器人的運(yùn)動[2]。同時(shí)，針對機(jī)器人的特殊要求，根據(jù)它的重量，功耗，以及考慮它的穩(wěn)定性、平衡性，提出了一整套完整的解決方案?？刂葡到y(tǒng)結(jié)構(gòu)如圖1所示。

圖1 機(jī)器人主控系統(tǒng)結(jié)構(gòu)

該系統(tǒng)把機(jī)器人的主控制系統(tǒng)分為上位機(jī)和下位機(jī)兩個(gè)部分。上位機(jī)它主要的是處理是在使用ARM芯片來完成的，它還負(fù)責(zé)完成無線遙控器的信號發(fā)射和信號的接收。ARM芯片中包括了兩個(gè)主要的功能模塊：信號調(diào)制和解調(diào)模塊。而下位機(jī)就是我們的機(jī)器人主控系統(tǒng)的核心部分，它主要由FPGA以及控制機(jī)器人運(yùn)動的舵機(jī)組成，當(dāng)FPGA接收到ARM芯片傳遞過來的動作指令信號，就會將其按照之前預(yù)設(shè)的轉(zhuǎn)換模式，將其轉(zhuǎn)換成驅(qū)動舵機(jī)的PWM脈沖信號，通過實(shí)時(shí)改變脈沖的占空比，就可以改變舵機(jī)所運(yùn)動的角度，并且我們在上位機(jī)中設(shè)計(jì)了幾個(gè)地址線，通過地址線來選擇哪個(gè)舵機(jī)工作。FPGA是整個(gè)下位機(jī)的主控核心部分，也是我們整個(gè)機(jī)器人平穩(wěn)運(yùn)行的最重要的組成部分[3]。

2 系統(tǒng)設(shè)計(jì)

該控制系統(tǒng)的上位機(jī)采用無線遙控器的發(fā)射接收兩個(gè)模塊信號來控制，ARM芯片作為上位機(jī)的核心控制系統(tǒng)，負(fù)責(zé)處理來自遙控器的信息請求。下位機(jī)使用FPGA作為主控器，來完成機(jī)器人舵機(jī)角度的精準(zhǔn)控制。最終實(shí)現(xiàn)機(jī)器人平穩(wěn)運(yùn)行。

2.1 系統(tǒng)控制設(shè)計(jì)的主要內(nèi)容

（1）機(jī)器人能夠在舵機(jī)的轉(zhuǎn)動角度范圍內(nèi)自由活動。

（2）多個(gè)舵機(jī)能夠同時(shí)被控制，完成指定動作的協(xié)調(diào)與分配。

（3）控制舵機(jī)的各個(gè)系統(tǒng)、舵機(jī)還有一些外圍電路都放在了機(jī)器人身體內(nèi)部，不至于放在外面影響機(jī)器人運(yùn)動。

（4）手持的無線遙控器可以遠(yuǎn)距離控制機(jī)器人的機(jī)械運(yùn)動。（5）利用FPGA控制機(jī)器人的準(zhǔn)確運(yùn)動。（6）編寫高速有效的verilog程序。

2.2 系統(tǒng)硬件設(shè)計(jì)

目前國內(nèi)大多采用一個(gè)伺服驅(qū)動器控制一個(gè)伺服電機(jī)的方式，這種方式機(jī)器人體積龐大，項(xiàng)目之間配合時(shí)出現(xiàn)延遲，而本課題采用一個(gè)FPGA主控芯片作為伺服驅(qū)動器，來完成驅(qū)動機(jī)器人腿部的伺服電機(jī)的工作，使機(jī)器人重量減輕，體積減小，達(dá)到精準(zhǔn)控制。

在該實(shí)驗(yàn)中，我們所使用的機(jī)器人一共有18個(gè)舵機(jī)，他們分別由PWM的內(nèi)核模塊集中控制，每個(gè)舵機(jī)占用一個(gè)I/O口。每個(gè)舵機(jī)之間我們加入了光電耦合器TLP521-4。因?yàn)樾盘栐趥鬏斶^程中經(jīng)過了反向，那么就必須把光電耦合出來的信號再次經(jīng)過反向才能還原成原來的信號。系統(tǒng)整體硬件由一個(gè)能夠獨(dú)立行走的機(jī)器人，以及一個(gè)手持的遙控設(shè)備，還有一個(gè)arm板、FPGA主控系統(tǒng)構(gòu)成，最終控制18路舵機(jī)分時(shí)運(yùn)轉(zhuǎn)，達(dá)到讓機(jī)器人運(yùn)動的目的[4]。系統(tǒng)實(shí)驗(yàn)中FPGA管腳配置硬件接口電路分配圖如圖2所示。

圖2 硬件接口電路管腳分配圖

基于FPGA的工業(yè)機(jī)器人控制系統(tǒng)不但可以讓機(jī)器人平穩(wěn)地行走，而且能夠穿越一些坡度較陡的路，甚至樓梯，為機(jī)器人重心與行走的穩(wěn)定性最佳參數(shù)配合的研究與開發(fā)起到指導(dǎo)作用。

2.3 控制策略的實(shí)現(xiàn)

該控制系統(tǒng)由上下兩部分構(gòu)成，一部分是來自上位機(jī)的ARM板子和無線遙控器，另一部分是下位機(jī)中的FPGA主控系統(tǒng)。無線遙控器經(jīng)過調(diào)制解調(diào)后輸出4個(gè)控制信號，信號連接至ARM板子作為他的輸入信號，arm將其轉(zhuǎn)換成可以控制的1位confirm線，1位run線，3位地址輸入線，1位讀寫信號線，2位數(shù)據(jù)信號線；最后由arm板子編譯后輸出到相對應(yīng)得FPGA主控板上，3位地址輸入線主要是控制9個(gè)舵機(jī)選擇哪個(gè)舵機(jī)運(yùn)動，2位數(shù)據(jù)信號線主要是控制對應(yīng)的舵機(jī)轉(zhuǎn)動相應(yīng)的角度，這個(gè)角度就代表了機(jī)器人動作的變化模式。

使用無線遙控器按下某個(gè)按鍵，它將觸發(fā)系統(tǒng)模塊產(chǎn)生相應(yīng)的動作編碼，然后經(jīng)過arm板處理后送到FPGA來處理[5]。而動作譯碼模塊主要功能就是在接收到的編碼信號后，對信號進(jìn)行分析，判斷按鍵的動作，并進(jìn)行舵機(jī)的選擇。我們將根據(jù)動作的不同產(chǎn)生相應(yīng)的控制信號，F(xiàn)PGA產(chǎn)生不同的PWM波來控制舵機(jī)的轉(zhuǎn)動角度，那么機(jī)器人也就完成了動作變化。

在實(shí)驗(yàn)過程中對控制機(jī)器人的舵機(jī)進(jìn)行了相應(yīng)的簡化，一共使用8個(gè)舵機(jī)，無線遙控器的1到8按鈕主要是針對8個(gè)舵機(jī)的選擇，當(dāng)按下某個(gè)按鍵的時(shí)候，系統(tǒng)鎖存器進(jìn)行鎖存，那么后面所有的操作都是針對該舵機(jī)進(jìn)行控制，其余均不受到影響。遙控器上第9個(gè)按鍵和第10個(gè)按鍵是針對機(jī)器人的動作進(jìn)行控制，如果按下第9鍵，那么代表該舵機(jī)要在原有角度的基礎(chǔ)上轉(zhuǎn)動加上45度，如果按下第10鍵，那么代表該舵機(jī)要在原有的角度基礎(chǔ)上減去45度，按下11鍵的時(shí)候，系統(tǒng)確認(rèn)該操作，機(jī)器人開始執(zhí)行相應(yīng)的轉(zhuǎn)動。按下12鍵得時(shí)候，系統(tǒng)恢復(fù)初始化，回到初始狀態(tài)。

3 實(shí)驗(yàn)測試

實(shí)驗(yàn)所用機(jī)器人模型主要是描繪出機(jī)器人在完成規(guī)定動作時(shí)舵機(jī)安裝的位置，各姿態(tài)下PWM信號參數(shù)如表1所示(空格處參數(shù)與相應(yīng)的直立時(shí)參數(shù)相同)，論文主要完成了以下工作：主要是設(shè)計(jì)FPGA來控制兩個(gè)以上的舵機(jī)的控制策略，它們能夠同時(shí)完成機(jī)器人一系列動作的協(xié)調(diào)，并且在保持機(jī)器人平衡上準(zhǔn)確地調(diào)整角度，來改變由于重心變化引起的不平衡。完成了FPGA引腳的分配，PWM 信號的發(fā)生程序設(shè)計(jì)，使用verilog語言實(shí)現(xiàn)了對機(jī)器人角度的精確控制，使得機(jī)器人能夠平穩(wěn)運(yùn)動。

表1 仿人機(jī)器人各姿態(tài)下PWM 信號參數(shù) 單位：0.1 ms

4 結(jié)語

基于FPGA的工業(yè)機(jī)器人控制系統(tǒng)的研究具有很大的現(xiàn)實(shí)意義，現(xiàn)在我國新增工業(yè)機(jī)器人中超過70%依賴國外進(jìn)口，而我國近幾年工業(yè)機(jī)器人需求量增大，學(xué)生如果可以掌握該技術(shù)，那么對于學(xué)生的就業(yè)有很大的幫助。目前高職高專組進(jìn)行的工業(yè)機(jī)器人大賽就是為了促進(jìn)機(jī)器人技術(shù)的推廣與發(fā)展，而這個(gè)項(xiàng)目的研究正是對大賽后續(xù)的一個(gè)補(bǔ)充，讓學(xué)生可以多方面地掌握機(jī)器人運(yùn)動的控制技術(shù)?，F(xiàn)在學(xué)院開設(shè)了FPGA項(xiàng)目化教學(xué)，該系統(tǒng)的研究正是與這門課程的融合，既體現(xiàn)了當(dāng)代機(jī)器人物聯(lián)網(wǎng)要求，又拓展了學(xué)生對FPGA學(xué)習(xí)的動手能力，讓學(xué)生對課程融會貫通，不再獨(dú)立教學(xué)就能夠讓學(xué)生綜合運(yùn)用所學(xué)知識。