【溫馨提示】 dwg后綴的文件為CAD圖,可編輯,無水印,高清圖,,壓縮包內(nèi)文檔可直接點(diǎn)開預(yù)覽,需要原稿請(qǐng)自助充值下載,請(qǐng)見壓縮包內(nèi)的文件,所見才能所得,下載可得到【資源目錄】下的所有文件哦--有疑問可咨詢QQ:1304139763 或 414951605
江西農(nóng)業(yè)大學(xué),基于五自由度機(jī)械手的遙控智能車,指導(dǎo)老師:康麗春周華茂專業(yè)名稱:農(nóng)業(yè)機(jī)械化及其自動(dòng)化學(xué)生姓名:蔡曉亮學(xué)生學(xué)號(hào):20100964,排險(xiǎn)排爆機(jī)器人國外現(xiàn)狀,德國排爆機(jī)器人,美國Marcbot-4排爆機(jī)器人,英國“手推車”,法國TSR-200排爆機(jī)器人,排險(xiǎn)排爆機(jī)器人國內(nèi)現(xiàn)狀,中國航天科工“雪豹-10”,北京博創(chuàng)Raptor-eod機(jī)器人,“靈晰-B”爆炸物處理機(jī)器人,作品展示,作品展示,,,,2:目前,排險(xiǎn)排爆機(jī)器人價(jià)格昂貴,一般機(jī)構(gòu)或?qū)W校難以接受,學(xué)生難以接觸到實(shí)際的排險(xiǎn)排爆機(jī)器人,學(xué)習(xí)相關(guān)的機(jī)械電子知識(shí)。,設(shè)計(jì)背景,1:目前的排險(xiǎn)排爆機(jī)器人操作箱,多采用按鍵式一個(gè)一個(gè)調(diào)節(jié)各個(gè)機(jī)械關(guān)節(jié)臂的角度,遙控機(jī)械手時(shí)不像開車那樣靈活自如,操作人員需要經(jīng)過相關(guān)的操作培訓(xùn)后才能較好地控制機(jī)械手抓取,搬運(yùn)物體。,設(shè)計(jì)意義,基于五自由度機(jī)械手的遙控智能車將重點(diǎn)突破這些弊端,以較低的設(shè)計(jì)成本投入以及切實(shí)可執(zhí)行的設(shè)計(jì),做出帶機(jī)械手的遠(yuǎn)程智能小車。1:采用五自由度模擬機(jī)械手,無線同步控制車載五自由度機(jī)械手,實(shí)現(xiàn)空間抓取物體一步到位,打破傳統(tǒng)的一個(gè)個(gè)微調(diào)的控制方式。2:將書本理論知識(shí)應(yīng)用實(shí)際,綜合機(jī)械和電子多門課程知識(shí),可直接作為高等創(chuàng)新教育的典范科技類作品,激發(fā)學(xué)生的創(chuàng)新思維和創(chuàng)新意識(shí),加強(qiáng)學(xué)生的專業(yè)知識(shí)和技能教育,培養(yǎng)學(xué)生的創(chuàng)新能力。,設(shè)計(jì)目標(biāo),1、無線靈活控制小車運(yùn)動(dòng);2、機(jī)械臂抓取物體和搬運(yùn)物體;3、視頻無線實(shí)時(shí)傳輸監(jiān)控;4、小車自主避障行駛。,總系統(tǒng)組成,,,具體設(shè)計(jì),驅(qū)動(dòng)裝置使用三級(jí)減速箱驅(qū)動(dòng),動(dòng)力強(qiáng)勁。,使用履帶式底盤,穩(wěn)定性好及對(duì)地面壓強(qiáng)??;加獨(dú)立懸掛減震系統(tǒng)具有一定的越障能力。,,,機(jī)械臂由鋁合金L支架,U型支架,多功能支架等構(gòu)成,外加機(jī)械爪,構(gòu)成一個(gè)五自由度機(jī)械手,在各個(gè)關(guān)節(jié)臂上用舵機(jī)控制,實(shí)現(xiàn)機(jī)械手抓取空間任意角度的物體。,五自由度機(jī)械手遙控端采用薄鋁合金制作的模擬機(jī)械臂,操作模擬機(jī)械臂,即可實(shí)現(xiàn)遠(yuǎn)程無線控制車載機(jī)械臂同步運(yùn)動(dòng)。,,攝像頭兩個(gè),機(jī)械爪一個(gè),另外一個(gè)安裝在車上的兩自由度云臺(tái)上,可以一鍵切換,能實(shí)現(xiàn)空間各個(gè)角度的攝像,然后無線實(shí)時(shí)傳輸回液晶屏。,7寸液晶顯示屏,實(shí)時(shí)顯示攝像頭采集的圖像。,,,,遙控端采用雙單片機(jī)控制。通過按鍵可以無線控制小車靈活地前后左右運(yùn)動(dòng),加減檔;切換攝像頭;控制夜燈的開閉;切換小車自主行駛;數(shù)碼管顯示當(dāng)前檔位。,小車前端有LED夜燈,在黑暗條件下也能看清周圍物體;前端還有超聲波模塊,通過遙控端按鍵切換能實(shí)現(xiàn)自主避障行駛。,,小車端采用雙單片機(jī)控制:高速處理遙控端模擬機(jī)械臂信號(hào),使機(jī)械手五軸聯(lián)動(dòng),做和模擬機(jī)械臂一樣的動(dòng)作;快速響應(yīng)遙控端的命令,靈活控制小車運(yùn)動(dòng)。,視頻演示,致謝,非常感謝康麗春老師和周華茂老師的指導(dǎo)和評(píng)改,同時(shí)感謝那些幫助和支持我的同學(xué)。謝謝所有評(píng)委老師,歡迎各位老師提出寶貴的意見和建議!,基于五自由度機(jī)械手的遙控智能車
JIANGXI AGRICULTURAL UNIVERSITY
本 科 畢 業(yè) 設(shè) 計(jì)
題目: 基于五自由度機(jī)械手的遙控智能車
學(xué) 院: 江西農(nóng)業(yè)大學(xué)工學(xué)院
姓 名: 蔡曉亮
學(xué) 號(hào): 20100964
專 業(yè): 農(nóng)業(yè)機(jī)械化及其自動(dòng)化
年 級(jí): 農(nóng)機(jī)1001
指導(dǎo)教師: 康麗春 職 稱: 講師
周華茂 職 稱: 副教授
二0 一 四 年 五 月
摘要
本文對(duì)基于五自由度機(jī)械手的遙控智能車進(jìn)行了總體設(shè)計(jì)及分析,包括整體結(jié)構(gòu)設(shè)計(jì)、機(jī)械臂零件和小車底盤零件選用和分析、機(jī)械臂關(guān)節(jié)驅(qū)動(dòng)舵機(jī)選用、小車減速箱和驅(qū)動(dòng)電機(jī)選用、五自由度模擬機(jī)械臂的設(shè)計(jì)、遙控端電路和接收端電路設(shè)計(jì),遙控端和接收端程序設(shè)計(jì)等。
本設(shè)計(jì)還做出了實(shí)物,能夠?qū)崿F(xiàn)無線靈活控制小車前進(jìn)后退,左轉(zhuǎn)右轉(zhuǎn);通過模擬機(jī)械臂無線同步控制車載五自由度機(jī)械手抓取物體和搬運(yùn)物體;小車周圍環(huán)境視頻無線實(shí)時(shí)監(jiān)控;遙控端一鍵切換攝像頭;一鍵控制夜燈開閉;一鍵切換手動(dòng)遙控小車和小車自主行駛。這個(gè)帶有機(jī)械手的無線小車,可以用于需要遠(yuǎn)程移動(dòng)巡邏的地方,也可用于化工廠等危險(xiǎn)區(qū)域巡邏,搬運(yùn)小型物體;另外綜合了機(jī)械和電子多門課程多個(gè)重要知識(shí)點(diǎn),并且很好的結(jié)合在一起,非常適用于課堂現(xiàn)場實(shí)物教學(xué)。
關(guān)鍵詞:機(jī)械手;無線;單片機(jī);視頻實(shí)時(shí);智能車
III
ABSTRACT
In this paper, based on five -DOF manipulator remote intelligent vehicle carried the overall design and analysis, including overall design, robotic parts and car chassis parts selection and analysis , manipulator joint drive servo selection, car gear box and drive motor selection , five degrees of freedom manipulator design simulation , remote control of the circuit and the receiver circuit design, remote control and the receiver program design.
This design is also made ??in-kind , to achieve flexible wireless control car forward and back, Turn left and turn right; synchronization control car radio by simulating five degrees of freedom robotic manipulator grab objects and moving objects ; trolley ambient video wireless real-time monitoring ; remote end of a key switch cameras ; opening and closing a key control nightlights ; a key switch manual remote control car and trolley autonomous driving. The wireless car with a mechanical hand , can be used for remote mobile patrols where needed , can also be used in hazardous areas such as chemical plants patrol , handling small objects ; another combination of mechanical and electronic multi- course a number of important knowledge and good together, ideal for classroom teaching physical site .
Key word :robot , radio ,MCU ,video in real time ,smart car
基于五自由度機(jī)械手的遙控智能車
目錄
摘要 II
ABSTRACT III
1 緒論 1
1.1 課題背景,國內(nèi)外現(xiàn)狀和意義 1
1.1.1 課題背景 1
1.1.2 國內(nèi)外現(xiàn)狀 1
1.1.3 設(shè)計(jì)意義 2
1.2 設(shè)計(jì)目標(biāo),總體設(shè)計(jì)和控制途徑 3
1.2.1 設(shè)計(jì)目標(biāo) 3
1.2.2 總體設(shè)計(jì) 3
1.2.3 控制途徑 4
2 機(jī)械部分結(jié)構(gòu)設(shè)計(jì)與零件選用 5
2.1 模擬機(jī)械臂 5
2.2 車載端五自由度機(jī)械臂 6
2.3 二自由度攝像頭云臺(tái) 9
2.4 小車底盤選擇 9
2.5 減速齒輪箱 10
2.6 小車驅(qū)動(dòng)電機(jī) 11
2.7 機(jī)械臂關(guān)節(jié)驅(qū)動(dòng) 12
3 遙控端電路原理及設(shè)計(jì) 13
3.1 單片機(jī)的選擇與分析 13
3.2 小車遙控電路設(shè)計(jì) 14
3.3 模擬機(jī)械臂電路設(shè)計(jì) 15
4 車載端電路原理及設(shè)計(jì) 16
4.1 小車接收電路設(shè)計(jì) 16
4.2 車載五自由度機(jī)械手電路設(shè)計(jì) 16
4.3 小車電機(jī)驅(qū)動(dòng)電路 17
4.4 小車超聲波避礙模塊 18
5 無線視頻實(shí)時(shí)傳輸 19
5.1 無線視頻方案選擇與分析 19
5.2 視頻發(fā)送模塊 19
5.3 視頻接收模塊 20
5.4 液晶顯示 21
6 程序設(shè)計(jì) 22
6.1 遙控小車程序 22
6.2 模擬機(jī)械臂程序 22
6.3 小車接收端程序 22
6.4 五自由度機(jī)械臂程序 22
7 結(jié)論與展望 24
7.1結(jié)論 24
7.2展望 24
參考文獻(xiàn) 25
附錄一 26
致謝 28
1 緒論
1.1 課題背景,國內(nèi)外現(xiàn)狀和意義
1.1.1 課題背景
隨著時(shí)代和高新技術(shù)的發(fā)展,機(jī)器人技術(shù)的應(yīng)用領(lǐng)域不斷擴(kuò)大,工業(yè)機(jī)器人 、特種作業(yè)機(jī)器人、服務(wù)機(jī)器人、微小型機(jī)器人等已經(jīng)在各個(gè)方面得到廣泛的應(yīng)用和發(fā)展。機(jī)器人技術(shù)是集機(jī)械、電子、控制和計(jì)算機(jī)技術(shù)的一項(xiàng)綜合技術(shù)。從某些意義上來說,機(jī)器人的技術(shù)水平的高與低反映了這個(gè)國家的綜合技術(shù)實(shí)力。
基于五自由度機(jī)械手的遙控智能車和排險(xiǎn)排爆機(jī)器人類似。它是針對(duì)公安、核工業(yè)、軍事、化工等危險(xiǎn)、惡劣、有害環(huán)境下應(yīng)用的特種作業(yè)機(jī)器人,它不受任何外界電磁干擾,可以代替人在危險(xiǎn)、惡劣、有害環(huán)境中進(jìn)行觀察、檢查、搬運(yùn)、清理、操作及安放特殊裝置,代替現(xiàn)場安檢人員實(shí)地勘察,實(shí)時(shí)傳輸現(xiàn)場圖像;用以保證人員的安全、健康,避免不必要的人員傷亡。
1.1.2 國內(nèi)外現(xiàn)狀
在西方國家中,恐怖活動(dòng)始終是個(gè)令當(dāng)局頭疼的問題。英國由于民族矛盾,飽受爆炸物的威脅,因而英國在60年代就研制成功排爆機(jī)器人。英國研制的履帶式“手推車”及“超級(jí)手推車”排爆機(jī)器人(如圖1.1.a),已向50多個(gè)國家的軍警機(jī)構(gòu)售出了800臺(tái)以上。美國Remotec公司的Andros系列機(jī)器人受到各國軍警部門的歡迎,白宮及國會(huì)大廈的警察局都購買了這種機(jī)器人(如圖1.1.b)。Andros機(jī)器人可用于小型隨機(jī)爆炸物的處理,它是美國空軍客機(jī)及客車上使用的唯一的機(jī)器人。海灣戰(zhàn)爭后,美國海軍也曾用這種機(jī)器人在沙特阿拉伯和科威特的空軍基地清理地雷及未爆炸的彈藥。美國空軍還派出5臺(tái)Andros機(jī)器人前往科索沃,用于爆炸物及子炮彈的清理??哲娒總€(gè)現(xiàn)役排爆小隊(duì)及航空救援中心都裝備有一臺(tái)Andros VI(引用自百度網(wǎng)頁)。
a 英國機(jī)器人 b 美國國機(jī)器人
圖1.1 歐美機(jī)器人
與國外相比,中國的排爆機(jī)器人起步較晚。但是隨著這些年中國經(jīng)濟(jì)和科技的不斷崛起和創(chuàng)新,我國也有了自己的排險(xiǎn)排爆機(jī)器人。Raptor-eod 機(jī)器人是北京博創(chuàng)集團(tuán)開發(fā)的一款中型特種排爆排險(xiǎn)機(jī)器人,用于處置各種突發(fā)涉爆、涉險(xiǎn)使用排爆機(jī)器人事件。代替以往人工排出可疑爆炸物及在危險(xiǎn)品搬運(yùn)過程中對(duì)操作者帶來的危險(xiǎn),如圖1.1.c(引自百度網(wǎng)頁);“雪豹-10”由中國航天科工集團(tuán)公司自主研制,車體可進(jìn)行前后擺臂,并根據(jù)地形,改變履帶形狀,從而完成不同地形的行走命令,如平地行走、跨越溝壑、上下樓梯等,如圖1.1.d(引自百度網(wǎng)頁)。
C 北京博創(chuàng)Raptor-eod 機(jī)器人 d 中國航天科工“雪豹-10”
圖1.1 中國機(jī)器人
1.1.3 設(shè)計(jì)意義
目前,排險(xiǎn)排爆機(jī)器人價(jià)格昂貴,一般機(jī)構(gòu)或?qū)W校很少購買,學(xué)生難以接觸到實(shí)際的排險(xiǎn)排爆機(jī)器人,學(xué)習(xí)相關(guān)的機(jī)械電子知識(shí)。另外目前的排險(xiǎn)排爆機(jī)器人操作箱操作復(fù)雜,遙控機(jī)械手時(shí)不像真的開車那樣靈活自如,多采用按鍵式一個(gè)一個(gè)調(diào)節(jié)各個(gè)機(jī)械關(guān)節(jié)臂的角度,操作人員需要經(jīng)過相關(guān)的操作培訓(xùn)后才能較好地控制機(jī)械手抓取,搬運(yùn)物體。本設(shè)計(jì)基于五自由度機(jī)械手的遙控智能車將重點(diǎn)突破這些弊端,以較低的設(shè)計(jì)成本投入以及切實(shí)可執(zhí)行的設(shè)計(jì),做出一輛帶機(jī)械手的遠(yuǎn)程智能小車,用于需要遠(yuǎn)程移動(dòng)巡邏的地方,也可用于化工廠等危險(xiǎn)區(qū)域巡邏,搬運(yùn)物體。將書本理論知識(shí)應(yīng)用實(shí)際,綜合機(jī)械和電子多門課程知識(shí),可直接作為高等創(chuàng)新教育的典范科技類作品,激發(fā)學(xué)生的創(chuàng)新思維和創(chuàng)新意識(shí),加強(qiáng)學(xué)生的專業(yè)知識(shí)和技能教育,培養(yǎng)學(xué)生的創(chuàng)新能力。
1.2 設(shè)計(jì)目標(biāo),總體設(shè)計(jì)和控制途徑
1.2.1 設(shè)計(jì)目標(biāo)
(1) 無線靈活控制小車運(yùn)動(dòng);
(2) 機(jī)械手抓取物體和搬運(yùn)物體;
(3) 視頻無線實(shí)時(shí)傳輸監(jiān)控;
(4) 小車自主避障。
1.2.2 總體設(shè)計(jì)
基于五自由度機(jī)械手遙控智能車分為遙控部分和小車及機(jī)械手部分。
遙控部分:以STC12C5A60S2單片機(jī)為主芯片,加NRF24L01無線芯片;實(shí)現(xiàn)無線控制小車前進(jìn),后退,左轉(zhuǎn),右轉(zhuǎn)運(yùn)動(dòng); 7寸液晶無線實(shí)時(shí)顯示小車終端圖像;加上五自由度模擬機(jī)械臂,直接控制小車端五自由度機(jī)械手抓取,搬運(yùn)物體;操作人員根據(jù)液晶圖像,操作模擬機(jī)械臂和按鍵,即可無線控制遠(yuǎn)距離小車及小車端五自由度機(jī)械臂。
小車及機(jī)械手部分:以STC12C5A60S2單片機(jī)為主芯片,加NRF24L01無線芯片,接收處理遙控端發(fā)來的命令。小車端帶有減速齒輪履帶式底盤,動(dòng)力強(qiáng)勁,運(yùn)動(dòng)平穩(wěn);車上裝有五自由度機(jī)械手,接收遙控端發(fā)送的指令,實(shí)現(xiàn)空間任意角度抓取物體;機(jī)械手上和小車二自由度云臺(tái)配有攝像頭,把小車周圍的圖像無線發(fā)回遙控端液晶顯示(小車總體完成效果圖如1.2)。
圖1.2 小車總體效果圖
1.2.3 控制途徑
1.無線靈活控制小車運(yùn)動(dòng)
利用STC12C5A60S2單片機(jī)和NRF24L01無線芯片,按鍵,數(shù)碼管,和其他外圍電路設(shè)計(jì)成電路控制板;按鍵控制小車加減檔和前進(jìn),后退,左轉(zhuǎn),右轉(zhuǎn),停止,攝像頭切換,開關(guān)夜燈,手動(dòng)控制和超聲波自動(dòng)駕駛切換;數(shù)碼管顯示當(dāng)前檔位。
2.機(jī)械手抓取物體和搬運(yùn)物體
遙控端用鋁合金和電位器做成一個(gè)小型模擬五自由度機(jī)械臂,加上STC12C5A60S2單片機(jī)和NRF24L01無線芯片,把模擬機(jī)械臂的模擬信號(hào)轉(zhuǎn)換成數(shù)字信號(hào),無線發(fā)送給小車端,實(shí)現(xiàn)小車端機(jī)械臂做和模擬機(jī)械臂相同的動(dòng)作。
3.視頻無線實(shí)時(shí)傳輸
采用2.4GHZ無線視頻傳輸模塊,發(fā)射模塊TX6722采集模擬攝像頭的信號(hào),加載高頻,調(diào)制后通過天線發(fā)送出去;接收模塊RX6788接收到無線視頻信號(hào),進(jìn)行解調(diào);視頻信號(hào)進(jìn)入液晶驅(qū)動(dòng)板,液晶驅(qū)動(dòng)板通過解碼把視頻信號(hào)傳給7寸液晶屏,實(shí)現(xiàn)圖像顯示。
4.小車自主避障
采用HY_SRF05超聲波模塊,當(dāng)小車遙控端通過按鍵切換為超聲波自動(dòng)駕駛后,小車接收端單片機(jī)啟動(dòng)自動(dòng)行駛模式,控制超聲波模塊發(fā)送超聲波,根據(jù)小車周圍的障礙物回應(yīng)回來的超聲波信號(hào),進(jìn)行調(diào)速,前進(jìn),轉(zhuǎn)彎等功能;實(shí)現(xiàn)小車自動(dòng)避障行駛。
2 機(jī)械部分結(jié)構(gòu)設(shè)計(jì)與零件選用
2.1 模擬機(jī)械臂
采用旋鈕電位器,鋁合金機(jī)械臂支架,螺母,摩擦片等做成。采用簡單的L支架,一字支架,一字薄木板,帶手指孔的長鋁片做成五自由度機(jī)械臂,支架連接處采用旋鈕電位器轉(zhuǎn)軸連接,連接軸中間加上摩擦片,是為了使模擬機(jī)械臂在操作后能自鎖在原來的位置;實(shí)物圖如圖2.1.a所示,運(yùn)動(dòng)示意圖如2.1.e。
圖2.1.a 模擬機(jī)械臂實(shí)物圖
模擬機(jī)械臂主要零件尺寸,見下圖:圖2.1.b長L支架; 圖2.1.c一字支架;圖2.1.d機(jī)械手指。
b 長L支架 c 一字支架
d 機(jī)械手指架 e 運(yùn)動(dòng)示意圖
圖2.1 模擬機(jī)械臂零件圖
2.2 車載端五自由度機(jī)械臂
采用制作機(jī)器人的支架,996舵機(jī),加上小型軸承,螺母,螺栓連接,做成一個(gè)五自由度的機(jī)械臂,包括U梁,長U支架,L支架,多功能支架,機(jī)械爪,三維圖如圖2.2.a所示,運(yùn)動(dòng)示意圖如2.2.e。
圖2.2.a 車載五自由度機(jī)械臂
車載機(jī)械臂主要支架及相關(guān)零件圖,見下圖:圖2.1.b多功能支架; 圖2.1.c長U型支架;圖2.2.d短L支架。
b 多功能支架 c 長U型支架
d 短L支架 e 運(yùn)動(dòng)示意圖
圖2.2 車載機(jī)械臂主要零件圖
2.3 二自由度攝像頭云臺(tái)
為了實(shí)時(shí)監(jiān)控小車周圍的環(huán)境,五自由度機(jī)械手抓取物體看清物體,采用了兩個(gè)攝像頭。第一個(gè)攝像頭直接安裝在機(jī)械爪后端,第二個(gè)攝像頭裝在車載二自由度云臺(tái)上,通過遙控端的攝像頭切換按鍵,在液晶顯示終端實(shí)時(shí)觀看兩個(gè)攝像頭的圖像;二自由度云臺(tái)采用兩個(gè)舵機(jī),兩個(gè)多功能支架,一個(gè)長U支架構(gòu)成等組成,能夠?qū)崿F(xiàn)空間360度的攝像。三維圖如圖2.3所示。
圖2.3 二自由度攝像頭云臺(tái)
2.4 小車底盤選擇
方案一:輪式小車底盤
優(yōu)點(diǎn):速度快、效率高、運(yùn)動(dòng)噪聲低。
缺點(diǎn):越障能力、地形適應(yīng)能力差、轉(zhuǎn)彎效率低,或轉(zhuǎn)外半徑大。
適合:野外、城市環(huán)境都可以,但是地形不能太復(fù)雜,如碎石地難以靈活控制。
方案二:履帶式小車底盤
優(yōu)點(diǎn):地形適應(yīng)能力強(qiáng),可原地轉(zhuǎn)彎,運(yùn)動(dòng)時(shí)車體減震,有負(fù)載輪可載重物。
缺點(diǎn):速度相對(duì)較低、效率低、運(yùn)動(dòng)噪聲較大。
適合:野外、城市環(huán)境都可以,在平穩(wěn)、越障,負(fù)載重量等方面優(yōu)于輪式。
為實(shí)現(xiàn)小車平穩(wěn)運(yùn)動(dòng),使搭載在小車上的攝像頭,在小車運(yùn)動(dòng)過程中不抖動(dòng),保證圖像傳輸清晰;小車加載機(jī)械手、電路板,電池后重量達(dá)到兩公斤,負(fù)載較重;另外適應(yīng)一定的復(fù)雜環(huán)境,使小車具有一定的越障功能,比較之下選擇坦克式小車平臺(tái):坦克1:16虎式3818-1底盤,底盤尺寸:38*22*10(長寬高),塑料履帶2條、金屬驅(qū)動(dòng)輪2個(gè)、塑料誘導(dǎo)輪2個(gè),負(fù)重輪16個(gè),加寬覆帶與地面的接觸面積更大,行走起來更穩(wěn)!每一個(gè)輪子都有獨(dú)立的減震彈簧。前進(jìn)、后退、左轉(zhuǎn)、右轉(zhuǎn)操作靈活自如。實(shí)物圖如圖2.4所示。
圖2.4 履帶式小車底盤
2.5 減速齒輪箱
方案1:塑料齒減速齒輪箱
優(yōu)點(diǎn):重量輕、運(yùn)動(dòng)噪聲低。
缺點(diǎn):加載較重物體時(shí),塑料齒輪剛度強(qiáng)度不夠,容易發(fā)生齒輪變形,磨損。
適合:小型輕載小車。
方案2:金屬齒減速齒輪箱
優(yōu)點(diǎn):剛度和強(qiáng)度好,耐磨,傳動(dòng)比精確,扭力更大。
缺點(diǎn):運(yùn)動(dòng)噪聲稍高。
適合:大部分小車都可以,特別適合于重載小車。
小車加載機(jī)械手、電路板和電池等后重量達(dá)到兩公斤,負(fù)載較重,需要能輸出大扭矩的減速齒輪箱,來保證小車在較復(fù)雜的環(huán)境中也能運(yùn)動(dòng)自如;所以采用金屬三級(jí)減速齒輪箱,金屬齒輪為0.6模數(shù)的鋅合金雙聯(lián)齒輪和0.6模的直齒齒輪,雙聯(lián)齒輪1:小齒齒輪:14齒,齒厚5mm;大齒齒輪:46齒,齒厚5mm;內(nèi)孔:Φ3mm; 雙聯(lián)齒輪2:小齒齒輪:14齒,齒厚6mm;大齒齒輪:53齒,齒厚5mm;內(nèi)孔:Φ3mm; 雙聯(lián)齒輪3:小齒齒輪:40齒,齒厚5mm;大齒齒輪:53齒,齒厚5mm;內(nèi)孔:Φ3mm;直齒輸出輪::齒輪:28齒,齒厚5mm;內(nèi)孔:Φ6mm;齒輪嚙合圖如圖2.5。
圖2.5 減速箱齒輪嚙合圖
2.6 小車驅(qū)動(dòng)電機(jī)
基于五自由度機(jī)械手的遙控智能車為適應(yīng)小車的靈活運(yùn)動(dòng)和精確控制機(jī)械手抓取物體,速度分為3檔,用于不同環(huán)境不同速度的需要。
直流電機(jī)的控制方法比較簡單,只需給電機(jī)的兩根控制線加上適當(dāng)?shù)碾妷杭纯墒闺姍C(jī)轉(zhuǎn)動(dòng)起來,電壓越高則電機(jī)轉(zhuǎn)速越高。而且改變正負(fù)極可方便的改變電機(jī)轉(zhuǎn)動(dòng)的方向,方便改變小車的行進(jìn)狀態(tài)。對(duì)于直流電機(jī)的速度調(diào)高,可以采用改變電壓的方法,也可采用PWM調(diào)速方法。PWM調(diào)速就是使加在直流電機(jī)兩端的電壓為方波形式,通過改變方波的占空比實(shí)現(xiàn)對(duì)電機(jī)轉(zhuǎn)速的調(diào)節(jié)。?
綜上所述采用小型380直流電機(jī) ,電機(jī)輸出軸連接模數(shù)為0.6,齒數(shù)為10的齒輪與減速箱一級(jí)雙聯(lián)齒輪相連,實(shí)現(xiàn)小車驅(qū)動(dòng)輪的大扭力輸出。380直流電機(jī)參數(shù)如下:使用電壓范圍?3.0-12V,額定電壓值?9V,無負(fù)荷轉(zhuǎn)速20160,無負(fù)載電流:680MA,最大電流3.8A,額定功率20W,尺寸約:直徑27.7MM,長38MM,軸徑2.3MM,軸長12.7MM,重量:75克。
2.7 機(jī)械臂關(guān)節(jié)驅(qū)動(dòng)
機(jī)械臂采用機(jī)械式驅(qū)動(dòng),需要對(duì)關(guān)節(jié)的驅(qū)動(dòng)電機(jī)進(jìn)行選擇。一種好的電機(jī)不僅
會(huì)給機(jī)械臂的動(dòng)作特性帶來提高,而且在運(yùn)動(dòng)精度上也會(huì)有很大改善,同時(shí)安裝,及控制方式也會(huì)帶來很大便利。目前,市面上的各種機(jī)械臂的驅(qū)動(dòng)電機(jī)有:步進(jìn)電機(jī),伺服電機(jī),舵機(jī)。下面表 2.1,將幾種電機(jī)的特點(diǎn)進(jìn)行比較:
表 2.1電機(jī)的比較
項(xiàng)目 是否反饋 控制精度 低頻特性 過載能力 速度相應(yīng) 成本
步進(jìn)電機(jī) 否 較高 不好 較差 較好 普通
伺服電機(jī) 是 高 好 較好 好 高
舵機(jī) 是 較高 較好 差 較好 低
由上表可以看出,步進(jìn)電機(jī)和舵機(jī)成本較低,伺服電機(jī)從哪個(gè)方面都是較優(yōu)的。
其中步進(jìn)電機(jī)和伺服電機(jī)一般是面向較為大型的工業(yè)機(jī)器人的關(guān)節(jié)驅(qū)動(dòng),而舵機(jī)則常
常應(yīng)用在小型的特殊機(jī)械臂上面,同時(shí)舵機(jī)小巧,安裝方便。本設(shè)計(jì)主要是面向小型
作業(yè)的機(jī)械臂,對(duì)于驅(qū)動(dòng)力沒有太大要求,同時(shí)出于成本考慮,最終選擇舵機(jī)來驅(qū)動(dòng)
關(guān)節(jié)。
選用的舵機(jī)參數(shù)如下:產(chǎn)品名稱:TOWER?PRO(輝盛)最新大扭力舵機(jī)MG996R?(MG995升級(jí)產(chǎn)品)6v/11Kg。廠家編號(hào):MG996R;凈重:55g;產(chǎn)品尺寸:40.7*19.7*42.9mm;產(chǎn)品拉力:9.4kg/cm(4.8V),11kg/cm(6V);反應(yīng)速度:?0.17S/60°(4.8v),0.14 S /60°(6v);工作電壓:?4.8-7.2V;工作溫度:?0℃-55℃;齒輪形式:金屬齒輪;工作死區(qū):?5us(微秒)。實(shí)物圖如圖2.6所示。
圖2.6 MG996R舵機(jī)
3 遙控端電路原理及設(shè)計(jì)
3.1 單片機(jī)的選擇與分析
基于五自由度機(jī)械手的遙控智能車,采用五自由度機(jī)械手五軸聯(lián)動(dòng)控制,打破傳統(tǒng)的一個(gè)個(gè)按鍵微調(diào)的控制方式,實(shí)現(xiàn)空間抓取物體一步到位。控制流程為:五自由度模擬機(jī)械臂采集AD數(shù)據(jù),處理好AD數(shù)據(jù),無線發(fā)送給車載端,車載端接收數(shù)據(jù)后快速響應(yīng),車載五自由度機(jī)械手各個(gè)關(guān)節(jié)舵機(jī)響應(yīng),轉(zhuǎn)動(dòng)相應(yīng)角度,帶動(dòng)車載機(jī)械臂,做和模擬機(jī)械臂相同的動(dòng)作。
用單片機(jī)控制則簡要的流程為:遙控端單片機(jī)發(fā)出指令然后讀取AD值,接著處理AD值,加載打包數(shù)據(jù),發(fā)送給無線模塊,無線模塊發(fā)送數(shù)據(jù);接收端單片機(jī)不斷發(fā)出指令,讀取無線接收模塊收到的數(shù)據(jù),然后處理分析,生成不同寬度的PWM脈寬信號(hào),給機(jī)械臂各個(gè)關(guān)節(jié)的996R舵機(jī),車載機(jī)械臂響應(yīng)完成相應(yīng)角度轉(zhuǎn)動(dòng)。單片機(jī)處理AD數(shù)據(jù),無線發(fā)送數(shù)據(jù),無線接收數(shù)據(jù),產(chǎn)生5路PWM信號(hào),需要花費(fèi)大量的時(shí)間,如果采用普通的51單片機(jī),數(shù)據(jù)處理較慢,難以滿足車載機(jī)械臂和模擬機(jī)械臂同步運(yùn)動(dòng)的要求,需要采用更高處理速度的單片機(jī)。
經(jīng)過查閱資料得知STC12C5A60S2單片機(jī)是宏晶科技生產(chǎn)的單時(shí)鐘/機(jī)器周期(1T)的單片機(jī),是高速/低功耗/超強(qiáng)抗干擾的新一代8051單片機(jī),指令代碼完全兼容傳統(tǒng)8051,但速度快8-12倍。內(nèi)部集成MAX810專用復(fù)位電路,2路PWM,8路高速10位A/D轉(zhuǎn)換(250K/S),針對(duì)電機(jī)控制,強(qiáng)干擾場合。能夠很好的滿足處理速度快,帶AD轉(zhuǎn)換的功能。STC12C5A60S2單片機(jī)特性參數(shù)如下:
1.增強(qiáng)型8051 CPU,1T,單時(shí)鐘/機(jī)器周期,指令代碼完全兼容傳統(tǒng)8051;
2.工作電壓:STC12C5A60S2系列工作電壓:5.5V-3.3V(5V單片機(jī));
3.工作頻率范圍:0 - 35MHz,相當(dāng)于普通8051的 0~420MHz;
4.用戶應(yīng)用程序空間60K字節(jié);
5.片上集成1280字節(jié)RAM;
6.通用I/O口(36/40/44個(gè)),復(fù)位后為:準(zhǔn)雙向口/弱上拉(普通8051傳統(tǒng)I/O口),可設(shè)置成四種模式:準(zhǔn)雙向口/弱上拉,推挽/強(qiáng)上拉,僅為輸入/高阻,開漏,每個(gè)I/O口驅(qū)動(dòng)能力均可達(dá)到20mA;
7. ISP(在系統(tǒng)可編程)/IAP(在應(yīng)用可編程),無需專用編程器,無需專用仿真器 可通過串口(P3.0/P3.1)直接下載用戶程序,數(shù)秒即可完成一片;
8.共4個(gè)16位定時(shí)器 兩個(gè)與傳統(tǒng)8051兼容的定時(shí)器/計(jì)數(shù)器,16位定時(shí)器T0和T1,沒有定時(shí)器2,但有獨(dú)立波特率發(fā)生器 做串行通訊的波特率發(fā)生器 再加上2路PCA模塊可再實(shí)現(xiàn)2個(gè)16位定時(shí)器;
9.A/D轉(zhuǎn)換, 10位精度ADC,共8路,轉(zhuǎn)換速度可達(dá)250K/S(每秒鐘25萬次)18.通用全雙工異步串行口(UART),由于STC12系列是高速的8051,可再用定時(shí)器或PCA軟件實(shí)現(xiàn)多串口;
3.2 小車遙控電路設(shè)計(jì)
采用STC12C5A6OS2為主控芯片,NRF24LO1無線模塊實(shí)現(xiàn)指令發(fā)送,按鍵響應(yīng)相應(yīng)的小車運(yùn)動(dòng)指令,切換攝像頭,開關(guān)小車端的LED夜燈,手動(dòng)控制和超聲波自動(dòng)行駛切
換,數(shù)碼管顯示當(dāng)前速度檔位。具體電路原理圖如圖3.1所示。
圖3.1 小車遙控電路
3.3 模擬機(jī)械臂電路設(shè)計(jì)
模擬機(jī)械臂采用電位器和鋁合金機(jī)械支架做成;操作人員通過操作模擬機(jī)械臂,得到五路模擬電壓,進(jìn)入STC12C5A6OS2主控芯片,進(jìn)行AD轉(zhuǎn)換,轉(zhuǎn)換成數(shù)字量,通過NRF24L01無線模塊發(fā)送信號(hào)。具體電路原理圖如圖3.2所示。
圖3.2 模擬機(jī)械臂發(fā)射模塊電路圖
4 車載端電路原理及設(shè)計(jì)
4.1 小車接收電路設(shè)計(jì)
采用STC12C5A6OS2為主控芯片,NRF24LO1無線模塊實(shí)現(xiàn)指令接收,數(shù)碼管顯示當(dāng)前速度檔位。采用專用芯片L298N作為電機(jī)驅(qū)動(dòng)芯片,一片L298N分別控制兩個(gè)直流電機(jī);單片機(jī)P3.2.P3.3口接HY-SRF05超聲波模塊,具體電路原理圖如圖4.1所示。
圖4.1 小車接收電路
4.2 車載五自由度機(jī)械手電路設(shè)計(jì)
采用STC12C5A6OS2為主控芯片,NRF24LO1無線模塊實(shí)現(xiàn)指令發(fā)接收,單片機(jī)控制PWM,從而輸出信號(hào)給機(jī)械臂的996舵機(jī),舵機(jī)轉(zhuǎn)動(dòng)相應(yīng)角度帶動(dòng)機(jī)械臂轉(zhuǎn)動(dòng),實(shí)現(xiàn)與模擬機(jī)械臂同樣的動(dòng)作。具體電路原理圖如圖4.2所示。
圖4.2 五自由度機(jī)械臂控制
4.3 小車電機(jī)驅(qū)動(dòng)電路
小車采用雙電機(jī)驅(qū)動(dòng),電機(jī)驅(qū)動(dòng)采用L298N專用電機(jī)驅(qū)動(dòng)芯片做成電機(jī)驅(qū)動(dòng)板。L298N是ST公司生產(chǎn)的一種高電壓,大電流電機(jī)驅(qū)動(dòng)芯片。該芯片的主要特點(diǎn)是工作電壓高,最高工作電壓可達(dá)46V;輸出電流大,瞬間峰值電流可達(dá)3A,持續(xù)工作電流為2A;內(nèi)含兩個(gè)H橋的高電壓大電流全橋式驅(qū)動(dòng)器,可以用來驅(qū)動(dòng)直流電動(dòng)機(jī)和步進(jìn)電機(jī),繼電器,線圈等感性負(fù)載;采用標(biāo)準(zhǔn)TTL邏輯電平信號(hào)控制;具有兩個(gè)使能控制端,在不受輸入信號(hào)影響的情況下允許或禁止器件工作;有一個(gè)邏輯電源輸入端,使內(nèi)部邏輯電路部分在低電壓下工作。小車檔位轉(zhuǎn)速采用PWM調(diào)速方法。PWM調(diào)速就是使加在直流電機(jī)兩端的電壓為方波形式,通過改變方波的占空比實(shí)現(xiàn)對(duì)電機(jī)轉(zhuǎn)速的調(diào)節(jié)。驅(qū)動(dòng)電路如4.3所示。?
圖4.3 電機(jī)驅(qū)動(dòng)電路
4.4 小車超聲波避礙模塊
小車在遠(yuǎn)程行駛或作業(yè)時(shí),操作人員通過液晶顯示終端看到的視頻是攝像頭看到的小車周圍的局部圖像,如果小車進(jìn)入狹長曲折的道路時(shí),人為操控小車因?yàn)橐粫r(shí)不能夠完全看清小車的周圍情況,雖然可以通過遙控端控制車載二自由度云臺(tái)來看清周圍的環(huán)境,但是這個(gè)過程比較費(fèi)時(shí);加載了HY-SRF05超聲波模塊則可以在這個(gè)時(shí)候一鍵切換為小車自主駕駛模式,使小車快速自主駛出狹長曲折的空間;另外在進(jìn)入危險(xiǎn)區(qū)域作業(yè)時(shí),啟動(dòng)超聲波自主避障,能夠很好的避開危險(xiǎn)物體,防止小車在人為操作下誤撞危險(xiǎn)物體。超聲波模塊如圖4.4所示。
圖4.4 超聲波模塊
5 無線視頻實(shí)時(shí)傳輸
5.1 無線視頻方案選擇與分析
無線視頻傳輸就是指不用布線(線纜)利用無線電波作為傳輸介質(zhì),在空中搭建傳輸鏈路來傳輸視頻、聲音、數(shù)據(jù)等信號(hào)的監(jiān)控系統(tǒng)。在無線監(jiān)控系統(tǒng)中,無線監(jiān)控中心實(shí)時(shí)得到被監(jiān)控點(diǎn)的視頻信息,并且該視頻信息是連續(xù)、清晰的。在無線監(jiān)控點(diǎn),通常使用攝像頭對(duì)現(xiàn)場情況進(jìn)行實(shí)時(shí)采集,攝像頭通過無線視頻傳輸設(shè)備相連,并通過由無線電波將數(shù)據(jù)信號(hào)發(fā)送到監(jiān)控中心;目前主流的無線視頻傳輸有兩種方案。
方案1:基于網(wǎng)絡(luò)的數(shù)字視頻傳輸,是解決城域間遠(yuǎn)距離、點(diǎn)位極其分散的監(jiān)控傳輸方式,采用MPEG2/4、H.264音視頻壓縮格式傳輸監(jiān)控信號(hào)。優(yōu)點(diǎn):采用網(wǎng)絡(luò)視頻服務(wù)器作為監(jiān)控信號(hào)上傳設(shè)備,有Internet網(wǎng)絡(luò)安裝上遠(yuǎn)程監(jiān)控軟件就可監(jiān)看和控制。缺點(diǎn):受網(wǎng)絡(luò)帶寬和速度的限制,只能傳輸小畫面、低畫質(zhì)的圖像;每秒只能傳輸幾到十幾幀圖像,動(dòng)畫效果十分明顯并有延時(shí),無法做到實(shí)時(shí)監(jiān)控。
方案2:微波信號(hào)模擬視頻傳輸:是解決幾公里甚至幾十公里不易布線場所監(jiān)控傳輸?shù)慕鉀Q方式之一。采用調(diào)頻調(diào)制或調(diào)幅調(diào)制的辦法,將圖像搭載到高頻載波上,轉(zhuǎn)換為高頻電磁波在空中傳輸。優(yōu)點(diǎn):省去布線及線纜維護(hù)費(fèi)用,可動(dòng)態(tài)實(shí)時(shí)傳輸廣播級(jí)圖像。缺點(diǎn):由于采用微波傳輸,頻段在1GHz以上,常用的有L波段(1.0~2.0GHz)、S波段(2.0~3.0GHz)、Ku波段(10~12GHz),傳輸環(huán)境是開放的空間很容易受外界電磁干擾;微波信號(hào)為直線傳輸,中間不能有山體、建筑物遮擋;Ku波段受天氣影響較為嚴(yán)重,尤其是雨雪 天氣會(huì)有嚴(yán)重雨衰想象。
基于五自由度機(jī)械手的遙控智能車,當(dāng)小車在行駛中和用機(jī)械臂抓取物體時(shí),都需要實(shí)時(shí)監(jiān)控;另外基于五自由度機(jī)械手的遙控智能車用于野外作業(yè)時(shí),有便攜式要求,不管在何種環(huán)境下,只要打開液晶顯示終端就能收到視頻,不能夠依賴網(wǎng)絡(luò),否則在沒有網(wǎng)絡(luò)或網(wǎng)絡(luò)信號(hào)不強(qiáng)的環(huán)境下難以作業(yè)。綜合考慮采用方案2符合我們的需求。
5.2 視頻發(fā)送模塊
采用2.4G遠(yuǎn)距離無線監(jiān)控發(fā)射模塊TX6722,TX6722是工作在2414-2468MHz ISM頻段內(nèi)的FM音視頻接收解調(diào)模塊。模塊采用單芯片設(shè)計(jì),該芯片集成了VCO、PLL、寬帶FM視頻解調(diào)、FM伴音解調(diào),模塊體積小功耗低靈敏度高等特點(diǎn)。具體電路原理圖如圖5.1所示。
圖5.1 無線視頻發(fā)送
5.3 視頻接收模塊
采用2.4G遠(yuǎn)距離無線監(jiān)控接收模塊RX6788, RX6788是工作在2414-2468MHz ISM頻段內(nèi)的FM音視頻接收解調(diào)模塊。模塊采用單芯片設(shè)計(jì),該芯片集成了VCO、PLL、寬帶FM視頻解調(diào)、FM伴音解調(diào),模塊體積小功耗低靈敏度高等特點(diǎn);具體電路原理圖如圖5.2所示。
圖5.2 無線視頻接收
5.4 液晶顯示??
采用7寸液晶顯示屏,加驅(qū)動(dòng)板,連接視頻接收模塊信號(hào)線,實(shí)現(xiàn)視頻實(shí)時(shí)顯示;具體參數(shù)為:
產(chǎn)品名稱:7寸高清液晶屏
產(chǎn)品型號(hào):AT070TN92
解析度:800*RGB*480
背光方式:LED
電源輸入:DC 9V-12V
額定功率:2.6W
輸入信號(hào):AV
系統(tǒng)制式:PAL/NTSC
驅(qū)動(dòng)板結(jié)構(gòu)尺寸(mm):73(W)*60(H)*9.2(D)
液晶屏外觀尺寸(mm):164.9(W)*100.0(H)*5.7(D)
工作環(huán)境溫度:Low(-10℃)-High(60℃)
1、一路AV輸入,有PAL制和NTSC兩種制式,可實(shí)現(xiàn)自動(dòng)轉(zhuǎn)換;
2、電位器調(diào)節(jié)亮度及色彩;
3、電源9V--12V范圍;
適用范圍:顯示設(shè)備、可視樓宇對(duì)講、可視門鈴、樓宇對(duì)講、汽車倒車系統(tǒng)、安防監(jiān)控系統(tǒng)、廣告顯示、醫(yī)療設(shè)備、工業(yè)控制等領(lǐng)域。實(shí)物圖如圖5.3所示。
圖5.3 液晶顯示模塊
6 程序設(shè)計(jì)
6.1 編寫程序軟件
采用Keil uVision4進(jìn)行單片機(jī)C語言程序編寫,編譯與調(diào)試。
6.2 遙控小車程序
采用按鍵,數(shù)碼管,增強(qiáng)型單片機(jī)STC12C5A60S2,NRF24L01無線芯片,根據(jù)自己所學(xué)的單片機(jī)知識(shí),電路硬件知識(shí), C語言程序全原創(chuàng),只要操作人員按相應(yīng)按鍵,實(shí)現(xiàn)小車響應(yīng)相應(yīng)指令如:前進(jìn),后退,左轉(zhuǎn),右轉(zhuǎn),加檔,減檔,攝像頭切換,車燈開關(guān)等。部分相關(guān)程序見附錄一:1遙控小車程序。
6.3 模擬機(jī)械臂程序
采用旋鈕電位器,模擬機(jī)械臂支架,增強(qiáng)型單片機(jī)STC12C5A60S2,NRF24L01無線芯片,轉(zhuǎn)動(dòng)模擬機(jī)械臂,五個(gè)自由度關(guān)節(jié)的電位器得到相應(yīng)的模擬電壓值,進(jìn)入STC12C5A60S2處理,進(jìn)行AD轉(zhuǎn)換,此程序部分參考了STC單片機(jī)手冊(cè)程序,自己優(yōu)化,加入自己原創(chuàng)算法,處理相關(guān)AD值,實(shí)現(xiàn)實(shí)際機(jī)械臂與模擬機(jī)械臂同步運(yùn)動(dòng)。部分相關(guān)程序見附錄一:2模擬機(jī)械臂程序。
6.4 小車接收端程序
采用STC89C52RC單片機(jī),NRF24L01無線芯片,L298N電機(jī)驅(qū)動(dòng)芯片,HY-SRF05超聲波模塊,繼電器等組成接收電路;程序響應(yīng)遙控端小車指令,小車作出相關(guān)動(dòng)作;接收到攝像頭切換指令,視頻信號(hào)在機(jī)械手?jǐn)z像頭和小車兩自由度云臺(tái)攝像頭之間切換;接收到開啟LED夜燈命令,小車端開啟夜燈,程序全原創(chuàng)。部分相關(guān)程序見附錄一:3小車接收端程序。
6.5 五自由度機(jī)械臂程序
采用STC12C5A60S2C單片機(jī),NRF24L01無線芯片,組成相關(guān)電路,自己編寫程序,原創(chuàng)算法,控制舵機(jī),帶動(dòng)機(jī)械臂,實(shí)現(xiàn)五自由度機(jī)械臂聯(lián)動(dòng),而且響應(yīng)快速。
舵機(jī)控制中最基本的概念是 PWM 脈沖寬度調(diào)制。脈沖寬度調(diào)制是一種模擬控制方式,其根據(jù)相應(yīng)載荷的變化來調(diào)制晶體管柵極或基極的偏置,來實(shí)現(xiàn)開關(guān)穩(wěn)壓電源輸出晶體管或晶體管導(dǎo)通時(shí)間的改變,這種方式能使電源的輸出電壓在工作條件變化時(shí)保持恒定,是利用微處理器的數(shù)字輸出來對(duì)模擬電路進(jìn)行控制的一種非常有效的技術(shù)。它是把每一脈沖寬度均相等的脈沖列作為PWM波形,通過改變脈沖列的周期可以調(diào)頻,改變脈沖的寬度或占空比可以調(diào)壓,采用適當(dāng)控制方法即可使電壓與頻率協(xié)調(diào)變化??梢酝ㄟ^調(diào)整 PWM 的周期、PWM 的占空比而達(dá)到控制充電電流的目的。 緊接著,舵機(jī)的控制一般需要一個(gè) 20ms 左右的時(shí)基脈沖,該脈沖的高電平部分般為 0.5ms~2.5ms 范圍內(nèi)的角度控制脈沖部分。以 180 度角度伺服為例,那么對(duì)應(yīng)的控制關(guān)系是這樣的:
·0.5ms——0度
·1.0ms——45度
·1.5ms——90度
·2.0ms——135度
·2.5ms——180度
部分相關(guān)程序見附錄一:4五自由度機(jī)械臂程序。
7 結(jié)論與展望
7.1結(jié)論
經(jīng)過三個(gè)半月的的思考、分析、設(shè)計(jì)、選器件、制作、編程、調(diào)試。最終完成了基于五自由度機(jī)械手的遙控智能車各個(gè)部分設(shè)計(jì);整個(gè)過程下來后,對(duì)于如何設(shè)計(jì)一個(gè)五自由度機(jī)械手和制作一個(gè)遙控智能車有了一定的認(rèn)識(shí),同時(shí)也鞏固加深了課本上學(xué)到的機(jī)械和電子設(shè)計(jì)相關(guān)的知識(shí)。不僅如此,將模型制作出來,還鍛煉了自己的動(dòng)手能力。整個(gè)設(shè)計(jì)包含了最基本的機(jī)械設(shè)計(jì),電路設(shè)計(jì),單片機(jī)編程,完成的主要工作如下:
1)進(jìn)行了五自由度機(jī)械手機(jī)械結(jié)構(gòu)的設(shè)計(jì),小車底盤選用和相關(guān)零件的選用和分析。運(yùn)用機(jī)械原理,機(jī)械設(shè)計(jì),機(jī)器人技術(shù)基礎(chǔ)等課程中所學(xué)的知識(shí),對(duì)機(jī)械臂的結(jié)構(gòu)尺寸進(jìn)行了設(shè)計(jì)。
2)對(duì)機(jī)械臂的關(guān)節(jié)驅(qū)動(dòng)進(jìn)行設(shè)計(jì)。對(duì)關(guān)節(jié)驅(qū)動(dòng)的多種方式,進(jìn)行了比較選擇,
在步進(jìn)電機(jī),伺服電機(jī),舵機(jī)中進(jìn)行比較,羅列出各驅(qū)動(dòng)方式的優(yōu)劣,最終選擇性價(jià)
比較高的舵機(jī)來驅(qū)動(dòng)。同時(shí)對(duì)于多路舵機(jī)的驅(qū)動(dòng)方式進(jìn)行了設(shè)計(jì),即多路 PWM 脈沖的
發(fā)生方式的設(shè)計(jì)。
3)對(duì)于控制電路和程序進(jìn)行設(shè)計(jì),包括遙控端小車控制和模擬機(jī)械臂控制系統(tǒng),以及車載端小車運(yùn)動(dòng),超聲波和車載機(jī)械臂控制系統(tǒng)。
4)制作出了實(shí)物,將各部分的設(shè)計(jì)運(yùn)用其中,并且在一定精度許可內(nèi)滿足要求。
操作人員控制模擬機(jī)械臂即可控制車載五自由度機(jī)械臂,簡單實(shí)用;小車運(yùn)動(dòng)通過遙控端無線靈活控制;雙攝像頭,保證工作視區(qū)廣闊;超聲波避障,在一定環(huán)境下實(shí)現(xiàn)自主行駛。
7.2展望
目前對(duì)于基于五自由度機(jī)械手的遙控車有了一定的設(shè)計(jì),但是還是有幾個(gè)方面有待完善,需要在以后的工作研究中深入:
1)五自由度模擬機(jī)械臂的剛度和自鎖性能需要改善。模擬機(jī)械臂采用1mm的鋁合金直角支架和一字支架構(gòu)成,操作人員操控模擬機(jī)械臂的時(shí)候有少量抖動(dòng),從而使采集的AD值不太穩(wěn)定,使車載端五自由度度機(jī)械手有時(shí)抖動(dòng);另外模擬機(jī)械臂關(guān)節(jié)處采用了摩擦片自鎖,長期使用后自鎖性能下降。
2)視頻實(shí)時(shí)傳輸信號(hào)有時(shí)和小車遙控有沖突。因?yàn)椴捎玫亩际?.4GHz信號(hào)無線傳輸,視頻信號(hào)采用的是1W的大功率傳輸,有時(shí)會(huì)干擾小車信號(hào),后期視頻傳輸模塊可以改成1.2GHz或5.8Hz無線傳輸。
28
參考文獻(xiàn)
[1]林志煒. 履帶式移動(dòng)機(jī)器人運(yùn)動(dòng)控制系統(tǒng)設(shè)計(jì)[D].南京理工大學(xué),2008.
[2]肖慧杰. 舞蹈機(jī)器人控制系統(tǒng)研究與設(shè)計(jì)[D].東北大學(xué),2006.
[3]韋積慧. 基于nRF24L01的無線網(wǎng)絡(luò)設(shè)計(jì)與實(shí)現(xiàn)[D].吉林大學(xué),2012.
[4]萬小丹,孔凡讓,李巖,趙小偉. 基于at89c52單片機(jī)的機(jī)器人關(guān)節(jié)控制系統(tǒng)設(shè)計(jì)[J]. 機(jī)電一體
化,2008.
[5] 賈偉濤. 單片機(jī)控制機(jī)械手臂的設(shè)計(jì)與制作[J]. 電子制作. 2006(05) .
[6]付麗,劉衛(wèi)國,伊強(qiáng). 單片機(jī)控制的多路舵機(jī)用PWM波產(chǎn)生方法[J]. 微特電機(jī),2006.
[7] J.L.Martinez,,A.Mandow,,J.Morales,,S.Pedraza,A.Garcia-Cerezo.Approximating kinematics
for tracked mobile robots. Intl.J.of Robotics Research . 2005.
[8] Zhen Wang,Qing Hu,Jie Huang.Design of Wireless Temperature Collection System Based
onnRF24L01. Journal of Electronic Design Engineering . 2009.
[9]Anonymous. Anaren, Inc.; Anaren Releases Application Note/Layout Package for Nordic
Semiconductor Ultra-Low Power, 2.4GHz Transceiver Aimed at Wireless Sports-Device Segment
[J]. Electronics Business Journal,2008.
[10] Tan Guanzheng,Zhu Jianying.Method of mechanism synthesis for biped robots. Transactions of Nonferrous Metals Society of China . 1997.
附錄一
1 部分遙控小車程序:
void main()
{
init_NRF24L01();
P1M1=0x00;
P1M0=0xFF;
P1=Number[speed];
while(1)
{ Getdata();
NRF24L01_Txpacket(TXBuf);
SPI_RW_Reg(WRITE_REG+STATUS,0xFF);
SPI_RW_Reg(FLUSH_TX,0xFF)
}
}
2 部分模擬機(jī)械臂程序:
void main()
{ uchar i;
InitTimer0();
init_NRF24L01();
InitADC();
while(1)
{ for(i=0;i<8;i++)
{ TXBuf[i]=GetADCResult(i)/1.5;
}
}
}
3 部分小車接收端程序:
void init_NRF24L01(void)
{ delayus(10);
CE=0;
CSN=1;
SCK=0;
IRQ=1;
SPI_Write_Buf(WRITE_REG+TX_ADDR,TX_ADDRESS,TX_ADR_WIDTH);
SPI_Write_Buf(WRITE_REG+RX_ADDR_P0,RX_ADDRESS,RX_ADR_WIDTH); SPI_RW_Reg(WRITE_REG+EN_AA,0x00);
SPI_RW_Reg(WRITE_REG+EN_RXADDR,0x01);
SPI_RW_Reg(WRITE_REG+RF_CH,0x4D);
SPI_RW_Reg(WRITE_REG+RX_PW_P0,RX_PLOAD_WIDTH); SPI_RW_Reg(WRITE_REG+RF_SETUP,0x07);
}
4 部分五自由度機(jī)械臂程序:
void main()
{ init_NRF24L01();
InitTimer0();
while(1)
{ SetRX_Mode();
if(IRQ==0)
{ nRF24L01_RxPacket(RXBuf);
LED=~LED;
}
致謝
本設(shè)計(jì)是在指導(dǎo)老師周華茂、康麗春老師的大力支持和悉心指導(dǎo)下完成的。在設(shè)計(jì)過程中我遇到了不少機(jī)械和電子的問題,老師都不知疲倦、不厭其煩的給我分析和講解,而且也給我灌輸了一些先進(jìn)的設(shè)計(jì)方法和設(shè)計(jì)理念,使我大受裨益。他們嚴(yán)肅的科學(xué)態(tài)度,嚴(yán)謹(jǐn)?shù)闹螌W(xué)精神,深深地感染和激勵(lì)著我。從課題的選擇到項(xiàng)目的最終完成,周老師和康老師始終給予我細(xì)心的指導(dǎo)和不懈的支持。在此我謹(jǐn)向周老師和康老師兩位老師致以誠摯的謝意和崇高的敬意。
同時(shí)在設(shè)計(jì)過程中,有機(jī)制1003班王俊斌,電子信息工程1102王新海同學(xué)以及班上同學(xué)的幫助一起探討設(shè)計(jì)課題、步驟、方法等;但是由于該設(shè)計(jì)許多方面的細(xì)節(jié)問題涉及面太廣,而本人知識(shí)面和能力都極其有限,也因?yàn)闀r(shí)間倉促,因而不能科學(xué)詳盡地做出正確的判斷和選擇。所以設(shè)計(jì)中難免出現(xiàn)很多錯(cuò)誤。雖然有這些不足和遺憾,但是總的來說,此次設(shè)計(jì)學(xué)到了很多東西的。并且最終獨(dú)立的完成總體機(jī)械設(shè)計(jì),電路設(shè)計(jì)和程序編寫調(diào)試,成功的完成了老師布置的任務(wù)。如果有不夠完善的地方還請(qǐng)各位老師批評(píng)指正。
本文同時(shí)參考了大量的文獻(xiàn)資料,在此,我要感謝機(jī)械和電子行業(yè)的前輩們,是你們不斷的摸索和高超的智慧總結(jié)出來的經(jīng)驗(yàn)給我夯實(shí)了學(xué)習(xí)的基礎(chǔ),在此表示衷心的感謝。