尋線搬運機器人模型及其控制系統(tǒng)設計含開題及6張CAD圖
尋線搬運機器人模型及其控制系統(tǒng)設計含開題及6張CAD圖,搬運,機器人,模型,及其,控制系統(tǒng),設計,開題,cad
一個精確的駕駛差異曲線移動機器人運動規(guī)劃
摘要
一個有固定單一曲率半徑旋轉軌跡建議,旨在將移動機器人駕駛差最優(yōu)軌跡計劃捕捉移動物體。一般來說,當差分驅動一路走來,其旋轉半徑移動機器人的動作不是常數(shù),與旅行距離增加移動機器人跟蹤誤差。此外,跟蹤誤差大大增加,當移動機器人如下與旋轉半徑小軌跡?;谝陨蟽牲c,一個單一的曲率軌跡,它不斷旋轉半徑大,建議作為最優(yōu)軌跡,以盡量減少移動機器人駕駛差分跟蹤誤差。
本文首先回顧了單一曲率軌跡的特點。接下來,一個算法捕捉運動物體的建議恰恰是使用單一曲率軌跡。由于預先確定的初始狀態(tài)(即位置和移動機器人的方向和最后的狀態(tài)),移動機器人是由此捕捉移動物體的。
通過模擬和使用兩自由度的車輪實際試驗為基礎的移動機器人,該算法的有效性得到了驗證。
1.導言
移動機器人的研究被大體分為三種類別:路徑規(guī)劃,位置估計,和驅動控制。
移動機器人軌跡規(guī)劃,旨在提供從初始位置的最佳路徑目標位置。優(yōu)化的移動機器人路徑規(guī)劃提供了一個路徑,它跟蹤誤差最小,最短的行車時間和距離。
移動機器人的跟蹤誤差會導致沖突的障礙由于偏離計劃的道路,也使機器人對未能成功的完成任務。跟蹤誤差減少要通過反饋控制。然而,這需要過度的控制努力是由于高增益控制。
跟蹤誤差也造成了旅行時間的增加,以及旅行的距離,由于需要滿足駕駛的額外調整狀態(tài)。因此,軌跡規(guī)劃,以減少跟蹤誤差是非常重要,需要謹慎處理。
跟蹤誤差的主要原因之一是差分驅動移動機器人在不同的路徑的旋轉半徑不連續(xù)的。在直線和曲線路線,或在一個轉折點連接點的旋轉半徑的變化。
在這幾點,差分驅動移動機器人由于方向的快速變化,很容易的脫離目標軌道。因此,為了減少跟蹤誤差,在移動機器人軌跡必須要有計劃,盡可能使旋轉半徑維持為一個常數(shù)。
跟蹤誤差由于小旋轉半徑增加干擾了移動機器人的準確駕駛。路徑在移動機器人可分為彎曲和直線段,總體看來。雖然跟蹤誤差不在直線部分產生的,產生重大的錯誤,在彎曲的部分,由于離心力和向心力,它使機器人在地面滑動。此外,跟蹤誤差增加旋轉時,半徑小。事實上,直線段可以被看作是一個彎曲的部分,其旋轉半徑無窮大。由于跟蹤誤差變大的彎曲段,一個同在彎曲的道路,旋轉半徑減少跟蹤誤差增長的可能性。請注意,一個相對較小的錯誤在直線路徑發(fā)生。
因此,重要的是要同時保持大并不斷旋轉半徑,以減少差分驅動移動機器人的跟蹤誤差。本文提出了一種單曲率軌跡,它不斷旋轉變大半徑。鑒于規(guī)模和旋轉半徑,單一曲率軌跡和雙曲率連續(xù)軌跡視圖比較顯示,隨著旋轉半徑減少跟蹤誤差增加。通過跟蹤沿每個軌道實驗,證明了單曲率軌跡跟蹤誤差最小。精確軌跡規(guī)劃,一個算法的移動機器人捕捉運動物體的建議。隨著預指定的初始位置和移動機器人的方向和最后的狀態(tài),并假設運動物體的速度是預先估計,最佳捕捉移動機器人路徑作為這項研究的結果產生。
在第2節(jié)用運動學分析移動機器人的駕駛特點,同時分析了移動機器人正在彎曲的議案。單曲率軌跡和雙曲率軌跡說明,在第3節(jié)。第4節(jié),講彎曲的軌跡形成的算法,根據單一曲率軌跡與理論公式.第五節(jié)引入顯示關于跟蹤誤差的比較單一曲率和雙曲率軌跡,在現(xiàn)實的捕捉實驗 。第6節(jié)結束這份文件,為今后的工作議程。
2.移動的移動機器人駕駛差的特
要形成駕駛移動機器人,運動學分析,首先需要不同的軌跡進行。根據運動學分析,移動機器人駕駛差分驅動機制的特點進行建模,它提供了軌跡規(guī)劃的理論基礎。
2.1 運動學分析的移動機器人
如圖所示。 1A是一個差分驅動機制的移動機器人有兩個在同一軸線車輪,每個車輪是由一個獨立的電機控制。讓我們定義Vl為左車輪速度,Vr為右車輪速度,l表示兩個輪子之間的距離。機器人的馬達決定兩輪的速度,vL 和 vR表示線速度和角速度,移動機器人vL和VR可以表示為:
一個有差分驅動機制的移動機器人運動學模型,可以說,如圖1b中所示.
兩個X _Y笛卡爾坐標,對移動機器人的狀態(tài)用(t)和(t)表示,而方向用(t)表示.同時,用 和代表線性速度,代表角速度。在移動機器人速度矢量定義為:
現(xiàn)在,移動機器人運動學模型可以同樣地可以表示為
2.2 驅動移動機器人的原則
通過運動學分析,可以確認,移動機器人的運動狀態(tài)與差分驅動機制改變的兩個輪子的速度。當多個輪子的機器人繞瞬間旋轉中心旋轉時,這個旋轉中心被稱為ICC(瞬時曲率中心)。如圖2b所示。ICC是位于橫截面的擴展點的車輪中心的路線。對于一個差分驅動機制的移動機器人,ICC可以設在方向盤上的任何軸點,因為這兩個輪子軸在同一行。在這種情況下,ICC將取決于兩個輪子之間的速度比。圖 3說明ICC隨著機器人的運動和的位置改變。一個車輪之間的速度和車輪到ICC的距離成比例關系,如圖所示。
同樣地,上式可簡化為:
請注意,移動機器人旋轉半徑是左,右前輪速度值確定。當機器人耕作跟蹤一條直線時,
R =1,vR = vL。當vR != vL,機器人遵循某種旋轉半徑曲線軌跡。因此,速度和加速度的機器人改變,造成旋轉半徑是多種多樣的。當移動機器人在A點時,其坐標為,此時時間=T,到B,其坐標為, 時間 = t + d t,
在時間= t + d t時,ICC坐標可動態(tài)確定為
現(xiàn)在,機器人的運動位置,時間 = t + d t,可以來表示根據ICC和角位置
速度Vx,如下:
(a) 移動機器人的速度 (b) 機器人位置的表示形式
圖1 一種移動機器人的運動學模型
圖3 曲率
圖4 機器人移動中心
現(xiàn)在,移動機器人從A運動到B地點總距離d和旋轉角度u可表示如下:
利用這些方程,當旋轉半徑,運動距離,以及移動機器人旋轉角度事先確定,所需的線性和角速度,可變區(qū),虛擬現(xiàn)實和VX可以動態(tài)獲取,當機器人是在行駛的曲線路徑運行時。
3.曲率軌跡
3.1 運動特性曲線
曲率,K是定義為移動機器人從一個點P旋轉至Q 時,Dh 與 Ds比值,如圖4所示。也就是說,曲率的定義是:
旋轉半徑可以定義為曲率的倒數(shù),p=1/k,其中k〉0。從方程(11),可看出,總沿曲線的距離,弧的長度是與曲率成正比。K是成反比Ds的,曲率K也與曲線半徑成反比。如果k = 0,則曲線半徑,即旋轉半徑,成為無限。請注意,使得k = 0意味著一條直線,這是一種無限的半徑。
當移動機器人沿著彎曲的軌跡前進,旋轉半徑對跟蹤誤差產生嚴重影響。一般來說,移動機器人沿著一條直線(k= 0)比曲線路徑(k!=0)錯誤的可能性更小。從理論上說,一個彎曲的軌跡,可以計算出均衡器。 (6) - (8),假定純滾動和非滑移條件。
但是,實際駕駛可能導致與理論值的一些不同。當一個移動機器人路徑彎曲后,有離心和向心合力。車輪與地面之間的摩擦力,作為ICC的向心力,維護了移動機器人曲線運動摩擦力。在理想的條件下滑動,跟蹤誤差為零。然而,在實際情況下,總會有一個跟蹤誤差造成的延誤。在離心力的作用,可以制定作為一個旋轉半徑R和速度v函數(shù):
其中m是機器人的質量和c是一個比例常數(shù)。圖 5說明了移動機器人駕駛的情況,從A出發(fā),走曲線路徑。在理想的條件下,機器人,估計情況會如B1。然而,在實際情況下,通過機器人到達跟蹤誤差在B2。目前已經進行,在減少跟蹤誤差小的旋轉半徑和高運行速度進行了許多研究。.圖 6顯示了一個真正的移動機器人誤差的特點,根據運動半徑和速度。右前輪的時速保持在恒定的,而左車輪被更改,以推動在一個彎曲移動的機器人。
隨著左車輪速度增加,以及跟蹤誤差的增加。還要注意的是一個小的旋轉速度,即使保持半徑不變跟蹤誤差也會增加。從對圖6的分析,可以得出結論,一個一個較小的旋轉半徑和更高的速度移動機器人的跟蹤誤差,同時提高了移動機器人沿著彎曲的道路運動。
圖5 移動機器人曲線的路徑傳動誤差
圖6 移動速度和曲線半徑的偏差
3.2 單曲率軌跡
圖7A和b分別代表單曲率和雙曲率軌跡。雙曲率軌跡又一對稱形狀的拐點。單曲率軌跡保持相同的曲率,而雙曲率軌跡改變其方向和曲率在拐點。圖7C表示了軌跡曲率隨機變化,即拐點在幾個地方存在。雖然移動機器人正沿軌跡7c。當旋轉半徑,運動方向的改變時,車輪速度需要改變,按照式(7)。
同樣的運動距離,圖7A顯示了最大的旋轉半徑,而其他有不同的小半徑。因此,可以預見,當移動機器人沿著單一軌道曲率旅行,它有最少跟蹤誤差。圖 8顯示了模擬單曲率和雙曲率軌跡形狀。
使用公式 (6)-(11),旋轉半徑,行駛距離,旋轉角度,以及ICC的位置,得到表1。運行的總距離單曲率和雙曲率軌跡相同。然而,旋轉半徑的單曲率軌跡2倍的雙曲軌道大。具體來說,旋轉半徑的單曲率軌跡5.0米,而另外的雙曲率是2.5米,它的拐點在(2.5,2.5)。接近圖6和7的顯示值,導致期望單一曲率的軌跡會比雙曲軌跡跟蹤誤差小。通過實時實驗,單曲率軌跡和雙曲率軌跡跟蹤誤差可以相互定量比較,。
?對移動機器人在最后位置方向,并非只對雙曲率軌跡,因為另一個轉折點曲率軌跡是必要的,以匹配方向移動機器人單曲率軌跡。
4.1 預先假設
根據不同的運動物體的狀態(tài)和移動機器人,為移動機器人最優(yōu)軌跡可能會有所不同。因此,在本文,是一個移動機器人最優(yōu)軌跡規(guī)劃,其中認為對運動物體的運動的限制,以及移動機器人。
首先,移動的物體其線速度和角速度,表示如下:
(a) 單-曲率 (b) 雙曲率 (c) 復雜-曲率
圖7 曲率類型
(a) 單-曲率 (b) 雙曲率
圖8單曲率和雙曲率軌跡
根據方程(14)和(15),對移動物體的運動從最初的位置僅限于直在勻速直線運動。據推測,移動機器人保持靜態(tài)的,開始時,應該有相同的速度和在目前的捕捉運動物體的方向。 移動機器人最優(yōu)路徑規(guī)劃,主要有兩個考慮因素:運動時間和跟蹤誤差。如果速度加快,最低的行車時間移動機器人移動時,跟蹤誤差會增加一個彎曲的路徑。因此,駕駛時的最低條件和跟蹤誤差在移動機器人的最小線速度和加速度范圍內。
其表示如下:
其中Vmax是最大允許線速度和amax最大允許加速度。
對于一個給定的路徑最基本的駕駛時間,加速移動機器人選擇在允許的范圍內加速范圍內,最高速度。此外,在移動機器人的最高速度被限制在最小范圍內允許的最大范圍內跟蹤誤差。
4.2 獲得移動物體的移動機器人的狀態(tài)
由于移動機器人最優(yōu)路徑可以根據運動物體的移動機器人的狀態(tài)創(chuàng)建,在移動機器人狀態(tài)和運動物體的需要定義為成功的移動機器人路徑規(guī)劃準確。
如圖9所示,一個移動物體的位置和移動機器人的定義為兩個三維笛卡爾變量x和y,以及方向變量h,然后,面向對象的移動,hobj,表示為
運動物體的初始位置,,可以表示為
現(xiàn)在,移動物體的線速度,vobj,可以計算如下:
在移動機器人的初始位置被表示為
在移動機器人的使命要求,它開始捕獲了以固定的初始位置恒定速度運動的物體。如果移動機器人具有相同的速度,并在最后的位置定位移動物體,移動物體將被移動機器人輕易抓獲。
圖9 移動機器人與移動對象的初始狀態(tài)
4.3 確定路徑
根據移動機器人和物體的初始狀態(tài),無論選中是單或雙曲率軌跡。單一曲率軌道存在的條件是獲得,這是一個有趣的觀察,這項研究產生的如圖10所示。當沿單一曲率移動機器人移動的軌跡,從A至D可減少自彎曲運動延誤,可以跟蹤誤差最小化。
因此,在移動機器人可以捕捉運動物體時,正是具有相同的速度和移動物體。如果軌跡和運動物體的位置,方向被準確估計,預計捕捉位置D (xD,yD)為:
在這種情況下,C的坐標(xC,yC),可以從運動物體的初始狀態(tài)和移動機器人的所得如下:
其中(xI,yI)代表了運動物體的初始位置。ICC坐標單曲率軌跡,和旋轉半徑為R,可以表示如下:
還有一些單一曲率軌跡不能產生的情況,由于軌跡取決于移動機器人的狀態(tài)和運動目標。如圖11所示,如果移動機器人與運動物體的角度和方向的區(qū)別是不積極,單曲率軌跡不能滿足在最后的位置捕獲條件。在這種情況下,雙曲率軌跡被選擇為最佳路徑,而不是單一曲率。在這種情況下,一個移動機器人軌跡分解為路徑1和路徑2。根據移動對象和移動機器人,旋轉半徑和ICC的坐標被決定(見圖12)。
從最初的狀態(tài),坐標ICC1和 ICC2, ,表示如下:
對路徑1和路徑2的旋轉半徑選擇相同可減少跟蹤誤差,以及旋轉半徑可以表示為
請注意,移動機器人的方向是在轉折點,改變了雙曲率軌跡。
4.4設計文件的速度
移動機器人的速度決定的運動物體的速度和駕駛距離捕獲的對象。在單曲率軌跡的移動機器人線速度分為三個部分:加速,勻速和減速。在移動機器人線速度可以表示如下:
其中T是移動機器人的總行車時間。
根據移動機器人運動學,車輪速度,vR 和vL,以及移動機器人角速度hR,確定如下:
對于雙曲軌跡,兩個速度分布是必要的。也就是說,在拐點的移動機器人暫時停止和改變的速度分布。
5實驗
5.1實驗環(huán)境
實驗是在智能機器人實驗室.地板平整,光滑。移動機器人的實驗中使用的是三輪的驅動機制不同兩個自由度的移動機器人。在實施主計算機遠程控制使用串行的通道。在移動機器人有一個 DSP320LF2407A控制板來控制的電機。
一個10位編碼器安裝在移動機器人每個車輪。對于運動物體的采樣周期是1 / 30秒。對移動機器人的硬件規(guī)格如表2。
表2 移動機器人的硬件列表
5.2實驗表明單一曲率軌跡優(yōu)勢
在前兩個實驗,同樣的移動機器人移動的單,雙曲率,曲率軌跡捕獲如圖14所示移動對象。跟蹤誤差測量和比較圖15。在計算單曲率和雙曲率軌跡表1可見,用來捕捉移動物體。正如15圖所示。為雙曲率軌跡跟蹤誤差的增長十分迅速,而單軌跡慢慢增加。通過這些實驗,可以得出結論,一個單一曲率軌跡是精確跟蹤運作的最佳,除非它是不可能的。
圖15 尋跡誤差比較
5.3實驗的捕獲軌跡
允許加速度被設置為0.1?常用和運動物體的線速度是假設恒定在0.3米/秒抽樣時間是0.1秒?;谠撍惴ǎ瑔吻受壽E,計劃捕捉如圖16A所示移動對象。與單一曲率軌跡的實驗結果如圖16B所示。以及規(guī)格和單曲率軌道實驗結果總結在表3。
(A)理論單曲率曲線 (B)實際運動曲線
圖17 機器人捕捉曲線
當單曲率軌跡不可用,雙曲率軌跡被選擇,而不是單一曲率軌跡最優(yōu)軌跡捕捉移動物體。圖 17A說明路徑的移動機器人應遵循捕捉運動物體沿著雙曲軌道上。與雙曲彈道實驗結果如圖17B所示。以及規(guī)格和雙曲率彈道實驗結果總結在表4.通過這些實驗,它再次證實了雙曲率軌跡具有比單曲率較大的軌跡跟蹤誤差。即使軌跡生成過程不是說明在這一節(jié)中。該算法在第4節(jié)解釋了一個成功的跟蹤和捕捉重要的作用。
表3 單-曲率軌跡的實驗結果 表4 雙曲率彈道實驗結果
(A)理論雙曲率曲線 (B)實際運動曲線
圖17 機器人雙曲率捕捉曲線
結論
本文為一個差分驅動移動機器人最優(yōu)路徑規(guī)劃新算法被提出。其中造成跟蹤移動機器人誤差的因素很多,路徑的曲率是深入分析本文,因為它可以不執(zhí)行以進行任務的選擇。
這項研究表明了精確的彎曲議案單一曲率軌跡最優(yōu)。一個精確的曲線運動,運動物體的捕捉,是真正的實驗說明。在單曲率軌跡優(yōu)勢已核實的基礎上從理論和實際觀測實驗。由于與航位推算傳感器只能總額估計誤差的位置移動機器人當他們航行,一個誤差校正算法,以支持精確和及時的控制。頻繁的糾錯過程降低了行駛性能至關重要,并可能導致不穩(wěn)定的行動。提供一個軌跡這會導致更少的錯誤,是非常有效的精確和快速彎跟蹤移動機器人駕駛差的議案。為了提高移動機器人駕駛的準確性,在未來的研究中,智能位置估計計劃和駕駛控制算法將不得不進一步發(fā)展。
鳴謝
這項工作是由支持MIC和國際熱帶農業(yè)研究所的一部分,通過領先的IT研發(fā)支持項目。
移動機器人軌跡跟蹤的控制設計方法
摘要
基于微分幾何理論,運用相對階動態(tài)擴展的方法,對移動機器人的運動誤差模型的精確反饋線性化的實現(xiàn)。軌跡跟蹤控制器被用來設計極點配置法。當角的移動機器人的速度永遠為零,當?shù)貪u近穩(wěn)定控制器的設計。當角的移動機器人的速度并非永久為零,軌跡跟蹤全程跟蹤與控制策略的約束給出。該算法簡單,應用方便。仿真結果表明其有效性。
關鍵詞:軌跡跟蹤;動態(tài)擴展的方法;精確反饋線性化;在全程范圍內跟蹤約束
1 導言
最近,在移動機器人跟蹤控制利益與不同的理論和實踐作出的貢獻正在增加。特別是,反饋線性化,吸引近非線性控制理論的研究的極大興趣,一些技術已在路徑跟蹤控制的移動機器人有幾種類型由線性化的靜態(tài)和動態(tài)方法研究了移動機器人的就業(yè)問題反饋。當?shù)睾腿騿栴},通過跟蹤時變狀態(tài)反饋基于反演技術都已經解決了。由于四輪驅動移動機器人非完整約束,從制約了移動機器人的滾動車輪出現(xiàn)打滑的情況下與線性非完整約束移動機器人具有可控性不足,很難控制他們。穩(wěn)定問題,這一點可以被視為新一代的控制輸入驅動從任何初始點機器人的目標點。在這一個事實,即移動機器人模型不符合售書的著名必要的順利反饋鎮(zhèn)定的條件,因此移動機器人不能穩(wěn)定與穩(wěn)定問題的中心,關鍵的問題平穩(wěn)狀態(tài)反饋,從而導致在應用的限制。因此,一些離散時不變的控制器,時變控制器和基于Lyapunov混合控制器控制理論基礎已提出。
全面軌跡跟蹤問題,參考討論移動機器人基于反演技術在[5]。軌跡跟蹤問題的參考移動機器人的基礎上,討論終端滑模在[6技巧],但它需要非零的旋轉速度。點穩(wěn)定的移動機器人通過狀態(tài)空間的精確反饋線性化動態(tài)擴展的方法,提出了[7]。在極地幀點鎮(zhèn)定問題可以較準確地轉化為控制線性時不變系統(tǒng)的問題。但其缺點是要求復雜合核查。而點鎮(zhèn)定問題只討論軌跡跟蹤,但沒有得到解決。
在本文件中,軌跡跟蹤的提法,[5]和[6]是針對移動機器人的基礎上在[7動態(tài)擴展的方法]。關于移動機器人的運動誤差模型的精確反饋線性化的實現(xiàn)。其證明是簡單的,從[7個不同]自核查合復雜的過程,是可以避免的。通過線性,非線性系統(tǒng)轉移到線性時不變系統(tǒng),相當于兩個降階線性時不變的,可以很容易控制系統(tǒng)。如果角度的移動機器人的速度永遠為零,當?shù)貪u近穩(wěn)定控制器的設計。如果角
移動機器人的速度并非永久為零,軌跡跟蹤全球跟蹤與控制策略的約束給出。該算法簡單,應用方便。
2.預備知識及問題描述
考慮一個描述為一類非線性系統(tǒng)
定義(Slotine和李和鋒和費)。鑒于X是一個n維微流形,如果存在的x0附近V和整數(shù)向量使得
?
非奇異8xAV,我們說系統(tǒng)(1)–(2)公式的相對程度er1,R2的:y在點x0:引理(豐和費)。
系統(tǒng)必要和精確反饋線性化的充要條件為x0(1)是存在一個x0附近V和光滑實值函數(shù),使得系統(tǒng)(1)–(2)的相對是矢量車輪運動的模型驅動的移動機器人如下:
其中(x,y)是移動機器人的位置和y是航向。移動機器人的控制變量的線性速度v和角速度?:在這里,軌跡跟蹤的問題是要跟蹤已知的姿態(tài)不怕參考移動機器人; yrT和速度vr;,如圖1所示。我們擁有的移動機器人姿態(tài)誤差方程[5,6]
因此,我們的姿態(tài)誤差差分方程
從上述的分析,軌跡跟蹤問題的參考移動機器人可以表述為:發(fā)現(xiàn)有界輸入v和?使一個任意初始誤差,系統(tǒng)狀態(tài)可由附近,也就是說
3 設計的軌跡跟蹤控制器
顯然,系統(tǒng)(5)不能精確反饋空間狀態(tài)線性化。它不能輸入/輸出反饋線性化選擇出y1 = ye; y2 = ye:這是因為系統(tǒng)(5)沒有相對程度。其實很明顯,去耦矩陣是奇異的。
證明,區(qū)分輸出方程y1 = x2,y2 = X3的話,我們有
從(11)和(13),我們有解耦矩陣
從(14)我們有
因此,根據y1 = x2,y2 = X3,角速度oa0;系統(tǒng)(9)有相對程度和;使用第2引理,存在局部的微分,使系統(tǒng)(9)線性準確。局部的微分和改變狀態(tài)的定義如下:
輸入變換的定義如下:使用式 (10)–(13), (16)和 (17), 系統(tǒng) (9)可以轉化為線性時不變系統(tǒng):
其中是新的矢量;是新的控制輸入。
非線性系統(tǒng)(9)轉化為線性時不變系統(tǒng)的狀態(tài)和輸入轉換(16) - (17)對于線性時不變系統(tǒng)(18) - (19),我們可以應用已知,極點配置方法的線性控制方法實施控制,因此,我們有以下定理和定理2。假設角速度Oa,當系統(tǒng)(9)是由控制器(20a)控制,它具有局部漸近穩(wěn)定。如果oa0不能滿足,系統(tǒng)(9)是由控制器(20A)和(20B)交替控制,它已在全局范圍內引用跟蹤與已知的移動機器人坐標和速度Vr。其中e是一個給定的任意小的正數(shù)。證明,根據角速度oa0,從定理1,系統(tǒng)(9)可轉化為線性時不變系統(tǒng)(18) - (19)。顯然,式(18) - (19)是完全可控和完全觀察。它包含兩個減少,為了獨立的子系統(tǒng)
其中.i=1,2;其參數(shù)為:
使矩陣 , ,它們分別是:
證明,根據角速度oa0,從定理1,系統(tǒng)(9)可轉化為線性時不變系統(tǒng)(18)–(19)。顯然,系統(tǒng)(18)–(19)是完全可控和完全觀察。它包含兩個減少為獨立的子系統(tǒng)。
眾所周知,線性時不變系統(tǒng)(22)可以很好地通過極點配置的方法控制。
? 角速度oa0如果不能滿足,以保證控制的實現(xiàn),我們選擇合適的小的正數(shù)e,可以指定人為根據實踐的要求進行,這樣,jojXe用來控制(20A),jojoe用來控制器(20B)。因此,控制器(20A)和(20)被交替使用,可以保證職權范圍內的跟蹤與移動機器人
已知的動態(tài)yrT和速度VR,從(20)我們可以看出,控制輸入v和o的范圍內,只要在O'R的范圍內。
4 仿真研究
我們實施仿真研究,驗證了跟蹤控制器(20A)和(20B)的有效性。在模擬,如初始條件的參數(shù),所需的速度和反饋增益列于表1。我們選擇了兩個時間不變系統(tǒng)(22 )和(22B),同圖2-5顯示了移動機器人反饋增益軌跡跟蹤控制的反應。圖2和3顯示了模擬結果如下,移動機器人的直線,其中控制器(20A)和(20B)被交替使用,以保證有界跟蹤引用或移動機器人or=0。從無花果。 2和3,我們看到,跟蹤性能好,雖然T=0之前5秒,它在接近零。從圖 4和5的仿真結果表明,移動機器人如下的曲線。從圖4和5,我們看到,跟蹤性能更好。和所有有界控制器,保證了控制的實現(xiàn)。
圖3 引用具有時變速度的移動機器人
圖4 引用具有恒定速度的移動機器人
圖5 引用具有時變速度的移動機器人
5 結論
?? 在實踐中,使移動機器人得到一些狀態(tài)和速度,我們可以假設參考這些姿態(tài)和速度移動機器人,并考慮軌跡跟蹤問題的參考移動機器人。
在這個文件中,軌跡跟蹤問題,引用是針對移動機器人基于動態(tài)擴展的方法。確切的反饋對移動機器人運動誤差模型線性化的實現(xiàn)。非線性系統(tǒng)轉移到二降階線性時不變的,可以很容易控制系統(tǒng)。下面的控制得以實現(xiàn),也就是說,如果在移動機器人角速度永久為零,當漸近穩(wěn)定控制器的設計。如果角度的移動機器人的速度并非永久為零,軌跡跟蹤的全局策略的約束給出跟蹤軌跡。該方法是簡單而有效的。
鳴謝
作者是感謝副主編并提出了寶貴的意見和建議裁判
一、畢業(yè)設計(論文)的內容
1、收集移動機器人相關資料;
2、深入學習電動機的單片機控制技術;
3、設計并制作尋線搬運機器人模型及其搬運引導系統(tǒng);
4、設計移動機器人的控制電路和程序;
5、驗證設計結果;
6、撰寫畢業(yè)設計說明書、翻譯英文資料、繪制機械圖。
二、畢業(yè)設計(論文)的要求與數(shù)據
1、移動機器人搬運路線的彎道半徑不大于 300mm,移動機器人的運動線路示意圖、移動機器人模型的結構圖采用 AutoCAD 或 CAXA 軟件繪制并打?。?
2、移動機器人由單片機控制,采用電池供電,能自動前后尋線運動搬運物體, 當沒有需要搬運的物體時自動等待,當運動線路的前方 300mm 處有障礙物時停止運動并報警,障礙消失后自動繼續(xù)運動;
3、采用 Protel99se 軟件繪制和打印系統(tǒng)的電路原理圖,電路原理圖標明全部零部件和元器件的型號或主要參數(shù);
4、采用 C51 語言設計控制程序,控制程序同時用程序流程框圖和 C 代碼表示, 程序流程框圖盡量細化并用計算機繪制打印,C 代碼添加詳細的中文注釋;
5、畢業(yè)設計說明書 2 萬字左右,主要內容包括移動機器人概述、移動機器人運動引導系統(tǒng)設計、移動機器人模型結構設計、控制系統(tǒng)電路設計、控制程序設計、以及控制效果報告,設計說明書包括 300~500 個單詞的英文摘要;
6、翻譯與設計題目相關的英文資料,翻譯量不少于 4 萬字符,同時附英文資料原文,翻譯資料的內容由指導教師另外指定;
7、機械圖的繪圖量折合 A0 幅面 1 張,用 AutoCAD 或 CAXA 軟件繪制并打印。
三、畢業(yè)設計(論文)應完成的工作
1、畢業(yè)設計說明書一份;
2、英文資料翻譯一份;
3、運動線路示意圖、機械圖、電路圖、程序流程框圖一套;
4、移動機器人模型一個;
5、畢業(yè)設計電子文檔一份。
四、應收集的資料及主要參考文獻
[1] 郭丙華, 胡躍明. 移動機器人計算機控制[J]. 計算機測量與控制, 2003, 11(10):749~750,766.
[2] 關健生. 基于單片機的聲音導航定位系統(tǒng)的設計[J]. 信息系統(tǒng)工程, 2009, 28(9):86~89.
[3] 霍成立, 謝凡, 秦世引. 面向室內移動機器人的無跡濾波實時導航方法
[J]. 智能系統(tǒng)學報, 2009, 4(4):295~302.
[4] 馬兆青, 袁曾任. 基于柵格方法的移動機器人實時導航和避障[J]. 機器人, 1996, 18(6):344~348.
[5] 姜志兵, 趙英凱. 基于虛力柵格法的移動機器人實時避障和導航[J]. 機床與液壓, 2007, 35(05):91~93.
[6] 徐國華, 譚民. 移動機器人的發(fā)展現(xiàn)狀及其趨勢[J]. 機器人技術與應用, 2001, (3):7~14.
[7] 張明路, 丁承君, 段萍. 移動機器人的研究現(xiàn)狀與趨勢[J]. 河北工業(yè)大學學報, 2004, 33(2):110~115.
[8] Soonshin Han, ByoungSuk Choi, JangMyung Lee. A precise curved motion planning for a differential driving mobile robot[J]. Mechatronics, 2008, 18(9):486~494.
[9] Felipe N. Martins, Wanderley C. Celeste, Ricardo Carelli, Mário Sarcinelli-Filho, Teodiano F. Bastos-Filho. An adaptive dynamic controller for autonomous mobile robot trajectory tracking[J]. Control Engineering Practice, 2008, 16(11):1354~1363.
[10] Shuli Sun. Designing approach on trajectory-tracking control of mobile robot[J]. Robotics and Computer-Integrated Manufacturing, 2005, 21(1):81~85.
五、試驗、測試、試制加工所需主要儀器設備及條件
計算機
任務下達時間:
2010 年 1 月 12 日
畢業(yè)設計開始與完成時間:
2010 年 3 月 1 日至 2010 年 6 月 20 日
組織實施單位:
教研室主任意見:
簽字: 2010 年 1 月 8 日
院領導小組意見:
簽字: 2010 年 1 月 11 日
1.畢業(yè)設計的主要內容、重點和難點等
一、畢業(yè)設計(論文)的內容:
收集移動機器人相關資料;深入學習電動機的單片機控制技術;設計并制作尋線搬運機器人模型及其搬運引導系統(tǒng);設計移動機器人的控制電路和程序;驗證設計結果;撰寫畢業(yè)設計說明書、翻譯英文資料、繪制機械圖。
二、重點是:電動機的單片機控制技術,尋線搬運機器人模型的設計和制作,移動機器人運動引導系統(tǒng)設計、移動機器人模型結構設計、控制系統(tǒng)電路設計、控制程序設計。
三、難點是:巡線機器人控制電路及傳感器信號處理電路的設計與實現(xiàn),控制系統(tǒng)電路設計、控制程序設計。
2.準備情況(查閱過的文獻資料及調研情況、現(xiàn)有設備、實驗條件等)
一、文獻資料:
[1] 郭丙華, 胡躍明. 移動機器人計算機控制[J]. 計算機測量與控制, 2003.
[2] 關健生. 基于單片機的聲音導航定位系統(tǒng)的設計[J]. 信息系統(tǒng)工程, 2009.
[3] 霍成立, 謝凡, 秦世引. 面向室內移動機器人的無跡濾波實時導航方法[J]. 智能系統(tǒng)學報, 2009.
[4] 馬兆青. 基于柵格方法的移動機器人實時導航和避障[J]. 機器人, 1996.
[5] 姜志兵. 基于虛力柵格法的移動機器人實時避障和導航[J]. 機床與液壓.
[6] 徐國華, 譚民. 移動機器人的發(fā)展現(xiàn)狀及其趨勢.機器人技術與應用, 2001.
[7] [美]David Cook 機器人制作入門篇,北京航天航空大學出版社,2005.
[8] 黃賢武,鄭莜霞,傳感器原理及應用,2004.3.
[9] 張毅,羅元,移動機器人技術及其應用,2007.9.
[10][美] Gordon McComb,Myke Predko,機器人設計與實現(xiàn),2007.
二、實驗設備及條件:
實驗室提供的通用儀器及自己購買的一些電子元器件。
3.實施方案、進度實施計劃及預期提交的畢業(yè)設計資料
一、實施方案:
收集移動機器人相關資料,深入學習電動機的單片機控制技術,制作尋線搬運機器人模型及其搬運引導系統(tǒng),設計移動機器人的控制電路和程序,驗證設計結果。
二、進度實施計劃:
3月至4月初搜集文獻及資料,深入對其控制原理和控制方法的理解,掌握各種電子元器件的原理及應用,對電路設計和控制部分重點學習。4月初至5月初設計和制作的尋線搬運機器人模型,設計運動引導系統(tǒng)、設計模型結構、設計控制系統(tǒng)電路、設計控制程序,制作模型及其搬運引導系統(tǒng)。5月調試系統(tǒng);撰寫說明書、繪制機械圖。
三、應提交的畢業(yè)設計資料:
畢業(yè)設計說明書;英文資料翻譯;運動線路示意圖、機械圖、電路圖、程序流程框圖;移動機器人模型;畢業(yè)設計電子文檔一份。
指導教師意見
該生對設計任務和設計要求已基本明確,進度計劃安排基本可行,準備工作已基本就緒,同意按計劃展開設計工作。還應進一步分析資料,把握設計重點,抓緊制作機器人模型,以便后續(xù)電路和程序的設計與調試。要特別注意控制程序的設計方法。
指導教師(簽字):
2010年3月5日
開題小組意見
開題小組組長(簽字):
2010年3月 日
院(系、部)意見
主管院長(系、部主任)簽字:
2010年3月 日
- 3 -
目 錄
引言 1
1 緒 論 2
1.1 移動機器人概述 2
1.1.1巡線機器人的發(fā)展 2
1.2 移動機器人的設計思路 5
1.3 課題設計的任務和要求 5
2 移動機器人總體設計 7
2.1移動機器人整體設計 7
2.2移動機器人整體方案論證 7
2.2.1 傳感器設計方案 7
2.2.2 電機的選擇及驅動方案 9
2.2.3 電機的控制方案選擇 10
3 移動機器人模型結構及引導系統(tǒng)設計 12
3.1移動機器人模型結構 12
3.2移動機器人引導系統(tǒng) 12
3.2.1 導軌引導系統(tǒng) 12
3.2.2 機器視覺引導系統(tǒng) 13
4 控制系統(tǒng)電路設計 15
4.1 單片機的功能特點 15
4.2 紅外檢測電路的設計 17
4.3 超聲波測距的硬件設計 18
4.3.1超聲波測距的原理 18
4.3.2 超聲波發(fā)射電路 19
4.3.3 超聲波檢測接收電路 20
4.4 搬用物檢測電路 20
4.5 電機驅動電路 21
4.6 電源模塊設計 23
4.7 報警電路設計 23
5 系統(tǒng)軟件的設計 24
5.1 編程思路及總流程圖 24
5.1.1總流程圖 24
5.1.2 程序設計思路 25
5.2 超聲波測距的算法設計 25
5.3 巡線算法設計 26
5.4電機控制設計 27
5.5 超聲波發(fā)生子程序與超聲波接受中斷程序 28
5.6 完整源程序 29
5.7控制效果報告 33
6 結 論 35
謝 辭 36
參考文獻 37
附 錄 38
尋線搬運機器人模型及其控制系統(tǒng)設計
摘 要
近年來,隨著機器人技術的發(fā)展,移動機器人軌跡跟蹤問題受到了人們越來越多的關注。前輪轉向、后輪驅動的輪式類車移動機器人與四輪汽車的運動學模型相近,因此對輪式類車移動機器人的軌跡跟蹤控制問題的研究在汽車自動駕駛、智能交通等方面具有重要的意義。
自動引導機器人技術可用于無人駕駛汽車,無人工廠、倉庫及服務機器人等領域。本文詳細介紹了基于51單片機的巡線機器人設計,其主要包括超聲波檢測模塊、紅外巡線檢測、電動機調速驅動以及搬用機械手模塊。該系統(tǒng)在單片機的控制下,采集、存儲、處理巡線系統(tǒng)輸入的數(shù)字信號,并通過驅動系統(tǒng)來控制直流電機,使機器人按照預設的路線行走及搬運物體。該系統(tǒng)使用反射式紅外傳感器識別與地面顏色差別較大的引導線信息,采用L298H橋驅動電路和PWM波調速方法控制行走電機。給出了系統(tǒng)調試方法并分析了試驗數(shù)據,討論了提升系統(tǒng)性能的必要手段,實現(xiàn)了機器人的自動巡線功能。
本設計采用以AT89C51單片機為核心的低成本、高精度、微型化數(shù)字顯示超聲波測距儀的硬件電路和軟件設計方法。整個電路采用模塊化設計,由主程序、預置子程序、發(fā)射子程序、接收子程序模塊組成。探頭的信號經單片機綜合分析處理,實現(xiàn)超聲波測距的功能。在此基礎上設計了系統(tǒng)的總體方案,最后通過硬件和軟件實現(xiàn)了各個功能模塊。相關部分附有硬件電路圖、程序流程圖。
關鍵詞:機器人;巡線;光電三極管;PWM波;51單片機;超聲波
Abstract
With the development of robot technology,the trajectory—tracking problem of
mobile robot is paid more and more attention.A wheeled car-like mobile robot,which is steered by two front wheel sand driven by two real wheels,has similar kinematic model to that of a four-wheel car.So the study on the trajectory-tracking problem of the wheeled car-like mobile robot is significant for automatic drive of car as well as intelligent transportation.
Automatic Guided robot technology can be used for unmanned aerial vehicles, unmanned factories, warehouses and service robots, and other fields. This paper describes Line-tracking robot design on the base of the 51. Its main module include: photoelectric detection module ultrasonic measurement detection and line patrols and infrared detection, Motor-driven, human-machine interfaces. Under the control of the single-chip microcomputer subsystem, the system can collect, save and process the digital signal from the line-tracking system, then controls the motor through the driving system, and with the system robot can move according to reinstalling tracking. The system uses infrared reflectance sensor identification with the ground vary greatly in color line guide information, Drivers using L298H bridge circuit and PWM control methods wave speed motor running. Commissioning is a systematic method of analysis and test data, discussed the upgrade system performance necessary means, the robot's automatic line-tracking function.
At the core of the design using AT89C51 low-cost, high accuracy, Micro figures show that the ultrasonic range finder hardware and software design methods. Modular design of the whole circuit from the main program, pre subroutine fired subroutine receive subroutine. display subroutine modules form. SCM comprehensive analysis of the probe signal processing, and the ultrasonic range finder function. On the basis of the overall system design, hardware and software by the end of each module.
Keyword: robot; line-tracking; photoelectric triode ;PWM wave,;51single-chip microcomputer;ultrasonic
目 錄
引言 1
1 緒 論 2
1.1 移動機器人概述 2
1.1.1巡線機器人的發(fā)展 2
1.2 移動機器人的設計思路 5
1.3 課題設計的任務和要求 5
2 移動機器人總體設計 7
2.1移動機器人整體設計 7
2.2移動機器人整體方案論證 7
2.2.1 傳感器設計方案 7
2.2.2 電機的選擇及驅動方案 9
2.2.3 電機的控制方案選擇 10
3 移動機器人模型結構及引導系統(tǒng)設計 12
3.1移動機器人模型結構 12
3.2移動機器人引導系統(tǒng) 12
3.2.1 導軌引導系統(tǒng) 12
3.2.2 機器視覺引導系統(tǒng) 13
4 控制系統(tǒng)電路設計 15
4.1 單片機的功能特點 15
4.2 紅外檢測電路的設計 17
4.3 超聲波測距的硬件設計 18
4.3.1超聲波測距的原理 18
4.3.2 超聲波發(fā)射電路 19
4.3.3 超聲波檢測接收電路 20
4.4 搬用物檢測電路 20
4.5 電機驅動電路 21
4.6 電源模塊設計 23
4.7 報警電路設計 23
5 系統(tǒng)軟件的設計 24
5.1 編程思路及總流程圖 24
5.1.1總流程圖 24
5.1.2 程序設計思路 25
5.2 超聲波測距的算法設計 25
5.3 巡線算法設計 26
5.4電機控制設計 27
5.5 超聲波發(fā)生子程序與超聲波接受中斷程序 28
5.6 完整源程序 29
5.7控制效果報告 33
6 結 論 35
謝 辭 36
參考文獻 37
附 錄 38
引言
輪式移動機器人是機器人研究領域的一項重要內容.它集機械、電子、檢測技術與智能控制于一體。在各種移動機構中,輪式移動機構最為常見。輪式移動機構之所以得到廣泛的應用。主要是因為容易控制其移動速度和移動方向。因此.有必要研制一套完整的輪式機器人系統(tǒng)。并進行相應的運動規(guī)劃和控制算法研究。
隨著微電子技術的不斷發(fā)展,微處理器芯片的集成程度越來越高,單片機已可以在一塊芯片上同時集成cpu、存儲器、定時器/計數(shù)器、并行和串行接口、看門狗、前置放大器、a/d轉換器、d/a轉換器等多種電路,這就很容易將計算機技術與測量控制技術結合,組成智能化測量控制系統(tǒng)。這種技術促使機器人技術也有了突飛猛進的發(fā)展,目前人們已經完全可以設計并制造出具有某些特殊功能的簡易智能機器人。筆者設計和開發(fā)了基于5l型單片機的自動巡線輪式機器人控制系統(tǒng)。
1 緒 論
1.1 移動機器人概述
自動引導機器人技術可用于無人駕駛汽車,電力、無人工廠、倉庫及服務機器人等領域。本文結合機器人的產生和發(fā)展狀況,在討論電力線巡檢常用設備和方法的基礎上,分析了國內外巡線機器人、研究及應用現(xiàn)狀。結合作者進行的具體研究工作討論了巡線機器人的一般結構、控制方案,并提出了兩臂機器人的故障探測、行為規(guī)劃方案。
兩院院士宋健曾說過:“機器人學的進步和應用是本世紀自動控制最有說服力的成就,是當代最高意義上的自動化”??茖W的進步與技術的創(chuàng)新,為機器人的研究與應用開辟了廣闊的思路與空間。
1.1.1巡線機器人的發(fā)展
(1) 國外巡線機器人的發(fā)展
移動機器人技術的發(fā)展為架空電力線路巡檢提供了新的技術平臺。20世紀80年代,國際上開始研制高壓輸電線路巡線機器人。早期日本、美國和加拿大等國相繼開發(fā)了不同用途的巡線機器人,并取得了較大的進展,尤其是可在兩個桿塔之間巡檢的機器人技術較為成熟,有些已達到產品化的程度。1988年Sawada等人首先研制了具有初步自主越障能力的光纖復合架空地線巡檢移動機器人,該機器人依靠內嵌的輸電線路結構參數(shù)進行運動行為的規(guī)劃。當遇到桿塔時,該機器人利用自身攜帶的導軌從桿塔側面滑過,如圖1,因為沒有安裝外部環(huán)境感知傳感器,因而適應性較差。而且導軌約100kg,機器人自身過重,對電池供電有更高要求。
圖1-1 光纖架空地線巡檢機器人
美國TRC公司1989年研制了一臺懸臂自治巡檢機器人模型,能沿架空導線進行較長距離的行走,可進行電暈損耗、絕緣子、結合點、壓接頭等視覺檢查任務,并將探測到的線路故障參數(shù)進行預處理后傳送給地面人員,如圖2。然而僅在兩個桿塔之間爬行的巡線機器人已遠遠不能滿足實際線路巡檢工作的要求,輸電線路不僅存在著支撐桿塔,而且還存在著多種線路附件構成的障礙物,如防震錘、懸垂線夾、耐張線夾和絕緣子等。因此具有越障功能的巡線機器人成為該領域研究的重點。
圖1-2 TRC公司的懸臂機器人
由日本Sato公司生產的輸電線路損傷探測器也采用了單體小車結構(圖1-3 所示),能在地面操作人員的遙控下,沿輸電線路行走,利用車載探測儀探測線路損傷程度及準確位置,將獲取的數(shù)據和圖片資料存儲在數(shù)據記錄器中。地面工作人員可回放復查,進一步確定損傷情況。加拿大魁北克水電研究院的Serge Montambault等人2000年開始了HQ LineROVer控小車的研制工作。遙控小車起初用于清除電力傳輸線地線上的積冰,逐漸發(fā)展為用于線路巡檢、維護等多用途移動平臺。該移動小車驅動力大,能爬上52o 的斜坡,通信距離可達1km。小車采用靈活的模塊化結構,安裝不同的工作頭即可完成架空線視覺和紅外檢查、壓接頭狀態(tài)評估、導線清污和除冰等帶電作業(yè)。但是,HQ LineROVer 無越障能力,只能在兩線塔間的輸電線路上工作。
圖1-3 Sato公司的探傷機器人
此外,日本的Hideo Nakamura 等研制了蛇形運動機器人。泰國Peungsungwal等人2001 年設計的自給電巡線機器人,采用電流互感器從爬行的輸電線路上獲取感應電流作為機器人的工作電源,從而解決了巡線機器人長時間驅動的動力問題。
(2)國內巡線機器人的發(fā)展現(xiàn)狀
90年代末,國內的一些研究機構和高等學校開始巡線機器人的研究工作,并已經研制多種機構的巡線機器人樣機。武漢大學和山東大學在這方面的研究起步最早。在“十五”國家高新技術發(fā)展計劃(863 計劃)的支持下,武漢大學和中科院自動化所、中科院沈陽自動化所等同時開展了對巡線機器人的研制工作。1998年武漢水利電力大學的吳功平教授研制出了架空高壓線路巡線小車,小車采用單體三驅動輪結構,具有穩(wěn)定的行走功能和越障功能,能順利越過絕緣子、防振錘、懸垂線夾等主要障礙物,并利用攜帶的近距離紅外故障診斷儀完成線路的診斷。巡線小車的行走、越障通過人工遙控加機械控制器來實現(xiàn)。目前,該研究組正在進行智能化程度較高、越障能力強的自治巡線機器人的研制工作。在863計劃的支持下,與漢陽供電公司合作,針對220kV單分裂相線,進行了巡線機器人關鍵技術的研究,在機器人越障機構、智能控制、移動導航、機器視覺技術、電能在線補給等方面取得了全面的突破。巡線機器人能夠避讓和跨越兩檔線路間的防震錘、懸垂和耐張絕緣子串和跳線等各種障礙物。利用機器人攜帶的攝像裝置,實現(xiàn)線路及其安全通道的檢測與巡視,將檢測到的數(shù)據和圖像信息經過無線傳輸系統(tǒng)發(fā)送到地面基站;通過地面基站接收、顯示發(fā)回的數(shù)據和圖像資料。
圖1-4 兩臂回旋式機器人
圖1-5 三臂輪式機器人
在863計劃以及國電東北電網有限公司的支持下,中國科學院沈陽自動化研究所開展了“沿500kV地線巡檢機器人”的研制,課題組攻克了機器人機構、自主控制、數(shù)據和圖像的傳輸?shù)汝P鍵技術,成功地開發(fā)出由巡檢機器人和地面移動基站組成的系統(tǒng),并與錦州超高壓局合作進行了現(xiàn)場帶電巡檢試驗,完成了超高壓實際環(huán)境下的巡檢試驗。該機器人能夠沿500kV地線行走、跨越障礙,利用攜帶的攝像機或紅外熱像儀等檢測裝置,檢測了輸電線、防震錘、絕緣子和桿塔等輸電設備的損傷情況。實現(xiàn)機器人和地面基站遠程通訊,基站對機器人運行狀態(tài)的遠程控制。該樣機的成功研制,在系統(tǒng)電源、機器人本體、控制系統(tǒng)、檢測設備和通訊設備,地面控制與數(shù)據后臺處理等方面積累了豐富的經驗。
“十五”期間,中科院自動化所開展了“11 0 k V輸電線路巡檢機器人”的研究,其研究成果主要表現(xiàn)在:一是設計了三臂懸掛式移動機器人機構;二是采用“基于知識庫的自動控制”和“基于視覺的遠程遙控主從控制”的混合控制系統(tǒng),實現(xiàn)了典型障礙的越障;三是采用多層神經元網絡分類器,實現(xiàn)了實驗室復雜環(huán)境下絕緣子開裂、破損視覺檢查。目前,中科院自動化所復雜系統(tǒng)與智能科學重點實驗室新研制的110kv輸電線路巡檢機器人采用二臂回轉式懸掛機構,增加了臂距調整機構、夾持輪抱線機構等,可實現(xiàn)旋轉、俯仰等運動功能,爬坡能力強。開發(fā)的二臂巡線機器人樣機在實驗室模擬線路上,沿一檔架空線自主行走,并且能夠跨越兩檔線路間的防震錘、懸垂線夾等障礙物。機器人攜帶的檢測用地攝像機,可進行障礙物的檢測和越障時的輔助指導工作,有效地克服了三臂機器人的不足,當然兩臂機器人的行為規(guī)劃復雜,增加了控制電路設計及運動控制的難度。東南大學,山東大學等相繼研制出各自的巡線機器人。
從國內外已取得的研究成果可以看出,國外無越障功能的架空電力線路巡線機器人技術較為成熟,已進于實用階段。這類機器人一般需人工參與,只能完成兩線塔之間電力線路的檢查,作業(yè)范圍小,自治程度低。自主巡線機器人能跨越線路附件、線塔等障礙物,可實施大范圍、長時間的線路巡檢作業(yè),國內對具有自主越障功能的機器人研究投入力量大,取得了多項研究成果。為滿足在柔性輸電線行走并跨越各種障礙物,巡線機器人必須解決好結構設計、障礙物探測識別和控制行為規(guī)劃三方面的問題。
1.2 移動機器人的設計思路
巡線搬運機器人以16位微控制AT89S52為控制器,采用多傳感器進行信息采集,巡線機器人設計,其主要包括超聲波檢測障礙物模塊、紅外巡線檢測、電動機調速驅動以及人機接口等模塊。該系統(tǒng)在單片機的控制下,采集、存儲、處理巡線系統(tǒng)輸入的數(shù)字信號,并通過驅動系統(tǒng)來控制直流電機,使機器人按照預設的路線行走。該系統(tǒng)使用反射式紅外傳感器識別與地面顏色差別較大的引導線信息,采用L298H橋驅動電路和PWM波調速方法控制行走電機。給出了系統(tǒng)調試方法并分析了試驗數(shù)據,討論了提升系統(tǒng)性能的必要手段,實現(xiàn)了機器人的自動巡線功能。
1.3 課題設計的任務和要求
(1)動機器人搬運路線的彎道半徑不大于300mm,移動機器人的運動線路示意
圖、移動機器人模型的結構圖采用AutoCAD或CAXA軟件繪制并打??;
(2) 移動機器人由單片機控制,采用電池供電,能自動前后尋線運動搬運物體,
當沒有需要搬運的物體時自動等待,當運動線路的前方300mm處有障礙物時
停止運動并報警,障礙消失后自動繼續(xù)運動;
(3) 采用Protel99se軟件繪制和打印系統(tǒng)的電路原理圖,電路原理圖標明全部零部件和元器件的型號或主要參數(shù);
(4) 采用C51語言設計控制程序,控制程序同時用程序流程框圖和C代碼表示,
程序流程框圖盡量細化并用計算機繪制打印,C代碼添加詳細的中文注釋;
2 移動機器人總體設計
2.1移動機器人整體設計
系統(tǒng)框架如圖1-1所示:
圖2-1系統(tǒng)框架圖
如圖2-1所示,該智能小車系統(tǒng)主要分為以下四大塊:
(1) 信息采集模塊:在該模塊中包括有速度信息采集和位置信息采集兩個子模塊,分別采集小車當前的位置信息和速度信息,并將采集到的信息傳給MCU,其核心是傳感器。
(2) 信息處理模塊:信息處理模塊包括信息處理和控制模塊,其核心是MCU,MCU接收到采集來的信號,對信號進行處理后作出判斷,并發(fā)出控制命令。
(3) 執(zhí)行模塊:該模塊包括了驅動電機、轉向電機、機械手指和報警裝置,當接收到MCU的命令后便執(zhí)行相應的操作,同時信息采集模塊又采集到電機和舵機的狀態(tài)信息,反饋給MCU 。從而整個系統(tǒng)構成一個閉環(huán)系統(tǒng),在運行過程中,系統(tǒng)自動調節(jié)而達到正確行駛的目的。
(4) 超聲波收發(fā)模塊:在該模塊中包含了超聲波輸出與超聲波輸入,其中超聲波輸出用來發(fā)射40Mhz的超聲波,結合超聲波接受部分,從而可以檢測和計算障礙物的距離。
2.2移動機器人整體方案論證
2.2.1 傳感器設計方案
(1) 軌道檢測:
探測路面黑線的基本原理:光線照射到路面并反射,由于黑線和白紙對光的反射系數(shù)不同,可根據接收到的反射光強弱來判斷黑線,可實現(xiàn)的方案有以下幾種:
方案一:使用CCD傳感器來采集路面信息。使用CCD傳感器,可以獲取大量的圖像信息,可以全面完整的掌握路徑信息,可以進行較遠距離的預測和識別圖像復雜的路面,而且抗干擾能力強。但是對于本項目來說,使用CCD傳感器也有其不足之處。首先使用CCD傳感器需要有大量圖像處理的工作,需要進行大量數(shù)據的存儲和計算。因為是以實現(xiàn)小車視覺為目的,實現(xiàn)起來工作量較大,相當繁瑣。
? 方案二:采用普通發(fā)光二極管及光敏電阻組成的發(fā)射接收方案,電路如圖1-1所示。該方案在實際使用時,容易受到外界光源的干擾,有時甚至檢測不到。主要是因為可見光的反射效果跟地表的平坦程度、地表材料的反射情況均對檢測效果產生直接影響。雖然可采取超高亮度發(fā)光二極管降低一定的干擾,但這有增加額外的功率損耗。
? 方案三:脈沖調制的反射式紅外發(fā)射接收器。由于采用該有交流分量的調制信號,則可大幅度減少外界干擾;另外紅外發(fā)射接受管的最大工作電流取決與平均電流,如果采用占空比小的調制信號,在平均電流不變的情況下,瞬時電流很大(50~100mA),則大大提高了信噪比。
在本次設計中,導軌只有黑白兩種顏色,小車只要能區(qū)分黑白兩色就可以采集到準確的路面信息。經過綜合考慮,在本項目中采用方案二紅外光電傳感器作為信息采集元件。
(2) 障礙物檢測:障礙物檢測可以使用超聲波,也可以使用紅外;但由于紅外傳感器抗干擾能力弱,即使調制后,其檢測距離也有限,不易實現(xiàn)本設計要求;所以采用超聲波傳感器,其靈敏度高,檢測距離遠,誤差小,抗干擾能力強,可靠性高。
(3) 搬用物檢測:搬用物檢測,采用接近開關,因為位移傳感器可以根據不同的原理和不同的方法做成,而不同的位移傳感器對物體的“感知”方法也不同,所以常見的接近開關有以下幾種:
渦流式接近開關
這種開關有時也叫電感式接近開關。它是利用導電物體在接近這個能產生電磁場接近開關時,使物體內部產生渦流。這個渦流反作用到接近開關,使開關內部電路參數(shù)發(fā)生變化,由此識別出有無導電物體移近,進而控制開關的通或斷。這種接近開關所能檢測的物體必須是導電體。
電容式接近開關
這種開關的測量通常是構成電容器的一個極板,而另一個極板是開關的外殼。這個外殼在測量過程中通常是接地或與設備的機殼相連接。當有物體移向接近開關時,不論它是否為導體,由于它的接近,總要使電容的介電常數(shù)發(fā)生變化,從而使電容量發(fā)生變化,使得和測量頭相連的電路狀態(tài)也隨之發(fā)生變化,由此便可控制開關的接通或斷開。這種接近開關檢測的對象,不限于導體,可以絕緣的液體或粉狀物等。
霍爾接近開關
霍爾元件是一種磁敏元件。利用霍爾元件做成的開關,叫做霍爾開關。當磁性物件移近霍爾開關時,開關檢測面上的霍爾元件因產生霍爾效應而使開關內部電路狀態(tài)發(fā)生變化,由此識別附近有磁性物體存在,進而控制開關的通或斷。這種接近開關的檢測對象必須是磁性物體。
光電式接近開關
利用光電效應做成的開關叫光電開關。將發(fā)光器件與光電器件按一定方向裝在同一個檢測頭內。當有反光面(被檢測物體)接近時,光電器件接收到反射光后便在信號輸出,由此便可“感知”有物體接近。
熱釋電式接近開關
用能感知溫度變化的元件做成的開關叫熱釋電式接近開關。這種開關是將熱釋電器件安裝在開關的檢測面上,當有與環(huán)境溫度不同的物體接近時,熱釋電器件的輸出便變化,由此便可檢測出有物體接近。
機械式接觸開關,采用靈敏度很高的接觸式開關,其檢測可靠,原理簡單,壽命長。
考慮到實際情況,搬用物檢測采用自制接觸開關,安全可靠,實現(xiàn)方便,使用簡單,可大大簡化電路設計。
2.2.2 電機的選擇及驅動方案
(1) 電動機的選擇
? 方案一:采用步進電機,步進電機的一個顯著特點就是具有快速啟停能力,如果負荷不超過步進電機所能提供的動態(tài)轉矩值,就能夠立即使步進電機啟動或反轉。另一個顯著特點是轉換精度高,正轉反轉控制靈活。
? 方案二:采用普通直流電機。直流電動機具有優(yōu)良的調速特性,調速平滑、方便,調整范圍廣;過載能力強,能承受頻繁的沖擊負載,可實現(xiàn)頻繁的無級快速啟動、制動和反轉;能滿足各種不同的特殊運行要求。
? 由于普通直流電機更易于購買,并且電路相對簡單,因此建議采用直流電機作為動力源。
(2) 電動機驅動方案的選擇
??方案一:采用電阻網絡或數(shù)字電位器調整電動機的分壓,從而達到調速目的。但是電阻網絡只能實現(xiàn)有級調速,而數(shù)字電阻的元器件價格比較昂貴,且可能存在干擾。更主要的問題在于一般電動機的電阻比較小,但電流很大,分壓不僅會降低效率,而且實現(xiàn)很困難。
??方案二:采用繼電器對電動機的開與關進行控制,通過控制開關的切換速度實現(xiàn)對小車的速度進行調整。這個電路的優(yōu)點是電路較為簡單,缺點是繼電器的響應時間長,易損壞,壽命較短,可靠性不高。
??方案三:采用四個大功率晶體管組成H橋電路,四個大功率晶體管分為兩組,交替導通和截止,用單片機控制使之工作在開關狀態(tài),進而控制電動機的運行。該控制電路由于四個大功率晶體管只工作在飽和與截止狀態(tài)下,效率非常高,并且大功率晶體管開關的速度很快,穩(wěn)定性也極強,是一種廣泛采用的電路。
??基于以上的分析,建議電動機驅動電路選擇方案三。
2.2.3 電機的控制方案選擇
(1) PWM控制介紹:
在小車的運行中,主要有方向和速度的控制,即轉向電機和驅動電機的控制,這兩個控制是系統(tǒng)軟件的核心操作,對小車的性能有著決定性的作用。
對電機機的控制,要達到的目的就是:在任何情況下,總能使小車在軌道上,并且實現(xiàn)速度和方向的控制。本次設計所用電機都是直流電機。
直流電機轉速控制可分為勵磁控制法與電樞電壓控制法。勵磁控制法是控制磁通,其控制功率小,低速時受到磁飽和限制,高速時受到換向火花和換向器結構強度的限制,而且由于勵磁線圈電感較大動態(tài)響應較差,所以這種控制方法用得很少。大多數(shù)應用場合都使用電樞電壓控制法。隨著電力電子技術的進步,改變電樞電壓可通過多種途徑實現(xiàn),其中PWM(脈寬調制)便是常用的改變電樞電壓的一種調速方法。
PWM調速控制的基本原理是按一個固定頻率來接通和斷開電源,并根據需要改變一個周期內接通和斷開的時間比(占空比)來改變直流電機電樞上電壓的"占空比",從而改變平均電壓,控制電機的轉速。在脈寬調速系統(tǒng)中,當電機通電時其速度增加,電機斷電時其速度減低。只要按照一定的規(guī)律改變通、斷電的時間,即可控制電機轉速。而且采用PWM技術構成的無級調速系統(tǒng).啟停時對直流系統(tǒng)無沖擊,并且具有啟動功耗小、運行穩(wěn)定的特點。
根據上述,對驅動電機的控制(即速度控制),要達到的目的就是在行駛過程中,小車要有最有效的加速和減速機制。對驅動電機采用PWM控制使小車能在直道上高速行駛,而在彎道減速則保證了小車運行的穩(wěn)定,流暢。為了精確控制速度,時時對速度進行監(jiān)控,我們還引入了閉環(huán)控制的思想,在硬件設計,增加了速度傳感器實時采集速度信息。
(2) 電機控制PWM方案選擇
PWM調速工作方式:
方案一:雙極性工作制。雙極性工作制是在一個脈沖周期內,單片機兩控制口各輸出一個控制信號,兩信號高低電平相反,兩信號的高電平時差決定電動機的轉向和轉速。
方案二:單極性工作制。單極性工作制是單片機控制口一端置低電平,另一端輸出PWM信號,兩口的輸出切換和對PWM的占空比調節(jié)決定電動機的轉向和轉速。
由于單極性工作制電壓波開中的交流成分比雙極性工作制的小,其電流的最大波動也比雙極性工作制的小,所以我們采用了單極性工作制。
PWM調脈寬方式:
調脈寬的方式有三種:定頻調寬、定寬調頻和調寬調頻。我們采用了定頻調寬方式,因為采用這種方式,電動機在運轉時比較穩(wěn)定;并且在采用單片機產生PWM脈沖的軟件實現(xiàn)上比較方便。
PWM軟件實現(xiàn)方式:
方案一:采用定時器做為脈寬控制的定時方式,這一方式產生的脈沖寬度極其精確,誤差只在幾個us。
方案二:采用軟件延時方式,這一方式在精度上不及方案一,特別是引入中斷后,將有一定的誤差。但是基于不占用定時器資源,且對于直流電機,采用軟件延時所產生的定時誤差在允許范圍,故采用方案二。
對轉向電機的控制(即方向控制),采用正負脈沖,改變其轉向,用通電時間長短,來決定轉向的多少。
對機械手電機采用一端通高電平,一端通高低電平,來控制其啟動與停止。
3 移動機器人模型結構及引導系統(tǒng)設計
3.1移動機器人模型結構
方案1:購買玩具電動車。購買的玩具電動車具有組裝完整的車架車輪、電機及其驅動電路。一般的說來,玩具電動車具有如下特點:首先,這種玩具電動車裝配緊湊,輕巧,經過改造,各種所需傳感器的安裝方便。其次,這種電動車一般是前輪轉向后輪驅動,能適應該題目的環(huán)形地圖,能方便迅速的實現(xiàn)180度的彎角。再次,玩具電動車的電機多為玩具直流電機,易于控制,而且這種電動車價格一般都較便宜。
方案2:自己制作電動車。制定了左右兩輪分別驅動,后萬向輪轉向的方案。即左右輪分別用兩個轉速和力矩基本完全相同的直流電機進行驅動,車體尾部裝一個萬向輪。這樣,當兩個直流電機轉向相反同時轉速相同時就可以實現(xiàn)電動車的原地旋轉,由此可以輕松的實現(xiàn)小車坐標不變的90度和180度的轉彎。在安裝時我們保證兩個驅動電機同軸。當小車前進時,左右兩驅動輪與后萬向輪形成了三點結構。這種結構使得小車在前進時比較平穩(wěn),可以避免出現(xiàn)后輪過低而使左右兩驅動輪驅動力不夠的情況。為了防止小車重心的偏移,后萬向輪起支撐作用。
鑒于實驗條件和環(huán)境的限制,我選擇以第一種方案和自己的一些改造后,為本次設計的實物模型,移動機器人機械本體,采用購買的玩具汽車和自己的改造,其結構大致分為:前后電機盒,電池盒,傳感器安置板和機械手部分,其示意圖如下:
圖3-1 移動小車模型
3.2移動機器人引導系統(tǒng)
3.2.1 導軌引導系統(tǒng)
導軌:金屬或其它材料制成的槽或脊,可承受、固定、引導移動裝置或設備并減少其摩擦的一種裝置。導軌表面上的縱向槽或脊,用于導引、固定機器部件、專用設備、儀器等。導軌又稱滑軌、線性導軌、線性滑軌,用于直線往復運動場合,擁有比直線軸承更高的額定負載, 同時可以承擔一定的扭矩,可在高負載的情況下實現(xiàn)高精度的直線運動。
導軌在我們的日常生活中的應用也是很普遍的,如滑動門的滑糟、火車的鐵軌等等都是導軌的具體應用。還有就是導軌可以用于任何需要帶滑動滑動的機器或設備上面,如有用于電梯導軌,還有就是窗簾上有時也會用到它。
導軌引導系統(tǒng),安全可靠,但其制造和設計成本昂貴,軌道固定,缺乏靈活性,并且工作時,噪音大,磨損嚴重,壽命短。
3.2.2 機器視覺引導系統(tǒng)
機器視覺技術是計算機學科的一個重要分支,它綜合了光學、機械、電子、計算機軟硬件等方面的技術,涉及到計算機、圖像處理、模式識別、人工智能、信號處理、光機電一體化等多個領域。自起步發(fā)展至今,已經有20多年的歷史,其功能以及應用范圍隨著工業(yè)自動化的發(fā)展逐漸完善和推廣,其中特別是目前的數(shù)字圖像傳感器、CMOS和CCD攝像機、DSP、FPGA、ARM等嵌入式技術、圖像處理和模式識別等技術的快速發(fā)展,大大地推動了機器視覺的發(fā)展。
簡而言之,機器視覺就是利用機器代替人眼來作各種測量和判斷。在生產線上,人來做此類測量和判斷會因疲勞、個人之間的差異等產生誤差和錯誤,但是機器卻會不知疲倦地、穩(wěn)定地進行下去。一般來說,機器視覺系統(tǒng)包括了照明系統(tǒng)、鏡頭、攝像系統(tǒng)和圖像處理系統(tǒng)。對于每一個應用,我們都需要考慮系統(tǒng)的運行速度和圖像的處理速度、使用彩色還是黑白攝像機、檢測目標的尺寸還是檢測目標有無缺陷、視場需要多大、分辨率需要多高、對比度需要多大等。從功能上來看,典型的機器視覺系統(tǒng)可以分為:圖像采集部分、圖像處理部分和運動控制部分。
機器視覺系統(tǒng)的優(yōu)點有:非接觸測量,對于觀測者與被觀測者都不會產生任何損傷,從而提高系統(tǒng)的可靠性。具有較寬的光譜響應范圍,例如使用人眼看不見的紅外測量,擴展了人眼的視覺范圍。 長時間穩(wěn)定工作,人類難以長時間對同一對象進行觀察,而機器視覺則可以長時間地作測量、分析和識別任務,機器視覺系統(tǒng)的應用領域越來越廣泛。在工業(yè)、農業(yè)、國防、交通、醫(yī)療、金融甚至體育、娛樂等等行業(yè)都獲得了廣泛的應用,可以說已經深入到我們的生活、生產和工作的方方面面。
移動機器人引導系統(tǒng)是采用視覺引導系統(tǒng)讓移動機器人識別、追蹤黑線來實現(xiàn),黑線的路徑就是機器人的引導系統(tǒng),其原理是不同顏色對光的反射和吸收不同,從而通過光學元器件,機器人可以就識別路線,實現(xiàn)路徑跟隨,同時,在軌道上設置不同的標記,來讓機器人識別彎道和搬用處的識別,其示意圖如下:
圖3-2 巡線軌道示意圖
4 控制系統(tǒng)電路設計
4.1 單片機的功能特點
MCS-51單片機產品兼容 、8K字節(jié)在系統(tǒng)可編程Flash存儲器、 1000次擦寫周期、 全靜態(tài)操作:0Hz~33Hz 、 三級加密程序存儲器 、 32個可編程I/O口線 、三個16位定時器/計數(shù)器 八個中斷源 、全雙工UART串行通道、 低功耗空閑和掉電模式 、掉電后中斷可喚醒 、看門狗定時器 、雙數(shù)據指針 、掉電標識符 。
At89s52 是一種低功耗、高性能CMOS8位微控制器,具有 8K 在系統(tǒng)可編程Flash 存儲器。使用Atmel 公司高密度非 易失性存儲器技術制造,與工業(yè)80C51 產品指令和引腳完 全兼容。片上Flash允許程序存儲器在系統(tǒng)可編程,亦適于 常規(guī)編程器。在單芯片上,擁有靈巧的8 位CPU 和在系統(tǒng) 可編程Flash,使得AT89S52為眾多嵌入式控制應用系統(tǒng)提 供高靈活、超有效的解決方案。 AT89S52具有以下標準功能: 8k字節(jié)Flash,256字節(jié)RAM, 32 位I/O 口線,看門狗定時器,2 個數(shù)據指針,三個16 位 定時器/計數(shù)器,一個6向量2級中斷結構,全雙工串行口, 片內晶振及時鐘電路。另外,AT89S52 可降至0Hz 靜態(tài)邏 輯操作,支持2種軟件可選擇節(jié)電模式。空閑模式下,CPU 停止工作,允許RAM、定時器/計數(shù)器、串口、中斷繼續(xù)工 作。掉電保護方式下,RAM內容被保存,振蕩器被凍結, 單片機一切工作停止,直到下一個中斷或硬件復位為止。8 位微控制器 8K 字節(jié)在系統(tǒng)可編程 Flash AT89S52?。
圖4-1 C52單片機引腳圖
P0 口:P0口是一個8位漏極開路的雙向I/O口。作為輸出口,每位能驅動8個TTL邏?輯電平。對P0端口寫“1”時,引腳用作高阻抗輸入。?當訪問外部程序和數(shù)據存儲器時,P0口也被作為低8位地址/數(shù)據復用。在這種模式下,?P0具有內部上拉電阻。?
在flash編程時,P0口也用來接收指令字節(jié);在程序校驗時,輸出指令字節(jié)。程序校驗?時,需要外部上拉電阻。?
P1 口:P1 口是一個具有內部上拉電阻的8 位雙向I/O 口,p1 輸出緩沖器能驅此外,P1.0和P1.2分別作定時器/計數(shù)器2的外部計數(shù)輸入(P1.0/T2)和時器/計數(shù)器2?的觸發(fā)輸入(P1.1/T2EX),具體如下表所示。?在flash編程和校驗時,P1口接收低8位地址字節(jié)。?
引腳號第二功能?
P1.0 T2(定時器/計數(shù)器T2的外部計數(shù)輸入),時鐘輸出?
P1.1 T2EX(定時器/計數(shù)器T2的捕捉/重載觸發(fā)信號和方向控制)?
P2 口:P2 口是一個具有內部上拉電阻的8 位雙向I/O 口,P2 輸出緩沖器能驅動4 個?TTL 邏輯電平。對P2 端口寫“1”時,內部上拉電阻把端口拉高,此時可以作為輸入?口使用。作為輸入使用時,被外部拉低的引腳由于內部電阻的原因,將輸出電流(IIL)。?
在訪問外部程序存儲器或用16位地址讀取外部數(shù)據存儲器(例如執(zhí)行MOVX @DPTR)?時,P2 口送出高八位地址。在這種應用中,P2 口使用很強的內部上拉發(fā)送1。在使用?8位地址(如MOVX @RI)訪問外部數(shù)據存儲器時,P2口輸出P2鎖存器的內容。?
P3 口:P3 口是一個具有內部上拉電阻的8 位雙向I/O 口,p2 輸出緩沖器能驅動4 個?TTL 邏輯電平。對P3 端口寫“1”時,內部上拉電阻把端口拉高,此時可以作為輸入?口使用。作為輸入使用時,被外部拉低的引腳由于內部電阻的原因,將輸出電流(IIL)。?P3口亦作為AT89S52特殊功能(第二功能)使用。在flash編程和校驗時,P3口也接收一些控制信號。
圖4-2 本設計中的最小系統(tǒng)
本系統(tǒng)采用at89S52單片機作為中央處理器。其主要任務是掃描紅外檢測傳感器輸入的信號啟動機器人,在機器人行走過程中不斷讀取傳感器采集到的數(shù)據,將得到的數(shù)據進行處理后,根據不同的情況產生占空比不同的pwm脈沖來控制電機,同時從單片機中發(fā)射周期為40KHZ的脈沖,采用中斷法接受用于檢測障礙物的反射信號,將相關數(shù)據進行計算判斷,從而產生聲光報警信號。其中,p1.0一p1.3為紅外傳感器輸入口,p1.4為接觸開關接口,p2.0接聲光報警單元,p2.1—p2.7用于控制兩直流電機,
p3.2接超聲波接受傳感器,p3.6接超聲波發(fā)射傳感器。P3.0和p3.7用于控制機械手電機。如圖4-2所示。
4.2 紅外檢測電路的設計
當檢測到黑線時,紅外光管接收到反射回來的紅外光,其輸出立即發(fā)生高低電平跳變,該信號經放大整形后送單片機分析處理。為保證小車延黑線行駛,采用了三個檢測器并行排列。在小車行走過程中,若向左方向稍微偏離黑線,則右側和中間的探頭就會檢測到黑線,把信號傳給單片機,單片機控制車頭稍微向右轉。若小車嚴重偏離線路時,只有右側探頭可以檢測到黑線,單片機控制轉向電機。傳感器布局圖如所示。
圖4-3傳感器布局
如圖所示,整個傳感器布局一字狀。中間黑線即為跑道中央黑線,在小車頭(路
面黑線處布局了三個傳感器),用來判斷小車是否處于軌道的狀態(tài)。其檢測結果與偏移的邏輯表如下:
表4-1 傳感器檢測邏輯表
傳感器A測試值
傳感器B測試值
傳感器C測試值
偏離情況
0
1
0
沒偏
1
1
0
微左偏
0
1
1
微右偏
0
0
1
嚴重左偏
0
0
0
嚴重右偏
路面黑線檢測電路如圖所示:
圖4 -4 路面黑線檢測電路
4.3 超聲波測距的硬件設計
4.3.1超聲波測距的原理
單片機發(fā)出超聲波測距是通過不斷檢測超聲波發(fā)射后遇到障礙物所反射的回波, 從而測出發(fā)射和接收回波的時間差t,然后求出距離
S=ct/2 (4-1)
式(4-1)中的c為超聲波在空氣中傳播的速度。
限制該系統(tǒng)的最大可測距離存在四個因素:超聲波的幅度、反射物的質地、反射和入射聲波之間的夾角以及接收換能器的靈敏度。接收換能器對聲波脈沖的直接接收能力將決定最小可測距離。為了增加所測量的覆蓋范圍,減少測量誤差,可采用多個超聲波換能器分別作為多路超聲波發(fā)射/接收的設計方法。由于超聲波發(fā)球聲波范圍,其波速c與溫度有關,表1-1列出了幾種不同溫度下的波速。
表4-2 聲速與溫度的關系
溫度(℃)
-30
-20
-10
0
10
20
30
100
聲速(m/s)
313
319
325
323
338
344
349
386
波速確定后,只要測得超聲波往返的時間t,即可求得距離S。其系統(tǒng)原理框圖如圖4-5所示。
圖4-5 超聲波測距系統(tǒng)框圖
單片機AT89C51發(fā)出短暫的40kHz信號,經放大后通過超聲波換能器輸出;反射后的超聲波經超聲波換能器作為系統(tǒng)的輸入,鎖相環(huán)對此信號鎖定,產生鎖定信號啟動單片機中斷程序,讀出時間t,再由系統(tǒng)軟件對其進行計算、判別后,相應的計算結果。
由單片機AT89C51編程產生40kHz的方波,由P3.6口輸出,再經過放大電路,驅動超聲波發(fā)射探頭發(fā)射超聲波。發(fā)射出去的超聲波經障礙物反射回來后,由超聲波接收頭接收到信號,通過接收電路的檢波放大、積分整形及一系列處理,送至單片機。單片機利用聲波的傳播速度和發(fā)射脈沖到接收反射脈沖的時間間隔計算出障礙物的距離,并由單片機控制顯示出來。
該測距裝置是由超聲波傳感器、單片機、發(fā)射/接收電路和LED顯示器組成。傳感器輸入端與發(fā)射接收電路相連,接收電路輸出端與單片機相連接,單片機的輸出端與顯示電路輸入端相連接。其時序圖如圖4-6所示。
圖4-6 時序圖
單片機在T0時刻發(fā)射方波,同時啟動定時器開始計時,當收到回波后,產生一負跳變到單片機中斷口,單片機響應中斷程序,定時器停止計數(shù)。計算時間差,即可得到超聲波在媒介中傳播的時間t,由此便可計算出距離。
4.3.2 超聲波發(fā)射電路
超聲波發(fā)射電路原理圖如圖4-8所示。發(fā)射電路主要由反相器74LS04和超聲波發(fā)射換能器T構成,單片機P1.0端口輸出的40kHz的方波信號一路經一級反向器后送到超聲波換能器的一個電極,另一路經兩級反向器后送到超聲波換能器的另一個電極,用這種推換形式將方波信號加到超聲波換能器的兩端,可以提高超聲波的發(fā)射強度。輸出端采兩個反向器并聯(lián),用以提高驅動能力。上位電阻R1O、R11一方面可以提高反向器74LS04輸出高電平的驅動能力,另一方面可以增加超聲波換能器的阻尼效果,縮短其自由振蕩時間。
圖4-7 74LS04芯片內部結構圖
圖4-8超聲波發(fā)射電路原理圖
壓電式超聲波換能器是利用壓電晶體的諧振來工作的。超聲波換能器內部有兩個壓電晶片和一個換能板。當它的兩極外加脈沖信號,其頻率等于壓電晶片的固有振蕩頻率時,壓電晶片會發(fā)生共振,并帶動共振板振動產生超聲波,這時它就是一個超聲波發(fā)生器;反之,如果兩電極問未外加電壓,當共振板接收到超聲波時,將壓迫壓電晶片作振動,將機械能轉換為電信號,這時它就成為超聲波接收換能器。超聲波發(fā)射換能器與接收換能器在結構上稍有不同,使用時應分清器件上的標志。
4.3.3 超聲波檢測接收電路
集成電路CX20106A是一款紅外線檢波接收的專用芯片,常用于電視機紅外遙控接收器。考慮到紅外遙控常用的載波頻率38 kHz與測距的超聲波頻率40 kHz較為接近,可以利用它制作超聲波檢測接收電路(如圖)。實驗證明用CX20106A接收超聲波(無信號時輸出高電平),具有很好的靈敏度和較強的抗干擾能力。適當更改電容C4的大小,可以改變接收電路的靈敏度和抗干擾能力。
圖4-9 超聲波檢測接收電路
4.4 搬用物檢測電路
搬用電路采用自制接觸開關,其電路圖如下:
圖4-10 接觸開關電路示意圖
4.5 電機驅動電路
直流電機驅動采用恒壓恒流橋式2A驅動芯片L298N,L298是SGS公司的產品,比較常見的是15腳Multiwatt封裝的L298N,內部同樣包含4通道邏輯驅動電路??梢苑奖愕尿寗觾蓚€直流電機,或一個兩相步進電機。L298N可接受標準TTL邏輯電平信號VSS,VSS可接4.5~7 V電壓。4腳VS接電源電壓,VS電壓范圍VIH為+2.5~46 V。輸出電流可達2.5 A,可驅動電感性負載。1腳和15腳下管的發(fā)射極分別單獨引出以便接入電流采樣電阻,形成電流傳感信號。L298可驅動2個電動機,OUT1,OUT2和OUT3,OUT4之間可分別接電動機,本實驗裝置我們選用驅動一臺電動機。5,7,10,12腳接輸入控制電平,控制電機的正反轉。EnA,EnB接控制使能端,控制電機的停轉。表1是L298N功能邏輯圖。
圖4-11 L298內部功能模塊
表4-3 L298控制邏輯表
Eab
In1
In2
運轉狀態(tài)
0
-
-
停止
1
1
0
正轉
1
0
1
反轉
1
1
1
剎車
1
0
0
停止
In3,In4的邏輯圖與表1相同。由表1可知EnA為低電平時,輸入電平對電機控制起作用,當EnA為高電平,輸入電平為一高一低,電機正或反轉。同為低電平電機停止,同為高電平電機剎停。
下圖是其引腳圖:
圖4-12 L298芯片引腳圖
圖4-13 L298控制兩電機示意圖
1、15腳是輸出電流反饋引腳,其它與L293相同。在通常使用中這兩個引腳也可以直接接地。上圖是其與51單片機連接的電路圖。
4.6 電源模塊設計
電源模塊采用三端穩(wěn)壓集成電路7805,從電池供電端,將9V電壓穩(wěn)壓到5V。7805是我們最常用到的穩(wěn)壓芯片了,他的使用方便,用很簡單的電路即可以輸入一個直流穩(wěn)壓電源,他的輸出電壓恰好為5v,剛好是51系列單片機運行所需的電壓,他有很多的系列如ka7805,ads7805,cw7805等,性能有微小的差別,用的最多的還是lm7805,下面我簡單的介紹一下他的3個引腳以及用它來構成的穩(wěn)壓電路的資料。
圖4-14 7805引腳圖
其中1接整流器輸出的+電壓,2為公共地(也就是負極),3就是我們需要的正5V輸出電壓了。
圖4-15 電源模塊電路圖
4.7 報警電路設計
報警電路采用三極管開關功能,控制蜂鳴器發(fā)聲和指示燈的發(fā)光,其電路圖如下:
圖4-16 報警模塊電路圖
5 系統(tǒng)軟件的設計
5.1 編程思路及總流程圖
5.1.1總流程圖
Y
Y
Y
N
N
開始
程序初始化 送初值 開中斷
巡線檢測
障礙物檢測
是否有搬運物標記?
是否有彎道標記?
是否有障礙物?
檢測標志計數(shù)為奇?
檢測標志計數(shù)為奇?
距離小于30cm
是否有搬運物?
驅動電機減速
停機報警
停車20秒機械手動作
加速
停車20秒機械手動作
停機等待
Y
Y
N
N
N
Y
Y
N
N
圖5-1 總流程圖
5.1.2 程序設計思路
移動小車在開始工作時,調運巡線子程序,至于小車前端的三個紅外傳感器檢測識別黑色軌道,并引導小車順著軌道運行,同時超聲波檢測障礙的程序也用來檢測軌道前方路面情況,如果30cm以內用障礙物,小車停止報警;否則,小車繼續(xù)行駛。在軌道上,設置了用于定位的不同標志,用來識別搬用地點和彎道,當小車移動到搬用物標志處,小城停下來判斷是否有搬運物,有則啟動機械手搬用,否則停止;在小車識別到時彎道標志時減速運行,如此循環(huán),直到完成任務。
5.2 超聲波測距的算法設計
???? 超聲波測距的原理為超聲波發(fā)生器T在某一時刻發(fā)出一個超聲波信號,當這個超聲波遇到被測物體后反射回來,就被超聲波接收器R所接收到。這樣只要計算出從發(fā)出超聲波信號到接收到返回信號所用的時間,就可算出超聲波發(fā)生器與反射物體的距離。距離的計算公式為:?
d=s/2=(c×t)/2
其中,d為被測物與測距儀的距離
收藏