一種簡單的雙舵機控制電路范

范全亮++盧好陽

摘 要本文介紹了舵機的結構及調速原理，分析了伺服控制模塊芯片的功能，設計了一種雙時基電路用于控制兩個不同的舵機以完成不同動作，這種電路可以廣泛應用于機器人或機械臂和一些人工智能裝備上。

【關鍵詞】舵機 控制原理 雙時基電路

1 舵機的結構與調速原理

舵機是組合式機器人的關鍵部件，舵機的輸出準確性直接關系到機器人是否可以完成預定動作指令。開環(huán)控制的直流電機轉速不穩(wěn)定，當外部負載變大或電壓波動時，轉速會隨之改變，所以當多個無反饋電機串聯(lián)執(zhí)行動作時，動作誤差很大，此時就要求電機轉速能對外部變化進行自適應調節(jié)，而舵機符合機器人對準確性的要求，如圖1所示。

從控制原理上看，舵機調速的方式是一個閉環(huán)反饋系統(tǒng)，通常情況下對于舵機的反饋信號主要有電壓、電流和轉速。電壓反饋的控制電路在原理和機構上都比較簡單、方便設計，本文舵機調速反饋方式為比例電壓反饋。該系統(tǒng)的原理如圖2所示。

通電時，直流電機轉動帶動齒輪組輸出扭矩。與減速器相似，齒輪組的齒輪比越大，輸出軸轉速越低，輸出扭矩越大，負載能力更強。舵機輸出軸與外殼間有滑動軸承，舵機可在0-180度內轉動。舵機的電源線有三條引線，紅色線是電源線，工作電壓是4.8V或6V，黑色線接地，白色是信號控制線。由三菱M51660L構成的伺服控制電路處理輸入的脈沖信號，控制脈沖為0.5-2.5ms。

舵機的舵盤和電位計同軸轉動，當舵盤位置變化時，電位計自身的阻值和兩端電壓也發(fā)生變化，由于電阻和電壓成正比，電壓變化的信號反饋到控制電路?？刂齐娐吩賹⑵渑c輸入的脈沖信號進行比對，然后再發(fā)出信號對舵機轉動角度進行修正，如此反復，最終將舵盤調整到位。

2 舵機的伺服控制模塊

m51660l芯片一般用于無線控制的伺服電機集成電路中。14PIN直插式封裝，其內置電壓調節(jié)電路，用于比較電路的差分比較器有著穩(wěn)定的電源電壓波動特性和溫度變化特征。

引腳功能：（M51660L芯片見圖3）。

（1）外接PNP管基極驅動（1）；

（2）輸入；

（3）輸出（1）；

（4）地；

（5）誤差脈沖輸出；

（6）輸出（2）；

（7）擴展輸入端；

（8）外接PNP管基極驅動（2）；

（9）穩(wěn)壓輸出；

（10）電源圖3 M51660L芯片；

（11）伺服位置電壓輸入；

（12）空腳；

（13）振蕩定時電容；

（14）振蕩定時電阻；

測量環(huán)境溫度Ta=25℃，電源電壓Vcc=4.8 V的M51660L電特性見表1。

3 雙時基電路設計

一款機器人或機器臂至少有兩個舵機構成，因此舵機控制電路顯得尤為重要。文章應用一塊NE556組成雙時基集成電路，同時分別控制兩個舵機，實現(xiàn)兩個方向的控制。其電路原理圖見圖4。NE556可以產生兩個頻率控制兩個舵機。NE556芯片由兩個NE555時基電路組成，該電路經(jīng)常被用于路燈延時、空調溫控、艙室氣壓調節(jié)、汽車自適應巡航等多種控制系統(tǒng)中。本文主要用于控制兩個舵機在同一時間段內做出不同的動作。

參考文獻

[1]高飛，土太杰，吳攀，林俊杰.雙足行走機器人多舵機控制及動態(tài)平衡研究[J].高校實驗室工作研究，2012（01）.

[2]韓慶瑤，洪草根，朱曉光，徐瑾.基于AVR單片機的多舵機控制系統(tǒng)設計及仿真[J].計算機測量與控制，2011，19（02）.

[3]談世哲，梅志千，楊汝清.基于DSP的工業(yè)機器人控制器的設計與實現(xiàn)[J].機器人，2002.

作者簡介

范全亮，現(xiàn)為上海工程技術大學高職學院大二學生。

盧好陽，現(xiàn)為上海工程技術大學高職學院助教。

作者單位

上海工程技術大學高職學院 上海市 201620endprint