CN100465845C - 小型机载云台跟踪控制装置 - Google Patents
小型机载云台跟踪控制装置 Download PDFInfo
- Publication number
- CN100465845C CN100465845C CNB2006101163618A CN200610116361A CN100465845C CN 100465845 C CN100465845 C CN 100465845C CN B2006101163618 A CNB2006101163618 A CN B2006101163618A CN 200610116361 A CN200610116361 A CN 200610116361A CN 100465845 C CN100465845 C CN 100465845C
- Authority
- CN
- China
- Prior art keywords
- main control
- follow
- control apparatus
- cradle head
- serial ports
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Studio Devices (AREA)
Abstract
本发明涉及一种小型机载云台跟踪控制装置。其电路结构是一个主控单片机与一个辅助单片机采用SPI串行口相连,该两单片机的四个串口经RS-232电平转换芯片后,一个连接电子罗盘,另外三个作为外部串行通讯接口,分别连接一个图像处理模块、一个无线遥控通讯模块和一个机载云台,还有一个角速度传感器由三个电路结构均相同的单轴速度陀螺构成,其输出信号依次经过一个高通滤波器和一个低通滤波兼信号放大器接入所述的主控单片机。本发明对微型飞行器环境具有较好的适应性,能保证摄像头对地面目标的跟踪。
Description
技术领域
本发明涉及一种小型机载云台跟踪控制装置,特别是涉及一种机载的小型的、多传感器、多串口的云台跟踪控制装置。
背景技术
微型无人飞行器携带摄像头可用于地面区域监控或移动目标跟踪,这就要求能准确地按照***需要控制摄像头视线,以获得被监控区域或被跟踪目标的图像,然而飞行器的机身振动和机体姿态难于做到精确控制,将摄像头直接固定在机体上是不可行的,这就需要一个具有两个或三个自由度云台来搭载摄像头,通过云台的准确控制来实现摄像头视线在一定范围内的调整,并稳定摄像头,保证摄像头视线能获得被监控区域或被跟踪目标的稳定图像,从而达到区域监控或目标跟踪的目的。
云台跟踪控制装置对于上述的应用***是不可缺少的,针对应用于微型无人飞行器有负载能力小、外部环境干扰大、周边设备常采用串口通信等特点,要求云台跟控制装置小型化,传感器响应快且准确,串口足够多,较强的运算处理能力,以适应***应用需要。现有的一些控制装置由于要么无相应的传感器、要么没有足够的串口,很难满足这些要求。
发明内容
鉴于以上所述应用的问题和技术要求,本发明的目的在于提供一种机载云台跟踪控制装置,它不仅体积小、重量轻、传感器响应快且信息可靠,而且具有四个串口供***使用,对微型飞行器环境具有较好的适应性。
本发明的构思是:装置采用数字集成电路,双面电路板,选用一款高性能的具有双串口的单片机作为主控芯片的同时,另采用一双串口的廉价的单片机作为串口扩展和辅助处理,在扩展串口的同时,为主控芯片减轻负担,两机间使用两者皆带有的高速的同步串行口(SPI)通信;传感器采用角速度传感器,其中角速度传感器由三个单轴速率陀螺构成,输出信号通过滤波放大电路后由主控芯片A/D采样处理,可以达到很高的响应频率,电子罗盘通过串口向主控芯片提供飞行器的三个姿态角,它响应慢,但比较准确,所以它主要为由角速率陀螺得到的速率信息进行补偿和修正,以获得准确而可靠的飞行器态信息;装置另三个串口作为外部串行通讯接口分别用于与机载云台、图像处理模块和无线遥控通讯模块的通信。
根据上述构思,本发明采用如下技术方案:
一种小型机载云台跟踪控制装置,包括壳体、安装在壳体内的线路板和外部接口,其特征在于电路结构为:有一个主控单片机与一个辅助单片机采用高速同步串口SPI相连,该两单片机的4个串口经过RS-232电平转换芯片后,一个连接到一个电子罗盘,另外三个作为外部串行通讯接口,分别与一个图像处理模块、一个无线遥控通讯模块和一个机载云台相连;还有一个角速度传感器由三个电路结构均相同的单轴速度陀螺构成,其输出信号依次经过高通滤波器、低通滤波兼信号放大器接入所述的主控单片机;所述的图像处理模块将摄像头摄取的目标图像处理结果通过串口送到辅助单片机;所述的辅助单片机为主控单片机扩展串口和辅助处理,输入的目标图像信号经其处理后送到主控单片机;所述的电子罗盘将飞行器三个姿态角数据提供给主控单片机;所述的角速度传感器感受飞行器的三个角速度,依次经过高通滤波、低通滤波和信号放大后由主控单片机A/D采样处理;所述的主控单片机融合跟踪目标图像信息、飞行器的姿态角和角速度信息,计算出机载云台各个方向上的移动角度或速度,并经过串口将控制命令发送给云台,从而完成一次周期控制;所述的无线遥控通讯模块在***工作期间,保持***与地面控制站的通信,在向地面发送实时的跟踪数据的同时,亦接受地面发来的遥控指令,从而实现地面操作人员对机载跟踪***的远程操作和人工干预。
上述的单轴速率陀螺采用ENC-03M型压电速率陀螺传感器。
上述的RS-232电平转换芯片采用两个MAX232电平转换芯片。
上述的电子罗盘采用EZ-COMPASS-3型电子罗盘模块。
上述的高通滤波器由三个电容和三个电阻构成。
上述的低通滤波兼信号放大器由三个运放和三个电容、六个电阻构成。
上述的主控单片机采用C8051F021型单片机。
上述的辅助单片机采用ATmega162型单片机。
本发明与现有技术相比较,具有如下显而易见的突出实质性特点和显著优点:本发明采用主控单片机与辅助单片机相连,具有四个串口供***使用,对微型飞行器环境具有较好的适应性。本发明提供的装置体积小、重量轻、传感器响应快且信息可靠,保证摄像头对地面目标的跟踪。
附图说明
图1是本发明的一个实施例的应用环境图。
图2是图1示例的电路框图。
图3是图1示例的电路原理图。
具体实施方式
本发明的一个优选实施例结合附图说明如下:
参见图1,本小型机载云台跟踪控制装置2应用于微型无人飞行器1携带摄像头对地面移动目标4进行跟踪。本装置2、机载云台3、图像处理模块6和无线遥控通讯模块7均装载在微型无人飞行器1上。机载云台3可两自由度运动,它集成电机驱动,并带有摄像头和RS-232控制接口。其中,5为地面控制站。本装置2的作用就是采集处理飞行器的姿态角和角速度信息,然后融合图像处理模块6传来的跟踪目标图像信息,经过一定的跟踪控制算法,计算出机载云台两个方向上的移动角度或速度,并经过串口将控制命令发送给云台,从而实现对机载云台3的控制;通过云台两个方向上的角度或速度控制来稳定和调整摄像头视线,从而保证被跟踪目标在摄像头视线内,并获得被跟踪目标的稳定图像。
参见图2,虚线框内即为本小型机载云台跟踪控制装置2,其中:角速度传感器8输出信号进入高通滤波器组9,滤除低频的信号和直流分量后进入低通滤波兼信号放大器组10,将高频杂音滤除之后输入到主控单片机11,进行A/D采样处理,得到飞行器的三个角速度;辅助单片机12与主控单片机11通过各自的高速同步串行口(SPI)相连,主控单片机11的两串口经电平转换后,其中一路与电子罗盘13相连,另一路作为外部串行通讯接口与机载云台3相连,主控单片机11可从电子罗盘13获得飞行器的三个姿态角数据;辅助单片机12的两串口经电平转换后均作为外部串行通讯接口,一路与图像处理模块6连接,另一路与无线遥控通讯模块7连接,辅助单片机12其将从图像处理模块6获得的图像处理结果传送给主控单片机11;这样,主控单片机11融合跟踪目标图像信息、飞行器的姿态角和角速度信息,经过一定的跟踪控制算法,计算出云台两个方向上的移动角度或速度,并经过串口将控制命令发送给云台,从而实现对机载云台3的控制;同时,通过无线遥控通讯模块与地面控制站5通信,在向地面发送实时的跟踪数据的同时,亦接受地面发来的遥控指令,从而实现地面操作人员对机载跟踪***的远程操作和人工干预。
本实施例的具体电路参见图3,首先通过外部接口14的电源接口接入+5V电压,经过3.3V稳压源15得到3.3V电压、经过2.5V电压基准16得到2.5V电压。角速度传感器8由三个ENC-03M单轴速度陀螺U1、U2、U3构成,其模拟量输出分别输到高通滤波器组9,即以电容C1和电阻R1构成的高通滤波器,以电容C4和电阻R4构成的高通滤波器,以电容C7和电阻R7构成的高通滤波器;然后再分别经过低通滤波器兼信号放大器组10,即以A1、R2、R3、C3构成的低通滤波兼信号放大器,以A2、R5、R6、C6构成的低通滤波兼信号放大器,以A3、R8、R9、C9构成的低通滤波兼信号放大器;这样低通滤波和电压放大后的信号PITCH、ROLL、YAW才分别输入到主控单片机11的模数转换口ADC0的通道0~2进行A/D采样并处理。主控单片机11和辅助单片机12通过高速同步串行口(SPI)19相连,两机可根据程序需要切换SPI通信模式(主机或从机),JTAG调试口18、20分别对主控单片机11和辅助单片机12进行程序调试及代码下载用。主控单片机11的串口1(P0.0和P0.1)经过MAX232电平转换芯片21后接到电子罗盘7,串口2(P0.6和P0.7)经过MAX232电平转换芯片21后作为外部接口14中的RS-232串口(TX1和RX1),用于与机载云台3相连;辅助单片机16的串口1(TXD0和RXD0)和串口2(TXD1和RXD1)经过MAX232电平转换17在作为外部接口14的中的RS-232串口(TX2和RX2)和RS-232串口(TX3和RX3),分别用于与图像处理模块6和无线遥控通讯模块7相连。
Claims (8)
1.一种小型机载云台跟踪控制装置,包括壳体、安装在壳体内的线路板和外部接口,其特征在于电路结构为:有一个主控单片机(11)与一个辅助单片机(12)采用高速串行口SPI相连,该两单片机(11、12)的四个串口经过RS-232电平转换芯片后,一个连接到一个电子罗盘(13),另外三个作为外部串行通讯接口,分别与一个图像处理模块(6)、一个无线遥控通讯模块(7)和一个机载云台(3)相连;还有一个角速度传感器(8)由三个电路结构均相同的单轴速度陀螺构成,其输出信号依次经过一个高通滤波器(9)和一个低通滤波兼信号放大器(10)接入所述的主控单片机(11);
所述的图像处理模块(6)将摄像头摄取的目标图像处理后通过串口送到所述的辅助单片机(12);
所述的辅助单片机(12)为主控单片机(11)扩展串口和辅助处理,输入目标图像信号经其辅助处理后送到主控单片机(11);
所述的电子罗盘(13)将飞行器(1)三个姿态角数据提供给主控单片机(11);
所述的角速度传感器(8)感受飞行器的三个角速度,依次经高通滤波、低通滤波和信号放大后由主控单片机A/D采样处理;
所述的主控单片机(11)融合跟踪目标、飞行器(1)的姿态角或角速度,计算出机载云台(3)各方向上的移动角度或速度,并经过串口将控制命令发送给云台,从而完成一次周期控制;
所述的无线遥控通讯模块(7)在***工作期间,保持***与地面控制站的通讯,在向地面发送实时的跟踪数据的同时,亦接受地面发来的遥控指令。
2.根据权利要求1所述的小型机载云台跟踪控制装置,其特征在于所述的单轴速度陀螺采用ENC-03M型压电速度陀螺传感器。
3.根据权利要求1所述的小型机载云台跟踪控制装置,其特征在于所述的RS-232电平转换芯片采用两个MAX232电平转换芯片。
4.根据权利要求1所述的小型机载云台跟踪控制装置,其特征在于所述的电子罗盘(13)采用EZ-COMPASS-3型电子罗盘模块。
5.根据权利要求1所述的小型机载云台跟踪控制装置,其特征在于所述的高通滤波器(9)由三个电容和三个电阻构成。
6.根据权利要求1所述的小型机载云台跟踪控制装置,其特征在于所述的低通滤波兼信号放大器(10)由三个运放和三个电容、六个电阻构成。
7.根据权利要求1所述的小型机载云台跟踪控制装置,其特征在于所述的主控单片机(11)采用C8051F021型单片机。
8.根据权利要求1所述的小型机载云台跟踪控制装置,其特征在于所述的辅助单片机(12)采用ATmega162型单片机。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2006101163618A CN100465845C (zh) | 2006-09-21 | 2006-09-21 | 小型机载云台跟踪控制装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2006101163618A CN100465845C (zh) | 2006-09-21 | 2006-09-21 | 小型机载云台跟踪控制装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1952827A CN1952827A (zh) | 2007-04-25 |
CN100465845C true CN100465845C (zh) | 2009-03-04 |
Family
ID=38059196
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNB2006101163618A Expired - Fee Related CN100465845C (zh) | 2006-09-21 | 2006-09-21 | 小型机载云台跟踪控制装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100465845C (zh) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101688783A (zh) | 2007-07-04 | 2010-03-31 | 三菱电机株式会社 | 导航*** |
CN101872198B (zh) * | 2010-05-10 | 2012-05-23 | 北京航天控制仪器研究所 | 车载摄像稳定平台 |
CN102355574B (zh) * | 2011-10-17 | 2013-12-25 | 上海大学 | 机载云台运动目标自主跟踪***的图像稳定方法 |
CN102506277A (zh) * | 2011-11-11 | 2012-06-20 | 桂林电子科技大学 | 基于电子罗盘的水下云台伺服*** |
CN103336529B (zh) * | 2013-06-27 | 2016-05-11 | 深圳市沈氏彤创航天模型有限公司 | 模型飞行增稳器无线设置调节参数的方法和装置 |
CN104281114B (zh) * | 2013-07-12 | 2018-03-06 | 上海弼智仿生高科技有限公司 | 智能设备运动控制*** |
DE112014000134B4 (de) * | 2014-06-04 | 2016-09-22 | Komatsu Ltd. | Stellungsberechnungsvorrichtung für eine Arbeitsmaschine, Arbeitsmaschine und Stellungsberechnungsverfahren für eine Arbeitsmaschine |
CN105004266A (zh) * | 2015-06-26 | 2015-10-28 | 哈尔滨工程大学 | 一种具有滤波器的多管火箭射击精度测量仪 |
CN105867436B (zh) * | 2015-11-27 | 2018-11-09 | 深圳市星图智控科技有限公司 | 无人飞行器及其云台*** |
CN105739544B (zh) * | 2016-03-24 | 2020-02-04 | 北京臻迪机器人有限公司 | 云台航向跟随方法及装置 |
CN105892498B (zh) * | 2016-04-01 | 2018-11-13 | 南京工程学院 | 基于三轴云台的目标凝视与扫视控制*** |
CN106375720A (zh) * | 2016-09-12 | 2017-02-01 | 中国科学院自动化研究所 | 智能视觉云台***及其实现方法 |
CN106325309A (zh) * | 2016-11-02 | 2017-01-11 | 兰州大学 | 一种无线体感云台控制装置 |
CN107219863B (zh) * | 2017-06-16 | 2020-04-10 | 中国科学院长春光学精密机械与物理研究所 | 稳定云台转动的控制方法及控制***及稳定云台 |
WO2020087392A1 (zh) * | 2018-10-31 | 2020-05-07 | 深圳市大疆创新科技有限公司 | 电路板***、拍摄装置、云台组件及可移动平台 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002135766A (ja) * | 2000-10-26 | 2002-05-10 | Fuji Photo Optical Co Ltd | 自動追尾装置 |
CN1449186A (zh) * | 2003-04-03 | 2003-10-15 | 上海交通大学 | 异常目标自动发现及跟踪摄像机*** |
-
2006
- 2006-09-21 CN CNB2006101163618A patent/CN100465845C/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002135766A (ja) * | 2000-10-26 | 2002-05-10 | Fuji Photo Optical Co Ltd | 自動追尾装置 |
CN1449186A (zh) * | 2003-04-03 | 2003-10-15 | 上海交通大学 | 异常目标自动发现及跟踪摄像机*** |
Non-Patent Citations (2)
Title |
---|
闭路监视***中云台镜头控制的原理及实现. 戴钧,戴国骏.杭州电子工业学院学报,第21卷第1期. 2001 |
闭路监视***中云台镜头控制的原理及实现. 戴钧,戴国骏.杭州电子工业学院学报,第21卷第1期. 2001 * |
Also Published As
Publication number | Publication date |
---|---|
CN1952827A (zh) | 2007-04-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100465845C (zh) | 小型机载云台跟踪控制装置 | |
CN102980578B (zh) | 一种双轴旋转光纤捷联惯性导航装置 | |
CN201397468Y (zh) | 一种空中探测无人机地面控制站*** | |
CN101667032A (zh) | 基于视觉的无人直升机目标跟踪*** | |
CN201488737U (zh) | 一种用于惯性测量单元的数据采集*** | |
CN101561681B (zh) | 一种无人机的抗干扰实时数据采样*** | |
CN103064430A (zh) | 机电融合型图像稳定装置 | |
CN102736591A (zh) | 一种分布式pos子imu数据同步采集*** | |
CN104503473B (zh) | 一种惯性稳定控制器 | |
CN202209986U (zh) | 设备状态监测和故障诊断传感装置 | |
CN109143942B (zh) | 一种姿态传感器控制*** | |
CN104898594B (zh) | 一种用于水下机器人群协同控制的通信装置与方法 | |
CN107193292A (zh) | 机载天线高速伺服运动平台 | |
CN103279126A (zh) | 小型无人直升机开发测试平台 | |
CN207459193U (zh) | 一种动中通天线*** | |
CN113395102B (zh) | 一种自适应卫星通信设备以及链路智能选择方法 | |
CN105373136A (zh) | 基于vpx架构的综合电子*** | |
CN202008367U (zh) | 微姿态参考***参数解算电路 | |
CN201463893U (zh) | 数字陀螺组合 | |
CN112562305A (zh) | 一种基于电力载波通信的飞机测试总线*** | |
CN208172576U (zh) | 基于模块化网关装置的物联网车况监控*** | |
CN111142447A (zh) | 一种适用于机载动中通天线的控制单元 | |
CN216301525U (zh) | 两轴低轨卫星激光转台控制装置 | |
CN203350873U (zh) | 三通道数据发送适配器 | |
CN210687719U (zh) | 一种结构紧凑的稳定器 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20090304 Termination date: 20120921 |