CN103019250B - Bevel take-off control method of inspection flying robot - Google Patents
Bevel take-off control method of inspection flying robot Download PDFInfo
- Publication number
- CN103019250B CN103019250B CN201210510268.0A CN201210510268A CN103019250B CN 103019250 B CN103019250 B CN 103019250B CN 201210510268 A CN201210510268 A CN 201210510268A CN 103019250 B CN103019250 B CN 103019250B
- Authority
- CN
- China
- Prior art keywords
- flying robot
- angle
- patrolling
- examining
- bevel
- 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
Landscapes
- Manipulator (AREA)
Abstract
The invention discloses a bevel take-off control method of an inspection flying robot. The technical scheme is that a bevel inclination angle is divided into a first angle range, a second angle range and a third angle range; the inspection flying robot is placed on the bevel, the bevel angle value is measured, and the angle range of the bevel is determined; when the measured bevel angle value is within the first angle range and the second angle range, the gesture of the inspection flying robot is controlled through a first objective function; when the measured bevel angle value is within the third angle range, take-off of the inspection flying robot is stopped; whether turning the inspection flying robot to be in the hovering stage is judged through switching conditions; and the inspection flying robot is turned to be in the hovering stage when the switching conditions are met, and the gesture of the inspection flying robot is controlled through a second objective function. The bevel take-off control method of the inspection flying robot has the advantages of meeting site practical requirements and paving the basis for take-off of the inspection flying robot in the practical environment.
Description
Technical field
The invention belongs to flight control method, particularly relate to one and patrol and examine flying robot's bevel take-off control method.
Background technology
The autonomous flight control of air-robot is an emphasis aspect of current electric power line inspection research, patrol and examine due to unmanned plane and there is high security, light flexibly, decrease the cost of manual inspection simultaneously, therefore it be realize patrolling and examining that such as overhead power line is patrolled and examined, pipe laying is patrolled and examined, the important channel of traffic monitoring etc.Carry out in the wild because power circuit polling is many, objective condition does not allow that aircraft takes off from ideal plane.But existing model all takes off based on plane, a small amount of research aircraft inclined-plane is only had to take off problem.In order to better real reproduction takes off process, we are necessary to introduce the three-dimensional model of aircraft when inclined-plane takes off.
Here novel simple control algolithm is introduced for the actual objective problem run into.Because there are certain inclination angle and height in inclined-plane when aircraft takes off on inclined-plane, the too early adjustment attitude of aircraft may cause aircraft rotary wing to get on inclined-plane, causes very large potential safety hazard.In addition, in view of the complicacy of field environment, this control algolithm has rapidity, stability, energy saving and good environmental suitability, latter 2 to be mainly reflected in aircraft flight actual range short, can adapt to take off in narrow and small environment, better can adapt to rugged surroundings.
Optical flow method is the important method analyzed movement sequence image, light stream not only comprises the movable information of target in image, and contain the abundant information of three dimensional physical structure, therefore can be used to determine the motion conditions of target and reflection image other etc. information.Light stream sensor for the athletic posture of the acquisition air-robot of real-time high-precision and estimation significant.
Summary of the invention
Carry out in the wild for the power circuit polling mentioned in background technology is many, objective condition does not allow the problem that aircraft takes off from ideal plane, the present invention proposes one and patrols and examines flying robot's bevel take-off control method.
One patrols and examines flying robot's bevel take-off control method, it is characterized in that, concrete steps comprise:
Step 1: angle of inclination is divided into the first angular range 0-π/5, second angular range π/5-π/3 and angular extent π/3-pi/2;
Step 2: flying robot will be patrolled and examined and be placed on inclined-plane, and measure angle of chamfer angle value, and determine the angular range on inclined-plane;
Step 3: when measuring angle of chamfer angle value and belonging to the first angular range and the second angular range, controls to patrol and examine flying robot's attitude by first object function; When measuring angle of chamfer angle value and belonging to angular extent, stop taking off;
Step 4: judge whether patrol and examine flying robot goes into hover the stage by switching condition;
Step 5: when meeting switching condition, patrols and examines flying robot and goes into hover the stage, and controls to patrol and examine flying robot's attitude by the second objective function; When not meeting switching condition, return step 4.Described first object function is:
Wherein, τ
p, τ
r, τ
ypatrol and examine the pitching of flying robot respectively, driftage and roll angle; The lift that T representative needs, ω
0for the speed of rotor; k
pprepresent the proportional unit coefficient that pitch angle controls; k
dprepresent the differentiation element coefficient that pitch angle controls; k
pr, k
pyand k
pzrepresent the proportional unit coefficient of crab angle, roll angle and lift control respectively, k
dr, k
dyand k
dzrepresent the integral unit coefficient of crab angle, roll angle and lift control respectively; h
eit is the deviation of patrolling and examining flying robot's height takeoff phase; θ
efor patrolling and examining the deviate of angle that flying robot rotates along Y-axis and the Y-axis setting value anglec of rotation; α
efor patrolling and examining the deviate of angle that flying robot rotates along X-axis and the X-axis setting value anglec of rotation; β
efor patrolling and examining the deviate of angle that flying robot rotates along Z axis and the Z axis setting value anglec of rotation;
with
represent θ
e, α
e, β
eand h
edifferentiate;
Described switching condition is:
Wherein, θ
efor patrolling and examining the deviate of angle that flying robot rotates along Y-axis and the Y-axis setting value anglec of rotation; α
efor patrolling and examining the deviate of angle that flying robot rotates along X-axis and the X-axis setting value anglec of rotation; β
efor patrolling and examining the deviate of angle that flying robot rotates along Z axis and the Z axis setting value anglec of rotation; h
efor patrolling and examining the deviation of flying robot's height takeoff phase, and h
e=h-z, h are the height that takes off, and h=sin θ cos θ (r+d), and θ represents pitch angle, inclined-plane, and d represents that rotor centers is to the distance of patrolling and examining flying robot's center of gravity, and r represents and patrols and examines flying robot's rotor radius; Z patrols and examines the real-time height value of flying robot; Δ h is the height gain of setting.
Described second objective function is:
Wherein, the lift of T representative needs; Z
eit is the deviation of patrolling and examining flying robot's height; ω
0for the speed of rotor; τ
pfor patrolling and examining the angle of pitch of flying robot; k
pprepresent the proportional unit coefficient that pitch angle controls; k
dprepresent the differentiation element coefficient that pitch angle controls; k
pzrepresent the proportional unit coefficient of lift control; k
dzrepresent the integral unit coefficient controlled; θ
efor patrolling and examining the deviate of angle that flying robot rotates along Y-axis and the Y-axis setting value anglec of rotation; z
eit is the deviation of patrolling and examining flying robot's height takeoff phase;
with
represent θ
eand z
edifferentiate.
The invention has the beneficial effects as follows, be mainly used in the autonomous flight control of air-robot, the algorithm and the inclined-plane that investigated applicable on-the-spot actual demand takes off, lay a good foundation for air-robot takes off in actual environment, and patrol and examine flying robot for application in later reality and carry out electric power line inspection and done the analytical work of theoretical side.
Accompanying drawing explanation
Fig. 1 patrols and examines flying robot's structural representation;
Fig. 2 patrols and examines flying robot to take off planar structure schematic diagram;
Fig. 3 be patrol and examine flying robot take off the first stage switch to subordinate phase hovering schematic diagram;
Fig. 4 patrols and examines the range of bevel angles that flying robot takes off to divide schematic diagram;
Fig. 5 patrols and examines flying robot's bevel take-off control method process flow diagram.
Embodiment
Below in conjunction with accompanying drawing, preferred embodiment is elaborated.It should be emphasized that following explanation is only exemplary, instead of in order to limit the scope of the invention and apply.
Fig. 1 patrols and examines flying robot's structural representation.In Fig. 1, shown in patrol and examine on flying robot and light stream sensor be housed, sonac, gyro and accelerometer.Wherein light stream sensor obtains the information of patrolling and examining flying robot's tangential movement, and sonac obtains and patrols and examines the real-time altitude signal size of flying robot, and gyro is for measuring roll angle.
Fig. 2 patrols and examines flying robot to take off planar structure schematic diagram.In Fig. 2, xyz coordinate system is distinguished and body axis system, represents earth axes o{x, y, z}; According to different bevel inclination angle because flying robot's direction of motion is patrolled and examined in supposition here, flying robot's working direction is patrolled and examined in X-direction representative, the side direction voyage of flying robot is patrolled and examined in Y representative, and Z axis is perpendicular to ground, and flying robot's flying height is patrolled and examined in instruction.
Fig. 3 be patrol and examine flying robot by the first stage take off switch to subordinate phase hover schematic diagram.In Fig. 3, when meeting switching condition after patrolling and examining flying robot and taking off, be just converted to hovering phase from takeoff phase.
Fig. 4 patrols and examines the range of bevel angles that flying robot takes off to divide schematic diagram.In Fig. 4, the first stage takes off and can be divided into the first angular range (0-π/5), the second angular range (π/5-π/3), angular extent (π/3-pi/2) according to different angles of inclination.First angular range (0-π/5) determines that patrolling and examining flying robot can keep tiltangleθ constant, can remain on the flight attitude taken off in other words; When patrolling and examining flying robot's take-off angle and being in the second angular range (π/5-π/3), patrolling and examining flying robot keeps pitch angle constant when taking off, its objective is and take off on dip plane to prevent the wing of patrolling and examining flying robot from striking, after flight a period of time, flying robot's attitude to the first angular range is patrolled and examined in adjustment; When patrolling and examining in flying robot's take-off angle angular extent (π/3-pi/2), because angle of inclination is excessive, should not take off.
In the present embodiment, pitch angle initial value design is π/3, and set angle is π/5.When switch condition meets time, patrol and examine flying robot's flight attitude angle and forward π/5 to from π/3, after adjustment after a while, adjust to 0 by π/5.Here 0 representative be patrol and examine flying robot to be in hover mode.
Fig. 5 patrols and examines flying robot's bevel take-off control method process flow diagram.In Fig. 5, concrete steps comprise:
Step 1: angle of inclination is divided into the first angular range 0-π/5, second angular range π/5-π/3 and angular extent π/3-pi/2;
Step 2: flying robot will be patrolled and examined and be placed on inclined-plane, and measure angle of chamfer angle value, and determine the angular range on inclined-plane;
Step 3: when measuring angle of chamfer angle value and belonging to the first angular range and the second angular range, controls to patrol and examine flying robot's attitude by first object function; When measuring angle of chamfer angle value and belonging to angular extent, stop taking off;
Step 4: judge whether patrol and examine flying robot goes into hover the stage by switching condition;
Step 5: when meeting switching condition, patrols and examines flying robot and goes into hover the stage, and controls to patrol and examine flying robot's attitude by the second objective function; When not meeting switching condition, return step 4.
The above; be only the present invention's preferably embodiment, but protection scope of the present invention is not limited thereto, is anyly familiar with those skilled in the art in the technical scope that the present invention discloses; the change that can expect easily or replacement, all should be encompassed within protection scope of the present invention.Therefore, protection scope of the present invention should be as the criterion with the protection domain of claim.
Claims (1)
1. patrol and examine flying robot's bevel take-off control method, it is characterized in that, concrete steps comprise:
Step 1: angle of inclination is divided into the first angular range 0-π/5, second angular range π/5-π/3 and angular extent π/3-pi/2;
Step 2: flying robot will be patrolled and examined and be placed on inclined-plane, and measure angle of chamfer angle value, and determine the angular range on inclined-plane;
Step 3: when measuring angle of chamfer angle value and belonging to the first angular range and the second angular range, controls to patrol and examine flying robot's attitude by first object function; When measuring angle of chamfer angle value and belonging to angular extent, stop taking off;
Described first object function is:
Wherein, τ
p, τ
r, τ
ypatrol and examine the pitching of flying robot respectively, driftage and roll angle; The lift that T representative needs, ω
0for the speed of rotor; k
pprepresent the proportional unit coefficient that pitch angle controls; k
dprepresent the differentiation element coefficient that pitch angle controls; k
pr, k
pyand k
pzrepresent the proportional unit coefficient of crab angle, roll angle and lift control respectively, k
dr, k
dyand k
dzrepresent the integral unit coefficient of crab angle, roll angle and lift control respectively; h
eit is the deviation of patrolling and examining flying robot's height takeoff phase; θ
efor patrolling and examining the deviate of angle that flying robot rotates along Y-axis and the Y-axis setting value anglec of rotation; α
efor patrolling and examining the deviate of angle that flying robot rotates along X-axis and the X-axis setting value anglec of rotation; β
efor patrolling and examining the deviate of angle that flying robot rotates along Z axis and the Z axis setting value anglec of rotation;
with
represent θ
e, α
e, β
eand h
edifferentiate;
Step 4: judge whether patrol and examine flying robot goes into hover the stage by switching condition;
Described switching condition is:
Wherein, h
e=h-z, h are the height that takes off, and h=sin θ cos θ (r+d), and θ represents pitch angle, inclined-plane, and d represents that rotor centers is to the distance of patrolling and examining flying robot's center of gravity, and r represents and patrols and examines flying robot's rotor radius; Z patrols and examines the real-time height value of flying robot; Δ h is the height gain of setting;
Step 5: when meeting switching condition, patrols and examines flying robot and goes into hover the stage, and controls to patrol and examine flying robot's attitude by the second objective function; When not meeting switching condition, return step 4;
Described second objective function is:
Wherein, Z
ethe deviation of patrolling and examining flying robot's height,
represent Z
edifferentiate.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210510268.0A CN103019250B (en) | 2012-12-03 | 2012-12-03 | Bevel take-off control method of inspection flying robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210510268.0A CN103019250B (en) | 2012-12-03 | 2012-12-03 | Bevel take-off control method of inspection flying robot |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103019250A CN103019250A (en) | 2013-04-03 |
CN103019250B true CN103019250B (en) | 2015-01-07 |
Family
ID=47967957
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210510268.0A Expired - Fee Related CN103019250B (en) | 2012-12-03 | 2012-12-03 | Bevel take-off control method of inspection flying robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103019250B (en) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106200681B (en) * | 2014-03-27 | 2020-03-06 | 深圳市大疆创新科技有限公司 | Method and system for assisting take-off of movable object |
CN105005342B (en) * | 2015-08-11 | 2017-06-16 | 中国航空工业集团公司西安飞机设计研究所 | The method for controlling aircraft automatic takeoff |
CN108450032B (en) * | 2016-12-22 | 2021-03-02 | 深圳市大疆创新科技有限公司 | Flight control method and device |
CN107703971B (en) * | 2017-11-20 | 2023-08-25 | 唐菲菲 | Unmanned aerial vehicle mobilization method and unmanned aerial vehicle mobilization system for patrol area |
CN107977021A (en) * | 2017-11-28 | 2018-05-01 | 佛山市安尔康姆航空科技有限公司 | A kind of control method of holder steering engine |
CN108780330A (en) * | 2017-12-14 | 2018-11-09 | 深圳市大疆创新科技有限公司 | Aircraft security takeoff method, landing method and aircraft |
JP6777355B2 (en) * | 2018-06-04 | 2020-10-28 | 株式会社ナイルワークス | Drone system, drone system control method, and drone system control program |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101940845A (en) * | 2010-07-23 | 2011-01-12 | 燕高飞 | Eggshell-shaped outer frame |
CN102117072A (en) * | 2011-03-10 | 2011-07-06 | 上海交通大学 | Multi-rotor aircraft ground measurement and control system having function of detecting rotating speeds of rotors |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006082774A (en) * | 2004-09-17 | 2006-03-30 | Hiroboo Kk | Unmanned flying object and its controlling method |
JP5392891B2 (en) * | 2008-09-05 | 2014-01-22 | 学校法人東京電機大学 | Flying robot |
-
2012
- 2012-12-03 CN CN201210510268.0A patent/CN103019250B/en not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101940845A (en) * | 2010-07-23 | 2011-01-12 | 燕高飞 | Eggshell-shaped outer frame |
CN102117072A (en) * | 2011-03-10 | 2011-07-06 | 上海交通大学 | Multi-rotor aircraft ground measurement and control system having function of detecting rotating speeds of rotors |
Non-Patent Citations (2)
Title |
---|
JP特开2006-82774A 2006.03.30 * |
JP特开2010-58779A 2010.03.18 * |
Also Published As
Publication number | Publication date |
---|---|
CN103019250A (en) | 2013-04-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103019250B (en) | Bevel take-off control method of inspection flying robot | |
CN108306217B (en) | Intelligent autonomous overhead high-voltage line wire flying inspection system and method | |
Mirallès et al. | LineDrone Technology: Landing an unmanned aerial vehicle on a power line | |
Laiacker et al. | Vision aided automatic landing system for fixed wing UAV | |
CN104843176B (en) | Unmanned-gyroplane system used for automatic-inspection of bridges and tunnels and navigation method | |
CN103224026B (en) | A kind ofly be applicable to dedicated unmanned helicopter obstacle avoidance system that mountain area electrical network patrols and examines and workflow thereof | |
Kim et al. | Accurate modeling and robust hovering control for a quad-rotor VTOL aircraft | |
CN103853156B (en) | A kind of small-sized four-rotor aircraft control system based on machine set sensor and method | |
JP6179502B2 (en) | Three-dimensional shape measuring method and apparatus using multicopter | |
Schäfer et al. | Multicopter unmanned aerial vehicle for automated inspection of wind turbines | |
CN103606852B (en) | The electric power line inspection method of depopulated helicopter | |
CN203397214U (en) | Special unmanned helicopter obstacle-avoiding system suitable for tour inspection of electrical networks in mountain area | |
CN203038112U (en) | Unmanned aerial vehicle (UAV) automatic control system | |
CN104298248A (en) | Accurate visual positioning and orienting method for rotor wing unmanned aerial vehicle | |
CN104460685A (en) | Control system for four-rotor aircraft and control method of control system | |
CN109709986A (en) | A kind of unmanned aerial vehicle control system and method | |
CN203825466U (en) | Airborne-sensor-based small-sized four rotor aircraft control system | |
CN204871599U (en) | Four shaft air vehicle | |
CN112748744A (en) | Transformer substation amphibious inspection device and inspection method thereof | |
CN105629995A (en) | Mooring following system and method | |
CN1669874A (en) | Automatic pilot for aircraft | |
CN104875882A (en) | Quadrotor | |
CN205121348U (en) | Unmanned vehicles safety system of descending fast and remote control equipment and unmanned vehicles thereof | |
CN103869811B (en) | The remote control of a kind of quadrotor and the monitoring method of servosignal | |
CN106802662A (en) | A kind of multi-rotor unmanned aerial vehicle embedded 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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150107 Termination date: 20151203 |
|
EXPY | Termination of patent right or utility model |