摘要：機器人運動控制是為移動機器人提供一種運動控制方式。本文通過對移動機器人的運動控制進行分析和研究，設計出以單片機為中央控制器的閉環(huán)調速的機器人伺服電機驅動控制系統(tǒng)，采用超聲波傳感器完成測距，方便和簡化了機器人障礙物的距離檢測。應用MATLAB/SimMechanics仿真平臺對所設計的控制系統(tǒng)進行驗證，最終實驗結果表明，本文所設計的機器人運動控制系統(tǒng)性能穩(wěn)定，控制結構簡單，機器人能夠很好的跟蹤設定路徑。

0引言

  國際上對機器人的研究開始于60年代后期的斯坦福研究院，在1972年制造出了第一臺具有自主移動能力的機器人。到70年代末期，國際上對移動機器人的研究達到了高潮，到了80年代中后期，機器人的設計和制造開始席卷全球。日木的本田和索尼、美國的通用等一批世界著名公司開始致力于研制移動機器人的運動平臺，當時所研究的移動機器人運動平臺大多是作為實驗室或研究院校的機器人實驗平臺，以此來促進移動機器人研究方向多方面發(fā)展。隨著機器人技術的不斷發(fā)展，以及在軍事、工業(yè)領域中的應用與日俱增，關于機器人的理論研究、設計制造和應用的新型機器人學也逐步形成，并越來越受到關注。對于移動機器人的研究也將進入了一個新的階段。

  移動式機器人可通過自身的傳感器感知外界的環(huán)境和顯現(xiàn)自身的狀態(tài)，當遇到障礙物時能夠面向運動目標進行自主的運動，完成機器人系統(tǒng)的某些特殊功能。目前所研究的最理想的移動機器人具有較高的智能水平，不需人為因素的干預，可以在各種負責的外界環(huán)境中自主完成程序中設定的任務，但目前國際上對移動式機器人的研究大多都處于實驗的階段，市場上比較實用的機器人大多都是半自主移動式的，需要通過外界的干預，并在特定的環(huán)境中去執(zhí)行設定任務?，F(xiàn)在市面上的遙控機器人更是離不開人的控制。

  現(xiàn)在，國際上對機器人的概念已經逐漸趨近一致。一般說來，人們都可以接受這種說法，即機器人是靠自身動力和控制能力來實現(xiàn)各種功能的一種機器。聯(lián)合國標準化組織采納了美國機器人協(xié)會給機器人下的定義：“一種可編程和多功能的，用來搬運材料、零件、工具的操作機；或是為了執(zhí)行不同的任務而具有可改變和可編程動作的專門系統(tǒng)?！睓C器人能力的評價標準包括：智能，感覺和感知，包括記憶、運算、比較、鑒別、判斷、決策、學習和邏輯推理等；機能，指變通性、通用性或空間占有性等；物理能，指力、速度、連續(xù)運行能力、可靠性、聯(lián)用性、壽命等。因此，可以說機器人是具有生物功能的空間三維坐標機器。

  新式智能控制算法出現(xiàn)，可使移動機器人向著智能化的方向發(fā)展，因此對運動控制系統(tǒng)提出了更高的要求。通過對智能機器人的研究，熟悉其軟件和硬件的開發(fā)原理，掌握其運動控制的特性，設計出智能的機器人控制系統(tǒng)，為我國移動機器人的后續(xù)功能擴展建立一個穩(wěn)定、可行的平臺，而此平臺還可作為其它種類機器人的公共基礎開發(fā)平臺。對實現(xiàn)智能機器人的控制系統(tǒng)開發(fā)具有十分重要的意義，并為后期機器人的開發(fā)奠定了基礎。

1、機器人控制系統(tǒng)結構功能

  移動式機器人的執(zhí)行機構是機器人的運動控制系統(tǒng)，它對機器人的平穩(wěn)運行起著至關重要的作用，同時它也是一個結構簡單的控制器。如圖1所示為本文設計的移動機器人的運動控制系統(tǒng)框圖。移動式機器人運動控制系統(tǒng)主要包括四大部分：I/O設備、PC機控制軟件及硬件、執(zhí)行機構驅動器和各類傳感器等。

圖1移動機器人運動控制系統(tǒng)框圖

1.1移動式機器人的控制系統(tǒng)

  移動式機器人的控制系統(tǒng)的作用是生成控制信息，控制機器人的執(zhí)行機構進行運動。跟蹤設定軌跡是設計移動機器人的一項重要任務，其工作過程根據設定好的路線轉為運動控制信號傳輸給機器人，移動機器人根據控制器信號完成相應的動作，最終達到設定的目標位置。在機器人的運動控制過程中需輸入給機器人的信息包含伺服電機編碼器轉換出來的機器人移動位置和速度的信息，超聲波傳感器檢測出來的障礙物位置的信息，以及單目視覺攝像機、全景攝像機所采集到的視頻信息。

1.2移動式機器人的驅動機構

  移動式機器人底座上裝有四個伺服電機，以此作為機器人的運動執(zhí)行機構。每個電機都裝有一個編碼器，通過采集編碼器A和B相的正交編碼脈沖信號，可以實現(xiàn)電機的閉環(huán)調速和完成機器人的定位。移動式機器人身上安裝的中央處理器則主要用于負責傳感器模塊的控制和管理、定位信息的采集，以及與PC機的通信等，本文所設計控制系統(tǒng)采用了嵌入式大容量單片機控制器。

1.3移動式機器人的信息處理

  輸入信息包含視覺信號和距離測量。視覺信號由單目視覺攝像機和全景視覺攝像機提供。距離測量由超聲波和激光測距完成。機器人程序開發(fā)人員應事先根據運行環(huán)境建立良好的運行環(huán)境地圖，在機器人的移動過程中實時讀取位置信息，在中央控制器中根據程序設計的控制算法進行運算，將輸出信號發(fā)生給伺服電機控制器到驅動電機，從而控制移動機器人的移動。

  機器人以中央處理器和上位機作為神經中樞，接收來自超聲波和激光模塊檢測的障礙物信息，單目和全景攝像機提供視覺信息。根據上位機設定的參數和一些其他功能，通過控制器處理輸出給電機控制機器人執(zhí)行機構完成相應動作。

1.4基于環(huán)境模型的規(guī)劃方法

  該方法首先需要建立一個關于機器人運動環(huán)境的環(huán)境模型。在很多時候由于移動機器人的工作環(huán)境具有不確定性(包括非結構性、動態(tài)性等)，使得移動機器人無法建立全局環(huán)境模型，而只能根據傳感器信息實時地建立局部環(huán)境模型，因此局部模型的實時性、可靠性成為影響移動機器人是否可以安全、連續(xù)、平穩(wěn)運動的關鍵。環(huán)境建模的方法基本上可以分為兩類：網絡／圖建模方法、基于網格的建模方法。前者主要包括自由空間法、頂點圖像法、廣義錐法等，利用它們在進行路徑規(guī)劃時可得到比較精確的解，但所耗費的計算量相當大，不適合于實際的應用。而后者在實現(xiàn)上要簡單許多，所以應用比較廣泛，其典型代表就是四叉樹建模法及其擴展算法(如基于位置碼四叉樹建模法、Framed-quadtrees建模法等)。

  基于環(huán)境模型的規(guī)劃方法根據掌握環(huán)境信息的完整程度可以細分為環(huán)境信息完全已知的全局路徑規(guī)劃和環(huán)境信息完全未知或部分未知的局部路徑規(guī)劃。由于環(huán)境模型是已知的，全局路徑規(guī)劃的設計標準是盡量使規(guī)劃的效果達到最優(yōu)。在此領域已經有了許多成熟的方法，包括可視圖法、切線圖法、Voronoi圖法、拓撲法、懲罰函數法、柵格法等。先前方法多采用基于圖論的思想，將目標、機器人及其工作空間用一個連接圖表示，如此一來，路徑規(guī)劃問題就轉化為在圖上尋找一條從起始節(jié)點到目標節(jié)點的路線。懲罰函數法將路徑規(guī)劃這個有約束的問題(受到障礙物的限制)轉化為一個無約束最優(yōu)化問題，再求解就可得出解答。柵格法用網格描述機器人的工作環(huán)境，根據柵格的可信度值可確定出障礙物的分布，此時通過避障規(guī)劃就可得到無碰路徑。

2、控制系統(tǒng)硬件設計

  移動式機器人的運動控制系統(tǒng)硬件設計主要包括三部分：主控板設計、驅動機構設計和傳感器單元。

2.1主控板設計

  主控板的主要作用是完成控制器與模塊接口之間的數據管理、傳輸和控制功能。因移動式機器人上不同種類的傳感器模塊接口可能不相同，如：雙目攝像機為RS232接口；全景視覺攝像機為USB接口。主控板可完成與PC機的通信，驅動機構的的控制信號由上位機經主控板發(fā)送給電機控制器。主控板可采集電機編碼器的正交編碼脈沖信號經過處理作為作位置信號。主控板也對距離測量模塊接口進行管理，傳感器接收信號的采集處理和發(fā)射信號的產生以及超聲波傳感器運行時間的設置都是由主控板來完成的。

2.2驅動機構

  移動式機器人采用四輪運動模式，四個輪分別由通過電機驅動。每個電機都是由各自的電機控制器單獨進行驅動，保證了電機閉環(huán)調速的獨立性、實時性、穩(wěn)定性和準確性。每個電機單元模塊都由控制器和電機組成。電機控制器模塊的控制芯片接收上位機的控制指令，經處理器計算后將運行速度和方向輸出給執(zhí)行電機，控制器能夠輸出控制電機電壓，同時通過編碼器實時檢測電機的運行速度，對電機測量速度和設定速度差值進行比較運算，輸出電機的控制電壓，從而完成電機的閉環(huán)調速。

2.3傳感器單元

  超聲波傳感器用于測量附近障礙物與機器人的實際距離，傳感器所需的40KHz方波源信號由中央控制器產生，經放大器轉換后輸出給超聲波傳感器信號，當超聲波信號在傳播過程中遇到障礙物會反射回來，超聲波接收器接收到超聲波信號后經轉化器轉換成小幅值的電信號，然后在經放大和濾波后傳輸給中央控制器，由中央控制器換算成位置信號。由于超聲波傳感器發(fā)出的信號隨的距離的增加而衰弱，因此接收器接收的信號也極其微弱，一般都為毫伏級的，并有干擾噪聲，所以需對傳感器接收到的信號進行放大和濾波處理。從超聲波控制芯片發(fā)出信號開始到接收器接收到信號后之間的時差即就是波傳輸時間，通過傳輸時間和速度就可計算出距離。如圖2所示為超聲波測距硬件結構圖。

圖2超聲波測距單元硬件結構圖

3、仿真模型

  本文利用MATLAB/SimMechanics仿真平臺對移動式機器人的運動控制進行仿真研究，構造了基于仿真平臺SimMechanics的運動學仿真模型和基于MATLAB函數的運動學仿真模型。并設計了一個智能小車仿真平臺來模仿移動式機器人，本文根據控制系統(tǒng)的性能參數要求確定了PID控制器的各項參數，并且采用傳感器技術實時了智能小車在運行過程中的實時狀態(tài)。

  假設智能小車所處的環(huán)境在一個二維坐標系中的坐標為(X，Y)，小車的運行方向與X軸之間的夾角用θ表示，因此就可用向量[X，Y，θ]表示智能小車的位置姿態(tài)，小車的運動方程可用下式表示：

  式中，v為小車前進速度，b為小車左右輪之間的橫向距離，vL為小車左輪的速度，ω為小車的轉向速度，vR為小車右輪的速度，Tf為車輪摩擦時產生的反抗性恒轉矩負載。假設i為傳動機構的減速比，η為傳動機械效率，則電機軸上負載轉矩的等效轉矩可表示為：

T=Tf/iη

  為使智能小車測控更加直觀本文采用了虛擬仿真技術，SimMechanics的優(yōu)化設計模塊使運動控制系統(tǒng)的參數調整更加方便，虛擬仿真技術與SimMechanics相結合可實現(xiàn)交互性操作，并能實時顯現(xiàn)出智能小車的運動狀態(tài)。

4、控制器參數優(yōu)化

  因普通的PID控制器性能的好壞實際上能取決于比例，積分和微分參數的整定，若設定的參數越符合該控制系統(tǒng)，則控制效果就越好，否則相反。本文設計的仿真控制系統(tǒng)通過調整比例、積分和微分三項控制參數，使小車能夠更加快速、準確的沿設定路徑前進到達目的地。圖3中基于SimMechanics平臺建立的小車運動學仿真模型，本模型中具有圖形界面的控制器優(yōu)化設計功能和仿真的功能，可根據上位機設定的參數對電機控制器中的參數進行優(yōu)化計算。PID控制器輸出的信號經電機控制器后去控制執(zhí)行電機。

圖3SimMechanics平臺的運動學仿真模型

  根據所建立的SimMechanics運動學仿真模型，在仿真軟件環(huán)境中設置仿真的分析類型，就可以實現(xiàn)移動式機器人的運動學仿真分析。通過安裝的編碼器可以測得移動機器人的末端軌跡如圖4所示。

圖4機器人的末端運動軌跡

5、結論

  本文設計了可獨立完成電機的閉環(huán)調速的移動機器人控制系統(tǒng)。由上位機直接發(fā)送指令給機器人控制器控制運動，無需再參與閉環(huán)調速的運算中。使用MATLAB/SimMechanics仿真平臺實現(xiàn)了移動式機器人的運動學仿真，通過移動式機器人上的編碼器記錄的機器人移動的位移，通過控制器將位置信號轉換為機器人當前的位置姿態(tài)，從而實現(xiàn)對機器人路徑的跟蹤控制。