Robofun 機器人論壇

標題: 24伺服機控制板電路設計 [打印本頁]

作者: uucww 時間: 2006-7-10 14:51
標題: 24伺服機控制板電路設計
24伺服機控制板電路設計

24.jpg (82.83 KB, 下載次數: 945)

作者: marbol 時間: 2006-7-10 20:59

原帖由 uucww 於 2006-7-10 14:51 發表
24伺服機控制板電路設計

uucww大大~~~
這個電路圖很不錯喔!!簡捷有力!!
只要把reset腳的觸發方式改為正脈波觸發(圖上用的是負脈波觸發是給 AVR使用的),pin20接地,pin31接+5v之後,就可以讓51使用囉!!

如何產生正脈波~~~~~就是把圖上reset腳接出去的電阻與電容位置互調,加入電源時即可產生!!

[ 本帖最後由 marbol 於 2006-7-10 21:03 編輯 ]

作者: uucww 時間: 2006-7-10 21:32

原帖由 marbol 於 2006-7-10 20:59 發表

uucww大大~~~
這個電路圖很不錯喔!!簡捷有力!!
只要把reset腳的觸發方式改為正脈波觸發(圖上用的是負脈波觸發是給 AVR使用的),pin20接地,pin31接+5v之後,就可以讓51使用囉!!

如何產生正脈波~~~~~就是把圖 ...

marbol大大.....謝謝指教......請問一下這伺服機的電源與主板電源是如何製作分離方式供電!!??

作者: marbol 時間: 2006-7-11 12:24

原帖由 uucww 於 2006-7-10 21:32 發表

marbol大大.....謝謝指教......請問一下這伺服機的電源與主板電源是如何製作分離方式供電!!??

您說的分離式供電是必需的,這是因為伺服機通常吃相當大的電流關係,
如果如圖所示只由一顆穩壓IC供電,而伺服機通常有好幾顆嗷嗷待哺,一旦吃的電流超過穩壓IC的限制條件,電壓就被拉低,微控器就當機囉!!

最穩當的方式就是用兩顆穩壓IC來做分離式供電,以免提供的電流不足而導致電壓漂移的危險~~~~~

不過需考量主控制板與伺服機需要的電壓範圍來選擇,可以檢討一下,主控制板使用的8515微控器可工作的電壓範圍可能在4~6V(或2.7~6V視型式而定),而廣X伺服機用的電源4.8~6V之間,所以可以選擇7805這顆穩壓IC(TO-220包裝),在1A的輸出電流下,7805這顆穩壓IC可以提供+5v的穩定電壓輸出,而不會漂移喔~~~~~

分離的方式可以將兩顆穩壓IC的輸入一起接到006p的9v電池,而這兩顆穩壓IC的輸出則分別接給伺服機與主控制板用即可~~~~~~

[ 本帖最後由 marbol 於 2006-7-13 18:12 編輯 ]

作者: uucww 時間: 2006-7-13 14:01

原帖由 marbol 於 2006-7-11 12:24 發表

您說的分離式供電是必需的,這是因為伺服機通常吃相當大的電流關係,
如果如圖所示只由一顆穩壓IC供電,而伺服機通常有好幾顆嗷嗷待哺,一旦吃的電流超過穩壓IC的限制條件,電壓就被拉低,微控器就當機囉!!

最穩 ...

marbol大大...謝謝指教....相當完美的說明!!!請問是兩顆穩壓IC分別做不同線路供電??一邊是伺服機供電一邊是電路板供電???

[ 本帖最後由 uucww 於 2006-7-13 14:05 編輯 ]

作者: marbol 時間: 2006-7-13 18:28

原帖由 uucww 於 2006-7-13 14:01 發表

marbol大大...謝謝指教....相當完美的說明!!!請問是兩顆穩壓IC分別做不同線路供電??一邊是伺服機供電一邊是電路板供電???

就像附圖的接法,其中for servo多並一個0.01uF陶瓷電容,多少濾掉一些servo的雜訊~~~

若是想讓servo發揮快速的響應及扭力,可以供給servo上限電壓使用~~~~像廣X的servo可以使用到6v的直流電壓~~~這時候就可以挑選7806穩壓IC或者是LM317可調式穩壓IC(調到6v)來使用,享受狂飆的快感喔~~~~

[ 本帖最後由 marbol 於 2006-7-13 18:40 編輯 ]

分離式穩壓供電.jpg (70.36 KB, 下載次數: 471)

作者: uucww 時間: 2006-7-14 06:07

原帖由 marbol 於 2006-7-13 18:28 發表

就像附圖的接法,其中for servo多並一個0.01uF陶瓷電容,多少濾掉一些servo的雜訊~~~

若是想讓servo發揮快速的響應及扭力,可以供給servo上限電壓使用~~~~像廣X的servo可以使用到6v的直流電壓~~~這時候就可以 ...

marbol大大....太感謝了...我以PM我的信箱您收到嗎?
這張電路圖太棒了.....對我純玩家來講是很大的啟發與學習入門的穩壓電路設計...感恩!!

作者: uucww 時間: 2006-7-16 18:39
marbol大大....請問一下...目前市面上穩定信好一點的控制板有哪些呢?

作者: marbol 時間: 2006-7-16 23:43

原帖由 uucww 於 2006-7-16 18:39 發表
marbol大大....請問一下...目前市面上穩定信好一點的控制板有哪些呢?

uucww大大~~~~
我只用過SSCII,所以無法知道其他控制板的狀況是如何~~~

SSCII使用上還蠻方便的,我的機器蟲就是用這片板子,不過輸出只有8通道,
但蟲蟲需要12通道,所以串接兩個SSCII(共16通道)來涵蓋~~~~

在使用上如同簡訊上說的,SSCII控制板與servo需要某種協調性存在,當然,傳給SSCII控制板的指令也需要一些時間來消化處理,實作中發現,傳給SSCII的資料太快,SSCII會有停頓的現象,可能SSCII的串列埠暫存器是有限的,所以一直塞資料的結果,會使後來的指令資料覆蓋掉前一次~~~~需要邊試邊調整來解決這個問題喔~~~~

作者: uucww 時間: 2006-7-17 00:23

原帖由 marbol 於 2006-7-16 23:43 發表

uucww大大~~~~
我只用過SSCII,所以無法知道其他控制板的狀況是如何~~~
SSCII使用上還蠻方便的,我的機器蟲就是用這片板子,不過輸出只有8通道,
但蟲蟲需要12通道,所以串接兩個SSCII(共16通道)來涵蓋~~~~:v ...

marbol大大...請問這SSCII哪有可以買到???大怪價錢是如何?參考一下!!串接兩塊板是如何接線的??穩定性如何...會不會當機或是伺服機有時扭在一起情況發生??

作者: marbol 時間: 2006-7-17 00:39

原帖由 uucww 於 2006-7-17 00:23 發表

marbol大大...請問這SSCII哪有可以買到???大怪價錢是如何?參考一下!!串接兩塊板是如何接線的??穩定性如何...會不會當機或是伺服機有時扭在一起情況發生??

uucww大大~~~~
先不急著買SSCII~~~~~

您手頭上不是有一塊SSC嗎??使用上有什麼問題嗎??可以的話有無說明書可以參考~~~~~讓小弟先看看再說~~~~

作者: uucww 時間: 2006-7-17 01:16
marbol大大....沒有說明書...只有網站的一些資料!!!基本上與一般板子軟體操作差不多的...

作者: marbol 時間: 2006-7-17 21:10

原帖由 uucww 於 2006-7-17 01:16 發表
marbol大大....沒有說明書...只有網站的一些資料!!!基本上與一般板子軟體操作差不多的...

我的天~~~應該有些控制指令說明才對~~~~是哪個網站呢???

作者: uucww 時間: 2006-7-18 06:30

原帖由 marbol 於 2006-7-17 21:10 發表

我的天~~~應該有些控制指令說明才對~~~~是哪個網站呢???

marbol大大.....短信回給你了!!

作者: marbol 時間: 2006-7-19 07:39

原帖由 uucww 於 2006-7-18 06:30 發表

marbol大大.....短信回給你了!!

喔!!我猜您用的板子是透過PC介面程式進行動作規劃~~~~完成規劃後就直接載入執行,這樣子就必須板子跟PC介面程式搭配使用,是這樣子嗎??

作者: uucww 時間: 2006-7-19 22:21

原帖由 marbol 於 2006-7-19 07:39 發表

喔!!我猜您用的板子是透過PC介面程式進行動作規劃~~~~完成規劃後就直接載入執行,這樣子就必須板子跟PC介面程式搭配使用,是這樣子嗎??

marbol大大...基本上與一般版子功能相當....差不多功能!!

作者: marbol 時間: 2006-7-20 06:23

原帖由 uucww 於 2006-7-19 22:21 發表

marbol大大...基本上與一般版子功能相當....差不多功能!!

這樣說好了~~~
1.控制板是透過PC介面程式進行動作規劃~~~~完成規劃後就直接載入,可以離開PC端來執行~~~~這種板子很像中鳴電子的機器蟲套件

2.控制板是透過PC介面程式進行動作規劃~~~~完成規劃後需連著PC才能執行動作
~~~~~~這種板子類似mini SSCII,當然也可以使用微控器對它進行連線控制喔~~~

如果是第一種的話,因為整個流程已經寫死,無法改寫,只能從所附人機介面來找尋調整的可能性!!
如果是第二種的話,還可以改寫PC端或者是微控制器端的程式!!

uucww大大,您的是哪一腫呢??

作者: uucww 時間: 2006-7-20 08:26

原帖由 marbol 於 2006-7-20 06:23 發表

這樣說好了~~~
1.控制板是透過PC介面程式進行動作規劃~~~~完成規劃後就直接載入,可以離開PC端來執行~~~~這種板子很像中鳴電子的機器蟲套件

2.控制板是透過PC介面程式進行動作規劃~~~~完成規劃後需連著PC才 ...

marbol大大....我終於瞭解....是第一種的....不能改寫功能的!!!

作者: uucww 時間: 2006-7-26 15:51
http://www.icci.com.tw/book66/_f ... 22066265_zh_TW.html

24.jpg (66.76 KB, 下載次數: 457)

作者: marbol 時間: 2006-7-26 22:54

原帖由 uucww 於 2006-7-26 15:51 發表
http://www.icci.com.tw/book66/_f ... 22066265_zh_TW.html

uucww大大~~~
就是這個啦!!不過跟一年前型錄所呈現的好像有點不同,只是當初看到時直覺認為怎麼可能勒,51做的伺服機控制板???網路上有太多的PIC,與AVR做的伺服機控制板,後來自製的結果發現51伺服機控制板是可以做的到的~~~~

當然,軟體介面程式也可以自製啦~~~

最有意思的就是深入一點的課題,例如調控伺服機的速度及載入串列記憶體做脫機動作演示整合喔~~~~

[ 本帖最後由 marbol 於 2006-7-26 23:01 編輯 ]

作者: uucww 時間: 2006-7-27 05:04
利用單片機PWM信號進行舵機控制
[日期：2005-10-15] 來源：今日電子作者：北京交通大學時瑋

基於單片機的舵機控制方法具有簡單、精度高、成本低、體積小的特點，並可根據不同的舵機數量加以靈活應用。

在機器人機電控制系統中，舵機控制效果是性能的重要影響因素。舵機可以在微機電系統和航模中作為基本的輸出執行機構，其簡單的控制和輸出使得單片機系統非常容易與之接口。

舵機是一種位置伺服的驅動器，適用於那些需要角度不斷變化並可以保持的控制系統。其工作原理是：控制信號由接收機的通道進入信號調製芯片，獲得直流偏置電壓。它內部有一個基準電路，產生週期為20ms，寬度為1.5ms的基準信號，將獲得的直流偏置電壓與電位器的電壓比較，獲得電壓差輸出。最後，電壓差的正負輸出到電機驅動芯片決定電機的正反轉。當電機轉速一定時，通過級聯減速齒輪帶動電位器旋轉，使得電壓差為0，電機停止轉動。

圖1 舵機的控制要求

舵機的控制信號是PWM信號，利用占空比的變化改變舵機的位置。一般舵機的控制要求如圖1所示。

單片機實現舵機轉角控制
可以使用FPGA、模擬電路、單片機來產生舵機的控制信號，但FPGA成本高且電路複雜。對於脈寬調製信號的脈寬變換，常用的一種方法是採用調製信號獲取有源濾波後的直流電壓，但是需要50Hz(週期是20ms)的信號，這對運放器件的選擇有較高要求，從電路體積和功耗考慮也不易採用。5mV以上的控制電壓的變化就會引起舵機的抖動，對於機載的測控系統而言，電源和其他器件的信號噪聲都遠大於5mV，所以濾波電路的精度難以達到舵機的控制精度要求。

也可以用單片機作為舵機的控制單元，使PWM信號的脈衝寬度實現微秒級的變化，從而提高舵機的轉角精度。單片機完成控制算法，再將計算結果轉化為PWM信號輸出到舵機，由於單片機系統是一個數字系統，其控制信號的變化完全依靠硬件計數，所以受外界干擾較小，整個系統工作可靠。

單片機系統實現對舵機輸出轉角的控制，必須首先完成兩個任務：首先是產生基本的PWM週期信號，本設計是產生20ms的週期信號；其次是脈寬的調整，即單片機模擬PWM信號的輸出，並且調整占空比。

當系統中只需要實現一個舵機的控制，採用的控制方式是改變單片機的一個定時器中斷的初值，將20ms分為兩次中斷執行，一次短定時中斷和一次長定時中斷。這樣既節省了硬件電路，也減少了軟件開銷，控制系統工作效率和控制精度都很高。

具體的設計過程：例如想讓舵機轉向左極限的角度，它的正脈衝為2ms，則負脈衝為20ms-2ms=18ms，所以開始時在控制口發送高電平，然後設置定時器在2ms後發生中斷，中斷發生後，在中斷程序裡將控制口改為低電平，並將中斷時間改為18ms，再過18ms進入下一次定時中斷，再將控制口改為高電平，並將定時器初值改為2ms，等待下次中斷到來，如此往復實現PWM信號輸出到舵機。用修改定時器中斷初值的方法巧妙形成了脈衝信號，調整時間段的寬度便可使伺服機靈活運動。

為保證軟件在定時中斷裡採集其他信號，並且使發生PWM信號的程序不影響中斷程序的運行(如果這些程序所佔用時間過長，有可能會發生中斷程序還未結束，下次中斷又到來的後果)，所以需要將採集信號的函數放在長定時中斷過程中執行，也就是說每經過兩次中斷執行一次這些程序，執行的週期還是20ms。軟件流程如圖2所示。

如圖2 產生PWM信號的軟件流程

如果系統中需要控制幾個舵機的準確轉動，可以用單片機和計數器進行脈衝計數產生PWM信號。

脈衝計數可以利用51單片機的內部計數器來實現，但是從軟件系統的穩定性和程序結構的合理性看，宜使用外部的計數器，還可以提高CPU的工作效率。實驗後從精度上考慮，對於FUTABA系列的接收機，當採用1MHz的外部晶振時，其控制電壓幅值的變化為0.6mV，而且不會出現誤差積累，可以滿足控制舵機的要求。最後考慮數字系統的離散誤差，經估算誤差的範圍在±0.3%內，所以採用單片機和8253、8254這樣的計數器芯片的PWM信號產生電路是可靠的。圖3是硬件連接圖。

圖3 PWA信號的計數和輸出電路(點擊放大)

基於8253產生PWM信號的程序主要包括三方面內容：一是定義8253寄存器的地址，二是控制字的寫入，三是數據的寫入。軟件流程如圖4所示，具體代碼如下。
//關鍵程序及註釋：
//定時器T0中斷，向8253發送控制字和數據
void T0Int() interrupt 1
{
TH0 = 0xB1;
TL0 = 0xE0; //20ms的時鐘基準
//先寫入控制字，再寫入計數值
SERVO0 = 0x30; //選擇計數器0，寫入控制字
PWM0 = BUF0L; //先寫低，後寫高
PWM0 = BUF0H;
SERVO1 = 0x70; //選擇計數器1，寫入控制字
PWM1 = BUF1L;
PWM1 = BUF1H;
SERVO2 = 0xB0; //選擇計數器2，寫入控制字
PWM2 = BUF2L;
PWM2 = BUF2H;
}

圖4 基於8253產生PWA信號的軟件流程

當系統的主要工作任務就是控制多舵機的工作，並且使用的舵機工作週期均為20ms時，要求硬件產生的多路PWM波的週期也相同。使用51單片機的內部定時器產生脈衝計數，一般工作正脈衝寬度小於週期的1/8，這樣可以在1個週期內分時啟動各路PWM波的上升沿，再利用定時器中斷T0確定各路PWM波的輸出寬度，定時器中斷T1控制20ms的基準時間。

第1次定時器中斷T0按20ms的 1/8設置初值，並設置輸出I/O口，第1次T0定時中斷響應後，將當前輸出I/O口對應的引腳輸出置高電平，設置該路輸出正脈衝寬度，並啟動第2次定時器中斷，輸出I/O口指向下一個輸出口。第2次定時器定時時間結束後，將當前輸出引腳置低電平，設置此中斷週期為20ms的1/8減去正脈衝的時間，此路 PWM信號在該週期中輸出完畢，往復輸出。在每次循環的第16次(2×8=16)中斷實行關定時中斷T0的操作，最後就可以實現8路舵機控制信號的輸出。

也可以採用外部計數器進行多路舵機的控制，但是因為常見的8253、8254芯片都只有3個計數器，所以當系統需要產生多路PWM信號時，使用上述方法可以減少電路，降低成本，也可以達到較高的精度。調試時注意到由於程序中脈衝寬度的調整是靠調整定時器的初值，中斷程序也被分成了8個狀態週期，並且需要嚴格的週期循環，而且運行其他中斷程序代碼的時間需要嚴格把握。

在實際應用中，採用51單片機簡單方便地實現了舵機控制需要的PWM信號。對機器人舵機控制的測試表明，舵機控制系統工作穩定，PWM占空比 (0.5～2.5ms 的正脈衝寬度)和舵機的轉角(-90°～90°)線性度較好。

參考文獻
1 胡漢才．單片機原理及接口技術.清華大學出版社.1996
2 王時勝,姜建平.採用單片機實現PWM式D/A轉換技術.電子質量.2004
3 劉歌群.盧京潮.閆建國.薛堯舜.用單片機產生7路舵機控制PWM波的方法.機械與電子.2004

servo_motor_controller_01.gif (10.63 KB, 下載次數: 325)

servo_motor_controller_02.gif (7.54 KB, 下載次數: 334)

servo_motor_controller_03.gif (77.31 KB, 下載次數: 409)

servo_motor_controller_04.gif (14.92 KB, 下載次數: 368)

作者: uucww 時間: 2006-7-27 05:12
http://sci.ustc.edu.cn/news.aspx?id=5504
http://sci.ustc.edu.cn/news.aspx?id=5505

可變脈寬輸出試驗(舵機控制)
[日期： 2005-9-12 10:14:53] 來源：作者： xidongs 整理armok / www.OurAV [字體：大中小]

　舵機：英文叫Servo，台灣及香港中文稱伺服機。在航模及自動控制中，舵機擔當著重要的作用。

　　舵機由無核心馬達所構成，可依據接收機發出的指令，轉動至定點的位置，是各個舵面的動力來源。

　　伺服機的規格主要是扭力與速度，扭力的單位是　/　，意指擺臂長度1公分處所能吊起的物重。速度的單位是秒/60°，意指轉動60°所需要的秒數。
　　

　　本實驗中控制舵機的 PWM 由 M16 的 PB.0 輸出，8M 晶體，vcc：5v，僅使用一個八位定時器 timer2，波形比較準確，用示波器和實測都已經通過。分辨率為20微秒。

伺服馬達的控制：

　　標準的微型伺服馬達有三條控制線，分別為：電源、地及控制。電源線與地線用於提供內部的直流馬達及控制線路所需的能源，電壓通常介於4V-6V之間，該電源應盡可能與處理系統的電源隔離(因為伺服馬達會產生噪音)。甚至小伺服馬達在重負載時也會拉低放大器的電壓，所以整個系統的電源供應的比例必須合理。

　　控制線輸入一個週期性的正向脈衝信號，這個週期性脈衝信號的高電平時間通常在1ms-2ms之間。而低電平時間應在5ms到20ms間，並不很嚴格。下表表示出一個典型的20ms週期性脈衝的正脈衝寬度與微型伺服馬達的輸出臂位置的關係：

以下是形象的示意圖：

　

電路圖：

請點擊此處下載詳細C代碼、Protel SCH、及製作資料

[ 本帖最後由 uucww 於 2006-7-27 05:30 編輯 ]

1.jpg (102.38 KB, 下載次數: 338)