240 likes | 466 Views
Automatic Robot. 南台科技大學 Southern Taiwan University of Science and Technology. 感測元件控制期末報告 主題 : 循線搬運機器人. 組員 49912907 自控三乙 李汶桓 49912036 自控三乙 翁翊峻 49912097 自 控三 乙 林冠名 49912060 自控三乙 楊承智 49912106 自 控三 乙 徐淯軒 49815043 車輛四乙 鄭立 言 49812092 自 控 四 乙 徐鉅 威 指導教授 : 余遠渠 教授 . Automatic Robot.
E N D
AutomaticRobot 南台科技大學Southern Taiwan University of Science and Technology 感測元件控制期末報告 主題:循線搬運機器人 組員 49912907 自控三乙 李汶桓 49912036 自控三乙 翁翊峻 49912097 自控三乙 林冠名 49912060 自控三乙 楊承智 49912106 自控三乙 徐淯軒 49815043 車輛四乙 鄭立言 49812092 自控四乙 徐鉅威 指導教授:余遠渠 教授
AutomaticRobot • 大綱摘要 • 創作目的 • 設備與器材 • 製作過程 • 一、作動方式 • 二、機構架設 • PID程式控制 • 程式設計 • 一、指令介紹 • 二、完整指令圖 • 參考文獻 • Q&A
AutomaticRobot • 自動化搬運機器人 可以進行自動化搬運作業的 工業機器人。最早的搬運機器人出現在1960年的美國,Versatran和Unimate兩種機器人首次用於搬運作業。搬運作業是指用一種設備握持工件,是指從一個加工位置移到另一個加工位置。搬運機器人可安裝不同的末端執行器以完成各種不同形狀和狀態的工件搬運工作,大大減輕了人類繁重的體力勞動。 搬運機器人是近代自動控制領域出現的一項高新技術,涉及到了力學,機械學,電器液壓氣壓技術,自動控制技術,傳感器技術,單片機技術和計算機技術等學科領域,已成為現代機械製造生產體系中的一項重要組成部分。它的優點是可以通過編程完成各種預期的任務,在自身結構和性能上有了人和機器的各自優勢,尤其體現出了人工智能和適應性。
設計概念 • 此機器人的設計理念為在於方便物品的傳遞和運輸。在用途上有工廠小區塊的運輸工作。
AutomaticRobot • 設備與器材 NXT主機 X1 觸碰感應器 X1 光感測器 X1 超音波感測器 X1 輪子(大)X2 馬達 X3 Lego零件多數
AutomaticRobot • 製作過程 1、作動方式 這次的機構設計上並沒有用到惰輪,而是將輪子組裝在兩側,然後再加裝其他組件加強穩定性,使車子達到行走的目的。如圖所示 圖一、車身右側 圖二、車身左側
AutomaticRobot 2、機構用途 • 超音波感測器: • 用以偵測物體,感測目標物
光源感測器: • 必須有深色線條,就能配合系統循線行走
閘門: 利用閘門來拖行目標物,並防止目標物脫離。
AutomaticRobot • PID程式控制 1、何謂PID控制 PID控制為比例-積分-微分控制。 根據歷史數據和差別出現率來調整輸入值 應用:1.被控對象結構和參數不能完全掌握 2.得不到精確的數學模型 常見NXT應用:1.光源尋跡車 2.追蹤色球 3.二輪平衡車
單光源軌跡車 • 車子是在黑白線上來回移動,並非真的沿著軌跡前進。
白色區塊光源為50,黑色區塊為40,在比較值中設值為45,只要大於45,那表示在白色區塊,便呼叫馬達向右(左)邊調整白色區塊光源為50,黑色區塊為40,在比較值中設值為45,只要大於45,那表示在白色區塊,便呼叫馬達向右(左)邊調整
P(比例)控制 • 比例項的作用是放大誤差的幅值 • 1、在48到50之間:向右修正,且要修正大一點。 • 2、在45到48之間:向右修正,,但修正小一點即可 • 3、等於45:直線前進。 • 4、在42到45之間:向左修正,但修正小一點即可。 • 5、在40到42之間:向左修正,且要修正大一點。
PI(比例-積分)控制 • 主要目的在於消除穩態誤差。 • 積分控制-積分量會隨著時間而增加,直到某一個臨界值時,便會使馬達的輸出增大且讓穩態誤差近一步的減小,直到等於零。
PID(比例-積分-微分)控制 • 克服誤差的調節過程中可能會出現振蕩甚至失穩 • 解決辦法:使克服誤差的作用的變化要有些「超前」 • 增加「微分項」-能預測誤差變化的趨勢
AutomaticRobot • 程式設計 1、指令介紹 左圖為按下觸碰感測器,機器人開始執行Labview程式指令 停止條件為按下NXT面板按鈕,程式停止。
AutomaticRobot 機器人行走PID程式,超音波感測距離小於9時,進行下一步指令。
AutomaticRobot 2、完整指令圖
AutomaticRobot Q & A 1.利用什麼感測器來控制前進?
2.程式要求為馬達控制(PID控制分析),其中之P控制的功能為何?2.程式要求為馬達控制(PID控制分析),其中之P控制的功能為何?