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 影像感測器、紅外線感測器、超音波感測器、 觸碰感測器、以及人體紅外線感測器來感測週遭環 境的情況,使四足機器人具備環境感知及距離量測 的能力。本計畫同時設計製作一四輪之移動機器人, 並能自主規劃直線及轉彎運動軌跡。