600 likes | 767 Views
國立成功大學電機資訊科技研發中心 創意蘿蔔機器人工場. MyROBOT. SciFest Club 伺服馬達控制器製作. www.2mouse.com.tw. 學習目標. 伺服馬達原理 控制器線路 導入實作 (1)- 麵包板練習 導入實作 (2)- 萬用板焊接練習. 伺服馬達原理. 伺服馬達內部結構.
E N D
國立成功大學電機資訊科技研發中心 創意蘿蔔機器人工場 MyROBOT SciFest Club 伺服馬達控制器製作 www.2mouse.com.tw
學習目標 • 伺服馬達原理 • 控制器線路 • 導入實作(1)-麵包板練習 • 導入實作(2)-萬用板焊接練習
伺服馬達內部結構 • 一個伺服馬達內部包括了一個小型直流馬達;一組變速齒輪組;一個回饋可調電位器;及一塊電子控制板。其中,高速轉動的直流馬達提供了原始動力,帶動變速(減速)齒輪組,使之產生高扭力的輸出,齒輪組的變速比愈大,伺服馬達的輸出扭力也愈大,也就是說越能承受更大的重量,但轉動的速度也愈低。
變速齒輪組 可調電位器 小型直流馬達 電子控制板
伺服馬達的工作原理 減速齒輪組由馬達驅動,其終端(輸出端)帶動一個線性的比例電位器(VR)作位置檢測,該電位器把轉角座標轉換為一比例電壓回饋給控制線路板,控制線路板將其與輸入的控制脈衝信號比較,產生糾正脈衝,並驅動馬達正向或反向地轉動,使齒輪組的輸出位置與期望值相符,令糾正脈衝趨於為0,從而達到使伺服馬達精確定位的目的 控制脈衝 控制電路 比 例電位器 直流馬達 齒輪組
伺服馬達的控制 • 標準的伺服馬達有三條控制線,分別為:電源VCC(+)、地GND(-)及控制Signal (s) 。電源線與地線用於提供內部的直流馬達及控制線路所需的能源,電壓通常介於4V~6V之間,該電源應盡可能與處理系統的電源隔離(因為伺服馬達會產生噪音)。甚至小伺服馬達在重負載時也會拉低放大器的電壓,所以整個系統的電源供應的比例必須合理。 • 輸入一個週期性的正向脈衝信號,這個週期性脈衝信號的高電平時間通常在1ms~2ms之間,而低電平時間應在5ms到20ms之間
伺服馬達的控制 輸入正脈衝寬度(周期為20ms) 伺服馬達輸出臂位置
伺服器每個有3個接點,各廠牌的順序大都是一樣,但有時接線的顏色會不一樣伺服器每個有3個接點,各廠牌的順序大都是一樣,但有時接線的顏色會不一樣
控制器線路 4-6V 50k VR1 5.1k R1 6V電池盒 1k 4 8 R3 7 D1IN4148 JP1 Signal 1-2ms IC1555Timer 3 270k R2 3 6 接伺服馬達 2 1 2 LED 1 5 LED C10.1u(104)
電路說明 • 由R3+LED組合一個電源指示狀態,電源輸入時亮起 • 由555 IC輸出Signal接出LED,當可變電阻旋轉時,LED會有明暗漸進呈現 • JP1連接伺服馬達:1(黑) 2(紅) 3(白) • 輸出高電壓時間公式:T-high = 0.693 x(R1+VR1)xC1 • R1=5100(5.1k),VR1=0,C1=0.1uf=0.0000001 • T-high=0.693x5100x0.0000001=0.000353=0.35ms • R1=5100(5.1K),VR1=50K=50000,C1=0.1uf=0.0000001 • T-high=0.693x(5100+50000)x0.0000001=0.00382=3.8ms • 輸出低電壓時間公式:T-low = 0.693xR2xC1 • R2=27000(270K),C1=0.1uf=0.0000001 • T-low=0.693x270000x0.0000001=0.0187=18.7ms • 週期時間為 T=T-high + T-low最少 = 0.35ms + 18.7ms = 19.05ms最多 = 3.8ms + 18.7ms = 22.5msPWM週期為19.05ms~22.5ms,pulse時間為0.35ms~3.8ms
麵包板 IN4148二極體 發光二極體LED 陶瓷電容0.1uf 可變電阻50K IC:555 伺服器 電阻:5.1k,100,270k,1k 排針
555 IC腳位辨識 8 7 6 5 4 8 7 IC1555Timer 3 6 2 1 5 1 2 3 4
旋轉此,讓伺服器跟著轉動…. 由左至右:白(訊號)紅(正電源)黑(負電源) 觀察LED會隨訊號輸出有漸亮漸暗的狀態
問題排除 • 當LED燈號未亮時,該如何處理? • 檢查LED是否無損壞? • 接腳位置是否正確?(長接正) • 當所有的接腳均正確時,仍舊是無法工作? • 檢查每一個接線裸露的線端是否過短? • 當LED燈號正確漸亮,但是伺服馬達無法工作,該如何處理? • 檢查與IC 555的接腳元件是否位置正確? • 元件是否均有接觸到麵包板? • LED均有亮,但是輸出無法正確工作… • 檢查伺服馬達訊號接腳是否正確? • 換一顆伺服馬達試試看 • 檢查電池電壓是否過低?
焊接前注意事項 • 工作環境是否有較大的平坦空間? • IC 焊接時不可以過久 • 把握焊接秘訣1.2.3… • 剩餘零件腳可以利用做為零件電路串接 • 工具未使用時,關閉電源 • 隨時養成愛護工具及零件歸納習慣 • 遵守工具使用安全守則
當您已經完成麵包板練習後,接著可進行下面的萬用板實作部份…如果尚未完成請完成麵包板實作後再進行以下實作零件位置以麵包板方式進行設計,因此,在以下的實作中,盡可能參考電路圖予以施工,可以增進自己的實作看圖能力喔當您已經完成麵包板練習後,接著可進行下面的萬用板實作部份…如果尚未完成請完成麵包板實作後再進行以下實作零件位置以麵包板方式進行設計,因此,在以下的實作中,盡可能參考電路圖予以施工,可以增進自己的實作看圖能力喔
請依圖面零件擺放,並一一焊接 焊接時,可以折彎零件腳(先不剪斷),後面會以此進行點線的連接 如果您已善長焊接可以剪斷零件腳,自行串接點線的連接
IC 555位置 排針3支腳位置 C1(104)電容位置 養成前後觀看的能力,多注意一下前面是零件擺置,後面是接出的零件腳 焊接時,可以多想一下之前麵包板的位置及設計的電路圖
請依續依紅色框線將以導線予以串接起來 可以利用多出的零件腳折彎後進行連接 連接完成後再剪掉多出的零件腳
觀察一下目前實作與麵包零件位置,同時,也觀察電路圖的位置……觀察一下目前實作與麵包零件位置,同時,也觀察電路圖的位置……
對應電路圖中,將IC 555的第3腳連接到排針及LED(+) 取LED長腳連接到IC 555位置
請依藍框再檢查每一個線是否均連接上?藍框範圍為需要連接一起的請依藍框再檢查每一個線是否均連接上?藍框範圍為需要連接一起的