羅慶生，陳胤霏2，劉星棟，朱 琛

(1.北京理工大學(xué) 機(jī)電學(xué)院，北京 100081; 2.廣東省潮陽(yáng)實(shí)驗(yàn)學(xué)校，廣東 汕頭 515100)

0 引言

對(duì)于小型仿人機(jī)器人來說，機(jī)械結(jié)構(gòu)是其骨架與基礎(chǔ)，控制系統(tǒng)則是其核心與靈魂。要想設(shè)計(jì)出一款形象靚麗、結(jié)構(gòu)緊湊、功能出色、性能穩(wěn)定的小型仿人機(jī)器人，開展其機(jī)械結(jié)構(gòu)的優(yōu)化設(shè)計(jì)和控制系統(tǒng)的合理構(gòu)建是極為關(guān)鍵的[1-2]。這兩項(xiàng)工作在一定程度上相輔相成，共同決定著小型仿人機(jī)器人研制水平的高低與成敗，需要投入極大的精力才能做好。筆者為開展青少年機(jī)器人教育，特地研制了一種具有19個(gè)自由度的新型仿人機(jī)器人，在研制過程中，著力解決了機(jī)器人的機(jī)械結(jié)構(gòu)設(shè)計(jì)與控制系統(tǒng)構(gòu)建問題。

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

1.1 機(jī)器人結(jié)構(gòu)設(shè)計(jì)需考慮的問題

小型仿人機(jī)器人結(jié)構(gòu)設(shè)計(jì)的合理與否、優(yōu)化與否、適用與否直接決定著其整體性能，在其機(jī)械結(jié)構(gòu)設(shè)計(jì)過程中應(yīng)主要考慮“機(jī)器人自由度的分配、驅(qū)動(dòng)器的選型、機(jī)器人實(shí)體結(jié)構(gòu)的設(shè)計(jì)、機(jī)器人主體制作材料的選擇以及機(jī)器人整體裝配的工藝性”等問題。此外，在機(jī)器人結(jié)構(gòu)設(shè)計(jì)過程中還需要滿足以下幾個(gè)要求：

1)可靠性:機(jī)器人結(jié)構(gòu)設(shè)計(jì)必須滿足可靠性要求，可靠的結(jié)構(gòu)是機(jī)器人發(fā)揮功能的基石；

2)穩(wěn)定性:機(jī)器人結(jié)構(gòu)設(shè)計(jì)必須滿足穩(wěn)定性要求，穩(wěn)定的結(jié)構(gòu)是機(jī)器人實(shí)現(xiàn)運(yùn)動(dòng)的前提；

3)方便性:機(jī)器人結(jié)構(gòu)設(shè)計(jì)必須滿足方便性要求，在組裝機(jī)器人時(shí)方便與否是判斷機(jī)器人結(jié)構(gòu)設(shè)計(jì)水平高低的判據(jù)之一；

4)維護(hù)性:機(jī)器人結(jié)構(gòu)設(shè)計(jì)必須滿足維護(hù)性要求，在使用機(jī)器人時(shí)維護(hù)性能的好壞也是判斷機(jī)器人結(jié)構(gòu)設(shè)計(jì)水平高低的判據(jù)之一；

5)經(jīng)濟(jì)性:機(jī)器人結(jié)構(gòu)設(shè)計(jì)必須滿足經(jīng)濟(jì)性要求，經(jīng)濟(jì)性不好的機(jī)器人是沒有市場(chǎng)前景的，因而經(jīng)濟(jì)性優(yōu)劣與否亦是判斷機(jī)器人結(jié)構(gòu)設(shè)計(jì)水平高低的判據(jù)之一。

1.2 機(jī)器人自由度分配

小型仿人機(jī)器人是根據(jù)人體形態(tài)來設(shè)計(jì)的，設(shè)有頭部、軀干和四肢，其運(yùn)動(dòng)依靠關(guān)節(jié)的多自由度協(xié)調(diào)控制來實(shí)現(xiàn)，能夠雙足行走、手足配合運(yùn)動(dòng)并可以執(zhí)行一定的任務(wù)，因此其自由度分配極為重要[3]。對(duì)于人體而言，頭部有頸關(guān)節(jié)，軀干有腰關(guān)節(jié)，四肢有肩關(guān)節(jié)、腕關(guān)節(jié)、手指、髖關(guān)節(jié)、膝關(guān)節(jié)、踝關(guān)節(jié)和腳趾等[4]。由于人體自由度數(shù)量眾多，運(yùn)動(dòng)機(jī)制十分復(fù)雜，所以無法完全將人體構(gòu)造模式移植到仿人機(jī)器人上。本設(shè)計(jì)采用關(guān)節(jié)簡(jiǎn)化的方法進(jìn)行機(jī)器人的自由度分配，即：頸部采用一個(gè)自由度，以實(shí)現(xiàn)機(jī)器人頭部的轉(zhuǎn)向；手部采用三個(gè)自由度，分別是肩關(guān)節(jié)處的一個(gè)自由度、肘關(guān)節(jié)處的一個(gè)自由度和腕關(guān)節(jié)處的一個(gè)自由度，這三個(gè)自由度可以幫助機(jī)器人手臂實(shí)現(xiàn)旋轉(zhuǎn)、彎曲和平伸等動(dòng)作；腿部采用六個(gè)自由度，分別是髖關(guān)節(jié)處的三個(gè)自由度、膝關(guān)節(jié)處的一個(gè)自由度、踝關(guān)節(jié)處的二個(gè)自由度，它們幫助機(jī)器人腿部實(shí)現(xiàn)基本的步態(tài)行走功能。表1展示了機(jī)器人自由度的分配情況。

表1 小型仿人機(jī)器人自由度分配

機(jī)器人各自由度之間的連接形式分為串行連接和并行連接。串行連接具有體積小、運(yùn)動(dòng)空間大的特點(diǎn)，用于頸關(guān)節(jié)、肘關(guān)節(jié)和膝關(guān)節(jié)處較為適宜；并行連接雖然空間體積大，但運(yùn)動(dòng)靈活、承載力較大，用于機(jī)器人肩關(guān)節(jié)、髖關(guān)節(jié)和踝關(guān)節(jié)處較為合理。妥善確定機(jī)器人的自由度分配及其連接形式以后，即可繪制出如圖1所示的自由度結(jié)構(gòu)分布示意圖。

圖1 自由度結(jié)構(gòu)分布示意圖

1.3 機(jī)器人驅(qū)動(dòng)器選擇

經(jīng)過選型分析，筆者采用韓國(guó)Robotics公司生產(chǎn)的數(shù)字舵機(jī)AX-12A作為小型仿人機(jī)器人的關(guān)節(jié)驅(qū)動(dòng)器。該舵機(jī)具有體積小、扭矩大、精度高等優(yōu)點(diǎn)，同時(shí)它是一款總線數(shù)字舵機(jī)。與其他舵機(jī)相比主要優(yōu)勢(shì)在于：舵機(jī)之間采用總線連接方式，布線簡(jiǎn)單方便，提高了系統(tǒng)的可靠性；該舵機(jī)還有自我保護(hù)機(jī)制，可以防止由于輸入電壓過高、控制指令錯(cuò)誤或輸出力矩過大等原因?qū)е露鏅C(jī)損壞；此外，該舵機(jī)可以進(jìn)行自動(dòng)校準(zhǔn)，具有反饋機(jī)制，能夠提高控制精度。

1.4 機(jī)器人實(shí)體結(jié)構(gòu)設(shè)計(jì)

小型仿人機(jī)器人的實(shí)體結(jié)構(gòu)設(shè)計(jì)包括手部結(jié)構(gòu)設(shè)計(jì)、軀干結(jié)構(gòu)設(shè)計(jì)以及腿部結(jié)構(gòu)設(shè)計(jì)。根據(jù)規(guī)劃，筆者將設(shè)計(jì)一款高度約為360 mm的仿人機(jī)器人，參考人體比例和其他典型仿人機(jī)器人的主體尺寸，可規(guī)劃?rùn)C(jī)器人各關(guān)節(jié)之間的尺寸如表2所示。

表2 機(jī)器人結(jié)構(gòu)尺寸一覽表

在機(jī)器人實(shí)體結(jié)構(gòu)設(shè)計(jì)中，三維建模軟件采用了Solidworks，二維工程圖紙繪制軟件則采用了CAXA，以下依次介紹各部分的結(jié)構(gòu)設(shè)計(jì)情況。

1.4.1 手部結(jié)構(gòu)設(shè)計(jì)

首先，根據(jù)機(jī)器人自由度分配情況構(gòu)造如圖2(a)所示的手部關(guān)節(jié)自由度模型；其次，根據(jù)選定舵機(jī)AX-12A的結(jié)構(gòu)和尺寸，設(shè)計(jì)各關(guān)節(jié)處驅(qū)動(dòng)舵機(jī)之間的連接件，如圖2(b)所示；最后，在Solidworks軟件中將設(shè)計(jì)好的各個(gè)零件和舵機(jī)進(jìn)行裝配，得到機(jī)器人手部結(jié)構(gòu)三維情況如圖2(c)所示。

圖2 手部結(jié)構(gòu)設(shè)計(jì)三維模型圖

手部基本結(jié)構(gòu)設(shè)計(jì)完成后，為方便后續(xù)研究中的運(yùn)動(dòng)學(xué)分析，可提取出手部結(jié)構(gòu)關(guān)鍵尺寸。如圖3所示，x為肩部關(guān)節(jié)和肘關(guān)節(jié)的軸心距離，y為肘關(guān)節(jié)和腕關(guān)節(jié)的軸心距離，根據(jù)優(yōu)化模型，可確定各個(gè)關(guān)節(jié)關(guān)鍵尺寸數(shù)據(jù)如表3所示。

圖3 手部結(jié)構(gòu)關(guān)鍵尺寸

關(guān)鍵尺寸類型標(biāo)號(hào)數(shù)值肩部關(guān)節(jié)和肘關(guān)節(jié)的軸心距離x25.5mm肘關(guān)節(jié)和腕關(guān)節(jié)的軸心距離y68mm

1.4.2 軀干結(jié)構(gòu)設(shè)計(jì)

首先，根據(jù)機(jī)器人自由度分配情況構(gòu)造如圖4(a)所示的軀干關(guān)節(jié)自由度模型；其次，根據(jù)選定舵機(jī)AX-12A的結(jié)構(gòu)和尺寸，設(shè)計(jì)各關(guān)節(jié)處驅(qū)動(dòng)舵機(jī)之間的連接件，如圖4(b)所示；最后，在Solidworks軟件中將設(shè)計(jì)好的各個(gè)零件和舵機(jī)進(jìn)行裝配，得到機(jī)器人軀干結(jié)構(gòu)三維情況如圖4(c)所示。

圖4 軀干結(jié)構(gòu)設(shè)計(jì)三維模型圖

軀干基本結(jié)構(gòu)設(shè)計(jì)完成后，為方便后續(xù)研究中的運(yùn)動(dòng)學(xué)分析，可提取出軀干結(jié)構(gòu)關(guān)鍵尺寸。如圖5所示，x為左右肩部關(guān)節(jié)的軸心距離，y為肩關(guān)節(jié)和髖關(guān)節(jié)的軸心距離，根據(jù)軀干優(yōu)化模型，可確定各個(gè)關(guān)節(jié)關(guān)鍵尺寸數(shù)據(jù)如表4所示。

圖5 軀干結(jié)構(gòu)關(guān)鍵尺寸

關(guān)鍵尺寸類型標(biāo)號(hào)數(shù)值左右肩部關(guān)節(jié)的軸心距離x107mm肩關(guān)節(jié)和髖關(guān)節(jié)的軸心距離y81mm

1.4.3 腿部結(jié)構(gòu)設(shè)計(jì)

首先，根據(jù)機(jī)器人自由度分配情況構(gòu)造如圖6(a)所示的腿部關(guān)節(jié)自由度模型；其次，根據(jù)選定舵機(jī)AX-12A的結(jié)構(gòu)和尺寸，設(shè)計(jì)各關(guān)節(jié)處驅(qū)動(dòng)舵機(jī)之間的連接件，如圖6(b)所示；最后，在Solidworks軟件中將設(shè)計(jì)好的各個(gè)零件和舵機(jī)進(jìn)行裝配，得到機(jī)器人腿部結(jié)構(gòu)三維情況如圖6(c)所示。

圖6 腿部結(jié)構(gòu)設(shè)計(jì)三維模型圖

腿部基本結(jié)構(gòu)設(shè)計(jì)完成后，為方便后續(xù)研究中的運(yùn)動(dòng)學(xué)分析，可提取出腿部結(jié)構(gòu)關(guān)鍵尺寸。如圖7所示，x為左右髖關(guān)節(jié)的軸心距離，y為髖關(guān)節(jié)末端和髖關(guān)節(jié)的軸心距離，z為膝關(guān)節(jié)和髖關(guān)節(jié)的軸心距離，p為膝關(guān)節(jié)和踝關(guān)節(jié)的軸心距離，q為踝關(guān)節(jié)和腳底的軸心距離，根據(jù)腿部?jī)?yōu)化模型，可確定各個(gè)關(guān)節(jié)關(guān)鍵尺寸數(shù)據(jù)如表5所示。

圖7 腳部結(jié)構(gòu)關(guān)鍵尺寸

關(guān)鍵尺寸類型標(biāo)號(hào)數(shù)值左右髖關(guān)節(jié)的軸心距離x74mm髖關(guān)節(jié)末端和髖關(guān)節(jié)的軸心距離y25mm膝關(guān)節(jié)和髖關(guān)節(jié)的軸心距離z82.04mm膝關(guān)節(jié)和踝關(guān)節(jié)的軸心距離p76.87mm踝關(guān)節(jié)和腳底的軸心距離q25mm

1.4.4 整體結(jié)構(gòu)設(shè)計(jì)

將上述的手部結(jié)構(gòu)、軀干結(jié)構(gòu)以及腿部結(jié)構(gòu)組裝起來得到機(jī)器人整體，其自由度模型如圖8(a)所示，整體模型如圖8(b)所示，搭建完成的實(shí)體機(jī)器人則如圖8(c)所示。

圖8 仿人機(jī)器人整體結(jié)構(gòu)設(shè)計(jì)模型圖

2 小型仿人機(jī)器人的控制系統(tǒng)構(gòu)建

2.1 基于STM32單片機(jī)控制器的分析與設(shè)計(jì)

在小型仿人機(jī)器人的控制系統(tǒng)中，下位機(jī)控制是重中之重，而下位機(jī)控制器是其前沿的硬件設(shè)備，一個(gè)性能穩(wěn)定、功能齊全、開發(fā)上限高的控制器，對(duì)于整個(gè)機(jī)器人系統(tǒng)極為重要。

2.2 ROBOTIS控制器分析

ROBOTIS PREMIUM(百變金剛機(jī)器人)使用的CM-5控制器也是Dynamixel AX-12A舵機(jī)的專用控制器[5-6]，可控制30個(gè)AX-12舵機(jī)。它的6個(gè)按鈕中有5個(gè)用于選擇功能，1個(gè)用于重啟。CM-530和CM-510差不多，本文使用CM-510控制器，將其拆開，可見內(nèi)部PCB分為正反兩面，本文定義開關(guān)所在的為PCB的正面。PCB正面主要為可操控模塊：1個(gè)電源插孔、一個(gè)開關(guān)、6個(gè)微動(dòng)開關(guān)、5組Dynamixel AX-12A舵機(jī)插孔、4組排針、1個(gè)上位機(jī)連接口、一個(gè)連接電池組接口、1個(gè)蜂鳴器、7個(gè)貼片LED、3個(gè)保護(hù)電容、1個(gè)電機(jī)驅(qū)動(dòng)芯片。CM-510控制器PCB正面如圖9所示。

圖9 PCB正面視圖 圖10 PCB反面視圖

PCB反面是PCB的核心部分，CM-510控制器使用的是Atmel ATMEGA2561芯片，此外還有兩個(gè)芯片，一個(gè)是MAX202C，另一個(gè)是74HC126D(四象三態(tài)緩沖器)。MAX202C板上IC之間的連接可通過5V/3.3 V電平表示狀態(tài)1、通過0V電平表示狀態(tài)0, RS232接口是通過正負(fù)12 V分別表示1或0的狀態(tài)，該芯片起電平轉(zhuǎn)換作用，與之相連的一個(gè)接口是ROBOTIS公司的專用串口數(shù)據(jù)線接口；74HC126D芯片上的三態(tài)輸出由使能輸出端來控制，使能端有效與無效分別控制輸出處于正常邏輯狀態(tài)和高阻狀態(tài)，起著保護(hù)USART_TX的作用，電感則起防止電流突變的作用[7]?？焖偃蹟啾ｋU(xiǎn)絲配合保險(xiǎn)絲座，能夠有效保護(hù)控制器，防止MCU燒毀。此外，還有WTE SS14芯片來防止舵機(jī)接口正負(fù)極反接，目的是保護(hù)控制器不被損壞。CM-510控制器PCB反面如圖10所示。

2.3 控制器方案選擇

筆者在構(gòu)建小型仿人機(jī)器人的控制系統(tǒng)時(shí)，放棄使用Atmel公司的8位微控制器芯片，而選用ST公司的STM32F1系列32位微控制器芯片[8]，目的是增強(qiáng)機(jī)器人控制器的處理能力，提升機(jī)器人系統(tǒng)的開發(fā)上限。設(shè)計(jì)中選用STM32F1系列中的兩種芯片作為控制器MCU，一種是STM32F103ZET6，另一種是STM32F103C8T6。兩種芯片的區(qū)別在于封裝，由于STM32F103C8T6的管腳數(shù)少，僅用于第一版測(cè)試階段PCB，因此本設(shè)計(jì)僅討論STM32F103ZET6(后文簡(jiǎn)稱STM32)。

STM32芯片與Atmel芯片相比，優(yōu)勢(shì)在于其內(nèi)核使用的是ARM32位的CortexTM-M3 CPU，工作頻率最高為72 MHz，當(dāng)存儲(chǔ)器處于零等待周期訪問時(shí)，訪問速度可達(dá)1.25DMips/MHz[9]，具有512 K字節(jié)的閃存存儲(chǔ)器，并且擁有144個(gè)管腳，其中112個(gè)多功能雙向I/O端口都可以映像到16個(gè)外部中斷，并幾乎都支持5 V信號(hào)，以及13個(gè)通信接口(如USART、I2C、SPI等)，這些使機(jī)器人具有很高的開發(fā)上限。

2.4 基于STM32的控制器設(shè)計(jì)

STM32外圍電路主要包括時(shí)鐘、復(fù)位、啟動(dòng)和各個(gè)電源和參考引腳去耦電容的配置。STM32使用8 MHz晶振，過內(nèi)部分頻器、倍頻器處理后獲得72 MHz內(nèi)部時(shí)鐘。STM32的復(fù)位電路需要用0.1 μf電容接地以實(shí)現(xiàn)上電復(fù)位功能，外圍電容設(shè)計(jì)時(shí)則要求在每對(duì)Vdd和Vss之間就近配置0.1 μf。晶振兩端需要按照設(shè)計(jì)規(guī)范要求配置22 μf電容[10]。為了方便調(diào)試，筆者還特地加上了JTAG/SWD調(diào)試接口。本文所設(shè)計(jì)的小型仿人機(jī)器人控制系統(tǒng)相關(guān)的硬件和軟件均在閃存儲(chǔ)存器中運(yùn)行，因此啟動(dòng)配置需將BOOT0接地，具體形式如圖11所示。

引腳BOOT1BOOT0啟動(dòng)位置啟動(dòng)模式X0主閃存被映射到啟動(dòng)地址主FLASH01系統(tǒng)存儲(chǔ)器被映射到啟動(dòng)地址系統(tǒng)儲(chǔ)存器11內(nèi)部 SRAM 被映射到啟動(dòng)地址內(nèi)部SRAM

圖11 芯片啟動(dòng)配置情況圖

將SD卡進(jìn)行拓展，以便用來儲(chǔ)存圖片、音樂、動(dòng)作組等。除了MCU外圍電路，還有與上位機(jī)通信使用的串口通信電路，因?yàn)橄挛粰C(jī)的邏輯電平為5 V/3.3 V，與PC端電平不匹配，因此需要進(jìn)行電平匹配。以往主流的設(shè)計(jì)方式是使用MAX3232芯片作為核心，將邏輯電平轉(zhuǎn)換為±10 V，再配以9針串口與PC端相連。然而現(xiàn)在一般的電腦，尤其是筆記本電腦早已取消了9針串口，因此本文選擇使用CH340芯片設(shè)計(jì)串口轉(zhuǎn)USB電路。

無線傳輸模塊NRF2401通過SPI接口和MCU相連，其對(duì)應(yīng)接口PCB設(shè)計(jì)如圖12所示。

圖12 無線模塊電路圖

至此，小型仿人機(jī)器人控制系統(tǒng)及其主體電路的設(shè)計(jì)與構(gòu)建工作即告完成。

3 實(shí)驗(yàn)結(jié)果與分析

系統(tǒng)主界面是用戶打開軟件的初始界面，便于用戶選擇功能模式。本文設(shè)計(jì)的機(jī)器人軟件系統(tǒng)包括三個(gè)功能模式：機(jī)器人的虛擬組裝、三維可視化編程控制以及機(jī)器人在智能家居里面的運(yùn)用(在此只介紹機(jī)器人的虛擬組裝)。除了三個(gè)模式切換按鈕控件，還有一個(gè)界面預(yù)覽模型切換功能，即切換主頁(yè)面中機(jī)器人2D模型圖與3D模型圖。主界面的效果如圖13所示。

圖13 主界面模型預(yù)覽

3.1 機(jī)器人三維模型組裝模塊功能的實(shí)現(xiàn)

從主界面通過觸發(fā)“組裝”按鈕進(jìn)入虛擬三維模型組裝模塊場(chǎng)景，首先用戶點(diǎn)擊界面上相應(yīng)零件模型圖片，場(chǎng)景則加載相應(yīng)模型；再點(diǎn)擊選中要組裝的模型，進(jìn)行拖拽；拖拽到相應(yīng)模型位置，發(fā)生碰撞檢測(cè)；若碰撞檢測(cè)到是正確位置，那么零件模型自動(dòng)精確定位到相應(yīng)位置，完成零件的安放。

3.2 機(jī)器人三維模型組裝用戶界面實(shí)現(xiàn)效果展示

圖14是進(jìn)入三維模型組裝場(chǎng)景的初始界面圖：

圖14 三維模型組裝初始用戶界面

設(shè)計(jì)將界面分為兩部分：UI圖標(biāo)交互部分和三維模型組裝場(chǎng)景部分。用白條隔開的左側(cè)是模型圖標(biāo)界面和模型編輯工具欄，由于模型圖標(biāo)較多，而界面大小有限，將模型圖標(biāo)分為三個(gè)Widget中，分別存放機(jī)器人手部零件模型圖標(biāo)、身體零件模型圖標(biāo)和腿部模型圖標(biāo)，并通過右下側(cè)的粉色回轉(zhuǎn)按鈕切換這些Widget，便于獲取相應(yīng)模型；界面中左側(cè)上部是模型編輯工具欄，有個(gè)垃圾桶圖標(biāo)按鈕，用于清空?qǐng)鼍爸械牧慵Ｐ?。界面右?cè)為三維模型組裝場(chǎng)景部分，透明機(jī)器人是便于用戶組裝的參照和定位的背景機(jī)器人模型；右側(cè)的右下角有個(gè)白色小屋圖標(biāo)按鈕用于退出該場(chǎng)景，返回到主界面中。整個(gè)機(jī)器人虛擬現(xiàn)實(shí)組裝的效果非常良好，完全實(shí)現(xiàn)了預(yù)期的目標(biāo)。

4 結(jié)語(yǔ)

隨著我國(guó)機(jī)器人技術(shù)的不斷發(fā)展和機(jī)器人教育的不斷推進(jìn)，加強(qiáng)培養(yǎng)掌握機(jī)器人技術(shù)、熟悉機(jī)器人應(yīng)用的創(chuàng)新性人才變得日益重要。教育機(jī)器人作為機(jī)器人教育的主要教學(xué)載體，完善其教育功能，改進(jìn)其教學(xué)體系，對(duì)機(jī)器人教育的推廣具有重大意義，也對(duì)青少年創(chuàng)新型人才的培養(yǎng)具有重大意義。本文研發(fā)了一款適用于機(jī)器人教育教學(xué)的多功能、多用途、普適性的19自由度的小型仿人機(jī)器人，主要完成了該機(jī)器人的機(jī)械結(jié)構(gòu)設(shè)計(jì)與控制系統(tǒng)構(gòu)建工作。所設(shè)計(jì)的機(jī)器人機(jī)械結(jié)構(gòu)可靠性高、工藝性好、結(jié)構(gòu)緊湊、樣式新穎；所構(gòu)建的機(jī)器人控制系統(tǒng)魯棒性高、穩(wěn)定性好、控制準(zhǔn)確、反應(yīng)迅速，圓滿地實(shí)現(xiàn)了預(yù)期的設(shè)計(jì)任務(wù)。有望通過后續(xù)軟件系統(tǒng)的開發(fā)提高其運(yùn)動(dòng)效能，真正在青少年機(jī)器人教育中發(fā)揮重要作用。