CN108614572A - A kind of target identification method for tracing, equipment and storage device based on aircraft - Google Patents

A kind of target identification method for tracing, equipment and storage device based on aircraft Download PDF

Info

Publication number
CN108614572A
CN108614572A CN201810403029.2A CN201810403029A CN108614572A CN 108614572 A CN108614572 A CN 108614572A CN 201810403029 A CN201810403029 A CN 201810403029A CN 108614572 A CN108614572 A CN 108614572A
Authority
CN
China
Prior art keywords
aircraft
target
expectation
tracing
relative
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
CN201810403029.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.)
China University of Geosciences
Original Assignee
China University of Geosciences
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 China University of Geosciences filed Critical China University of Geosciences
Priority to CN201810403029.2A priority Critical patent/CN108614572A/en
Publication of CN108614572A publication Critical patent/CN108614572A/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
    • 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)
  • Radar Systems Or Details Thereof (AREA)

Abstract

The present invention provides a kind of target identification method for tracing, equipment and storage device based on aircraft, a kind of target identification method for tracing based on aircraft, image and height are obtained by sensor, and image is handled, the three-dimensional position that aircraft is obtained relative to tracking target obtains the expectation flight attitude of aircraft using the method and PID controller of Kalman filtering, the posture of aircraft is controlled by the Attitude Controller in aircraft, to achieve the purpose that track target;A kind of target identification tracing equipment and storage device based on aircraft, for realizing the target identification method for tracing based on aircraft.The beneficial effects of the invention are as follows:Aircraft can identify specified target, detect and track the movement of target object, and target is followed independently to be tracked, and ensure that objective body is constantly in the visual range of aircraft, and precise and stable flight is above target.

Description

A kind of target identification method for tracing, equipment and storage device based on aircraft
Technical field
The present invention relates to image procossing and embedded-type control fields more particularly to a kind of target identification based on aircraft to chase after Track method, equipment and storage device.
Background technology
Quadrotor drone has many advantages, such as small, VTOL, hovering, omnidirection flight, can be simple in the air More comprehensive terrestrial information is effectively singly obtained, and the switching and fixation of its position are simple and practicable, and can carried certain The article of amount.And since it has the characteristics that of low cost, easy to operate and operational safety, it is widely used in the military, people The multiple fields such as thing and scientific research.
The present invention is using image processing techniques and control technology as foundation stone, in conjunction with precision machinery, signal processing, servo control The autonomous navigation system of the technologies such as system, inertial navigation is chased after in the military fields such as automatic strike, information investigation and suspect The public security civil field such as track, public security fire-fighting, aerial search and rescue, high-altitude tracing monitoring has a wide range of applications, meanwhile, realize tool It is even more a revolutionary science and technology challenge to have the unmanned plane of independence.
Invention content
To solve the above-mentioned problems, the target identification method for tracing that the present invention provides a kind of based on aircraft, equipment and A kind of storage device, target identification method for tracing based on aircraft, mainly includes the following steps that:
S101:The flying height that aircraft is obtained using height sensor obtains tracking target using imaging sensor Image, and the image for tracking target is handled;
S102:According to the image of the obtained flying height and processed tracking target, the aircraft phase is obtained For tracking the three-dimensional position of target;
S103:The three-dimensional position is input in first order PID controller, with the preset aircraft relative to chasing after The three-dimensional position of track target is compared, and obtains expectation flying speed of the aircraft relative to tracking target;
S104:Compare the front and back three-dimensional position twice, front and back positional distance difference divided by interval time twice obtains Practical flight speed to the aircraft relative to tracking target;
S105:Using the method for Kalman filtering, by the aircraft relative to tracking target practical flight speed into Row is filtered;
S106:The practical flight speed relative to tracking target and the aircraft by the aircraft being filtered Expectation flying speed relative to tracking target is input in the PID controller of the second level, obtains the aircraft relative to tracking The expectation acceleration of target;
S107:Expectation acceleration according to the aircraft relative to tracking target, calculates the expectation of the aircraft Flight attitude angle obtains the expectation flight attitude;
S108:Described fly is controlled by the Attitude Controller in the aircraft according to the expectation flight attitude The flight attitude of row device makes the aircraft track target.
Further, in step S101, the height sensor and imaging sensor are mounted on the aircraft.
Further, in step s 107, the expectation flight attitude angle of the aircraft can be by formula Meter It obtains, wherein θ is the expectation flight attitude angle of the aircraft, and a is that the aircraft accelerates relative to the expectation of target Degree, g is acceleration of gravity.
A kind of storage device, the storage device store instruction and data are known for realizing a kind of target based on aircraft Other method for tracing.
A kind of target identification tracing equipment based on aircraft, including:Processor and the storage device;The processor It loads and executes the instruction in the storage device and data for realizing a kind of target identification method for tracing based on aircraft.
The advantageous effect that technical solution provided by the invention is brought is:Aircraft can identify specified target, and detection is simultaneously The movement of target object is tracked, and target is followed independently to be tracked, ensures that objective body is constantly in the visual range of aircraft Interior and precise and stable flight is above target.
Description of the drawings
Present invention will be further explained below with reference to the attached drawings and examples, in attached drawing:
Fig. 1 is a kind of flow chart of the target identification method for tracing based on aircraft in the embodiment of the present invention;
Fig. 2 is a kind of block schematic illustration of the target identification method for tracing based on aircraft in the embodiment of the present invention;
Fig. 3 is a kind of flow diagram of the target identification tracing system based on aircraft in the embodiment of the present invention;
Fig. 4 is the schematic diagram that hardware device works in the embodiment of the present invention.
Specific implementation mode
For a clearer understanding of the technical characteristics, objects and effects of the present invention, now control attached drawing is described in detail The specific implementation mode of the present invention.
The embodiment provides a kind of target identification method for tracing, equipment and storage device based on aircraft.
The embodiment of the present invention uses quadrotor, using F330 quadrotors rack as hardware platform, using the electricity of 20A Sub- governor drives the brushless motor of 4 880KV, coordinates 8045 type propellers;Autonomous tracking based on quadrotor is visited The hardware configuration for surveying platform courses software is obtained as posture using STM32F407ZGT6 microprocessors and flight control core, with The RX23T microprocessors that Renesas is provided are image procossing core, including nine axis attitude transducers, elevation information sensor, regarding Feel sensor, function button, OLED show, wireless module etc..Sensor includes mainly the distance being equipped on immediately below quadrotor Sensor and visual sensor.Range sensor uses US-100 ultrasonic distance measuring modules, carries temperature-compensation circuit, ranging essence Exactness is sent to processor up to 1mm, range data by serial ports;Visual sensor is taken the photograph using the OV7725 of 320*240 pixels As head module, which can be converted to binaryzation data by image data and be read by microcontroller, save the processing pressure of CPU Improve the transmission speed of image data.
Referring to FIG. 1, Fig. 1 is a kind of flow of the target identification method for tracing based on aircraft in the embodiment of the present invention Figure, specifically comprises the following steps:
S101:The flying height that aircraft is obtained using height sensor obtains tracking target using imaging sensor Image, and the image for tracking target is handled;The height sensor and imaging sensor are mounted on the aircraft;
S102:According to the image of the obtained flying height and processed tracking target, the aircraft phase is obtained For tracking the three-dimensional position of target;
S103:The three-dimensional position is input in first order PID controller, with the preset aircraft relative to chasing after The three-dimensional position of track target is compared, and obtains expectation flying speed of the aircraft relative to tracking target;
S104:Compare the front and back three-dimensional position twice, front and back positional distance difference divided by interval time twice obtains Practical flight speed to the aircraft relative to tracking target;
S105:Using the method for Kalman filtering, by the aircraft relative to tracking target practical flight speed into Row is filtered;
S106:The practical flight speed relative to tracking target and the aircraft by the aircraft being filtered Expectation flying speed relative to tracking target is input in the PID controller of the second level, obtains the aircraft relative to tracking The expectation acceleration of target;
S107:Expectation acceleration according to the aircraft relative to tracking target, calculates the expectation of the aircraft Flight attitude angle obtains the expectation flight attitude;The expectation flight attitude angle of the aircraft can be by formula It is calculated, wherein θ is the expectation flight attitude angle of the aircraft, and a is that the aircraft accelerates relative to the expectation of target Degree, g is acceleration of gravity;
S108:Described fly is controlled by the Attitude Controller in the aircraft according to the expectation flight attitude The flight attitude of row device makes the aircraft track target.
Referring to FIG. 2, Fig. 2 is that a kind of frame of the target identification method for tracing based on aircraft shows in the embodiment of the present invention It is intended to, height sensor is used to obtain the elevation information of the aircraft, obtain tracking target using imaging sensor first Image, and to track target image handle, processed image combination flying height obtain the aircraft relative to Track the three-dimensional position of target;Then, three dimensional local information is inputted in first order PID controller, with the preset flight Device is compared relative to the three-dimensional position of tracking target, obtains expectation flight speed of the aircraft relative to tracking target Degree;Compare the front and back three-dimensional position twice, by front and back positional distance difference divided by interval time twice, obtains the flight Practical flight speed of the device relative to tracking target;Then, using kalman filter method, by the aircraft relative to tracking The practical flight speed of target is filtered, and obtains practical flight speed of the stable aircraft relative to tracking target Degree;By the aircraft being filtered relative to the practical flight speed of tracking target and the aircraft relative to tracking The expectation flying speed of target is input in the PID controller of the second level, obtains expectation of the aircraft relative to tracking target Acceleration;Expectation acceleration according to the aircraft relative to tracking target, calculates the expectation flight appearance of the aircraft State angle obtains the expectation flight attitude;Finally, according to the expectation flight attitude, pass through the flight appearance in the aircraft State controller controls the flight attitude of the aircraft, to achieve the purpose that track target.
Referring to FIG. 3, Fig. 3 is that a kind of flow of the target identification tracing system based on aircraft is shown in the embodiment of the present invention It is intended to, the autonomous tracking test platform control software based on quadrotor includes mainly three zones module:Nine axis postures Detection module, image processing module and flight attitude position control module, the nine axis attitude detection module is for detecting institute The posture of aircraft is stated, described image processing module is used to handle the image of the tracking target of imaging sensor acquisition, described to fly Row posture position control module is used to control the aircraft and tracks target according to the expectation flight attitude.Based on quadrotor The autonomous tracking test platform control software of aircraft completes attitude of flight vehicle, position in real time by coordinating modules operation And acquisition, processing and the fusion of movable information, and four brushless motors of the aircraft are carried out in real time by cascade PID Adjustment of rotational speed enables quadrotor to reach splendid tracking effect in autonomous flight.
Fig. 4 is referred to, Fig. 4 is the hardware device operating diagram of the embodiment of the present invention, and the hardware device specifically includes: A kind of target identification tracing equipment 401, processor 402 and storage device 403 based on aircraft.
A kind of target identification tracing equipment 401 based on aircraft:A kind of target identification tracking based on aircraft Equipment 401 realizes a kind of target identification method for tracing based on aircraft.
Processor 402:The processor 402 loads and executes the instruction in the storage device 403 and data for real A kind of existing target identification method for tracing based on aircraft.
Storage device 403:403 store instruction of the storage device and data;The storage device 403 is for realizing described A kind of target identification method for tracing based on aircraft.
The beneficial effects of the invention are as follows:Aircraft can identify specified target, detect and track the movement of target object, And target is followed independently to be tracked, ensure that objective body is constantly in the visual range of aircraft, and precise and stable flight Above target.
The foregoing is merely presently preferred embodiments of the present invention, is not intended to limit the invention, it is all the present invention spirit and Within principle, any modification, equivalent replacement, improvement and so on should all be included in the protection scope of the present invention.

Claims (5)

1. a kind of target identification method for tracing based on aircraft, it is characterised in that:Include the following steps:
S101:The flying height that aircraft is obtained using height sensor obtains the image of tracking target using imaging sensor, And the image for tracking target is handled;
S102:According to the image of the obtained flying height and processed tracking target, obtain the aircraft relative to Track the three-dimensional position of target;
S103:The three-dimensional position is input in first order PID controller, with the preset aircraft relative to tracking mesh Target three-dimensional position is compared, and obtains expectation flying speed of the aircraft relative to tracking target;
S104:Compare the front and back three-dimensional position twice, by front and back positional distance difference divided by interval time twice, obtains institute State practical flight speed of the aircraft relative to tracking target;
S105:Using the method for Kalman filtering, the practical flight speed by the aircraft relative to tracking target is filtered Wave processing;
S106:The aircraft being filtered is opposite relative to the practical flight speed of tracking target and the aircraft It is input in the PID controller of the second level in the expectation flying speed of tracking target, obtains the aircraft relative to tracking target Expectation acceleration;
S107:Expectation acceleration according to the aircraft relative to tracking target calculates the expectation flight of the aircraft Attitude angle obtains the expectation flight attitude;
S108:The aircraft is controlled by the Attitude Controller in the aircraft according to the expectation flight attitude Flight attitude, so that the aircraft is tracked target.
2. a kind of target identification method for tracing based on aircraft as described in claim 1, it is characterised in that:In step S101 In, the height sensor and imaging sensor are mounted on the aircraft.
3. a kind of target identification method for tracing based on aircraft as described in claim 1, it is characterised in that:In step S107 In, the expectation flight attitude angle of the aircraft can be by formulaIt is calculated, wherein θ is the aircraft It is expected that flight attitude angle, a is expectation acceleration of the aircraft relative to target, and g is acceleration of gravity.
4. a kind of storage device, it is characterised in that:The storage device store instruction and data are for realizing claims 1 to 3 Target identification method for tracing of any one described based on aircraft.
5. a kind of target identification tracing equipment based on aircraft, it is characterised in that:Including:Processor and the storage device; The processor loads and executes the instruction in the storage device and data for realizing arbitrary described in claims 1 to 3 A kind of target identification method for tracing based on aircraft.
CN201810403029.2A 2018-04-28 2018-04-28 A kind of target identification method for tracing, equipment and storage device based on aircraft Pending CN108614572A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810403029.2A CN108614572A (en) 2018-04-28 2018-04-28 A kind of target identification method for tracing, equipment and storage device based on aircraft

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810403029.2A CN108614572A (en) 2018-04-28 2018-04-28 A kind of target identification method for tracing, equipment and storage device based on aircraft

Publications (1)

Publication Number Publication Date
CN108614572A true CN108614572A (en) 2018-10-02

Family

ID=63661387

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810403029.2A Pending CN108614572A (en) 2018-04-28 2018-04-28 A kind of target identification method for tracing, equipment and storage device based on aircraft

Country Status (1)

Country Link
CN (1) CN108614572A (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111420326A (en) * 2020-03-27 2020-07-17 国网湖南省电力有限公司 Control method and system for hovering and spraying fire extinguishing of aviation fire extinguishing device
CN111580542A (en) * 2019-02-15 2020-08-25 北京京东尚科信息技术有限公司 Dynamic unmanned aerial vehicle formation control method and device and storage medium
CN113176789A (en) * 2021-04-27 2021-07-27 北京三快在线科技有限公司 Aircraft control method, device, equipment and readable storage medium
CN117572885A (en) * 2023-11-20 2024-02-20 鸣飞伟业技术有限公司 Night tracking method, system and related device based on thermal infrared camera of unmanned aerial vehicle
CN111580542B (en) * 2019-02-15 2024-07-19 北京京东乾石科技有限公司 Dynamic unmanned aerial vehicle formation control method, device and storage medium

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104536453A (en) * 2014-11-28 2015-04-22 深圳一电科技有限公司 Aircraft control method and device
CN104597912A (en) * 2014-12-12 2015-05-06 南京航空航天大学 Tracking flying control system and method of six-rotor unmanned helicopter
KR101802880B1 (en) * 2016-04-22 2017-11-30 가천대학교 산학협력단 A position recognition and control device for a remote control device
CN107807661A (en) * 2017-11-24 2018-03-16 天津大学 Four rotor wing unmanned aerial vehicle formation demonstration and verification platforms and method in TRAJECTORY CONTROL room
CN107943102A (en) * 2017-12-28 2018-04-20 南京工程学院 A kind of aircraft of view-based access control model servo and its autonomous tracing system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104536453A (en) * 2014-11-28 2015-04-22 深圳一电科技有限公司 Aircraft control method and device
CN104597912A (en) * 2014-12-12 2015-05-06 南京航空航天大学 Tracking flying control system and method of six-rotor unmanned helicopter
KR101802880B1 (en) * 2016-04-22 2017-11-30 가천대학교 산학협력단 A position recognition and control device for a remote control device
CN107807661A (en) * 2017-11-24 2018-03-16 天津大学 Four rotor wing unmanned aerial vehicle formation demonstration and verification platforms and method in TRAJECTORY CONTROL room
CN107943102A (en) * 2017-12-28 2018-04-20 南京工程学院 A kind of aircraft of view-based access control model servo and its autonomous tracing system

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111580542A (en) * 2019-02-15 2020-08-25 北京京东尚科信息技术有限公司 Dynamic unmanned aerial vehicle formation control method and device and storage medium
CN111580542B (en) * 2019-02-15 2024-07-19 北京京东乾石科技有限公司 Dynamic unmanned aerial vehicle formation control method, device and storage medium
CN111420326A (en) * 2020-03-27 2020-07-17 国网湖南省电力有限公司 Control method and system for hovering and spraying fire extinguishing of aviation fire extinguishing device
CN111420326B (en) * 2020-03-27 2021-04-23 国网湖南省电力有限公司 Control method and system for hovering and spraying fire extinguishing of aviation fire extinguishing device
CN113176789A (en) * 2021-04-27 2021-07-27 北京三快在线科技有限公司 Aircraft control method, device, equipment and readable storage medium
CN113176789B (en) * 2021-04-27 2023-04-04 北京三快在线科技有限公司 Aircraft control method, device, equipment and readable storage medium
CN117572885A (en) * 2023-11-20 2024-02-20 鸣飞伟业技术有限公司 Night tracking method, system and related device based on thermal infrared camera of unmanned aerial vehicle
CN117572885B (en) * 2023-11-20 2024-05-31 鸣飞伟业技术有限公司 Night tracking method, system and related device based on thermal infrared camera of unmanned aerial vehicle

Similar Documents

Publication Publication Date Title
CN108453738B (en) Control method for four-rotor aircraft aerial autonomous grabbing operation based on Opencv image processing
Wenzel et al. Automatic take off, tracking and landing of a miniature UAV on a moving carrier vehicle
CN106774436B (en) Control system and method for stably tracking target of rotor unmanned aerial vehicle based on vision
CN105492985B (en) A kind of system and method for the control loose impediment in environment
CN103587708B (en) The microminiature unmanned rotary wing aircraft field zero autonomous soft landing method in blind area of fixing a point
CN107463181A (en) A kind of quadrotor self-adoptive trace system based on AprilTag
Wenzel et al. Low-cost visual tracking of a landing place and hovering flight control with a microcontroller
WO2015100899A1 (en) Intelligent cruise robot based on wireless charging odd-shaft aircraft
CN103365297A (en) Optical flow-based four-rotor unmanned aerial vehicle flight control method
Yang et al. Precise quadrotor autonomous landing with SRUKF vision perception
CN105182992A (en) Unmanned aerial vehicle control method and device
CN108614572A (en) A kind of target identification method for tracing, equipment and storage device based on aircraft
WO2019127029A1 (en) Obstacle avoidance method and device and aircraft
CN106500699B (en) A kind of position and orientation estimation method suitable for Autonomous landing in unmanned plane room
CN108037768A (en) Unmanned plane obstruction-avoiding control system, avoidance obstacle method and unmanned plane
CN110498039A (en) A kind of intelligent monitor system based on bionic flapping-wing flying vehicle
CN102190081A (en) Vision-based fixed point robust control method for airship
CN110109469A (en) It is a kind of with color, identification, positioning, following function quadrotor drone control system
CN110456822A (en) A kind of small and medium size unmanned aerial vehicles double redundancy independently measures flight control system
Wang et al. Monocular vision and IMU based navigation for a small unmanned helicopter
CN109709975B (en) Four-rotor aircraft indoor security system and method based on visual SLAM
CN108227749A (en) Unmanned plane and its tracing system
CN107943102A (en) A kind of aircraft of view-based access control model servo and its autonomous tracing system
Amidi et al. Research on an autonomous vision-guided helicopter
CN207650657U (en) A kind of aircraft of view-based access control model servo

Legal Events

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

Application publication date: 20181002

RJ01 Rejection of invention patent application after publication