常 遠 董 皓 郎豐濤 金 彬 尹慶慶 山東師范大學(xué) 山東濟南 250358

?

多功能機器人的設(shè)計

常 遠 董 皓 郎豐濤 金 彬 尹慶慶 山東師范大學(xué) 山東濟南 250358

【文章摘要】

本文采用MSP430系列單片機為控制核心，探索智能小車機器人的設(shè)計原理。硬件方面討論三自由度機械臂、直流電機的控制方法，研究無線模塊、車載傳感器的原理與應(yīng)用，設(shè)計直流穩(wěn)壓模塊；軟件方面基于IAR集成開發(fā)環(huán)境，運用PID控制算法和模塊化編程等思想設(shè)計程序。最終本文提出了能實現(xiàn)搬運、環(huán)境感知和無線遙控等任務(wù)的硬、軟件設(shè)計思路與實現(xiàn)方案。

【關(guān)鍵詞】

機械臂控制；MSP430；無線遙控；傳感器；PID

0　引言

近幾十年來，科學(xué)技術(shù)不斷發(fā)展與創(chuàng)新，計算機技術(shù)、電子技術(shù)、自動控制技術(shù)、人工智能技術(shù)等領(lǐng)域尤為突出。擁有自主或半自主能力的智能機器人，是各個學(xué)科領(lǐng)域相互交叉的產(chǎn)物，在當(dāng)今科技社會中最具代表性。

1　硬件設(shè)計

微處理器最小系統(tǒng)、執(zhí)行系統(tǒng)、環(huán)境感知系統(tǒng)、無線遙控、行走系統(tǒng)和LCD12864顯示六個功能模塊，加上配套的電源與穩(wěn)壓電路等，構(gòu)成了多功能機器人的硬件部分。整個機器人系統(tǒng)由一塊7.2V（VCC）可充電鎳鉻電池來供電。

1.1MG995舵機的相關(guān)參數(shù)測定

本文所使用的MG995舵機輸出角度與外部控制信號的關(guān)系，只是在外部控制信號的頻率提高為了100Hz，其他并無本質(zhì)區(qū)別。例如期望舵機輸出的角度為0°時所應(yīng)該給出的PWM信號占空比：

以上數(shù)據(jù)的得出是基于理想情況，由于安裝時的誤差及舵機的離散參數(shù)特性，實踐中舵機輸出的角度為0°時對應(yīng)的脈寬往往不是15ms，即外部的PWM信號占空比不是15%。于是本文通過實驗對三個舵機進行了角度標(biāo)定，標(biāo)定的結(jié)果如表（1）、表（2）和表（3）所示。

表（1）1#舵機標(biāo)定結(jié)果

表（2）2#舵機標(biāo)定結(jié)果

表（3）3#舵機標(biāo)定結(jié)果

經(jīng)過實測，三個MG995均有較好的線性特性，角度的誤差可以用軟件來調(diào)整，并不影響其正?？刂?。

2　環(huán)境感知系統(tǒng)

2.1DHT11傳感器簡介

DHT11將溫度、濕度測量集成到一塊芯片上，采用專用的數(shù)字模塊采集技術(shù)與溫濕度傳感技術(shù)，具有極高的可靠性和穩(wěn)定性。其溫度測量精度是2.0℃，濕度的測量精度為5.0% RH。

2.2煙霧傳感器

本文應(yīng)用MQ-2型煙霧傳感器模塊來完成煙霧檢測的目標(biāo)。電導(dǎo)率較低且對可燃氣體非常敏感的氣敏材料被該型號傳感器所采用。當(dāng)MQ-2周圍環(huán)境中存在可燃性氣體時，氣敏材料的電導(dǎo)率會隨之迅速增大。

2.3無線遙控模塊

無線遙控模塊由編、解碼電路和OOK調(diào)制、解調(diào)電路組成。

2.4行走系統(tǒng)

2.4.1直流電機的PWM閉環(huán)控制

直流電機具有起動和調(diào)速性能好、調(diào)速范圍廣和過載能力較強等優(yōu)點。其控制方式過去常采用模擬法，隨著計算機技術(shù)和控制技術(shù)的發(fā)展，數(shù)字控制成為直流電機控制的最常用手段。

2.4.2測速模塊

通過速度檢測模塊可以實時的獲取電機轉(zhuǎn)動速率，并以此為依據(jù)應(yīng)用控制算法計算能量輸出，達到實際速度快速跟隨期望速度的目的。

2.4.3系統(tǒng)軟件設(shè)計總體框架

軟件設(shè)計總體框圖如圖（1）所示。

圖（1）軟件設(shè)計總體框圖

3　電機控制程序設(shè)計

PID算法主要分為位置式PID及增量式PID兩種類型，對于電機這類大慣量系統(tǒng)經(jīng)典的控制方法是采用增量式。根據(jù)增量式PID控制原理，本文設(shè)計了用以控制左右電機的算法并編程實現(xiàn)，核心公式：

4　總結(jié)

本文所提出關(guān)于多功能機器人的硬、軟件設(shè)計思路與實現(xiàn)方案，較為良好的實現(xiàn)了搬運、環(huán)境感知和無線遙控等目標(biāo)。該項目的研究成果可以用于貨物搬運、家居服務(wù)、消防搜救等場合。

【參考文獻】

［1］付君.移動機器人運動控制系統(tǒng)的設(shè)計與實現(xiàn)［J］.科協(xié)論壇，2011，（4）∶91-94.

［2］范效瑋，湯臘梅，袁曉紅.無線遙控循跡機器人的設(shè)計與實現(xiàn)［J］.湖南工業(yè)職業(yè)技術(shù)學(xué)院學(xué)報，2013，（6）∶12-14.

［3］張廣紅.基于MSP430單片機的煤巷頂板離層監(jiān)測儀設(shè)計［J］.機械工程與自動化，2010，（2）∶141-143.

［4］杜紅.基于MSP430的直流電機控制器設(shè)計［J］.信息系統(tǒng)工程，2013，（10）∶81-82.

［5］魏小龍.MSP430系列單片機接口技術(shù)及系統(tǒng)設(shè)計實例［M］.北京∶北京航空航天大學(xué)出版社，2002.7-9.