一種小型直流電動機閉環控制系統及該系統的控制方法，涉及小型直流電動機控制技術。它為了解決現有的小型直流電動機控制系統對直流電機的控制不夠穩定的問題。本發明專利技術硬件上采用C8051F040單片機作為控制器，采用LM629模塊作為運動控制處理器，采用L6203芯片作為電機驅動電路；軟件上將PID控制算法與PWM直流脈寬控制電機方法融合，使控制系統具有功耗低、開關速度快、驅動電流大等優勢，并且具有很高的可靠性與給定跟隨性，適用于小型直流電動機的控制。
【技術實現步驟摘要】
【專利摘要】，涉及小型直流電動機控制技術。它為了解決現有的小型直流電動機控制系統對直流電機的控制不夠穩定的問題。本專利技術硬件上采用C8051F040單片機作為控制器，采用LM629模塊作為運動控制處理器，采用L6203芯片作為電機驅動電路；軟件上將PID控制算法與PWM直流脈寬控制電機方法融合，使控制系統具有功耗低、開關速度快、驅動電流大等優勢，并且具有很高的可靠性與給定跟隨性，適用于小型直流電動機的控制。【專利說明】
本專利技術涉及小型直流電動機控制技術。
技術介紹
直流電機具有良好的起、制動性能，易于在大范圍內平滑調速，在許多需要調速或 者快速正反向的電力拖動領域中得到了廣泛的應用。并且直流電機控制系統在理論上和實 踐上都比較成熟，從某種角度來說，也是交流電機控制的基礎。在大部分的自動控制系統 中，直流電機的控制都屬于基礎的部分，比如在小車的運動控制、機器人的行走、閥門的開 閉、機械臂的運動等等，都有電機的身影。但目前的小型直流電動機控制技術對對直流電機 的控制不夠穩定，無法達到所需的要求。
技術實現思路
本專利技術的目的是為了解決現有的小型直流電動機控制系統對直流電機的控制不 夠穩定的問題，提供。 本專利技術所述的一種小型直流電動機閉環控制系統包括控制器、電源模塊、屏幕、電 機驅動電路、運動控制處理器和編碼器；所述的控制器采用C8051F040單片機實現，運動控 制處理器采用LM629模塊實現；電源模塊由12V電池組提供工作電源，電源模塊用于將12V 電池組輸出的12V電壓信號轉換成5V電源為控制器、屏幕、電機驅動電路、運動控制處理器 和編碼器提供工作電源；控制器與運動控制處理器和屏幕連接；編碼器的編碼信號輸出端 連接運動控制處理器編碼信號輸入端；運動控制處理器的電機驅動信號輸出端通過光電耦 合器連接電機驅動電路的電機驅動信號輸入端；電機驅動電路用于發送驅動信號給電機； 所述的運動控制處理器內嵌入由軟件實現的控制模塊，該控制模塊包括以下單 元： 復位單元：進行硬件復位和中斷復位；并在該單元運行結束之后啟動PID參數讀 取單元； PID參數讀取單元：讀取并存儲PID參數；并在該單元運行結束之后啟動濾波參數 更新單元； 濾波參數更新單元：根據PID參數更新濾波器參數；并在該單元運行結束之后啟 動軌跡參數讀取單元； 軌跡參數讀取單元：讀取并存儲軌跡參數；并在該單元運行結束之后啟動運動控 制信號發送單元； 運動控制信號發送單元：向電機驅動電路發送運動控制信號，并在該單元運行結 束之后啟動新運動判斷單元； 新運動判斷單元：判斷是否收到控制器發來的新運動信號提示信號，并在判斷結 果為是時啟動PID參數讀取單元，在判斷結果為否時結束控制模塊的運行。 上述系統的控制方法包括以下步驟： 復位步驟：進行硬件復位和中斷復位；并在該步驟結束之后執行PID參數讀取步 驟； PID參數讀取步驟：讀取并存儲PID參數；并在該步驟結束之后執行濾波參數更新 步驟； 濾波參數更新步驟：根據PID參數更新濾波器參數；并在該步驟結束之后執行軌 跡參數讀取步驟； 軌跡參數讀取步驟：讀取并存儲軌跡參數；并在該步驟結束之后執行運動控制信 號發送步驟； 運動控制信號發送步驟：向電機驅動電路發送運動控制信號，并在該步驟結束之 后執行新運動判斷步驟； 新運動判斷步驟：判斷是否收到控制器發來的新運動信號提示信號，并在判斷結 果為是時執行PID參數讀取單元，在判斷結果為否時結束該控制方法。 本專利技術所述的，硬件上采 用C8051F040單片機作為控制器，采用LM629模塊作為運動控制處理器，采用L6203芯片作 為電機驅動電路；軟件上將PID控制算法與PWM直流脈寬控制電機方法融合，使控制系統具 有功耗低、開關速度快、驅動電流大等優勢，并且具有很高的可靠性與給定跟隨性。 【專利附圖】【附圖說明】 圖1為實施方式一所述的一種小型直流電動機閉環控制系統的原理框圖； 圖2為實施方式一中"忙"狀態檢測的流程圖； 圖3為實施方式一中控制模塊的工作流程圖； 圖4為實施方式二中復位單元的工作流程圖； 圖5為實施方式六中電源模塊的電路圖； 圖6為實施方式八中LM629模塊的原理框圖； 圖7為實施方式九中有源晶振的電路圖； 圖8為實施方式一中C8051RM0芯片與LM629模塊的連接關系電路圖； 圖9為實施方式七中編碼器向LM629模塊輸入的三個信號的波形圖； 圖10為實施方式十中L6203芯片內部的全橋驅動原理圖； 圖11為實施方式十中電機驅動電路的電路圖； 圖12為實施方式^^一中LM629模塊輸出的調制信號的波形圖； 圖13為實施方式^^一中光耦驅動電路的電路圖。 【具體實施方式】 【具體實施方式】一：結合圖1至圖3、圖8說明本實施方式，本實施方式所述的一種 小型直流電動機閉環控制系統包括控制器1、電源模塊2、屏幕3、電機驅動電路4、運動控制 處理器5和編碼器6 ;所述的控制器1采用C8051F040單片機實現，運動控制處理器5采用 LM629模塊實現；電源模塊2由12V電池組提供工作電源，電源模塊2用于將12V電池組輸 出的12V電壓信號轉換成5V電源為控制器1、屏幕3、電機驅動電路4、運動控制處理器5和 編碼器6提供工作電源；控制器1與運動控制處理器5和屏幕3連接；編碼器6的編碼信號 輸出端連接運動控制處理器5編碼信號輸入端；運動控制處理器5的電機驅動信號輸出端 通過光電耦合器連接電機驅動電路4的電機驅動信號輸入端；電機驅動電路4用于發送驅 動信號給電機； 所述的運動控制處理器5內嵌入由軟件實現的控制模塊，該控制模塊包括以下單 元： 復位單元：進行硬件復位和中斷復位；并在該單元運行結束之后啟動PID參數讀 取單元； PID參數讀取單元：讀取并存儲PID參數；并在該單元運行結束之后啟動濾波參數 更新單元； 濾波參數更新單元：根據PID參數更新濾波器參數；并在該單元運行結束之后啟 動軌跡參數讀取單元； 軌跡參數讀取單元：讀取并存儲軌跡參數；并在該單元運行結束之后啟動運動控 制信號發送單元； 運動控制信號發送單元：向電機驅動電路4發送運動控制信號，并在該單元運行 結束之后啟動新運動判斷單元； 新運動判斷單元：判斷是否收到控制器1發來的新運動信號提示信號，并在判斷 結果為是時啟動PID參數讀取單元，在判斷結果為否時結束控制模塊的運行。 本實施方式所述的一種小型直流電動機閉環控制系統以C8051F040單片機為作 控制器，與運動控制處理器5 (LM629模塊）進行數據交換。運動控制處理器5接收指令后， 做出響應，即產生不同占空比的PWM脈沖。運動控制處理器5直接與直流電機的驅動模塊 即電機驅動電路4相連，這樣即可完成對直流電機穩定的速度和方向的控制。另外，整個控 制系統的電力來源是12V蓄電池組，電源模塊2將12V電壓轉換為5V電壓，提供給控制器 1、屏幕3、電機驅動電路4、運動控制處理器5以及編碼器6。 C8051RM0單片機是高集成度的混合信號片上系統，有按8位端口組織本文檔來自技高網...
【技術保護點】
一種小型直流電動機閉環控制系統，其特征在于：它包括控制器(1)、電源模塊(2)、屏幕(3)、電機驅動電路(4)、運動控制處理器(5)和編碼器(6)；所述的控制器(1)采用C8051F040單片機實現，運動控制處理器(5)采用LM629模塊實現；電源模塊(2)由12V電池組提供工作電源，電源模塊(2)用于將12V電池組輸出的12V電壓信號轉換成5V電源為控制器(1)、屏幕(3)、電機驅動電路(4)、運動控制處理器(5)和編碼器(6)提供工作電源；控制器(1)與運動控制處理器(5)和屏幕(3)連接；編碼器(6)的編碼信號輸出端連接運動控制處理器(5)編碼信號輸入端；運動控制處理器(5)的電機驅動信號輸出端通過光電耦合器連接電機驅動電路(4)的電機驅動信號輸入端；電機驅動電路(4)用于發送驅動信號給電機；所述的運動控制處理器(5)內嵌入由軟件實現的控制模塊，該控制模塊包括以下單元：復位單元：進行硬件復位和中斷復位；并在該單元運行結束之后啟動PID參數讀取單元；PID參數讀取單元：讀取并存儲PID參數；并在該單元運行結束之后啟動濾波參數更新單元；濾波參數更新單元：根據PID參數更新濾波器參數；并在該單元運行結束之后啟動軌跡參數讀取單元；軌跡參數讀取單元：讀取并存儲軌跡參數；并在該單元運行結束之后啟動運動控制信號發送單元；運動控制信號發送單元：向電機驅動電路(4)發送運動控制信號，并在該單元運行結束之后啟動新運動判斷單元；新運動判斷單元：判斷是否收到控制器(1)發來的新運動信號提示信號，并在判斷結果為是時啟動PID參數讀取單元，在判斷結果為否時結束控制模塊的運行。...
【技術特征摘要】
【專利技術屬性】
技術研發人員：王丁，孫書利，
申請(專利權)人：黑龍江大學，
類型：發明
國別省市：黑龍江;23
還沒有人留言評論。發表了對其他瀏覽者有用的留言會獲得科技券。