基于ARM11的海洋浮標(biāo)云臺(tái)穩(wěn)定控制系統(tǒng)
中國(guó)測(cè)試周金金1，2， 林 志2， 王小英2
摘 要：由于載體姿態(tài)的變化和海浪等因素的影響，海洋浮標(biāo)成像系統(tǒng)所獲得的圖像不穩(wěn)定或者模糊，如何改變現(xiàn)狀是人們不斷探討和研究的課題。結(jié)合陀螺傳感器MPU6050和磁力計(jì)HMC5883L設(shè)計(jì)一套基于ARM11的云臺(tái)穩(wěn)定控制系統(tǒng)，通過S3C6410的I2C接口讀取MPU6050和HMC5883L的數(shù)據(jù)，采用卡爾曼濾波算法對(duì)其進(jìn)行處理，然后解算出載體的航向角和俯仰角，實(shí)現(xiàn)云臺(tái)攝像機(jī)姿態(tài)的反向調(diào)整。當(dāng)云臺(tái)攝像機(jī)與PC相連時(shí)，對(duì)UleadVideoStudio軟件進(jìn)行簡(jiǎn)單的配置，便可看到云臺(tái)攝像機(jī)所拍攝的視頻信息。實(shí)驗(yàn)結(jié)果表明：云臺(tái)將以水平速度280°/s、垂直速度100°/s完成反向偏轉(zhuǎn)，最長(zhǎng)反饋調(diào)整時(shí)間為0.38 s，滿足工程上的應(yīng)用需求；該系統(tǒng)電路結(jié)構(gòu)簡(jiǎn)單、成本低、可視化且穩(wěn)定，可以移植到無(wú)人機(jī)及船舶監(jiān)控等場(chǎng)合，具有一定的實(shí)用性。
關(guān)鍵詞：MPU6050；HMC5883L；卡爾曼濾波；四元數(shù)；云臺(tái)
文獻(xiàn)標(biāo)志碼：A 文章編號(hào)：1674-5124（2016）01-0074-05
Design of PTZ stability control system in ocean buoy based on ARM11
ZHOU Jinjin1，2， LIN Zhi2， WANG Xiaoying2
（1. School of Information and Electrical Engineering，China University of Mining and Technology，
Xuzhou 221000，China；
2. School of Electric and Automatic Engineering，Changshu Institute of Technology，Changshu 215500，China）
Abstract: Because of carrier changing postures and waves and other influential factors， the images acquired from the image system on an ocean buoys is unstable or fuzzy. How to solve this problem has become a topic of constant discussion and research. A set of PTZ stability control system， comprising a gyroscopic sensor MPU6050 and a magnetometer HMC5883L， was developed on an ARM11. The operating principle of the system is as follows: read the data of MPU6050 and HMC5883L through the I2C interface of S3C6410 and process these data by Kalman filtering algorithm. Next， calculate the azimuth angle and pitching angle of the carrier to adjust reversely the posture of the PTZ camera. When the PTZ is connected with PC by USB， the video information can be seen by simple configuration of Ulead VideoStudio software. The experiment results have shown that the PTZ would complete reverse deflection at a horizontal speed of 280°/s and a vertical speed of 100°/s and the longest adjustment time of feedback is 0.38 s， which meets the requirements of engineering application. The system， characterized by simple circuit structure， low cost， visualization and stability， can be transplanted to unmanned aerial vehicles （UAVs） and ship monitoring places.
Keywords: MPU6050； HMC5883L； Kalman filter； quaternions； PTZ
