模仿人的形態和行為而設計制造的機器人就是仿人機器人，一般分別或同時具有仿人的四肢和頭部。中國科技大學陳小平教授介紹，機器人一般根據不同應用需求被設計成不同形狀，如運用于工業的機械臂、輪椅機器人、步行機器人等。而仿人機器人研究集機械，電子，計算機，材料，傳感器，控制技術等多門科學于一體，代表著一個國家的高科技發展水平。從機器人技術和人工智能的研究現狀來看，要完全實現高智能，高靈活性的仿人機器人還有很長的路要走，而且，人類對自身也沒有徹底地了解，這些都限制了仿人機器人的發展。

　　一、基于ARM9的嵌入式仿人機器人傳感器系統設計

　　傳感器技術是仿人機器人研究的關鍵技術之一。仿人機器人之所以能在已知或未知的環境中完成一定的作業功能，是因為它能夠通過傳感器感知外部環境信息和自身狀態，獲得反饋信息，實現系統的閉環控制。目前在仿人機器人中應用的傳感器種類繁多，例如視覺傳感器、電子羅盤、加速度計和超聲波傳感器等都是仿人機器人中常用的傳感器。

　　DF-1機器人是我院自主研制的一款仿人機器人。本文首先對DF-1機器人總系統進行了介紹，然后根據DF-1機器人需要實現的功能，設計DF-1機器人的傳感器系統，然后實現傳感器系統的具體工作電路，利用ARM9實現了傳感器系統信息的采集，最后對傳感器系統的效果進行了試驗驗證。

　　1.DF-1仿人機器人簡介

　　DF-1機器人模仿人體外形結構，利用舵機結構實現人類關節的功能，如圖1所示。DF-1身長45cm，共設有17個自由度，具體分配為：踝關節2×2=4個自由度，膝關節2×1=2個自由度，胯關節2×2=4個自由度，肩關節2×2=4個自由度，肘關節2×1=2個自由度，頭部1個自由度。DF-1機器人內部采用ARM9微處理器，主要用來完成信息的融合、決策和規劃等任務。DF-1機器人已經能夠實現的功能有步行、做俯臥撐、上樓梯、打太極拳，這些功能的實現是建立在：DF-1機器人具有良好機械結構基礎上的，通過人工調試，設定具體程序完成的。為提高機器人動作的穩定性，實現DF-1機器人的智能控制，需要對機器人配置傳感器系統，使機器人能夠感知自身狀態和外界環境。

　　2 傳感器系統設計

　　DF-1機器人的胸腔部位安裝了三個超聲傳感器，分別用來測量機器人正前、左前和右前方向的障礙物。在該傳感器系統中，采用了ARM9微處理器作為信息的采集、數據預處理和通信單元。由于超聲波傳感器存在多次反射問題，在超聲波相對應的位置安裝了三個紅外測距傳感器用來解決這一問題。傳感器系統獲取的信息采用定長字節格式通過RS232接口傳送給上位機。傳感器系統的基本結構如圖1所示。

　　2．1加速度計傳感器

　　判定機器人姿態的傳感器有陀螺儀和加速度計等傳感器，由于陀螺成本較高，而DF-1機器人在運動變化上較為緩慢，故本文采用了成本較低的加速度計來感知機器人的姿態。加速度計是物體運動測試中的重要元件，它的輸出與物體的加速度成比例。傳感器系統所采用加速度計的具體型號為AD公司生產的雙軸加速度計ADXL202。ADXL202具有兩種輸出，一種是從XFILT和YFILT引腳輸出模擬信號；另一種是直接從XOUT和YOUT引腳輸出經調制后的DCM信號。在具體使用中，選用了加速度計的DCM信號輸出，這樣就可省去使用模擬信號需要引入的A／D轉換環節，簡化了電路設計難度。

　　2．2超聲傳感器

　　用來測距的傳感器主要有紅外傳感器、超聲波傳感器、激光測距儀等，為了能在測量距離的同時判斷出物體的大致形狀，應設計成多傳感器測距系統。考慮到機器人的安裝空間以及成本問題，主要選用了超聲波傳感器進行距離的測量。

　　超聲波傳感器主要用來完成機器人到周圍障礙距離信息的測量，超聲波在測距過程中存在多次反射問題，即超聲波遇到障礙物體時，沒有沿著原路返回發射接收點，而是經過多次反射后才返回發射接收點，這樣測量到的距離信息不再真實，情況嚴重時會“丟失”目標。本文選用DEVANTECH公司生產的SFR05。SFR05的體積小，信號穩定，便于在機器人中安裝，而且SFR05的測量距離為1cm～4m，在最小測量距離上可認為該傳感器不存在盲區。

　　2．3 紅外傳感器

　　為了彌補超聲傳感器在測距中多次反射的問題，在超聲波相對應的位置安裝了三個紅外測距傳感器。當超聲波傳感器測量的距離遠遠大于同方向上紅外傳感器測量的距離時，可以據此推斷出超聲波已經進行了多次反射，并用紅外傳感器測量的距離信息來取代超聲波傳感器的信息。本文使用的紅外傳感器為SHARP公司生產的GP2D12，可測距離為10～80cm。GP2D12加上電源就可工作，輸出電壓為0．3～2.8V。GP2D12傳感器在測量距離時受外界光強度、物體外表反射率及物體顏色的影響較小。

　　3.軟件實現

　　傳感器系統數據采集與處理單元采用ARM9微處理器，主要完成以下功能：實現對加速度計的控制和加速度的測量，并根據加速度值，計算機器人的傾角；實現對超聲波傳感器的控制，完成距離信息的計算；實現對紅外傳感器的控制，完成距離信息的獲取；對獲得的傾角、超聲波測距和紅外測距數據，按照規定的通信協議發送給上位機，程序主流程如圖3所示。

　　程序首先要初始化，主要包括系統時鐘的選擇、管腳的分配、中斷優先級、定時器時鐘和工作方式的選定等。在ARM9內部資源中，具有PCA定時器單元和A／D單元，這些方便了對本傳感器系統的數據采集。防止超聲波傳感器之間發生串擾，對超聲波傳感器采用輪流測量的方式。由于超聲波傳感器的工作周期為50ms，當工作時間少于50ms時，超聲波傳感器會誤認為下次測量發送超聲波產生的干擾為本次的回波，造成距離測量上的失真，而紅外傳感器建立電壓的時間只需要5ms，所以在編程上，利用定時器0產生50ms延遲，依次對3對超聲波傳感器和紅外傳感器進行數據采集。由于加速度傳感器和紅外、超聲傳感器之間是獨立的，而且數量只有一個，它的采集過程只依賴于PCA捕捉模塊捕捉到的時刻，所以加速度計信息的采集和預處理工作可貫穿于150ms以內。在完成對傳感器系統的信息采集和預處理后，還要將獲取的數據發送給上位機，為上位機的決策提供必要的數據。

　　4.實驗驗證

　　4．1加表實驗

　　由于當機器人傾斜的時候，重力加速度會在加速度兩軸上產生分量，這時加速度值為Ax=gsinα和Ay=gsinβ。在加速度計水平放置的時候，Ax=gsinα，由于條件的限制，很難使加速度計達到絕對水平。在α=0附近，sinα變化幅度大，這樣會影響標定效果，而在a=π／2附近，sinα變化幅度較小。為了得到較好的加速度計標定效果，采用了豎直標定的方法，即將PCB電路板用細線懸掛起來，分別得到g和-g時的值，通過計算就可得到加速度在0g時的值。由于ADXL202的輸出含有高斯白噪聲，應用直接采來的數據會有較大的誤差，因而需要對采集來的數據進行處理后再加以應用。

　　通過平均值濾波可降低噪聲的影響，假設Xi為直接采集來的數據，Yi為平均值濾波后的數據，Yi=(∑xi)／n，由概率論知識可知，EYi=EXi，DYi=DXi／n。從中可看出平均值濾波的效果與平均點數n有關，n越大，濾波效果越好。考慮到機器人的運動情況，可取n=15，即噪聲的方差變為原來的1／15。圖4是DF-1機器人在運動過程中獲取的傾斜角度值。其中L1表示了機器人的俯仰角度，L2表示了機器人的橫滾角度。

　　由于DF-1仿人機器人體型較小，運動較為緩慢，在障礙距離測量上，能夠對付2m以內的障礙就可滿足應用要求。在2m以內不同距離上放置平面障礙，利用超聲波和紅外傳感器測量這些距離信息，測得的距離與實際距離如表1所示。

　　從表中可以看出，超聲波測量距離的誤差在2％以內，紅外傳感器測量距離的誤差在4％以內，可以滿足DF-1仿人機器人的應用要求。

　　本文針對DF-1機器人要實現的功能，基于ARM9微處理器設計了傳感器系統。試驗結果證明，本傳感器系統基本可以滿足機器人的功能需求，具有一定的應用價值。具備傳感器系統的DF-1機器人對外界環境和自身狀態有了一定的感知能力，為上位機進行動作決策提供可靠的依據，提高了機器人的智能性。

　　二、 基于CAN總線的仿人機器人力信息檢測系統

　　隨著信息檢測技術和控制技術的發展，仿人機器人運動控制已經從傳統的離線規劃方法研究轉向基于環境信息的實時控制研究，仿人機器人的實時姿態調整與實時步態生成方法也成為運動控制的研究重點。對于步行機器人而言，其腳掌所受到的地面反力信息是最重要的外部環境信息之一，它尤其能夠反映仿人機器人的姿態信息，在仿人機器人的實時姿態調整中具有重要作用。早在1989年，日本早稻田大學就在他們研制的兩足步行機器人WL-12RⅢ中應用了六維力/力矩傳感器，該傳感器安裝在機器人的小腿上，機器人可根據反饋力信息在不平整地面上進行穩定行走；日本HONDA公司的仿人機器人P2，P3以及ASIMO均安裝了集成六維力/力矩傳感器，利用傳感器信息檢測地面反力信息。

　　在國家863計劃支持下，國防科技大學機器人實驗室于2003年研制出一臺新型仿人機器人；同時與合肥智能機械研究所合作，在該機器人腳掌上安裝了可檢測地面反力信息的集成五維力/力矩傳感器。本文通過對仿人機器人運動控制系統結構和傳感器電路結構的分析，提出了一種基于CAN總線的力信息檢測系統；通過實驗表明，該力信息檢測系統能夠滿足力信息采集的基本要求，為其他外部環境信息的采集建立了一定基礎。

　　仿人機器人控制結構分析與外部傳感信息采集結構

　　將仿人機器人控制系統的大開環變成大閉環對控制系統的上位計算機處理能力、上下位機與傳感器信息之間的傳輸通道結構以及傳感器信息采集與處理提出了挑戰。它要求上位計算機具備實時多任務處理能力，控制系統具有便于擴展的多傳感器信息采集與處理通道。增加外部信息傳感器是控制結構改進的最基本條件。

　　增加外部信息傳感器，首先要在現有控制系統硬件結構的基礎上，擴展外部信息采集與處理模塊，形成開放的分層信息采集與處理結構。結構的底層節點由多個傳感器信息采集和預處理模塊(包括解耦和濾波等)構成，得到的處理信息通過合適的物理通道傳送到決策層計算機，形成一個從環境信息到機器人動作序列產生的過程。

　　選擇實時性強且易于擴展的物理通道，可以增強控制系統的外部傳感擴展能力。在仿人機器人運動控制系統中，上下位機之間通過PC/104總線和RS232串行總線交換信息。當系統需要擴展外部傳感器時，由于PC/104總線的有限驅動能力，通過PC/104總線只能擴展相當有限的外部信息傳感器且擴展不便(涉及到地址的重新分配等問題)；RS232串行總線不能滿足高速實時信息傳輸與處理要求，因此考慮采用現場總線方式，如CAN總線，作為外部信息傳輸通道，同時設計其與上位機的通信接口。理想信息采集結構如圖1所示。

　　圖1所示的信息采集結構，具有較強的易擴展性和較高容錯性能。每一個外部信息傳感器都可以獨立設計；在整個信息采集結構中，每個模塊都是對等的，之間可以點對點通信；上位機可對各個傳感器信息處理模塊的廣播，信息處理模塊的增減不會對整個信息傳輸通道產生影響，有利于傳感器及其處理模塊的擴展和維護。另外，從底層通信協議角度而言，這種采集結構亦具有較高容錯性能。

　　力矩傳感器的電路結構及工作原理

　　五維力/力矩傳感器的電路結構如圖2所示。傳感器基本采集處理原理：當傳感器受到外力或外力矩作用時，彈性體產生形變，導致全橋橋路中的應變片阻值發生改變，改變橋路輸出電壓；橋路輸出電壓通過前置濾波與放大進入SoC，通過A/D變換得到的數字信號通過CAN總線或

　　RS232傳輸到上位機。

　　力/力矩傳感器與控制系統的電路接口設計方法

　　接口電路的基本功能

　　仿人機器人底層控制器與上位機接口采用PC/104總線方式，力/力矩傳感器信息傳輸采用CAN總線結構，因此需設計CAN總線與PC/104總線之間的接口，實現已有控制系統與傳感器之間的通信及對力/力矩信息的預處理，如圖3所示。

　　接口電路的硬件結構與基本設計原理

　　綜合考慮接口電路對主處理器的要求，如對力/力矩信息的實時處理能力、外設擴展能力等，選用TMS320LF2407作為主處理器，通過對CAN總線和雙端口RAM的讀寫控制，實現力信息的讀取、預處理和上傳。接口電路基本原理如圖4所示。

　　選用TMS320LF2407作為主處理器。它采用實時信號處理體系結構，可達到30×106條指令/s的執行速度，供電電壓為3.3V，功耗低，片內外設中集成有控制器局域網絡(CAN)2.0B模塊和SCI模塊。

　　傳輸數據主要包括兩個力/力矩傳感器的五維力信息和經過預處理得到的數據，因此雙端口RAM選用IDT7132(2K×8bit)。一個端口接PC/104總線的數據線、低位地址線、高位地址譯碼產生的選通信號以及讀寫信號，譯碼通過MAX7032，根據上位機的空閑地址分配RAM地址；另一個端口接經過電平轉換的DSP數據線低位地址線、高位地址譯碼產生的選通信號以及讀寫信號，通過SN74LV08A譯碼，分配的地址為F800～FFFF，通過SN74LV245A完成總線驅動和電平轉換。

　　選取PCA82C250T作為驅動CAN控制器和物理總線間的接口，提供對總線的差動發送和接收功能。同時利用DSP的SCI模塊擴展了一路RS232串口，選用3.3V供電的RS232驅動器MAX3320作為串口驅動器，與PC機進行通信。

　　接口電路的軟件流程

　　接口電路驅動程序中，首先對DSP進行初始化設置，包括定時器初始化和CAN模塊初始化以及在IDT7132中設置平滑數據隊列等；然后向發送郵箱中寫入0或1，即對傳感器清零或者請求發送數據；接收到數據之后，將數據從接收郵箱中讀入平滑數據隊列中，進行平滑數據處理，供上位機查詢和讀取。

　　在DSP的初始化設置中，首先通過設置MCR寄存器來配置CAN引腳；初始化位定時器主要是設置寄存器BCR1和BCR2，決定CAN控制器的通信波特率、同步跳轉寬度、采樣次數和重同步方式。對郵箱的初始化主要是設置郵箱的標識符；對發送的數據區賦初值，需要清零傳感器返回值時，數據區賦值0，需要讀取數據時，數據區賦值1。發送信息首先要使能發送郵箱，然后設置發送請求位，等待發送中斷標志位置位，若為1，則發送成功，最后清除發送中斷標志位和發送應答位。接受信息時，要對接收郵箱進行初始化，設置標識符以及與標識符相關的局部屏蔽寄存器(LAM)；然后等待接收中斷標志位MIFn置位，若MIFn=1則接收成功，最后清除接收中斷標志位和接收信息懸掛位。接收數據后，根據傳感器解耦矩陣完成數據解耦及平滑濾波。

　　根據文中提出的設計方法，已設計相應的電路，實現了對力信息的實時采集和傳送。所設計的系統能夠完成力信息采集和平滑預處理工作，但還沒有加入對力信息的數字濾波設計。通過對所采集的力信息數據的特性分析，下一步將在軟件流程中增加數字濾波部分，使獲取的力信息能夠更加真實地反映機器人所受到的地面反力信息，使力信息能夠應用于仿人機器人的大回路控制。

　　三、基于CAN總線和雙傳感器仿人機器人運動控制系統研究

　　機器人研究是自動化領域最復雜。最具挑戰性的課題，它集機械。電子。計算機。材料。傳感器。控制技術等多門學科于一體，是多學科高技術成果的集中體現。而仿人步行機器人技術的研究更是處于機器人課題研究的前沿，它在一定程度上代表了一個國家的高科技發展水平。運動控制系統是機器人控制技術的核心，也是機器人研究領域的關鍵技術之一，在機器人控制中具有舉足輕重的地位，因此，各研究機構都把對機器人運動控制系統的研究作為首要任務。

　　動作協調。具有一定智能。能實現無線實時行走已經成為當今機器人發展的主題。隨著以電子計算機和數字電子技術為代表的現代高技術的不斷發展，特別是以DSP為代表的高速數字信號處理器和大規模可編程邏輯器件(以CPLD和FPGA為代表)的廣泛應用，機器人運動控制系統也從以前單一的結構和簡單的功能向著結構化。標準化。模塊化和高度集成化的方向發展，采用開放式體系結構已經成為該技術發展的一種必然趨勢。本文作者正是順應這一趨勢，設計出一種多功能分布式仿人機器人運動控制系統。

　  控制對象與要求

　　我們以國防科技大學機電工程與自動化學院機器人教研室最新研制的新一代仿人步行機器人為研究對象(其外形如圖1所示)。該機器人高約1.55m,重約65kg,使用電池供電，無需外接電源和控制信號線，可以實現無纜行走，還可以完成人的腿部。手部和頭部的一些基本動作，已經初步具備了人類的外形特征。這臺新型仿人機器人一共具有36個自由度(如圖2所示),其中上肢12個，下肢12個，頭部2個，手部10個；下肢各個關節有位置傳感器，足部有多維力/力矩傳感器；具有視覺傳感。語音控制系統以及無線遙控模塊；整個控制系統。電源集成在機器人本體上。為了使之真正具有“仿人”的特點，控制系統必須能夠完成包括運動控制與規劃。視覺感知處理。語音識別和其它環境感知在內的多種功能。其中，運動控制是整個控制系統的關鍵，它必須能夠滿足以下要求：

   (1)系統集成度高。體積孝重量輕。功率大。效率高和機載化。

　　(2)各個模塊之間的連接簡潔，便于安裝和維護。

　　(3)控制器應具有良好的動態響應和跟隨特性，穩態誤差和靜態誤差校

　　(4)系統集成在機器人本體上，電磁干擾較強，必須具有較強的抗干擾能力。

　　(5)各部分的數據交換必須實時有效和準確可靠。

　　動控制系統設計

　　一種基于CAN現場總線的新型控制結構。整個控制系統采用集中管理分散控制的方式，按照控制系統的結構和功能劃分為三層：組織層。協調層。執行層。其中，組織層由機器人本體外的一臺工作站組成，主要負責實現人機交互。無線通訊。語音。視覺以及宏指令生成等功能，屬于智能控制范疇，本文不做深入探討；協調層和執行層都集成在機器人本體上，完成具體的控制任務，屬于物理控制范疇，是我們通常意義上的控制系統，其具體結構如圖3所示。1.主控計算機模塊主控計算機要求體積孝運算速度快，通常采用小板工業控制計算機，同時配備液晶顯示器和自制專用功能鍵盤，主要完成在線運動規劃。動作級運動控制。語音交互控制。視覺導引控制以及人機交互等功能。它接受本地傳感器的信息，根據一定的控制算法和任務要求，實時生成關節軸系的任務規劃數據并通過數據傳輸總線送至各底層運動控制器。

　　通信模塊

　　主控計算機和各控制器之間采用CAN總線進行通信。CAN(ControllerAreaNetwork)總線是應用最為廣泛的一種現場總線，也是目前為止唯一有國際標準的現場總線。相對于一般通信總線，它的數據通信具有突出的可靠性。實時性和靈活性。其特點主要有：

　　(1)CAN總線為多主方式，網絡上任一節點均可在任意時刻向其它節點發送數據。

　　(2)CAN總線上的節點可以通過標識符分成不同的優先級，滿足不同的實時要求。

　　(3)CAN總線采用非破壞的總線仲裁技術，低優先級節點不影響高優先級節點的發送。

　　(4)CAN總線節點在40m內通信速率最高可達1MBPS。

　　(5)CAN總線上的節點數在標準幀格式下可達到110個，擴展幀格式下幾乎不受限制。

　　(6)報文采用短幀格式，傳輸時間短，出錯率極低。

　　(7)CAN總線通信介質可選用雙絞線，其結構靈活，連接方便。

　　CAN總線的以上特點使之十分適用于機器人控制，鑒于此，本文選用CAN總線作為機器人控制系統的通信工具。具體連接方式為：主控計算機通過CAN總線接口卡連接到總線上，各運動控制器也都通過總線收發器掛接到總線上，而且可以根據實際情況增減數目。由于CAN總線只用兩根線進行通信，大大降低了系統連線的復雜程度，同時增強了系統的可靠性能。

　　執行層模塊

　　執行層處于整個控制系統的最底層，由不同類型的控制器組成，主要用來控制各運動關節軸系的具體執行過程。由于各運動關節電機的型號不同。承載的重量不同，對控制精度的要求也不同，我們分別為之設計了不同的運動控制器。

　　①開環DSP運動控制器

　　頭部和上肢負載重量較輕，因此采用開環DSP運動控制器來對頭部和上肢各關節進行控制。這些控制器不需要采樣和反饋，直接接收主控計算機發來的控制命令，然后生成相應的執行命令發給各關節軸系，使之轉到相應角度。

　　②開環MCU運動控制器

　　手部各個關節體積和質量都很小，故采用開環MCU運動控制器來進行控制。這些控制器采用MCS-51單片機作為處理器，可以直接嵌入到手掌內，它們接收主控計算機的控制命令，利用其IO引腳產生需要的多路脈沖控制信號，控制手部各關節的運動。

　　③閉環DSP運動控制器

　　腿部所有軸系均由直流減速驅動型電機構成，帶零位檢測。碼盤和電位計反饋以及多維力/力矩傳感器，結構復雜。控制難度大。精度要求也高，故采用閉環DSP運動控制器。這部分是整個控制系統的關鍵，也是我們研究的重點。

　　(4)控制系統流程

　　整個控制系統的具體流程為：系統開始運行并完成初始化工作；主控計算機根據規劃和計算向底層控制器發送控制命令，底層控制器接收到命令后，結合各傳感器反饋的信息，通過一定的控制算法生成相應的執行命令并發送給各關節執行軸系，同時把底層軸系的運行情況上傳給主控計算機，主控計算機根據新的情況再產生新的命令發送給各控制器，如此反復。這事實上是兩個閉環反饋過程，底層控制器通過傳感器與各關節軸系之間進行小循環反饋，主控計算機通過各控制器與各關節軸系之間進行大回路反饋，這樣可以使機器人具有更多的“智能”，更好的進行離線實時控制。

　　主控計算機每秒鐘向底層控制器發送200組數據，底層控制器向主控計算機反饋同樣數目的數據，而CAN總線的最大通信速率可以達到幾千幀/秒，完全可以滿足控制的要求。

　　控制器詳細設計

　　控制下肢的閉環DSP控制器是整個控制系統的核心部分，承擔著整個機器人的負載重量，輸出功率大，對控制的精度要求也高，因此它的性能直接關系到機器人運動的實現。我們專門為之設計了基于雙位置傳感器的閉環DSP控制器，其結構如圖4所示。

　　DSP主處理器選用的是TI公司的TMS320LF2407A芯片，它是TI家族C2000系列中的高檔產品，非常適用于工業控制。它的兩個事件管理器功能尤為強大，完全是為電機控制設計的，可利用多個PWM脈沖通道直接產生需要的PWM脈沖控制信號；其CAN總線模塊可以直接與主控計算機進行通信而不需要增加CAN總線控制器；外部看門狗可以對控制器電壓進行監控；外部存儲器中存放著控制算法所需的必要參數。

　　控制器的雙位置傳感器由電壓輸出傳感器和光電碼盤傳感器組成。其中，電壓傳感器把軸系的位置信息轉換成電壓信號，經過放大電路放大，再經過專門的A/D轉換器轉換成數字信號送入DSP主處理器。不用TMS320LF2407A自帶的A/D轉換器而使用專門的A/D轉換芯片，這是為了提高轉換的精度，因為TMS320LF2407A的A/D轉換器所能接受的最高轉換電壓只有3.3V,而經過功率放大后的電壓遠遠超出了此范圍，所以使用了專門的A/D轉換芯片。這部分電路雖然增加了控制器的復雜程度，卻可以大大提高轉換精度，所以是十分值得的。碼盤傳感器把軸系的位置信息轉換成脈沖信號，經過光電隔離器件隔離后送入專用脈沖計數器，計數后的信息送入DSP主處理器。脈沖計數器選用當今流行的CPLD器件，其強大的功能對提高控制器的性能有很大的幫助，同時還可以作為譯碼電路為主處理器提供譯碼功能。

　　主處理器通過對接收到的傳感器信號進行分析和計算之后產生相應的PWM脈沖控制信號，經過光電隔離和功率放大后送給底層軸系控制軸系的運行。使用雙傳感器可以大大提高反饋的精度，兩路信號可以同時考慮，也可以一路為主，另外一路提供補充和參考。

　　主處理器通過CAN總線與主控計算機進行通信，接收主控計算機的命令并把底層信息反饋給主控計算機，實現更高一級的反饋控制。主處理器通過CAN總線收發器連接到總線上，為提高精度，中間需要進行光電隔離。

　　該控制器直接安裝在仿人機器人的體內，每個控制器可以同時控制6個關節軸系，整個下肢只需要兩個控制器就可以實現其運動控制。

　　結論

　　我們在充分吸收當今相關學科高技術成果的基礎上，設計出一套速度快。穩定性強。集成度高。結構靈活。使用方便的仿人機器人運動控制系統。整個運動控制系統可直接嵌入到機器人本體內，以便在實際運行中圓滿地完成規定的控制任務。同時，該控制系統還有很強的擴展功能，可以方便地移植到其它類似的控制機構中去，是一種多功能通用型控制系統，具有廣闊的應用前景。(來源：電子發燒友）

　　四、仿人型機器人控制系統設計的幾個問題

　　1.引言

　　仿人型機器人由于具有類人的基本外形,在實際的生活中,能夠代替人完成很多工作,因此對仿人型機器人的研究具有實用價值,各國都在投入巨大的人力物力進行研發[1]。仿人型機器人具有多自由度的機械結構要求,因此需要對機器人的各個關節通過電機來完成轉動動作。這對于電機驅動控制提出了很高的性能要求。本文提出了一種基于STM32單片機的仿人型機器人控制系統方案,可以同時對機器人關節所需的16路舵機進行驅動控制。

　　2.硬件解決方案

　　本控制系統的硬件部分共分為5個模塊,其硬件系統模塊圖如圖1所示。

　　主控制器采用STM32F103xB增強型系列單片機,該系列單片機使用了高性能的ARMCortexTM-M332位的RISC內核,工作頻率為72MHz,內置高速存儲器(128K字節的閃存和20K字節的SRAM),增強型I/O端口[2]。這些性能使得STM32F103系列微控制器非常適合應用于小型仿人型機器人的控制系統。由于仿人型機器人的體型限定,因此我們在設計舵機控制板時采用了STM32F103系列的小型貼片封裝型號STM32F103CBT6。以得到體積較小的舵機控制電路板,如圖2所示。

　　為了實現對多自由度復雜結構的仿人型機器人進行動作控制,需要較多控制路數的舵機控制板。由于舵機的角度控制是采用PWM波形輸出,當單片機IO口的輸出脈沖寬度變化時,舵機舵盤角度發生改變,如圖3所示[3],因此在舵機控制板電路設計中,充分利用了STM32單片機的IO口數量多且具有PWM輸出的技術優勢[4]。共設計了16路舵機控制口,可以保證16個機器人關節同時動作。舵機驅動IO接口分布在PCB板的兩側,便于插拔。

　　在舵機的控制中,有一個容易出現的問題就是舵機抖舵問題。這種問題一般發生在采用普通電池做為機器人系統的主電源的情況下,如采用多節AA型鎳鎘或鎳氫電池串聯組成機器人供電主電源。原因是這些電池由于容量和放電能力的局限,無法在其額定電壓下提供長時間穩定持續的大電流。在仿人型機器人的多路舵機同時工作時,采用普通電源輸出的電壓會迅速降低,從而導致舵機的供電不足,最終出現舵盤異常抖動,造成機器人在執行動作時的抖舵現象。

　　因此我們設計的仿人型機器人控制電路中采用了型號為格氏25C放電倍率,容量為2200mAh,額定電壓為11.1V的鋰聚合物航模電池作為主電源。分為5V控制信號電源和6V舵機驅動電源,如圖4所示。為了保證多路舵機同時工作時所需要的大電流,利用鋰聚合物電池具有很強的持續放電能力,選用了型號為120W12A大功率降壓模塊[5],將機器人的供電電源穩壓在+6V,放電電流峰值為12A,如圖5所示。利用光電耦合器隔離單片機IO口控制信號和舵機驅動信號,提高控制信號的抗干擾能力。舵機的IO口電路設計原理圖如圖6所示。這樣解決了多路舵機由于同時工作時,電源電源被拉低引起的舵盤異常抖動問題。

　　舵機控制板在初始上電時,所有IO口會同時通入無序的PWM信號,造成瞬間出現巨大的電流消耗。經實驗測得舵機控制板上電時,單個IO口的峰值電流可以達到1.5A以上。因此在16個舵機同時初始上電通入PWM信號時,其總電流將達到24A以上,這就大大超出了大容量直流降壓模塊的極限供電電流,導致電源電路進入過流保護,整個舵機控制電路將無法進入正常的工作狀態。為了解決這個問題,我們在STM32單片機上電初始化時,首先只讓IO口1和2輸出PWM信號,然后同時再讓IO口3和4輸出初始化PWM信號,以此順序最后讓IO口15和16輸出PWM信號。這樣就保證IO口初始化時,最多只有兩路PWM信號同時通入。在機器人正常動作時,同時動作的舵機數量不超過6個,即6個IO同時輸出的峰值電流為9A,低于大功率降壓模塊的最大輸出電流12A,因此整個電路在工作期間的極限電流均小于12A。最終達到了舵機控制板穩定工作的硬件要求。

　　3.軟件部分的設計

　　仿人型機器人控制系統的軟件分為兩種模式:調試模式和正常模式。

　　調試模式:機器人上電默認靜止,以響應上位機信號為主。在該模式下,上位機通過RS232串口對機器人進行在線控制,可以對單個舵機的角度進行精確調整,編排好的流程動作單次執行,流程動作的全部執行等,并顯示當前機器人對代碼解析值。調試模式的工作界面如圖7所示。

　　正常模式:機器人上電即開始執行調試完畢的全套程序動作。

　　為了實行軟件控制,采用了多任務模塊的定時輪換機制[6]。共建立了3個模塊任務:任務0用來解析送入該任務的軟件代碼值到PWM輸出的轉換。任務1用來調用每套動作編碼,連續的將得到的軟件值發送給任務0。任務2為串口處理任務,通過分析串口發來的數據進行模式的轉換和響應。其程序流程圖如圖8所示。

　　4.系統調試效果

　　設計該仿人型機器人的走步步態時,主要考慮了機器人的自重為2.53Kg,身高為42cm,因此機器人的腳和手臂的舵機輸出幅度不能太大,否則會導致機器人走步時的重心偏移太大,造成機器人翻倒。因此在設計機器人的腳掌時,適當增大了與地面的接觸面積,腳掌的尺寸為8.5×15cm,同時加快了腳步移動的頻率,并在腳部增加了額外的配重,以增強機器人在走步過程中的穩定性,其走步的步態如圖9所示。該型機器人的走步步態協調一致,在2012年中國機器人大賽仿人競速比賽項目中獲得二等獎。

　　5.結束語

　　文中基于STM32微控制器的仿人型機器人控制系統,能夠靈活地控制16路大扭力舵機,通過大功率降壓電源模塊,可以得到16路舵機同時動作時所需要的直流電壓,實現了仿人型機器人的走步動作,可作為高校學生進行機器人技術創新時的參考。