CN105912008A - Electric power iron tower inspection unmanned plane flight control system and flight control method thereof - Google Patents

Electric power iron tower inspection unmanned plane flight control system and flight control method thereof Download PDF

Info

Publication number
CN105912008A
CN105912008A CN201610425253.2A CN201610425253A CN105912008A CN 105912008 A CN105912008 A CN 105912008A CN 201610425253 A CN201610425253 A CN 201610425253A CN 105912008 A CN105912008 A CN 105912008A
Authority
CN
China
Prior art keywords
unmanned plane
attitude
electric power
course
data
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.)
Pending
Application number
CN201610425253.2A
Other languages
Chinese (zh)
Inventor
杜强
王秋阳
赵瑜
杨学武
盛新蒲
姜超
黄桃丽
章子睿
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
HEFEI SIWILL INTELLIGENT Co Ltd
Original Assignee
HEFEI SIWILL INTELLIGENT Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by HEFEI SIWILL INTELLIGENT Co Ltd filed Critical HEFEI SIWILL INTELLIGENT Co Ltd
Priority to CN201610425253.2A priority Critical patent/CN105912008A/en
Publication of CN105912008A publication Critical patent/CN105912008A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

The invention discloses an electric power iron tower inspection unmanned plane flight control system and a flight control method thereof. The electric power iron tower inspection unmanned plane flight control system comprises a DSP module and an ARM module. The DSP module reads attitude calculation data of at least one IMU installed on at least one electric power iron tower inspection unmanned plane, carries out attitude calculation according to the attitude calculation data and calculates the current flight attitude of the unmanned plane; reads two paths of GPS signals from the unmanned plane, carries out difference calculation, calculates the current course of the unmanned plane and carries out navigation; and calculates the current attitude and course data according to the current flight attitude and course of the unmanned plane, and transmits the current attitude and course data to the ARM module. The ARM module analyzes the current attitude and course data, compares the data with control command data received by one RC from the ground, and transmits the deviation to a motor of the unmanned plane for attitude and course adjustment. The invention further discloses a flight control method of the electric power iron tower inspection unmanned plane flight control system.

Description

A kind of electric power tower patrol unmanned machine flight control system and fly prosecutor method
Technical field
The present invention relates to a kind of flight control system and fly prosecutor method, particularly relating to a kind of electric power tower patrol unmanned Machine flight control system and fly prosecutor method.
Background technology
Unmanned plane is the abbreviation (Unmanned Aerial Vehicle) of UAV, is to utilize radio Remote control equipment and the most manned aircraft of presetting apparatus provided for oneself, including depopulated helicopter, fixed-wing aircraft, Multi-rotor aerocraft, unmanned airship, unmanned parasol.Broadly see and also include near space vehicle (20-100 Kilometer spatial domain), such as stratospheric airship, aerostat, solar energy unmanned plane etc..From the point of view of certain angle, Unmanned plane can complete complicated airflight task and various loading commissions under conditions of unmanned, permissible It is seen as " air-robot ".
Flying to control subsystem is that unmanned plane completes to take off, airflight, execution task and recovery of giving an encore etc. are whole flies The core system of row process, flies to control and is equivalent to driver for there being man-machine effect for unmanned plane, and we recognize For being one of most crucial technology of unmanned plane.Fly control and generally comprise sensor, airborne computer and servo start Equipment three parts, it is achieved function mainly have unmanned plane attitude stabilization and control, unmanned plane task device pipe Reason and emergency flight control three major types.The attitude of unmanned plane and the adjustment of course (i.e. navigation attitude is also named course line), be In place of designing the key of the flight control system strong with extraneous enantiotropy.
Summary of the invention
In view of this, the invention provides the strong patrol unmanned machine of electric power tower of a kind of and extraneous enantiotropy and fly control System and fly prosecutor method.
The solution of the present invention is: a kind of electric power tower patrol unmanned machine flight control system, a kind of electric power tower Patrol unmanned machine flight control system, it includes DSP module, ARM module;Wherein,
At least one IMU's that the reading of described DSP module is arranged on a patrol unmanned machine of electric power tower Attitude settlement data, carries out attitude clearing according to described attitude settlement data, clears out working as of described unmanned plane Front flight attitude;And read the two-way gps signal from described unmanned plane, carry out Difference Calculation, resolve institute State the current course of unmanned plane, navigate;And always according to the current flight attitude of described unmanned plane and course, Calculate current pose and course data passes to described ARM module;
Described ARM module is by resolving the next current pose of described DSP module transmission and course data, warp Cross the control command data from ground received with a RC to contrast, then will partially if there is deviation Difference passes to the motor of described unmanned plane and is adjusted attitude and course.
As the further improvement of such scheme, described DSP module reads whole institute by built-in ADC State the temperature of unmanned plane, system voltage to guarantee the normal work of described unmanned plane.
As the further improvement of such scheme, data are stored in one as log by described DSP module In individual SD card.
Further, data are stored in one as log by SDIO interface by described ARM module In individual SD card.
As the further improvement of such scheme, described ARM module is read by SPI and is arranged on an electricity The attitude settlement data of at least one IMU on the patrol unmanned machine of power steel tower.
As the further improvement of such scheme, described DSP module reads two-way gps signal by serial ports.
As the further improvement of such scheme, described DSP module is calculated data and is transmitted by SPI communication To described ARM module.
As the further improvement of such scheme, described DSP module uses TMS320F28375 chip, institute State ARM module and use STM32f407 chip.
As the further improvement of such scheme, deviation is passed to by PPM agreement or CAN protocol The motor of described unmanned plane is adjusted attitude and course.
What the present invention also provided for above-mentioned any electric power tower patrol unmanned machine flight control system flies prosecutor method, and it includes Following steps:
Read the attitude settlement data of at least one IMU being arranged on a patrol unmanned machine of electric power tower, Carry out attitude clearing according to described attitude settlement data, clear out the current flight attitude of described unmanned plane;And Read the two-way gps signal from described unmanned plane, carry out Difference Calculation, resolve the current of described unmanned plane Course, navigates;And always according to the current flight attitude of described unmanned plane and course, parse current appearance State and course data;
By the current pose parsed and course data, through the control from ground received with a RC Order data processed contrasts, and the motor that deviation then passes to described unmanned plane if there is deviation is adjusted Whole attitude and course.
The present invention designs according to DSP+ARM double-core, owing to the DSP of TI has the most excellent for data process Gesture is so using TMS320F28375 to process as data, and ARM is higher for extraneous reciprocal action, So using ARM mutual as outside.
Accompanying drawing explanation
Fig. 1 is that the structure of the electric power tower patrol unmanned machine flight control system that better embodiment of the present invention provides is shown It is intended to.
Detailed description of the invention
In order to make the purpose of the present invention, technical scheme and advantage clearer, below in conjunction with accompanying drawing and reality Execute example, the present invention is further elaborated.Only should be appreciated that specific embodiment described herein Only in order to explain the present invention, it is not intended to limit the present invention.
Refer to Fig. 1, the electric power tower patrol unmanned machine flight control system of the present invention mainly include DSP module, ARM module.
At least one IMU's that the reading of described DSP module is arranged on a patrol unmanned machine of electric power tower Attitude settlement data, described DSP module carries out attitude clearing according to described attitude settlement data, clears out institute State the current flight attitude of unmanned plane.Described DSP module can be read by SPI and be arranged on an electric power tower The attitude settlement data of at least one IMU on patrol unmanned machine, Inertial measurement unit, letter Claim IMU, be Measuring Object three-axis attitude angle (or angular speed) and the device of acceleration.Described DSP module Can use TMS320F28375 chip, IMU can include ADIS16448 ten axle gyroscope.
Described DSP module reads the two-way gps signal from described unmanned plane, carries out Difference Calculation, solves Calculate the current course of described unmanned plane, navigate.Described DSP module can read two-way GPS by serial ports Signal.
Described DSP module, always according to the current flight attitude of described unmanned plane and course, calculates data transmission To described ARM module, described ARM module can be passed to by SPI communication.Described DSP module can The temperature of whole described unmanned plane, system voltage is read to guarantee described unmanned plane by built-in ADC Normal work.In data are stored in a SD card as log by described ARM module, in this enforcement In example, data are stored in a SD card by SDIO interface by described ARM module as log.
Described ARM module is by resolving the next current pose of described DSP module transmission and course data, warp Cross the control command data from ground received with a RC to contrast, then will partially if there is deviation The motor that difference passes to described unmanned plane by PPM agreement or CAN protocol is adjusted attitude and boat To.Whether mainly contrast attitude and course exists deviation, is then corrected if there is deviation.
The present invention possesses following characteristics:
1. this design is according to DSP+ARM double-core;
2. there is absolute advantages for data process so using TMS320F28375 conduct due to the DSP of TI Data process, and ARM is higher for extraneous reciprocal action, so using ARM mutual as outside, and institute State ARM module and use STM32f407 chip;
3.DSP reads ADIS16448 ten axle gyro data by SPI, (or use I2C to read The data of MPU9250 and pneumatics meter totally ten axle) carry out attitude clearing, the flight attitude of current aircraft at clearing, Read two-way gps signal by serial ports, carry out Difference Calculation, resolve current course, navigate;
The most then DSP is according to current pose and course, calculates data and passes to ARM by SPI communication; In addition DSP reads temperature by built-in ADC. and system voltages etc. guarantee that system is in normal work;
5.ARM by resolving the data that DSP transmission comes, (the remote controller or fixing through receiving with RC Course) data contrast, if there is deviation then by deviation by PPM agreement or CAN protocol, Pass to motor and be adjusted attitude and course, and data are deposited by SDIO interface as log Storage computer host computer in SD card can pass through serial ports or usb protocol, planning course etc..
The electric power tower patrol unmanned machine flight control system of the present invention, the prosecutor method that flies of its correspondence mainly includes following Step:
Read the attitude settlement data of at least one IMU being arranged on a patrol unmanned machine of electric power tower, Carry out attitude clearing according to described attitude settlement data, clear out the current flight attitude of described unmanned plane;And Read the two-way gps signal from described unmanned plane, carry out Difference Calculation, resolve the current of described unmanned plane Course, navigates;And always according to the current flight attitude of described unmanned plane and course, parse current appearance State and course data;
By the current pose parsed and course data, through the control from ground received with a RC Order data processed contrasts, and is passed to the electricity of described unmanned plane by PPM agreement or CAN protocol Machine is adjusted attitude and course.
In the first step, it is arranged at least on a patrol unmanned machine of electric power tower by SPI reading The attitude settlement data of individual IMU, carries out attitude clearing according to described attitude settlement data, clears out described nothing Man-machine current flight attitude;And read the two-way gps signal from described unmanned plane by serial ports, carry out Difference Calculation, resolves the current course of described unmanned plane, navigates;And working as always according to described unmanned plane Front flight attitude and course, parse current pose and course data.
The foregoing is only presently preferred embodiments of the present invention, not in order to limit the present invention, all at this Any amendment, equivalent and the improvement etc. made within bright spirit and principle, should be included in the present invention Protection domain within.

Claims (10)

1. an electric power tower patrol unmanned machine flight control system, it is characterised in that: it include DSP module, ARM module;Wherein,
At least one IMU's that the reading of described DSP module is arranged on a patrol unmanned machine of electric power tower Attitude settlement data, carries out attitude clearing according to described attitude settlement data, clears out working as of described unmanned plane Front flight attitude;And read the two-way gps signal from described unmanned plane, carry out Difference Calculation, resolve institute State the current course of unmanned plane, navigate;And always according to the current flight attitude of described unmanned plane and course, Calculate current pose and course data passes to described ARM module;
Described ARM module is by resolving the next current pose of described DSP module transmission and course data, warp Cross the control command data from ground received with a RC to contrast, then will partially if there is deviation Difference passes to the motor of described unmanned plane and is adjusted attitude and course.
2. electric power tower patrol unmanned machine flight control system as claimed in claim 1, it is characterised in that: described It is described to guarantee that DSP module reads the temperature of whole described unmanned plane, system voltage by built-in ADC The normal work of unmanned plane.
3. electric power tower patrol unmanned machine flight control system as claimed in claim 1, it is characterised in that: described In data are stored in a SD card as log by DSP module.
4. electric power tower patrol unmanned machine flight control system as claimed in claim 3, it is characterised in that: described Data are stored in a SD card by SDIO interface by ARM module as log.
5. electric power tower patrol unmanned machine flight control system as claimed in claim 1, it is characterised in that: described At least one IMU's that ARM module is arranged on a patrol unmanned machine of electric power tower by SPI reading Attitude settlement data.
6. electric power tower patrol unmanned machine flight control system as claimed in claim 1, it is characterised in that: described DSP module reads two-way gps signal by serial ports.
7. electric power tower patrol unmanned machine flight control system as claimed in claim 1, it is characterised in that: described DSP module calculates data and passes to described ARM module by SPI communication.
8. electric power tower patrol unmanned machine flight control system as claimed in claim 1, it is characterised in that: described DSP module uses TMS320F28375 chip, and described ARM module uses STM32f407 chip.
9. electric power tower patrol unmanned machine flight control system as claimed in claim 1, it is characterised in that: deviation The motor being passed to described unmanned plane by PPM agreement or CAN protocol is adjusted attitude and course.
10. the patrol unmanned machine of electric power tower as in one of claimed in any of claims 1 to 9 flies control system That unites flies prosecutor method, it is characterised in that: it comprises the following steps:
Read the attitude settlement data of at least one IMU being arranged on a patrol unmanned machine of electric power tower, Carry out attitude clearing according to described attitude settlement data, clear out the current flight attitude of described unmanned plane;And Read the two-way gps signal from described unmanned plane, carry out Difference Calculation, resolve the current of described unmanned plane Course, navigates;And always according to the current flight attitude of described unmanned plane and course, parse current appearance State and course data;
By the current pose parsed and course data, through the control from ground received with a RC Order data processed contrasts, and the motor that deviation then passes to described unmanned plane if there is deviation is adjusted Whole attitude and course.
CN201610425253.2A 2016-06-13 2016-06-13 Electric power iron tower inspection unmanned plane flight control system and flight control method thereof Pending CN105912008A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610425253.2A CN105912008A (en) 2016-06-13 2016-06-13 Electric power iron tower inspection unmanned plane flight control system and flight control method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610425253.2A CN105912008A (en) 2016-06-13 2016-06-13 Electric power iron tower inspection unmanned plane flight control system and flight control method thereof

Publications (1)

Publication Number Publication Date
CN105912008A true CN105912008A (en) 2016-08-31

Family

ID=56751285

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610425253.2A Pending CN105912008A (en) 2016-06-13 2016-06-13 Electric power iron tower inspection unmanned plane flight control system and flight control method thereof

Country Status (1)

Country Link
CN (1) CN105912008A (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106383481A (en) * 2016-11-25 2017-02-08 江苏飞图智能控制技术有限公司 Flight control panel based on bi-processor configuration
CN106527461A (en) * 2016-11-29 2017-03-22 合肥赛为智能有限公司 Flight control system based on dual-core processor
CN106643716A (en) * 2016-12-02 2017-05-10 中船重工西安东仪科工集团有限公司 MEMS inertial measuring device with redundant signal acquisition strategy
CN106710121A (en) * 2017-02-28 2017-05-24 桂林电子科技大学 Forest fire positioning device based on bionic inductor
CN109154832A (en) * 2017-10-27 2019-01-04 深圳市大疆创新科技有限公司 Inspection planing method, controlling terminal, unmanned plane and the UAV system of unmanned plane
CN111506004A (en) * 2020-05-28 2020-08-07 北京理工大学 Unmanned aerial vehicle aircraft control system
CN112180973A (en) * 2020-09-21 2021-01-05 重庆中电自能科技有限公司 Inspection system of photovoltaic power station and unmanned aerial vehicle system integration method

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101576750A (en) * 2009-04-14 2009-11-11 上海微小卫星工程中心 System and method for tracking and controlling gestures of spacecraft
CN104155988A (en) * 2014-08-12 2014-11-19 北京航天自动控制研究所 Multichannel attitude controller of aircraft
EP2835708A2 (en) * 2013-08-06 2015-02-11 Lockheed Martin Corporation Method and system for remotely controlling a vehicle
CN104503467A (en) * 2015-01-19 2015-04-08 中国人民解放军国防科学技术大学 Autonomous take-off and landing flight control system of unmanned aerial vehicle based on dual-core architecture
US9146557B1 (en) * 2014-04-23 2015-09-29 King Fahd University Of Petroleum And Minerals Adaptive control method for unmanned vehicle with slung load
CN105468009A (en) * 2015-12-25 2016-04-06 西北工业大学 System and method for multi-power integrated flight control applied in micro air vehicle
CN105652883A (en) * 2016-01-15 2016-06-08 中国人民解放军国防科学技术大学 Unmanned plane self-driving instrument realizing single board modularization and high reliability

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101576750A (en) * 2009-04-14 2009-11-11 上海微小卫星工程中心 System and method for tracking and controlling gestures of spacecraft
EP2835708A2 (en) * 2013-08-06 2015-02-11 Lockheed Martin Corporation Method and system for remotely controlling a vehicle
US9146557B1 (en) * 2014-04-23 2015-09-29 King Fahd University Of Petroleum And Minerals Adaptive control method for unmanned vehicle with slung load
CN104155988A (en) * 2014-08-12 2014-11-19 北京航天自动控制研究所 Multichannel attitude controller of aircraft
CN104503467A (en) * 2015-01-19 2015-04-08 中国人民解放军国防科学技术大学 Autonomous take-off and landing flight control system of unmanned aerial vehicle based on dual-core architecture
CN105468009A (en) * 2015-12-25 2016-04-06 西北工业大学 System and method for multi-power integrated flight control applied in micro air vehicle
CN105652883A (en) * 2016-01-15 2016-06-08 中国人民解放军国防科学技术大学 Unmanned plane self-driving instrument realizing single board modularization and high reliability

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
习业勋等: "《基于多核架构无人机飞行控制系统设计与实现》", 《电子测量技术》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106383481A (en) * 2016-11-25 2017-02-08 江苏飞图智能控制技术有限公司 Flight control panel based on bi-processor configuration
CN106527461A (en) * 2016-11-29 2017-03-22 合肥赛为智能有限公司 Flight control system based on dual-core processor
CN106643716A (en) * 2016-12-02 2017-05-10 中船重工西安东仪科工集团有限公司 MEMS inertial measuring device with redundant signal acquisition strategy
CN106643716B (en) * 2016-12-02 2020-03-17 中船重工西安东仪科工集团有限公司 MEMS inertial measurement unit with redundant signal acquisition strategy
CN106710121A (en) * 2017-02-28 2017-05-24 桂林电子科技大学 Forest fire positioning device based on bionic inductor
CN109154832A (en) * 2017-10-27 2019-01-04 深圳市大疆创新科技有限公司 Inspection planing method, controlling terminal, unmanned plane and the UAV system of unmanned plane
WO2019080113A1 (en) * 2017-10-27 2019-05-02 深圳市大疆创新科技有限公司 Patrol planning method for unmanned aerial vehicle, control terminal, unmanned aerial vehicle, and unmanned aerial vehicle system
CN111506004A (en) * 2020-05-28 2020-08-07 北京理工大学 Unmanned aerial vehicle aircraft control system
CN112180973A (en) * 2020-09-21 2021-01-05 重庆中电自能科技有限公司 Inspection system of photovoltaic power station and unmanned aerial vehicle system integration method

Similar Documents

Publication Publication Date Title
CN105912008A (en) Electric power iron tower inspection unmanned plane flight control system and flight control method thereof
CN111045454B (en) Unmanned aerial vehicle self-driving instrument based on bionic autonomous navigation
CN105867414A (en) Unmanned aerial vehicle flight control system having multisensor redundant backup
CN105807779A (en) Flight control system and method for unmanned aerial vehicle
US20180003161A1 (en) Unmanned aerial vehicle wind turbine inspection systems and methods
CN103927798B (en) A kind of recording method suitable in middle-size and small-size unmanned plane during flying data and device
CN104808675A (en) Intelligent terminal-based somatosensory flight operation and control system and terminal equipment
JP6161638B2 (en) Wind calculation system using steady bank angle turning
JP6506302B2 (en) Method and apparatus for operating a mobile platform
CN105629995B (en) One kind is tethered at system for tracking and method
CN105094138A (en) Low-altitude autonomous navigation system for rotary-wing unmanned plane
TWI558617B (en) Unmanned flight vehicle autonomous flight computer system and control method
CN104503467A (en) Autonomous take-off and landing flight control system of unmanned aerial vehicle based on dual-core architecture
CN103144770A (en) Full-automatic indoor environment control, obstacle avoidance and navigation type micro aerial vehicle
US20180141656A1 (en) Method and system for monitoring operational status of drone
EP2760000B1 (en) Systems and methods for catching takeoff performance errors
CN104180803A (en) Non-similar dual-redundancy integrated navigation device applied to unmanned plane
CN106586026B (en) A kind of measurement method of aircraft with respect to runway lateral deviation rate
CN104536453A (en) Aircraft control method and device
CN106781665A (en) Unmanned plane parking position guidance system based on Internet of Things
CN102981509A (en) Autopilot for fixed-wing and four-rotor unmanned aerial vehicles
CN105974494A (en) Radio-sondage system based on dual-redundancy fixed wing unmanned aerial vehicle
CN104360688A (en) Guide device of line-cruising unmanned aerial vehicle and control method of guide device
US20070085707A1 (en) System and method for presenting aircraft heading and track in a track-forward display format
CN205787901U (en) A kind of UAV Flight Control System

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20160831

RJ01 Rejection of invention patent application after publication