以STM32F103C8T6為核心,設計了無刷直流電機控制器硬件電路。電路主要包括IR2310構(gòu)成的PWM驅(qū)動電路、IRF3808構(gòu)成的逆變電路、增量式旋轉(zhuǎn)編碼構(gòu)成的速度反饋電路。控制器具有CAN和RS232通信接口,可與計算機或PLC構(gòu)成速度或位置伺服系統(tǒng)。利用由xPC目標搭建的半實物仿真平臺對PI參數(shù)進行整定。測試了控制器的速度伺服響應性能,給定速度為2400rpm時,控制器響應時間為0.32s。實驗結(jié)果表明,系統(tǒng)工作可靠,穩(wěn)定性好,響應速度快,可以滿足上肢康復機器人的機械臂速度控制性能要求。The hardware circuit of Brushless DC motor controller is designed by taking STM32F103C8T6 as the core,which mainly includes PWM driving circuits made up of IR2310,inverter circuit formed by IRF3808,speed feedback circuit composed of incremental rotary encoder and so on.Speed servo control system or position servo control system can be composed of BLDM controller with computer or PLC through CAN communication interface or RS232 serial communication interface.By using the hardware in the loop simulation platform built by xPC target,the PI parameters are set up.The Speed servo response performance of the controller is tested.When the speed is 2 400 rpm,the response time of the controller is 0...
針對四軸飛行器飛行性能不穩(wěn)定和慣性測量單元(IMU)易受干擾、存在漂移等問題,利用慣性傳感器MPU6050采集實時數(shù)據(jù),以經(jīng)典互補濾波為基礎,提出一種可以自適應補償系數(shù)的互補濾波算法,該算法在低通濾波環(huán)節(jié)加入PI控制器,依據(jù)陀螺儀測得的角速度實時調(diào)節(jié)PI控制器補償系數(shù)。飛行器姿態(tài)控制系統(tǒng)采用雙閉環(huán)PID控制方法,姿態(tài)解算的歐拉角作為系統(tǒng)外環(huán),陀螺儀角速度作為系統(tǒng)內(nèi)環(huán)。最后,搭建以NI my RIO為核心控制器的四軸飛行器,通過Lab VIEW實現(xiàn)算法和仿真,實驗結(jié)果表明,自適應互補濾波算法可以準確解算姿態(tài)信息,雙閉環(huán)PID控制超調(diào)量小、反應靈敏,控制系統(tǒng)基本滿足飛行要求。