CN101807080B - 架空线路巡检机器人飞艇控制***及其控制方法 - Google Patents
架空线路巡检机器人飞艇控制***及其控制方法 Download PDFInfo
- Publication number
- CN101807080B CN101807080B CN2010101254806A CN201010125480A CN101807080B CN 101807080 B CN101807080 B CN 101807080B CN 2010101254806 A CN2010101254806 A CN 2010101254806A CN 201010125480 A CN201010125480 A CN 201010125480A CN 101807080 B CN101807080 B CN 101807080B
- Authority
- CN
- China
- Prior art keywords
- dsp
- communication module
- ground
- master controller
- robot
- 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
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000007689 inspection Methods 0.000 title abstract description 15
- 238000004891 communication Methods 0.000 claims abstract description 43
- 238000006243 chemical reaction Methods 0.000 claims abstract description 18
- 230000005540 biological transmission Effects 0.000 claims description 18
- 230000003028 elevating effect Effects 0.000 claims description 9
- 230000001133 acceleration Effects 0.000 claims description 8
- 238000001514 detection method Methods 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 8
- 230000010354 integration Effects 0.000 claims description 5
- 238000012216 screening Methods 0.000 claims description 5
- 238000001914 filtration Methods 0.000 claims description 3
- 238000007667 floating Methods 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- BNIILDVGGAEEIG-UHFFFAOYSA-L disodium hydrogen phosphate Chemical compound [Na+].[Na+].OP([O-])([O-])=O BNIILDVGGAEEIG-UHFFFAOYSA-L 0.000 claims 13
- 238000005516 engineering process Methods 0.000 description 12
- 238000011160 research Methods 0.000 description 9
- SDJLVPMBBFRBLL-UHFFFAOYSA-N dsp-4 Chemical compound ClCCN(CC)CC1=CC=CC=C1Br SDJLVPMBBFRBLL-UHFFFAOYSA-N 0.000 description 6
- 238000013461 design Methods 0.000 description 4
- 230000002950 deficient Effects 0.000 description 3
- 230000005611 electricity Effects 0.000 description 3
- 238000009413 insulation Methods 0.000 description 3
- 230000000087 stabilizing effect Effects 0.000 description 3
- 101100388212 Arabidopsis thaliana DSP3 gene Proteins 0.000 description 2
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000007812 deficiency Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 229910052744 lithium Inorganic materials 0.000 description 2
- 239000000725 suspension Substances 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 101150062184 DSP4 gene Proteins 0.000 description 1
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 230000000712 assembly Effects 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 230000034994 death Effects 0.000 description 1
- 231100000517 death Toxicity 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009429 electrical wiring Methods 0.000 description 1
- PCHJSUWPFVWCPO-UHFFFAOYSA-N gold Chemical compound [Au] PCHJSUWPFVWCPO-UHFFFAOYSA-N 0.000 description 1
- 239000010931 gold Substances 0.000 description 1
- 229910052737 gold Inorganic materials 0.000 description 1
- 239000012212 insulator Substances 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种架空线巡检机器人飞艇控制***及其控制方法。控制***包括艇载***和地面***，艇载***结构为：主控制器DSP经模数转换、串口等端口连接各种传感器、无线通信模块、电机驱动电路、图像处理器DSP等，图像处理器DSP通过HPI接口连接红外CCD；地面***结构为：接口单片机经串口、I/O等端口与地面PC、无线通信设备、手动遥控器连接；艇载***和地面***由艇载无线通信模块和地面无线通信模块联系；无线摄像头通过无线视频信号向地面***发送图像信息，并显示在图像监视器上。该架空线巡检机器人飞艇控制***有红外视觉导航模式、GPS导航吗模式和人工遥控模式三种控制模式，巡检效率高、续航能力强、安全性高。
Description
技术领域
本发明涉及一种专用于架空输电线路巡检的机器人飞艇控制***及其控制方法。属于电力线路非接触式检测技术领域。
背景技术
随着几年来我国经济和技术的飞速发展，对能源的需求越来越大，长距离、超高压、大容量输电线路大幅扩建。线路走廊需要穿越各种复杂的地理环境，如经过大面积达水库、湖泊和崇山峻岭等，这些都给电力线路的检测带来了很多困难。尤其是对于电力线路穿越原始森林边缘地区、高海拔、冰雪覆盖区以及沿线存在频繁多滑坡、泥石流等地质灾害，大部分地区山高坡陡，交通和通讯极不发达时，给电力线路的日常巡检带来了很多困难。另一方面，随着技术和经济的发展，社会对供电的质量、连续性和可靠性的要求越来越高，如何解决电力线路的日常检测成为困扰电力行业的一个重大难题。
传统的输电线路的巡检主要采用两种方法，即人工目测法和载人直升飞机航测法。我国电力线路的巡检工作主要由人工完成；国外使用直升机代替人工进行电力线路的日常巡检工作已经比较流行，国内也开始探索。人工目测法的巡检精度低，劳动强度大，且存在巡检盲区；载人直升飞机航测法则存在飞行安全隐患且巡线费用昂贵等问题。随着机器人技术的发展，巡线机器人可以克服上述缺陷，因此，巡线机器人已成为特种机器领域的一个研究热点。机器人自动巡检技术可以分为行走式巡检机器人(Mobile Robot for OverheadPowerline Inspection，简称MROPI)和电力线路巡检飞行机器人(Flying Robotfor overhead powerline inspection，简称FROPI)。
MROPI能够带电工作，以一定的速度沿输电线爬行，并能跨越防震锤、耐张线夹、悬垂线夹、杆塔等障碍，利用携带的传感仪器对杆塔、导线及避雷线、绝缘子、线路金具、线路通道等实施接近检测。国外MROPI的研究始于20世纪80年代末，日本、美国、加拿大、泰国的一些研究机构先后开展了巡线机器人的研究。国内MROPI的研究始于20世纪90年代末，中国科学院、武汉大学等单位在该领域进行了研究。这类技术的主要缺陷是结构尺寸大、质量大，因而实用性差，并大多仍处在实验室研制阶段。其次，由于采用滚轮或机械臂等结构，机器人的移动速度受到限制，巡检效率不高。例如，《机器人技术与应用》杂志2006年03期中“500kv超高压输电线路巡检机器人现场带电巡检试验成功”一文中介绍了一种由中国科学院沈阳自动化研究设计的MROPI，其移动速度是仅为每分钟12-20米，即每小时巡检距离不超过1.2公里。另外，由于接触超高压设备，机器人登上或撤下输电线时的绝缘问题难以解决。
目前，国内外在FROPI领域的研究还较少，主要是针对以微型无人直升机为载体的研究。这些微型无人直升机安装CCD摄像机，利用GPS导航，可以沿着架空线低空飞行和超视距测控飞行；能够克服MROPI的缺陷，巡检速度高，且不受金具等障碍限制，也没有绝缘问题，同时巡检成本也较低。目前国内的华北电力大学就开展了FROPI的研究。中国专利CN1305194C，名称为“电力线路巡检机器人飞机及其控制***”，公开了一种由华北电力大学设计的FROPI。该技术的飞机结构采用共轴双螺旋桨反向驱动结构，采用两个发动机分别驱动两个螺旋桨反向旋转，通过控制两个直流电机的转速比控制飞机机身的稳定；使用GPS***与GIS***确定飞机的飞行轨迹，使用基于32位ARM嵌入式***进行飞行姿态调整，使用蓄电池为电机、检测传感器以及数据链路***提供电源。该技术主要缺陷是目前的GPS/GIS***定位精度难以确保精确有效地跟踪输电线路(主流的GPS接收器定位频率不大于5Hz，定位精度在5m至99m)，单纯依靠GPS导航可能出现飞行轨迹偏离输电线路径，从而出现巡检盲区；并且基于微型无人直升机的FROPI坠毁的风险较大，可能导致机身和记载设备严重损毁；同时无人直升机的续航能力不足也是制约该技术实际应用的重要问题。
发明内容
本发明的目的是提出一种架空线路巡检机器人飞艇控制***及其控制方法，以克服现有的行走式巡线机器人MROPI存在的行动慢、效率低、装卸绝缘难的缺陷，并解决基于无人直升机的飞行机器人FROPI存在的续航能力不足、GPS定位精度低、坠毁的风险较大等问题。
本发明的架空线巡检机器人飞艇控制***及其控制方法，是以无人飞艇为飞行平台，基于红外视觉导航技术和GPS导航技术，以数字信号处理器DSP为核心硬件，能实现沿着架空电力线自主飞行和超视距人工遥控飞行的智能控制***及其控制方法。
根据上述构思，本发明的架空线巡检机器人飞艇控制***，包含艇载***和地面***两部分，艇载***包括主控制器DSP、图像处理器DSP、红外CCD、倾角仪、加速度计、高度计、GSP定位模块、艇载无线通信模块、闪存、16位动态存储器、32位动态存储器、电机驱动电路、舵机控制器和无线摄像头；主控制器DSP通过外拓总线与闪存和16位动态存储器连接，图像处理器DSP通过外拓总线与32位动态存储器连接；图像处理器DSP的XINTF端口连接到主控制器DSP的XINTF端口；红外CCD输出的数字视频信号输出端连接到图像处理器DSP的HPI端口，倾角仪、加速度计和高度计分别与主控制器DSP的模/数转换接口相连，GSP定位模块和艇载无线通信模块分别与主控制器DSP的串口相连；驱动直流电机的电机驱动电路与主控制器DSP的PWM输出接口相连；驱动舵机的舵机驱动器的串口输入端与主控制器DSP的串口相连；地面***包括地面PC、接口单片机、电平转换芯片MAX232、地面无线通信模块、手动遥控器、CCD接收终端和图像监视器；地面PC的RS232接口端与电平转换芯片MAX232的RS232接口端相连，电平转换芯片MAX232的TTL端连与单片机的一个串口相连，接口单片机的另一个串口与地面无线通信模块连接，接口单片机的模数转换接口与手动遥控器的控制信号输出端连接，接口单片机的I/O引脚与手动遥控器的手动模式开关的输出信号端连接；CCD接收终端的AV信号输出端与图像监视器的AV信号输入端相连；艇载***和地面***通过艇载无线通信模块与地面无线通信模块实现通信联系；无线摄像头向地面的CCD接收终端发送视频信号，并显示在图像监视器上。
上述的主控制器DSP可以是TMS320F2812型16位浮点DSP数字信号处理器，用于控制和管理各种外部设备；图像处理器DSP可以是TMS320C6711B型32位浮点型DSP，用于红外CCD的图像识别。
上述的高度计可以是HP03型气压传感器；加速度计为具有3路模拟信号输出的MMA7260加速度传感芯片；倾角仪可以采用双轴SA100T信号倾角传感仪；GSP定位模块可以是台湾Goeget公司的ST-93型GPS模块；红外CCD可以是浙江大立公司制造的D780C型红外热像机芯组件。
上述的电机驱动电路采用机器人梦工厂公司生产的DF-MDV1.3型号直流电机驱动模块，该模块由一片L289型双路H桥直流电机驱动芯片、电源芯片以及功率开关电路组成。
上述的舵机控制器为Lynxmotion公司的SSC32V2型32路舵机控制器模块。
上述的艇载无线通信模块与地面无线通信模块均为BENQ公司制造的M22型号GPRS通信模块，采用GPRS公网方式通信；艇载无线通信模块与地面无线通信模块之间搭建了上行和下行两条数据链路，实现了艇载***和地面***之间的通信。
上述的接口单片机可以是ATMEL公司制造的Mega16型单片机，其电源由5V稳压芯片LM7805提供；手动遥控器是一个Futaba72M 4EX型号四通道比例控制遥控器，其输出信号是4路0V～5V的模拟信号，对应于舵机0度～180度的转角或电机的转速；手动遥控器还具有一个手动模式开关，其输出为0V或5V电位，对应于人工遥控模式开启和关闭。
架空线巡检机器人飞艇控制***的控制方法，其控制步骤如下：
1)利用倾角仪、加速度计、高度计和GSP定位模块读取飞艇的姿态角、加速度、飞行高度和位置坐标参数送至主控制器DSP，通过对加速度积分运算获取速度，进行尺度变换、积分运算和低通滤波的数据处理并存储于闪存；
2)将存储在闪存的飞行轨迹、飞行姿态和电池电量参数通过艇载无线通信模块发送到地面无线通信模块，并存储在地面PC；将无线摄像头拍摄的图像通过无线视频信号传输至地面的CCD接收终端，并显示在图像监视器上；
3)图像处理器DSP采用基于边缘检测、Hough变换和特征筛选方法的图像处理综合算法，对红外CCD采集的图像进行分析处理，获取输电线所在直线段的坐标方程，并计算该直线段与参考直线的最短距离和夹角，获取机器人飞艇的偏航距离和偏航角；
4)根据GPS定位模块获取的偏航距离和步骤3)中获取的图像信息，在GPS导航模式、红外视觉导航模式和人工遥控模式中进行三选一的切换：如果手动遥控器的手动模式开关为开启，则启用人工遥控模式；在人工遥控模式开关关闭的前提下，若步骤3)中返回的直线条数不为零且由GPS定位模块获取的偏航距离在预设范围内时，则启用红外视觉导航模式；若步骤3)中返回的直线条数为零或由GPS定位模块获取的偏航距离在预设范围外时，则启用GPS导航模式；其中，在GPS导航模式下，进入步骤5)；在红外视觉导航模式下，进入步骤6)；在人工遥控模式下，进入步骤7)；
5)从闪存中读取被检测输电线的分布位置信息和预设飞行路径的坐标信息；将步骤1)中获取的位置坐标、速度和飞行高度与预设的飞行路径进行比较，计算出偏差量，利用主控制器DSP向电机驱动电路和舵机驱动器发送控制信号，对方向舵偏角、推进器转速和升降舵偏角进行控制，实现偏航控制、速度控制和高度控制，使机器人飞艇沿着预设的飞行路径飞行；
6)根据步骤3)中获取的偏航距离和偏航角以及从步骤1)中读取的飞行高度和速度，利用主控制器DSP向电机驱动电路和舵机驱动器发送控制信号，对方向舵偏角、推进器转速和升降舵偏角进行控制，实现飞艇的航向控制、高度控制和速度控制，使机器人飞艇沿着架空线上方飞行；
7)地面人员通过手动控制器输入飞艇的航向控制信号、高度控制信号和速度控制信号，并通过地面无线通信模块将这些信号发送至艇载无线通信模块，经主控制器DSP传送至电机驱动电路和舵机驱动器，对方向舵偏角、推进器转速和升降舵偏角进行控制。
上述步骤3)中所说的图像处理器DSP基于边缘检测、Hough变换和特征筛选方法的图像处理综合算法，对红外CCD采集的图像进行分析处理，其步骤如下：a)图像处理器DSP读入单帧图像并存储图像的高度、宽度参数；b)处理边缘算子，采用Canny边缘算子提取对比度高的区域，作为物体边缘；c)对物体边缘进行Hough变换，排除干扰图形，选出超过指定长度的线段；d)删去与主线段交叉的线段；e)通过Hough变换的距离算法，将物体边缘处理产生的两条线段并为一条直线段，得到输电线所在直线的坐标方程。
本发明与现有技术相比，具有以下优点：
a.由于机器人飞艇具有自主飞行控制***，可以实现无人飞行，能够低空沿架空线飞行，即便发生了飞行意外也不会造成人员的伤亡，有效的解决了载人直升机飞行事故中可能造成的人员损失。
b.由于飞艇自身具有悬浮特性，不易出现急速坠落的情况，只要气囊不出现破损，即便坠落也不会造成飞艇和艇载设备的严重损毁，因此具有较低的坠毁风险。
c.由于飞艇悬浮依靠空气浮力，不需要额外能量，推进器只有需要提供克服空气阻力的能量，因此具有更强的续航能力；一般地，在使用同类推进器的前提下，飞艇比同载荷的无人直升机续航能力强30％以上。
d.由于引入了红外视觉控制技术，本发明较之单纯使用GPS导航具有更高的输电线路跟踪精度，能够确保红外CCD捕捉到架空电线图像，减少巡检死区。
因而，本发明提供了一种巡检效率高、续航能力强、安全性高、自动化程度高的架空线自动巡检技术。
附图说明
图1是架空线巡检机器人飞艇控制***示意图。
图2是红外视觉导航模式下架空线路巡检的Simulink二维仿真效果图。
具体实施方式
以下结合附图进一步说明本发明。
参见图1，本发明的架空线巡检机器人飞艇控制***，包含艇载***1和地面***2两部分，艇载***1包括主控制器DSP3、图像处理器DSP4、红外CCD5、倾角仪6、加速度计7、高度计8、GSP定位模块9、艇载无线通信模块10、闪存11、16位动态存储器12、32位动态存储器13、电机驱动电路14、舵机控制器15和无线摄像头21；主控制器DSP 3通过外拓总线与闪存11和16位动态存储器12连接，图像处理器DSP 4通过外拓总线与32位动态存储器13连接；图像处理器DSP 4的XINTF端口连接到主控制器DSP 3的XINTF端口；红外CCD 5输出的数字视频信号输出端连接到图像处理器DSP 4的HPI端口，倾角仪6、加速度计7和高度计8分别与主控制器DSP 3的模/数转换接口相连，GSP定位模块9和艇载无线通信模块10分别与主控制器DSP 3的串口相连；驱动直流电机的电机驱动电路14与主控制器DSP 3的PWM输出接口相连；驱动舵机的舵机驱动器15的串口输入端与主控制器DSP 3的串口相连；地面***2包括地面PC 16、接口单片机17、电平转换芯片MAX232 18、地面无线通信模块19、手动遥控器20、CCD接收终端22和图像监视器23；地面PC 16的RS232转口与电平转换芯片MAX232 18的RS232接口端相连，电平转换芯片MAX232 18的TTL端连与单片机17的一个串口相连，接口单片机17的另一个串口与地面无线通信模块19连接，接口单片机17的模数转换接口与手动遥控器20的控制信号输出端连接，接口单片机17的I/O引脚与手动遥控器20的手动模式开关的输出信号端连接；CCD接收终端22的AV信号输出端与图像监视器23的AV信号输入端相连；艇载***1和地面***2通过艇载无线通信模块10与地面无线通信模块19实现通信联系；无线摄像头21向地面的CCD接收终端22发送视频信号，并显示在图像监视器23上。
艇载***1中各个元件的型号、厂商和供电电压参见表1。
表1
| 编号 | 硬件名称 | 生产厂家 | 型号 | 电源电压 |
| 3 | 主控制器DSP | 德州仪器 | TMS320F2812 | 3.3V |
| 4 | 图像处理器DSP | 德州仪器 | TMS320C6711B | 3.3V |
| 5 | 红外CCD | 浙江大立 | D780C | 12V |
| 6 | 倾角仪 | VTI公司 | SA100T | 5V |
| 7 | 加速度计 | MMA7260 | MMA7260 | 3.3V |
| 8 | 高度计 | 深圳华普 | HP03 | 5V |
| 9 | GSP定位模块 | Goeget | ST93 | 5V |
| 10 | 艇载无线通信模块 | BENQ | M22 | 5V |
| 11 | 闪存 | Spansion | S29PL256N | 3.3V |
| 12 | 16位动态存储器 | 德州仪器 | BQ4015LY | 3.3V |
| 13 | 32位动态存储器 | 德州仪器 | BQ2204A | 3.3V |
| 14 | 电机驱动电路 | 机器人梦工厂 | DF-MD V1.3 | 12V |
| 15 | 舵机控制器 | Lynxmotion | SSC32 V2 | 5V |
| 21 | 无线摄像头 | Hobby Wireless | T1024 | 12V |
上述的高度计、加速度计、倾角仪、艇载无线通信模块、GSP定位模块、主控制器DSP、图像处理器DSP、闪存、16位动态存储器、32位动态存储器可以印刷在一张主电路板上；电机驱动电路、舵机控制器、红外CCD单独制版并通过电线连接到主电路板；艇载***采用12V锂电池供电，采用12V/5V/3.3V混合供电***，12V电源直接取自锂电池，5V电源由LM7605型稳压芯片提供，主要提供各种外设芯片供电，3.3V电压源由TPS7333型低压差线性稳压器提供。
地面***2的接口单片机17是ATMEL公司制造的Mega16型单片机，其电源由5V稳压芯片LM7805提供；手动遥控器20是一个Futaba72M 4EX型号四通道比例控制遥控器，其输出信号是4路0V～5V的电位信号，对应于舵机0度～180度的转角或电机的转速；手动遥控器20还具有一个手动模式开关，其输出为5V或0V电位，对应于自动飞行模式和人工遥控模式。
架空线巡检机器人飞艇控制***的控制方法，其控制步骤如下：
1)利用倾角仪6、加速度计7、高度计8和GSP定位模块9读取飞艇的姿态角、加速度、飞行高度和位置坐标参数送至主控制器DSP3，通过对加速度积分运算获取速度，进行尺度变换、积分运算和低通滤波的数据处理并存储于闪存11；
2)将存储在闪存11的飞行轨迹、飞行姿态和电池电量参数通过艇载无线通信模块10发送到地面无线通信模块19，并存储在地面PC16；将无线摄像头21拍摄的图像通过无线视频信号传输至地面的CCD接收终端22，并显示在图像监视器23上；
3)图像处理器DSP 4采用基于边缘检测、Hough变换和特征筛选方法的图像处理综合算法，对红外CCD 5采集的图像进行分析处理，步骤如下：a)图像处理器DSP 4读入单帧图像并存储图像的高度、宽度参数；b)处理边缘算子，采用Canny边缘算子提取对比度高的区域，作为物体边缘；c)对物体边缘进行Hough变换，排除干扰图形，选出超过指定长度的线段；d)删去与主线段交叉的线段；e)通过Hough变换的距离算法，将物体边缘处理产生的两条线段并为一条直线段，得到输电线所在直线的坐标方程。最后计算该直线段与参考直线的最短距离和夹角，获取机器人飞艇的偏航距离和偏航角；
4)根据GPS定位模块9获取的偏航距离和步骤3)中获取的图像信息，在GPS导航模式、红外视觉导航模式和人工遥控模式中进行三选一的切换：如果手动遥控器20的手动模式开关为开启，则启用人工遥控模式；在人工遥控模式开关关闭的前提下，若步骤3)中返回的直线条数不为零且由GPS定位模块9获取的偏航距离在预设范围内时，则启用红外视觉导航模式；若步骤3)中返回的直线条数为零或由GPS定位模块9获取的偏航距离在预设范围外时，则启用GPS导航模式；其中，在GPS导航模式下，进入步骤5)；在红外视觉导航模式下，进入步骤6)；在人工遥控模式下，进入步骤7)；
5)从闪存11中读取被检测输电线的分布位置信息和预设飞行路径的坐标信息；将步骤1)中获取的位置坐标、速度和飞行高度与预设的飞行路径进行比较，计算出偏差量，利用主控制器DSP 3向电机驱动电路14和舵机驱动器15发送控制信号，对方向舵偏角、推进器转速和升降舵偏角进行控制，实现偏航控制、速度控制和高度控制，使机器人飞艇沿着预设的飞行路径飞行；
6)根据步骤3)中获取的偏航距离和偏航角以及从步骤1)中读取的飞行高度和速度，利用主控制器DSP 3向电机驱动电路14和舵机驱动器15发送控制信号，对方向舵偏角、推进器转速和升降舵偏角进行控制，实现飞艇的航向控制、高度控制和速度控制，使机器人飞艇沿着架空线上方飞行；
7)地面人员通过手动控制器20输入飞艇的航向控制信号、高度控制信号和速度控制信号，并通过地面无线通信模块19将这些信号发送至艇载无线通信模块10，经主控制器DSP 3传送至电机驱动电路14和舵机驱动器15，对方向舵偏角、推进器转速和升降舵偏角进行控制。
图2给出了在Simulink仿真平台下，在红外视觉导航模式下进行二维飞行巡检的仿真效果图。在具体实施对高压架空电力线路进行检测时，先开启人工遥控模式，由地面人员遥控机器人飞艇起飞，并到达架空线斜上方10米到20米的位置后，关闭人工遥控模式，进入红外视觉导航模式，机器人飞艇开始沿电力线飞行，同时向地面传送红外图像、飞行参数、视频图像等信息，用于电力线故障诊断和飞行监控。由图2可见，飞艇能够沿着带巡检的架空线飞行。
Claims (3)
1.架空线巡检机器人飞艇控制***，包含艇载***(1)和地面***(2)两部分，其特征在于：艇载***(1)包括主控制器DSP(3)、图像处理器DSP(4)、红外CCD(5)、倾角仪(6)、加速度计(7)、高度计(8)、GSP定位模块(9)、艇载无线通信模块(10)、闪存(11)、16位动态存储器(12)、32位动态存储器(13)、电机驱动电路(14)、舵机控制器(15)和无线摄像头(21)；主控制器DSP(3)通过外拓总线与闪存(11)和16位动态存储器(12)连接，图像处理器DSP(4)通过外拓总线与32位动态存储器(13)连接；图像处理器DSP(4)的XINTF端口连接到主控制器DSP(3)的XINTF端口；红外CCD(5)输出的数字视频信号输出端连接到图像处理器DSP(4)的HPI端口，倾角仪(6)、加速度计(7)和高度计(8)分别与主控制器DSP(3)的模/数转换接口相连，GSP定位模块(9)和艇载无线通信模块(10)分别与主控制器DSP(3)的串口相连；驱动直流电机的电机驱动电路(14)与主控制器DSP(3)的PWM输出接口相连；驱动舵机的舵机驱动器(15)的串口输入端与主控制器DSP(3)的串口相连；地面***(2)包括地面PC(16)、接口单片机(17)、电平转换芯片MAX232(18)、地面无线通信模块(19)、手动遥控器(20)、CCD接收终端(22)和图像监视器(23)；地面PC(16)的RS232接口与电平转换芯片MAX232(18)的RS232接口端相连，电平转换芯片MAX232(18)的TTL端连与单片机(17)的一个串口相连，接口单片机(17)的另一个串口与地面无线通信模块(19)连接，接口单片机(17)的模数转换接口与手动遥控器(20)的控制信号输出端连接，接口单片机(17)的I/O引脚与手动遥控器(20)的手动模式开关的输出信号端连接；CCD接收终端(22)的AV信号输出端与图像监视器(23)的AV信号输入端相连；艇载***(1)和地面***(2)通过艇载无线通信模块(10)与地面无线通信模块(19)实现通信联系；无线摄像头(21)向地面的CCD接收终端(22)发送视频信号，并显示在图像监视器(23)上。
2.根据权利要求1所述的架空线巡检机器人飞艇控制***，其特征是，主控制器DSP(3)为TMS320F2812型16位浮点型数字信号处理器；图像处理器DSP(4)为TMS320C6711B型32位浮点型数字信号处理器；倾角仪(6)为双轴SA100T信号倾角传感仪；加速度计(7)为具有3路模拟信号输出的三轴MMA7260加速度传感芯片；高度计(8)为HP03型气压传感器；GSP定位模块(9)为ST-93型GPS模块。
3.用于权利要求1所述的架空线巡检机器人飞艇控制***的控制方法，其特征是控制步骤如下：
1)利用倾角仪(6)、加速度计(7)、高度计(8)和GPS定位模块(9)读取飞艇的姿态角、加速度、飞行高度和位置坐标参数送至主控制器DSP(3)，通过对加速度积分运算获取速度，进行尺度变换、积分运算和低通滤波的数据处理并存储于闪存(11)；
2)将存储在闪存(11)的飞行轨迹、飞行姿态和电池电量参数通过艇载无线通信模块(10)发送到地面无线通信模块(19)，并存储在地面PC(16)；将无线摄像头(21)拍摄的图像通过无线视频信号传输至地面的CCD接收终端(22)，并显示在图像监视器(23)上；
3)图像处理器DSP(4)采用基于边缘检测、Hough变换和特征筛选方法的图像处理综合算法，对红外CCD(5)采集的图像进行分析处理，获取输电线所在直线段的坐标方程，并计算该直线段与参考直线的最短距离和夹角，得到机器人飞艇的偏航距离和偏航角；
上述的图像处理器DSP(4)采用基于边缘检测、Hough变换和特征筛选方法的图像处理综合算法，对红外CCD(5)采集的图像进行分析处理，其步骤如下：a)图像处理器DSP(4)读入单帧图像并存储图像的高度、宽度参数；b)处理边缘算子，采用Canny边缘算子提取对比度高的区域，作为物体边缘；c)对物体边缘进行Hough变换，排除干扰图形，选出超过设定长度的线段；d)删去与主线段交叉的线段；e)通过Hough变换的距离算法，将物体边缘处理产生的两条线段并为一条直线段，得到输电线所在直线的坐标方程；
4)根据GPS定位模块(9)获取的偏航距离和步骤3)中获取的图像信息，在GPS导航模式、红外视觉导航模式和人工遥控模式中进行三选一的切换：如果手动遥控器(20)的手动模式开关为开启，则启用人工遥控模式；在人工遥控模式开关关闭的前提下，若步骤3)中返回的直线条数不为零且由GPS定位模块(9)获取的偏航距离在预设范围内时，则启用红外视觉导航模式；若步骤3)中返回的直线条数为零或由GPS定位模块(9)获取的偏航距离在预设范围外时，则启用GPS导航模式；其中，在GPS导航模式下，进入步骤5)；在红外视觉导航模式下，进入步骤6)；在人工遥控模式下，进入步骤7)；
5)从闪存(11)中读取被检测输电线的分布位置信息和预设飞行路径的坐标信息；将步骤1)中获取的位置坐标、速度和飞行高度与预设的飞行路径进行比较，计算出偏差量，利用主控制器DSP(3)向电机驱动电路(14)和舵机驱动器(15)发送控制信号，对方向舵偏角、推进器转速和升降舵偏角进行控制，实现偏航控制、速度控制和高度控制，使机器人飞艇沿着预设的飞行路径飞行；
6)根据步骤3)中获取的偏航距离和偏航角以及从步骤1)中读取的飞行高度和速度，利用主控制器DSP(3)向电机驱动电路(14)和舵机驱动器(15)发送控制信号，对方向舵偏角、推进器转速和升降舵偏角进行控制，实现飞艇的航向控制、高度控制和速度控制，使机器人飞艇沿着架空线上方飞行；
7)地面人员通过手动控制器(20)输入飞艇的航向控制信号、高度控制信号和速度控制信号，并通过地面无线通信模块(19)将这些信号发送至艇载无线通信模块(10)，经主控制器DSP(3)传送至电机驱动电路(14)和舵机驱动器(15)，对方向舵偏角、推进器转速和升降舵偏角进行控制。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010101254806A CN101807080B (zh) | 2010-03-16 | 2010-03-16 | 架空线路巡检机器人飞艇控制***及其控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010101254806A CN101807080B (zh) | 2010-03-16 | 2010-03-16 | 架空线路巡检机器人飞艇控制***及其控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN101807080A CN101807080A (zh) | 2010-08-18 |
| CN101807080B true CN101807080B (zh) | 2011-11-16 |
Family
ID=42608900
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2010101254806A Expired - Fee Related CN101807080B (zh) | 2010-03-16 | 2010-03-16 | 架空线路巡检机器人飞艇控制***及其控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN101807080B (zh) |
Families Citing this family (39)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101986114B (zh) * | 2010-08-26 | 2013-06-12 | 内蒙古国领科技有限公司 | 一种输电线路光电检测***和方法 |
| CN102082466A (zh) * | 2010-10-15 | 2011-06-01 | 重庆市电力公司超高压局 | 变电站设备智能巡检机器人*** |
| CN102033546B (zh) * | 2010-11-09 | 2013-03-27 | 上海交通大学 | 低空飞艇飞行控制***及其飞行控制方法 |
| CN102176161B (zh) * | 2011-01-27 | 2013-01-16 | 华北电力大学 | 面向电力线巡检的飞行模拟*** |
| KR101168549B1 (ko) | 2011-03-08 | 2012-07-27 | 엘에스산전 주식회사 | 인버터 제어용 데이터 전송 장치 및 전송 방법 |
| CN102495636B (zh) * | 2011-12-14 | 2013-05-15 | 中国人民解放军总参谋部第六十研究所 | 一种无人直升机主舵机*** |
| CN103163881A (zh) * | 2011-12-16 | 2013-06-19 | 国家电网公司 | 基于固定翼无人机的输电线路巡检*** |
| CN102874399A (zh) * | 2012-10-13 | 2013-01-16 | 广西电网公司南宁供电局 | 用于输电线路巡视的无人自动驾驶飞艇 |
| CN104070516A (zh) * | 2013-03-25 | 2014-10-01 | 华北电力大学（保定） | 一种变电站巡检方法和变电站巡检机器人 |
| CN103531044A (zh) * | 2013-10-15 | 2014-01-22 | 江苏艾锐泰克无人飞行器科技有限公司 | 无人机障碍报警*** |
| RU2558002C1 (ru) | 2014-02-03 | 2015-07-27 | Общество с ограниченной ответственностью "Лаборатория будущего" | Устройство диагностики воздушных линий электропередач и его компонент |
| CN103984355B (zh) * | 2014-05-19 | 2017-01-11 | 华北电力大学 | 一种巡检飞行机器人与架空电力线路距离预测和保持方法 |
| CN104020779B (zh) * | 2014-06-25 | 2018-04-27 | 唐智勇 | 一种分布式飞艇控制*** |
| CN104360688A (zh) * | 2014-11-19 | 2015-02-18 | 云南电网公司电力科学研究院 | 一种巡线无人机的导向装置及其控制方法 |
| CN104536460A (zh) * | 2014-12-31 | 2015-04-22 | 国家电网公司 | 一种无人飞行器对凹山坡输电线路进行巡视的方法 |
| CN104503465A (zh) * | 2014-12-31 | 2015-04-08 | 国家电网公司 | 一种无人飞行器对斜山坡输电线路进行巡视的方法 |
| CN106162056A (zh) * | 2015-04-02 | 2016-11-23 | 宿迁学院 | 基于Labview的航模机监控*** |
| CN107710091B (zh) | 2015-06-26 | 2021-07-16 | 深圳市大疆创新科技有限公司 | 用于选择移动平台的操作模式的***和方法 |
| CN105080014A (zh) * | 2015-07-13 | 2015-11-25 | 李占平 | 消防机器人定位导航***及其定位导航方法 |
| CN105068538A (zh) * | 2015-08-24 | 2015-11-18 | 铜陵学院 | 一种四轮低速灭火机器人伺服控制器 |
| CN105005318A (zh) * | 2015-08-24 | 2015-10-28 | 铜陵学院 | 一种全自动四轮低速灭火机器人伺服控制器 |
| CN105045267A (zh) * | 2015-08-24 | 2015-11-11 | 铜陵学院 | 六轮双核高速灭火机器人伺服控制器 |
| CN105320146A (zh) * | 2015-08-24 | 2016-02-10 | 铜陵学院 | 一种单轮双核中速灭火机器人伺服控制*** |
| CN105159322A (zh) * | 2015-08-24 | 2015-12-16 | 铜陵学院 | 基于全自动两轮中低速灭火机器人的伺服控制*** |
| CN106292695A (zh) * | 2015-12-11 | 2017-01-04 | 中国特种飞行器研究所 | 一种用于小型无人飞艇的自动飞控*** |
| CN105573339B (zh) * | 2016-01-16 | 2019-01-11 | 深圳先进技术研究院 | 一种基于旋翼飞艇的导航飞行*** |
| CN105607644A (zh) * | 2016-01-16 | 2016-05-25 | 深圳先进技术研究院 | 一种无障碍飞行*** |
| CN105843254A (zh) * | 2016-04-29 | 2016-08-10 | 乐视控股（北京）有限公司 | 一种无人机飞行控制方式切换方法、装置及其无人机 |
| CN106094869B (zh) * | 2016-08-04 | 2019-11-08 | 苏州健雄职业技术学院 | 一种用于垃圾运输的自动无人机***及其工作方法 |
| CN106444834A (zh) * | 2016-10-10 | 2017-02-22 | 上海拓攻机器人有限公司 | 一种植保无人机的喷药方法及植保无人机 |
| CN106406352A (zh) * | 2016-11-15 | 2017-02-15 | 上海拓攻机器人有限公司 | 一种无人机及其喷洒农药的作业方法 |
| CN106681212A (zh) * | 2016-12-30 | 2017-05-17 | 北京天恒长鹰科技股份有限公司 | 一种艇载无线测控网络***和方法 |
| CN106871889B (zh) * | 2017-03-29 | 2020-05-12 | 科大智能电气技术有限公司 | 一种可切换导航模式的控制方法 |
| WO2018191869A1 (zh) * | 2017-04-18 | 2018-10-25 | 深圳市大疆创新科技有限公司 | 无人飞行器的控制方法、飞行控制器及无人飞行器 |
| CN110244754B (zh) * | 2019-06-28 | 2021-12-10 | 上海工程技术大学 | 一种用于平流层浮空器定点驻空的控制***及方法 |
| CN110673638B (zh) * | 2019-10-15 | 2022-10-11 | 中国特种飞行器研究所 | 一种无人飞艇避让***和无人飞艇飞行控制*** |
| CN110927259B (zh) * | 2019-12-18 | 2022-06-24 | 东北电力大学 | 可移动架空输电导线疲劳损伤监测装置、***及方法 |
| CN114235029B (zh) * | 2022-02-24 | 2022-05-13 | 江西省自然资源事业发展中心 | 一种自然资源调查监测用gis监测装置 |
| CN114770518B (zh) * | 2022-05-23 | 2023-08-29 | 科沃斯机器人股份有限公司 | 机器人控制***、方法、电子设备及计算机可读存储介质 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4818990A (en) * | 1987-09-11 | 1989-04-04 | Fernandes Roosevelt A | Monitoring system for power lines and right-of-way using remotely piloted drone |
| CN1645284A (zh) * | 2004-12-17 | 2005-07-27 | 华北电力大学（北京） | 电力线路巡检机器人飞机及其控制*** |
| CN201000576Y (zh) * | 2007-01-26 | 2008-01-02 | 青岛天骄无人机遥感技术有限公司 | 无人机飞行控制*** |
| MX2008000487A (es) * | 2008-01-10 | 2009-07-10 | Cenro De Ingenieria Y Desarrol | Dispositivo aereo para supervision y monitoreo de lineas de transmision de energia electrica. |
| CN101513733A (zh) * | 2009-03-23 | 2009-08-26 | 山东电力集团公司超高压公司 | 架空线路清障检测机器人 |
| CN101604830A (zh) * | 2009-07-14 | 2009-12-16 | 山东电力研究院 | 巡检架空线路线和杆塔用无人直升机***及其方法 |
-
2010
- 2010-03-16 CN CN2010101254806A patent/CN101807080B/zh not_active Expired - Fee Related
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4818990A (en) * | 1987-09-11 | 1989-04-04 | Fernandes Roosevelt A | Monitoring system for power lines and right-of-way using remotely piloted drone |
| CN1645284A (zh) * | 2004-12-17 | 2005-07-27 | 华北电力大学（北京） | 电力线路巡检机器人飞机及其控制*** |
| CN201000576Y (zh) * | 2007-01-26 | 2008-01-02 | 青岛天骄无人机遥感技术有限公司 | 无人机飞行控制*** |
| MX2008000487A (es) * | 2008-01-10 | 2009-07-10 | Cenro De Ingenieria Y Desarrol | Dispositivo aereo para supervision y monitoreo de lineas de transmision de energia electrica. |
| CN101513733A (zh) * | 2009-03-23 | 2009-08-26 | 山东电力集团公司超高压公司 | 架空线路清障检测机器人 |
| CN101604830A (zh) * | 2009-07-14 | 2009-12-16 | 山东电力研究院 | 巡检架空线路线和杆塔用无人直升机***及其方法 |
Non-Patent Citations (1)
| Title |
|---|
| 蔡克等.一种新的直升机巡检***电力线提取算法.《计算机技术与发展》.2009,第19卷(第10期),113-116页. * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN101807080A (zh) | 2010-08-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN101807080B (zh) | 架空线路巡检机器人飞艇控制***及其控制方法 | |
| CN1305194C (zh) | 电力线路巡检机器人飞机及其控制*** | |
| CN204623851U (zh) | 基于无人机的电气设备在线监测*** | |
| CN106886225B (zh) | 一种多功能无人机智能起降站*** | |
| CN103078673B (zh) | 一种适用于山区电网巡检的专用无人直升机*** | |
| CN202094531U (zh) | 适合于无人飞行器的输电线路巡检装置 | |
| CN102941920A (zh) | 一种基于多旋翼飞行器的高压输电线路巡检机器人及其方法 | |
| CN106568441B (zh) | 一种利用基于北斗的电力巡检设备进行电力巡检的方法 | |
| CN104536456A (zh) | 一种自主飞行四旋翼无人机路桥施工巡检***及方法 | |
| CN203219298U (zh) | 一种适用于山区电网巡检的专用无人直升机*** | |
| CN103224026A (zh) | 一种适用于山区电网巡检的专用无人直升机避障***及其工作流程 | |
| CN102255259A (zh) | 适合于无人飞行器的输电线路巡检装置 | |
| CN106228862A (zh) | 一种输电线路无人机巡检仿真培训方法 | |
| CN104881042A (zh) | 一种多尺度航空遥感测试平台 | |
| CN208873047U (zh) | 一种基于多旋翼无人机的巡检装置 | |
| CN205543960U (zh) | 一种高效率无人机群电力巡检*** | |
| CN205302006U (zh) | 基于规划航线飞行的多旋翼无人机的油气管线巡检*** | |
| CN205139164U (zh) | 一种基于无人机的粒子图像测速检测*** | |
| CN111340804A (zh) | 基于无人飞艇的空气质量机器视觉在线监测***及方法 | |
| CN204832413U (zh) | 一种输电线路故障排查装置及*** | |
| CN103558653A (zh) | 基于多旋翼平台的气象检测飞机 | |
| CN104965520A (zh) | 一种基于rfid的电力线巡检无人机飞行控制*** | |
| CN207488829U (zh) | 一种环境监测用无人机 | |
| CN104683759A (zh) | 基于飞行器的烟囱内壁腐蚀情况无线视频监控设备与方法 | |
| CN102874399A (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: 20111116 Termination date: 20120316 |