一種基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法
【專利摘要】本發(fā)明涉及一種基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，整個控制系統(tǒng)包括核心控制器、電機驅(qū)動模塊、電流采集模塊以及通信模塊。其中核心控制器的主要功能是完成驅(qū)動電機的控制算法，產(chǎn)生PWM信號去控制系統(tǒng)工作，與上位機進行數(shù)據(jù)的通信，信號的采集，其底層系統(tǒng)由FLASH存儲器、快速的A/D轉(zhuǎn)換器、增強的CAN模塊、事件管理器、正交編碼電路接口機多通道緩沖串口等外設(shè)組成；通信模塊采用的是SCI串口通信來實現(xiàn)上位機與底層控制器DSP之間的數(shù)據(jù)交換；在直流驅(qū)動模塊，以驅(qū)動電流控制直流電機的加速度特性，實現(xiàn)直流電機的雙閉環(huán)調(diào)速，從而實現(xiàn)兩輪機器人的運動控制。
【專利說明】
一種基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法
技術(shù)領(lǐng)域
[0001 ]本發(fā)明涉及一種基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，屬于兩輪機器人運動控制技術(shù)領(lǐng)域。
【背景技術(shù)】
[0002]輪式機器人是以驅(qū)動輪子來帶動機器人進行移動和工作的機器人，由于其具有自重輕、承載大、機構(gòu)簡單、驅(qū)動和控制相對方便、行走速度快、工作效率高等特點，從而被廣泛應(yīng)用。隨著科技發(fā)展對機器人的自主智能化的需求，如何控制輪式機器人按照我們需要的方式進行移動和精準(zhǔn)的動作，即對輪式機器人的運動控制是十分重要的一個環(huán)節(jié)。
[0003]直流電機雙閉環(huán)調(diào)速系統(tǒng)是各種進行運動控制調(diào)速系統(tǒng)的基礎(chǔ)。其具有兩個調(diào)節(jié)器分別調(diào)節(jié)電流和轉(zhuǎn)速，克服了單閉環(huán)調(diào)速系統(tǒng)用一個調(diào)節(jié)器綜合多種信號，導(dǎo)致各參數(shù)相互影響等缺點，具有良好的靜態(tài)特性和動態(tài)特性，起步時間短、超調(diào)量小、并且抗擾動能力強等優(yōu)點。但是雙閉環(huán)直流調(diào)速系統(tǒng)在設(shè)計和調(diào)試過程中有大量的參數(shù)需要調(diào)整，運用傳統(tǒng)的設(shè)計方法工作量大，調(diào)試?yán)щy，并且兩輪輪式機器人本質(zhì)上具有飽和非線性問題，因此增加了基于直流電機雙閉環(huán)調(diào)速系統(tǒng)的兩輪機器人運動控制系統(tǒng)設(shè)計的難度。

【發(fā)明內(nèi)容】

[0004]本發(fā)明為了解決上述問題，提出了一種基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，本系統(tǒng)作為兩輪機器人不可或缺的一部分，完成驅(qū)動電機的控制算法實現(xiàn)，實現(xiàn)直流電機電樞電流和轉(zhuǎn)速的雙閉環(huán)調(diào)速，從而實現(xiàn)兩輪機器人的運動控制。
[0005]為了實現(xiàn)上述目的，本發(fā)明采用如下技術(shù)方案:
[0006]—種基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，所采用系統(tǒng)包括核心控制器、電機驅(qū)動模塊、電流采集模塊以及通信模塊;核心控制器與電流采集模塊相連，電流采集模塊和電機驅(qū)動模塊相連，完成信號的采集;通信模塊連接核心控制器的底層系統(tǒng)與上位機;核心控制器其底層系統(tǒng)由FLASH存儲器、快速的A/D轉(zhuǎn)換器、增強的CAN模塊、事件管理器、正交編碼電路接口機多通道緩沖串口組成;核心控制器完成驅(qū)動電機的控制算法，產(chǎn)生PffM信號去控制H橋電路電機驅(qū)動模塊工作。
[0007]所述的通信模塊采用SCI串口通信傳輸核心控制器的底層系統(tǒng)與上位機的交互數(shù)據(jù)，底層控制器接收并翻譯上位機的命令數(shù)據(jù)包;所述的直流調(diào)速系統(tǒng)直流電機雙閉環(huán)調(diào)速。
[0008]所述的快速的A/D轉(zhuǎn)換器對電動機電樞電流進行檢測采集。
[0009]所述的底層控制器模塊，采集編碼器反饋數(shù)據(jù)，經(jīng)過一定測速算法后將轉(zhuǎn)速數(shù)據(jù)發(fā)送給上位機。
[0010]所述的直流調(diào)速系統(tǒng)直流電機雙閉環(huán)調(diào)速，即在核心控制器，上位機通過轉(zhuǎn)速環(huán)和電流環(huán)雙閉環(huán)控制使電機按照上位機給定的電流進行加速并實現(xiàn)給定的轉(zhuǎn)速。
[0011]所述的驅(qū)動電流模塊控制直流電機的加速度特性來實現(xiàn)系統(tǒng)的調(diào)速。
[0012]本發(fā)明的有益效果為:
[0013](I)提供了一種能夠克服兩輪輪式機器人由于飽和非線性導(dǎo)致的失控的兩輪機器人運動控制系統(tǒng)，該系統(tǒng)采用直流電機電樞電流和轉(zhuǎn)速的雙閉環(huán)控制為調(diào)速系統(tǒng)，具有直流電機調(diào)速起步快、超調(diào)量小、并且抗擾動能力強等優(yōu)點。
[0014](2)底層控制器采用了以驅(qū)動電流控制直流電機的加速度特性的驅(qū)動系統(tǒng)，能實現(xiàn)雙閉環(huán)直流調(diào)速系統(tǒng)動態(tài)參數(shù)可調(diào)，以此來實現(xiàn)機器人驅(qū)動。
【附圖說明】
[0015]圖1為本發(fā)明的總體結(jié)構(gòu)示意圖。
[0016]圖2為本發(fā)明機器人運動控制系統(tǒng)的控制圖。
【具體實施方式】
[0017]下面結(jié)合附圖對本發(fā)明作進一步介紹:
[0018]實施例
[0019]如圖1所示，在核心控制器，完成驅(qū)動電機的控制算法實現(xiàn)。上位機通過SCI串口通信模塊經(jīng)底層控制器的雙閉環(huán)控制使電動機按照上位機給定的電流進行加速并實現(xiàn)給定的轉(zhuǎn)速;其底層控制器和進行數(shù)據(jù)交換。電流采集模塊采集電機的電樞電流在經(jīng)過編碼處理后經(jīng)ADC傳入核心控制器。核心控制器采集編碼器反饋數(shù)據(jù)，經(jīng)過一定測速算法將轉(zhuǎn)速數(shù)據(jù)發(fā)送給上位機。核心控制器再通過底層控制器產(chǎn)生HVM信號去控制H橋電路電機驅(qū)動模塊，從而控制電機轉(zhuǎn)速和電流。
[0020]整個控制系統(tǒng)采用的電流、轉(zhuǎn)速雙閉環(huán)調(diào)速結(jié)構(gòu)如圖2，外環(huán)為加速度控制環(huán)，內(nèi)環(huán)為PI控制電流環(huán)。給點轉(zhuǎn)速與反饋產(chǎn)生的速度差值經(jīng)過智能控制器控制后得到電流環(huán)給定將于電流反饋值比較差值作為電流環(huán)調(diào)節(jié)器的輸入，從而構(gòu)成兩輪機器人的運動控制系統(tǒng)。
[0021]以上所述是本發(fā)明的優(yōu)選實施方式，應(yīng)當(dāng)指出，對于本技術(shù)領(lǐng)域的普通技術(shù)人員來說，在不脫離本發(fā)明原理的前提下，還可以做出若干改進和潤飾，這些改進和潤飾也視為本發(fā)明的保護范圍。
【主權(quán)項】
1.一種基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，其特征在于:所采用的系統(tǒng)包括核心控制器、電機驅(qū)動模塊、電流采集模塊以及通信模塊;所述核心控制器的底層系統(tǒng)由FLASH存儲器、快速的A/D轉(zhuǎn)換器、增強的CAN模塊、事件管理器、正交編碼電路接口機多通道緩沖串口組成;核心控制器完成驅(qū)動電機的控制算法，產(chǎn)生PWM信號去控制H橋電路電機驅(qū)動模塊工作;所述核心控制器與電流采集模塊相連，所述電流采集模塊和電機相連，完成信號的采集;所述通信模塊連接核心控制模塊的底層系統(tǒng)與上位機。2.根據(jù)權(quán)利要求1所述的基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，其特征在于:所述通信模塊采用SCI串口通信傳輸核心控制器的底層系統(tǒng)與上位機的交互數(shù)據(jù)，底層控制器接收并翻譯上位機的命令數(shù)據(jù)包。3.根據(jù)權(quán)利要求1所述的基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，其特征在于:快速的A/D轉(zhuǎn)換器對電動機電樞電流進行檢測采集。4.根據(jù)權(quán)利要求1所述的基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，其特征在于:利用核心控制器的底層系統(tǒng)，采集編碼器反饋數(shù)據(jù)，經(jīng)過一定測速算法后將轉(zhuǎn)速數(shù)據(jù)發(fā)送給上位機。5.根據(jù)權(quán)利要求1所述的基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，其特征在于:上位機通過轉(zhuǎn)速環(huán)和電流環(huán)雙閉環(huán)控制使電機按照上位機給定的電流進行加速并實現(xiàn)給定的轉(zhuǎn)速。6.根據(jù)權(quán)利要求1所述的基于直流電機雙閉環(huán)調(diào)速的兩輪機器人運動控制方法，其特征在于:通過驅(qū)動電流模塊控制直流電機的加速度特性來實現(xiàn)系統(tǒng)的調(diào)速。
【文檔編號】H02P5/50GK105978410SQ201610026813
【公開日】2016年9月28日
【申請日】2016年1月18日
【發(fā)明人】劉劍鋒
【申請人】湖南品信生物工程有限公司