下載/瀏覽

Download Report

Transcript 下載/瀏覽

姓名:李政豪 李茂嘉
學號:99715019 99715034
班級:車輛三甲
步行機器人的足數愈少愈不易平衡,然而足數
過多則愈顯笨拙緩慢。折中的最佳選擇似乎是四足
步行機器人。四足結構容易穩定平衡而且運動速度
較快。四足步行機器人在適應地形環境、運動速度、
攜帶負荷、控制技術及穩定性上都比二足步行機器
人更具有優勢。四足機器人具有CMOS 影像感測器、
紅外線感測器、超音波感測器、觸碰感測器、以及
人體紅外線感測器來感測週遭環境的情況,使四足
機器人具備環境感知及距離量測的能力。

本計畫首先設計製作
一能夠自動充電之四足機
器人,並能自主規劃直線
及轉彎步行步態。四足機
器人的實體圖如圖1 所示。

電池電力量測是設計自
動充電功能的首要條件,由
dsPIC30F6014 微控制器偵
測電池電力,發現電力將不
足夠,則通知dsPIC30F6010
主控制器進入充電模式。而
在機器人的充電座上有裝設
紅外線發射器,四足機器人
能利用此紅外線發射訊號感
測充電座的方向,使其能順
利找到充電座並且坐下充電。
除此之外,還有規劃四足機
器人具備閃避障礙物能力,
利用前方超音波感測器及身
體左右兩方之紅外線感測模
組來感測周圍環境的物體,
進而閃避物體或障礙物。四
足機器人的系統方塊圖如圖
2 所示。

四足機器人頭部裝有
一個CMOS 影像感測器,
作為測距與尋找障礙物之
工具。裝設的CMOS 影像
感測器型號為PAS106BCB283,其實體如圖4

四足機器人的階層式步行控
制分為上層步態控制、中層姿態
與軌跡控制以及最下層的位置伺
服控制,並如圖3 所示。最高層
的運動命令接收及解譯模組為操
作者與機器人之溝通界面。上層
的步態控制可細分為步態產生器
及靜態穩定性判別及修正模組負
責下達各腳底離地及著地時間順
序及位置並維持機器人穩定不倒。
中層的姿態與軌跡控制負責規劃
四足及身體中心軌跡產生器、各
足直接運動學與反運動學的計算
以及各足位置與力量協調控制。
最下層的伺服控制則負責控制各
關節伺服馬達的位置。

本計畫同時設計製作一
四輪之移動機器人,並能自
主規劃直線及轉彎運動軌跡。
四輪移動機器人的運動控制
系統方塊圖如圖6 所示。運
動指令的格式以二個英文字
母為主,視需要再加上一個
整術參數或?號。控制器每
執行完一個指令均會傳回一
個整數值RS232 的通訊格式
為57600、N、8、1。


實驗結果
四足機器人之前進步態
為波浪步態,完成一個完整
的波浪步態需四個步驟,每
一步驟只移動一隻腳,另外
三隻腳則維持身體平衡,亦
即身體之重心位置落在三隻
腳所形成的三角形範圍內。
四足機器人實際行走步態實
驗結果如圖7 所示。此為一
完整行走步態週期,每次步
態週期約費時8 秒,每次前
進距離約8 公分。轉彎步態
為設定前腳向左轉彎角度為
25 度,每次的轉彎週期約
費時8 秒。四足機器人實際
轉彎步態實驗結果如圖8 所
示。

若由身體底部之右方紅
外線接收器收到訊號,表示
充電座位於四足機器人的右
方位置,因此四足機器人會
右轉前進充電。四足機器人
右轉充電實際動作圖如圖9
所示。當四足機器人進入充
電模式時,先利用爬行方式
來搜尋充電座,若偵測到充
電座,則會爬起並右轉行走
到充電座充電。

本計畫完成一能夠自動充電之四足機器人,並
能自主規劃直線及轉彎步行步態。四足機器人具有
CMOS 影像感測器、紅外線感測器、超音波感測器、
觸碰感測器、以及人體紅外線感測器來感測週遭環
境的情況,使四足機器人具備環境感知及距離量測
的能力。本計畫同時設計製作一四輪之移動機器人,
並能自主規劃直線及轉彎運動軌跡。