CN102298389A - System fully controlled and taken over by ground station during takeoff and landing stages of unmanned plane - Google Patents

System fully controlled and taken over by ground station during takeoff and landing stages of unmanned plane Download PDF

Info

Publication number
CN102298389A
CN102298389A CN2011101550132A CN201110155013A CN102298389A CN 102298389 A CN102298389 A CN 102298389A CN 2011101550132 A CN2011101550132 A CN 2011101550132A CN 201110155013 A CN201110155013 A CN 201110155013A CN 102298389 A CN102298389 A CN 102298389A
Authority
CN
China
Prior art keywords
control
unmanned plane
land station
flight
steering wheel
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
CN2011101550132A
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.)
Tsinghua University
Original Assignee
Tsinghua University
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 Tsinghua University filed Critical Tsinghua University
Priority to CN2011101550132A priority Critical patent/CN102298389A/en
Publication of CN102298389A publication Critical patent/CN102298389A/en
Pending legal-status Critical Current

Links

Classifications

    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Abstract

A system fully controlled and taken over by a ground station during takeoff and landing stages of an unmanned plane, which belongs to the unmanned plane technology field, is characterized in that: the system comprises an unmanned plane control department and a ground station control department, wherein the unmanned plane control department comprises a airborne sensor group, a flight control computer, a steering gear adapter, a steering group, a downlink data link transmitter and an uplink data link receiver and the ground station control department comprises a ground station, a downlink data link receiver, an uplink data link transmitter, a takeoff and landing platform and a takeoff and landing platform sensor group; during the takeoff and landing stages of the unmanned plane, the flight control computer sends flight data to the ground station by using the downlink data link; the ground station continues to calculate unmanned plane steering commands according to a relative movement relation between the unmanned plane and the takeoff and landing platform and controls the unmanned plane through the uplink data link so that the unmanned plane can complete takeoff and landing which are fully controlled by the ground station. By using the invention, security of the takeoff and landing stages of the unmanned plane can be raised and application occasions can be expanded.

Description

The take off land station full powers in landing stage of unmanned plane are taken over control system
Technical field
The present invention is used to control the device that unmanned plane takes off automatically and lands, and can automatically guide and handle unmanned plane taking off and land under complex environment.Be mainly used in technical fields such as Aero-Space, unmanned plane and robot.
Background technology
Taking off and landing of unmanned plane is the stage occurred frequently of air crash accident, and when unmanned plane (as narrow and small area or motion platform) under complex environment took off and lands, accident rate was higher.Taking off automatically and landing of unmanned plane can only be finished under such as good landing conditions such as broad smooth places usually, and many based on remote control mode under complex environment.In addition, when unmanned plane lands on mobile landing platforms such as warship and vehicle, because attitude, position and the speed of landing platform constantly change, unmanned plane needs to adjust rapidly, exactly self attitude keeping and being synchronized with the movement of mobile landing platform, and its landing process is difficulty and dangerous very.Therefore unmanned plane take-off and landing mode danger in the past is high, applicable situation is few, is difficult to satisfy present unmanned plane application demand.
The present invention utilizes land station to contrast the relative motion of unmanned plane and landing platform in real time, continues to calculate steering order and the directly flight of full powers control unmanned plane, make unmanned plane can be under complex environment automatically, take off safely and land.Take off with traditional unmanned plane and to compare with landing method, advantage of the present invention is full-automatic landing, safe and accommodation is extensive.Not only can make unmanned plane revise the course line in real time according to the indication of land station, in time evade barrier and safe take-off or landing at complicated ground (between high building); And can make unmanned plane in real time, promptly follow the motion of landing platform (as the warship in advancing, vehicle etc.), finish taking off and land on mobile landing platform.The present invention can significantly improve the flight safety that unmanned plane takes off and lands under complex environment, and can expand the equipment scope of application of unmanned plane.
Summary of the invention
The object of the present invention is to provide a kind of system that unmanned plane independently takes off and lands that is used under complex environment.
The invention is characterized in, contain: unmanned aerial vehicle (UAV) control portion and ground station control portion, wherein:
Unmanned aerial vehicle (UAV) control portion, contain: airborne sensor group, flight-control computer, steering wheel adapter, steering wheel group, downlink data link transmitter and up data link receiver, wherein:
The airborne sensor group, be integrated with: 3 shaft angle rate gyroscopes, 3 axis accelerometer meters, 3 magnetometers, ultrasonic height meter and GPS receivers, with the volume coordinate of real-time measurement unmanned plane, 3 axis angular rates, 3 axis accelerometers, 3 Eulerian angle and ultrasound wave relative height, be expressed as flying quality
Figure BSA00000514348200021
And send to flight-control computer:
γ A=[x A(t), y A(t), z A(t)] TBe the volume coordinate of unmanned plane,
A=[p A(t), q A(t), r A(t)] TBe 3 axis angular rates of unmanned plane,
Λ A=[u A(t), v A(t), w A(t)] TBe 3 axial velocities of unmanned plane,
Ξ A=[φ A(t), θ A(t), ψ A(t)] TBe 3 Eulerian angle of unmanned plane,
Δ h is the ultrasound wave relative height;
Flight-control computer is provided with: the flying quality signal input part of described airborne sensor group output, send flying quality η to the downlink data link transmitters A(t) output terminal, and fly to control steering wheel instruction δ according to what predefined flight path and flight control algorithm generated Fly control(t)=[δ Fly to control 1(t), δ Fly to control 2(t), L, δ Fly to control n(t)] T, n is the steering wheel number, wherein:
The flight path of expectation is expressed as Г C=[x C(t), y C(t), z C(t)] T, wherein, x C(t), y C(t), z C(t) volume coordinate for setting, t=1,2 ...., L, the flight time length of L for setting, unit is second;
Fly control instruction δ Fly to control i(t) expression formula is:
Figure BSA00000514348200022
Wherein,
Figure BSA00000514348200023
With
Figure BSA00000514348200024
Be the controller parameter of flight-control computer, wherein
Figure BSA00000514348200025
Be scale-up factor,
Figure BSA00000514348200026
Be integral coefficient, Be differential coefficient, be setting value;
The steering wheel adapter is made of the PIC single-chip microcomputer, is provided with:
Steering wheel control command signal input end receives and to fly control instruction δ from described flight-control computer Fly control(t)=[δ Fly to control 1(t), δ Fly to control 2(t), L, δ Fly to control n(t)] T, span is [100,100], i ∈ [1, n];
Land station's instruction input end receives the instruction δ of land station from described up data link receiver Land station(t)=[δ Land station 1(t), δ Land station 2(t), L, δ The n of land station(t)] T, span is [100,100], i ∈ [1, n];
The described control instruction δ that flies Fly control(t) and land station instruction δ Land station(t) all adopt RS232 serial signal form, wherein fly control instruction δ Fly control(t) frame head is defined as DB9033, the instruction δ of land station Land station(t) frame head is defined as DB9053, and δ is instructed in land station Land station(t) priority level initializing flies control instruction δ for being higher than Fly control(t) priority;
Described steering wheel adapter only is converted into n road steering wheel PWM pulse-width signal to the current the highest command signal of priority of receiving, the n road steering wheel that is used to control the steering wheel group instructs pairing PWM pulse-width signal to carry out deflection according to current limit priority; Described steering wheel adapter flies control instruction δ by the frame head that detects the instruction of receiving with identification Fly control(t) and land station instruction δ Land station(t);
Downlink data link transmitter is provided with the flying quality receiving end, receives the flying quality η from described flight-control computer output A(t), and immediately send flying quality η to the downlink data link receiver A(t);
Ground station control portion, contain: land station, downlink data link receiver, up data link transmitter, landing platform and landing platform sensor groups, wherein:
The landing platform is fixed with land station, landing platform sensor groups, downlink data link receiver and up data link transmitter, wherein:
Landing platform sensor groups, be integrated with described 3 shaft angle rate gyroscopes, 3 axis accelerometer meters, 3 magnetometers, and the GPS receiver, with volume coordinate, 3 axis angular rates, 3 axis accelerometers and 3 Eulerian angle of real-time measurement landing platform, be expressed as the exercise data of landing platform And send to land station:
γ G=[x G(t), y G(t), z G(t)] TBe the volume coordinate of landing platform,
G=[p G(t), q G(t), r G(t)] TBe 3 axis angular rates of landing platform,
Λ G=[u G(t), v G(t), w G(t)] TBe 3 axial velocities of landing platform,
Ξ G=[φ G(t), θ G(t), ψ G(t)] T3 Eulerian angle for the landing platform;
h 0Relative height for the landing platform is set at 0;
Land station is a PC, receives the flying quality η that sends from the described downlink data link of unmanned plane transmitter by described downlink data link receiver A(t), and by described up data link transmitter send the instruction δ of land station that land station calculates in real time to unmanned plane Land station(t);
Under the normal flight state, by the flight of flight-control computer control unmanned plane, the state of flight of unmanned plane is judged by described land station by the relative position of contrast unmanned plane and landing platform:
Wherein, D is predefined ground station control scope: when unmanned plane flies outside D, think the normal flight state; When unmanned plane flies within D, think to take off/the landing state; D is a setting value, gets 100 meters;
Described flight-control computer is according to the flying quality η from described airborne sensor group A(t), fly control instruction δ according to default flight control algorithm generation Fly control(t), the serial signal that and with the frame head is DB9033 sends to described steering wheel adapter; Described steering wheel adapter is the described control instruction δ that flies Fly control(t) be converted into n road steering wheel PWM pulse-width signal, be used to control the n road steering wheel of steering wheel group according to δ Fly control(t) pairing PWM pulse-width signal carries out deflection, to handle unmanned plane according to predetermined flight path Г CFlight;
Taking off/the landing state under, the flight of taking over the control unmanned plane by land station full powers, and judge that by following formula the unmanned plane current state is standby for takeoff or prepares to land:
Figure BSA00000514348200041
Wherein, when land station detects unmanned plane and flies within D, confirm that unmanned plane enters to take off/the landing state; Flight intention is further judged by predefined state judgment threshold d by land station: when unmanned plane enter when taking off/land state and the landing platform apart from greater than d, then think to prepare landing state; Otherwise, then think the standby for takeoff state; D is a setting value, gets 10 meters;
Then, described land station is according to the flying quality η of unmanned plane A(t) and the exercise data η of landing platform G(t), and current standby for takeoff or preparation landing state, calculating frame head in real time is the instruction δ of land station of DB9053 Land station (T), and by the up data link transmitter send to up data link receiver on the unmanned plane; The instruction δ of land station Land station(t) expression formula is:
Figure BSA00000514348200042
Wherein,
Figure BSA00000514348200043
With
Figure BSA00000514348200044
Be the controller parameter of land station, wherein
Figure BSA00000514348200045
Be scale-up factor,
Figure BSA00000514348200046
Be integral coefficient,
Figure BSA00000514348200047
Be differential coefficient, be setting value;
Described up data link receiver is with the instruction δ of land station that receives Land station(t) send to the steering wheel adapter; Because the instruction δ of land station Land station(t) priority is higher than and flies control instruction δ Fly control(t) therefore priority worked as the steering wheel adapter and detected the instruction δ of land station that frame head is DB9053 Land station(t) after, change into immediately δ is instructed in land station Land station(t) be converted into n road steering wheel PWM pulse-width signal, be used to control the n road steering wheel of steering wheel group according to δ Land station(t) pairing PWM pulse-width signal carries out deflection, so the time the taking off or land of unmanned plane fully by ground station control; Unmanned plane is constantly revised self state of flight under land station handles in real time, gradually away from or near the landing platform, finally finish and on the landing platform, take off automatically or land; And after unmanned plane flew out ground station control scope D, land station stopped to send the instruction δ of land station Land station(t), described steering wheel adapter changes into flight-control computer is flown control instruction δ Fly control(t) be converted into the n road steering wheel PWM pulse-width signal of steering wheel group, unmanned plane is automatically switched under the control of flight-control computer, thereby realizing that land station takes in landing/landing stage full powers unmanned plane controls.The invention has the advantages that: unmanned plane can be realized full-automatic landing, safe, wide accommodation.Not only can make unmanned plane revise the course line in real time according to the indication of land station, in time evade barrier and safe take-off or landing at complicated ground (between high building); And can make unmanned plane in real time, promptly follow the motion of mobile landing platform (as the warship in advancing, vehicle etc.), finish taking off and land on mobile platform; The present invention can significantly improve the flight safety that unmanned plane takes off and lands under complex environment, and effectively expands the equipment scope of application of unmanned plane.
Description of drawings
Fig. 1 is that the take off land station full powers in landing stage of unmanned plane are taken over the schematic diagram of control system.
Among Fig. 1,1. unmanned plane, 2. airborne sensor group, 3. flight-control computer, 4. steering wheel adapter, 5. steering wheel group, 6. downlink data link transmitter, 7. downlink data link receiver, 8. land station, 9. up data link transmitter, 10. up data link receiver, 11. the landing platform, 12. landing platform sensor groups.
Embodiment
The take off land station full powers in landing stage of unmanned plane are taken over control system and are used to control unmanned plane 1 and finish at landing platform 11 and automatically take off and land, and total system is made up of unmanned aerial vehicle (UAV) control portion and ground station control portion, wherein:
Unmanned aerial vehicle (UAV) control portion, contain: airborne sensor group 2, flight-control computer 3, steering wheel adapter 4, steering wheel group 5, downlink data link transmitter 6 and up data link receiver 7, wherein:
Airborne sensor group 2, be integrated with: 3 shaft angle rate gyroscopes, 3 axis accelerometer meters, 3 magnetometers, ultrasonic height meter and GPS receivers, with the volume coordinate of real-time measurement unmanned plane 1,3 axis angular rates, 3 axis accelerometers, 3 Eulerian angle and ultrasound wave relative height, be expressed as flying quality
Figure BSA00000514348200051
And send to flight-control computer 3:
γ A=[x A(t), y A(t), z A(t)] TBe the volume coordinate of unmanned plane 1,
A=[p A(t), q A(t), r A(t)] TBe 3 axis angular rates of unmanned plane 1,
Λ A=[u A(t), v A(t), w A(t)] TBe 3 axial velocities of unmanned plane 1,
Ξ A=[φ A(t), θ A(t), ψ A(t)] TBe 3 Eulerian angle of unmanned plane 1,
Δ h is the ultrasound wave relative height;
Flight-control computer 3 is provided with: the flying quality signal input part of described airborne sensor group 2 outputs, send flying quality η to downlink data link transmitters 6 A(t) output terminal, and fly to control steering wheel instruction δ according to what predefined flight path and flight control algorithm generated Fly control(t)=[δ Fly to control 1(t), δ Fly to control 2(t), L, δ Fly to control n(t)] T, n is the steering wheel number, wherein:
The flight path of setting is expressed as Г C=[x C(t), y C(t), z C(t)] T, wherein, x C(t), y C(t), z C(t) volume coordinate for setting, t=1,2 ...., L, the flight time length of L for setting, unit is second;
Fly control instruction δ Fly to control i(t) expression formula is:
Figure BSA00000514348200052
Wherein,
Figure BSA00000514348200061
With
Figure BSA00000514348200062
Be the controller parameter of flight-control computer 2, wherein
Figure BSA00000514348200063
Be scale-up factor,
Figure BSA00000514348200064
Be integral coefficient, Be differential coefficient, be setting value;
Steering wheel adapter 4 is made of the PIC single-chip microcomputer, is provided with:
Steering wheel control command signal input end receives and to fly control instruction δ from described flight-control computer 3 Fly control(t)=[δ Fly to control 1(t), δ Fly to control 2(t), L, δ Fly to control n(t)] T, span is [100,100], i ∈ [1, n];
Land station's instruction input end receives the instruction δ of land station from described up data link receiver 10 Land station(t)=[δ Land station 1(t), δ Land station 2(t), L, δ The n of land station(t)] T, span is [100,100], i ∈ [1, n];
The described control instruction δ that flies Fly control(t) and land station instruction δ Land station(t) all adopt RS232 serial signal form, wherein fly control instruction δ Fly control(t) frame head is defined as DB9033, the instruction δ of land station Land station(t) frame head is defined as DB9053, and δ is instructed in land station Land station(t) priority level initializing flies control instruction δ for being higher than Fly control(t) priority;
4 of described steering wheel adapters are converted into n road steering wheel PWM pulse-width signal to the current the highest command signal of priority of receiving, the n road steering wheel that is used to control steering wheel group 5 instructs pairing PWM pulse-width signal to carry out deflection according to current limit priority; Described steering wheel adapter 4 flies control instruction δ by the frame head that detects the instruction of receiving with identification Fly control(t) and land station instruction δ land station (t);
Downlink data link transmitter is provided with the flying quality receiving end, receives the flying quality η from described flight-control computer output A(t), and immediately send flying quality η to the downlink data link receiver A(t);
Ground station control portion, contain: land station 8, downlink data link receiver 7, up data link transmitter 9, landing platform 11 and landing platform sensor groups 12, wherein:
The landing platform is fixed with land station, landing platform sensor groups, downlink data link receiver and up data link transmitter, wherein:
Landing platform sensor groups 12, be integrated with described 3 shaft angle rate gyroscopes, 3 axis accelerometer meters, 3 magnetometers, and the GPS receiver, with volume coordinate, 3 axis angular rates, 3 axis accelerometers and 3 Eulerian angle of real-time measurement landing platform 11, be expressed as the exercise data of landing platform 11
Figure BSA00000514348200066
And send to land station 8:
γ G=[x G(t), y G(t), z G(t)] TBe the volume coordinate of landing platform 11,
G=[p G(t), q G(t), r G(t)] TBe 3 axis angular rates of landing platform 11,
Λ G=[u G(t), v G(t), w G(t)] TBe 3 axial velocities of landing platform 11,
Ξ G=[φ G(t), θ G(t), ψ G(t)] T3 Eulerian angle for landing platform 11;
h 0Relative height for the landing platform is set at 0;
Land station 8 is PCs, receives the flying quality η that sends from unmanned plane 1 described downlink data link transmitter 6 by described downlink data link receiver 7 A(t), and by described up data link transmitter 9 send the instruction δ of land station that land station 8 calculates in real time to unmanned plane 1 Land station(t);
Under the normal flight state, by the flight of flight-control computer 3 control unmanned planes 1, the state of flight of unmanned plane 1 is judged by described land station 8 by the contrast unmanned plane 1 and the relative position of landing platform 11:
Figure BSA00000514348200071
Wherein, D is predefined ground station control scope: when unmanned plane 1 flies outside D, think the normal flight state; When unmanned plane 1 flies within D, think to take off/the landing state; D is a setting value, gets 100 meters;
Described flight-control computer 3 is according to the flying quality η from described airborne sensor group 2 A(t), fly control instruction δ according to default flight control algorithm generation Fly control(t), the serial signal that and with the frame head is DB9033 sends to described steering wheel adapter 4; Described steering wheel adapter 4 is the described control instruction δ that flies Fly control(t) be converted into the n road steering wheel PWM pulse-width signal of steering wheel group 5, be used to control n road steering wheel according to δ Fly control(t) pairing PWM pulse-width signal carries out deflection, to handle unmanned plane 1 according to predetermined flight path Г CFlight;
Taking off/the landing state under, the flight of taking over control unmanned plane 1 by land station 8 full powers, and judge that by following formula unmanned plane 1 current state is standby for takeoff or prepares to land:
Figure BSA00000514348200072
Wherein, when land station 8 detects unmanned plane and flies within D, confirm that unmanned plane 1 enters to take off/the landing state; Flight intention is further judged by predefined state judgment threshold d by land station 8: when unmanned plane 1 enter when taking off/land state and landing platform 11 apart from greater than d, then think to prepare landing state; Otherwise, then think the standby for takeoff state; D is a setting value, gets 10 meters;
Then, described land station 8 is according to the flying quality η of unmanned plane 1 A(t) and the exercise data η of landing platform 11 G(t), and current standby for takeoff or preparation landing state, calculating frame head in real time is the instruction δ of land station of DB9053 Land station(t), and by up data link transmitter 9 send to up data link receiver 10 land stations instructions δ on the unmanned plane 1 Land station(t) expression formula is:
Figure BSA00000514348200073
Wherein,
Figure BSA00000514348200074
With
Figure BSA00000514348200075
Be the controller parameter of land station 8, wherein
Figure BSA00000514348200076
Be scale-up factor,
Figure BSA00000514348200077
Be integral coefficient,
Figure BSA00000514348200081
Be differential coefficient, be setting value;
Described up data link receiver 10 is with the instruction δ of land station that receives Land station(t) send to steering wheel adapter 4; Because the instruction δ of land station Land station(t) priority is higher than and flies control instruction δ Fly control(t) therefore priority worked as steering wheel adapter 4 and detected the instruction δ of land station that frame head is DB9053 Land station(t) after, change into immediately δ is instructed in land station Land station(t) be converted into n road steering wheel PWM pulse-width signal, be used to control the n road steering wheel of steering wheel group 5 according to δ Land station(t) pairing PWM pulse-width signal carries out deflection, so the time the taking off or land fully of unmanned plane 1 by land station's 8 controls; Unmanned plane 1 is constantly revised self state of flight under land station 8 handles in real time, gradually away from or near landing platform 11, finally finish and on landing platform 11, take off automatically or land; And after unmanned plane 1 flew out the 8 range of control D of land station, land station 8 stopped to send the instruction δ of land station Land station(t), described steering wheel adapter 4 changes into flight-control computer 3 is flown control instruction δ Fly control(t) be converted into n road steering wheel PWM pulse-width signal, unmanned plane 1 is automatically switched under the control of flight-control computer 3, thereby realize that 8 pairs of unmanned planes 1 of land station are in landing/landing stage full powers adapter control.

Claims (1)

1. the take off land station full powers in landing stage of unmanned plane are taken over control system, it is characterized in that, contain: unmanned aerial vehicle (UAV) control portion and ground station control portion, wherein:
Unmanned aerial vehicle (UAV) control portion, contain: airborne sensor group, flight-control computer, steering wheel adapter, steering wheel group, downlink data link transmitter and up data link receiver, wherein:
The airborne sensor group, be integrated with: 3 shaft angle rate gyroscopes, 3 axis accelerometer meters, 3 magnetometers, ultrasonic height meter and GPS receivers, with the volume coordinate of real-time measurement unmanned plane, 3 axis angular rates, 3 axis accelerometers, 3 Eulerian angle and ultrasound wave relative height, be expressed as flying quality
Figure FSA00000514348100011
And send to flight-control computer:
γ A=[x A(t), y A(t), z A(t)] TBe the volume coordinate of unmanned plane,
A=[p A(t), q A(t), r A(t)] TBe 3 axis angular rates of unmanned plane,
Λ A=[u A(t), v A(t), w A(t)] TBe 3 axial velocities of unmanned plane,
Ξ A=[φ A(t), θ A(t), ψ A(t)] TBe 3 Eulerian angle of unmanned plane,
Δ h is the ultrasound wave relative height;
Flight-control computer is provided with: the flying quality signal input part of described airborne sensor group output, send flying quality η to the downlink data link transmitters A(t) output terminal, and fly to control steering wheel instruction δ according to what predefined flight path and flight control algorithm generated Fly control(t)=[δ Fly to control 1(t), δ Fly to control 2(t), L, δ Fly to control n(t)] T, n is the steering wheel number, wherein:
The flight path of expectation is expressed as Γ C=[x C(t), y C(t), z C(t)] T, wherein, x C(t), y C(t), z C(t) volume coordinate for setting, t=1,2 ..., L, the flight time length of L for setting, unit is second;
Fly control instruction δ Fly to control i(t) expression formula is:
Figure FSA00000514348100012
Wherein,
Figure FSA00000514348100013
With
Figure FSA00000514348100014
Be the controller parameter of flight-control computer, wherein
Figure FSA00000514348100015
Be scale-up factor, Be integral coefficient,
Figure FSA00000514348100017
Be differential coefficient, be setting value;
The steering wheel adapter is made of the PIC single-chip microcomputer, is provided with:
Steering wheel control command signal input end receives and to fly control instruction δ from described flight-control computer Fly control(t)=[δ Fly to control 1(t), δ Fly to control 2(t), L, δ Fly to control n(t)] T, span is [100,100], i ∈ [1, n];
Land station's instruction input end receives the instruction δ of land station from described up data link receiver Land station(t)=[δ Land station 1(t), δ Land station 2(t), L, δ The n of land station(t)] T, span is [100,100], i ∈ [1, n];
The described control instruction δ that flies Fly control(t) and land station instruction δ Land station(t) all adopt RS232 serial signal form, wherein fly control instruction δ Fly control(t) frame head is defined as DB9033, the instruction δ of land station Land station(t) frame head is defined as DB9053, and δ is instructed in land station Land station(t) priority level initializing flies control instruction δ for being higher than Fly control(t) priority;
Described steering wheel adapter only is converted into n road steering wheel PWM pulse-width signal to the current the highest command signal of priority of receiving, the n road steering wheel that is used to control the steering wheel group instructs pairing PWM pulse-width signal to carry out deflection according to current limit priority; Described steering wheel adapter flies control instruction δ by the frame head that detects the instruction of receiving with identification Fly control(t) and land station instruction δ Land station(t);
Downlink data link transmitter is provided with the flying quality receiving end, receives the flying quality η from described flight-control computer output A(t), and immediately send flying quality η to the downlink data link receiver A(t);
Ground station control portion, contain: land station, downlink data link receiver, up data link transmitter, landing platform and landing platform sensor groups, wherein:
The landing platform is fixed with land station, landing platform sensor groups, downlink data link receiver and up data link transmitter, wherein:
Landing platform sensor groups, be integrated with described 3 shaft angle rate gyroscopes, 3 axis accelerometer meters, 3 magnetometers, and the GPS receiver, with volume coordinate, 3 axis angular rates, 3 axis accelerometers and 3 Eulerian angle of real-time measurement landing platform, be expressed as the exercise data of landing platform And send to land station:
γ G=[x G(t), y G(t), z G(t)] TBe the volume coordinate of landing platform,
G=[p G(t), q G(t), r G(t)] TBe 3 axis angular rates of landing platform,
Λ G=[u G(t), v G(t), w G(t)] TBe 3 axial velocities of landing platform,
Ξ G=[φ G(t), θ G(t), ψ G(t)] T3 Eulerian angle for the landing platform;
h 0Relative height for the landing platform is set at 0;
Land station is a PC, receives the flying quality η that sends from the described downlink data link of unmanned plane transmitter by described downlink data link receiver A(t), and by described up data link transmitter send the instruction δ of land station that land station calculates in real time to unmanned plane Land station(t);
Under the normal flight state, by the flight of flight-control computer control unmanned plane, the state of flight of unmanned plane is judged by described land station by the relative position of contrast unmanned plane and landing platform:
Figure FSA00000514348100031
Wherein, D is predefined ground station control scope: when unmanned plane flies outside D, think the normal flight state; When unmanned plane flies within D, think to take off/the landing state; D is a setting value, gets 100 meters;
Described flight-control computer is according to the flying quality η from described airborne sensor group A(t), fly control instruction δ according to default flight control algorithm generation Fly control(t), the serial signal that and with the frame head is DB9033 sends to described steering wheel adapter; Described steering wheel adapter is the described control instruction δ that flies Fly control(t) be converted into n road steering wheel PWM pulse-width signal, be used to control the n road steering wheel of steering wheel group according to δ Fly control(t) pairing PWM pulse-width signal carries out deflection, to handle unmanned plane according to predetermined flight path Γ CFlight;
Taking off/the landing state under, the flight of taking over the control unmanned plane by land station full powers, and judge that by following formula the unmanned plane current state is standby for takeoff or prepares to land:
Figure FSA00000514348100032
Wherein, when land station detects unmanned plane and flies within D, confirm that unmanned plane enters to take off/the landing state; Flight intention is further judged by predefined state judgment threshold d by land station: when unmanned plane enter when taking off/land state and the landing platform apart from greater than d, then think to prepare landing state; Otherwise, then think the standby for takeoff state; D is a setting value, gets 10 meters;
Then, described land station is according to the flying quality η of unmanned plane A(t) and the exercise data η of landing platform G(t), and current standby for takeoff or preparation landing state, calculating frame head in real time is the instruction δ of land station of DB9053 Land station(t), and by the up data link transmitter send to up data link receiver on the unmanned plane; The instruction δ of land station Land station(t) expression formula is:
Figure FSA00000514348100033
Wherein,
Figure FSA00000514348100034
With Be the controller parameter of land station, wherein
Figure FSA00000514348100036
Be scale-up factor,
Figure FSA00000514348100037
Be integral coefficient,
Figure FSA00000514348100038
Be differential coefficient, be setting value;
Described up data link receiver is with the instruction δ of land station that receives Land station(t) send to the steering wheel adapter; Because the instruction δ of land station Land station(t) priority is higher than and flies control instruction δ Fly control(t) therefore priority worked as the steering wheel adapter and detected the instruction δ of land station that frame head is DB9053 Land station(t) after, change into immediately δ is instructed in land station Land station(t) be converted into n road steering wheel PWM pulse-width signal, be used to control the n road steering wheel of steering wheel group according to δ Land station(t) pairing PWM pulse-width signal carries out deflection, so the time the taking off or land of unmanned plane fully by ground station control; Unmanned plane is constantly revised self state of flight under land station handles in real time, gradually away from or near the landing platform, finally finish and on the landing platform, take off automatically or land; And after unmanned plane flew out ground station control scope D, land station stopped to send the instruction δ of land station Land station(t), described steering wheel adapter changes into flight-control computer is flown control instruction δ Fly control(t) be converted into the n road steering wheel PWM pulse-width signal of steering wheel group, unmanned plane is automatically switched under the control of flight-control computer, thereby realizing that land station takes in landing/landing stage full powers unmanned plane controls.
CN2011101550132A 2011-06-10 2011-06-10 System fully controlled and taken over by ground station during takeoff and landing stages of unmanned plane Pending CN102298389A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN2011101550132A CN102298389A (en) 2011-06-10 2011-06-10 System fully controlled and taken over by ground station during takeoff and landing stages of unmanned plane

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN2011101550132A CN102298389A (en) 2011-06-10 2011-06-10 System fully controlled and taken over by ground station during takeoff and landing stages of unmanned plane

Publications (1)

Publication Number Publication Date
CN102298389A true CN102298389A (en) 2011-12-28

Family

ID=45358859

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2011101550132A Pending CN102298389A (en) 2011-06-10 2011-06-10 System fully controlled and taken over by ground station during takeoff and landing stages of unmanned plane

Country Status (1)

Country Link
CN (1) CN102298389A (en)

Cited By (31)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102814047A (en) * 2012-07-19 2012-12-12 南京航空航天大学 Autonomous return system and control method of dual-rotor remote-controlled model helicopter
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
CN104584578A (en) * 2012-03-02 2015-04-29 莫戈公司 Real-time aircraft status detection system and method
CN104656665A (en) * 2015-03-06 2015-05-27 云南电网有限责任公司电力科学研究院 Novel general obstacle avoidance module for UAV (unmanned aerial vehicle) and steps
CN105182986A (en) * 2015-08-10 2015-12-23 北京零零无限科技有限公司 Method of retrieving and releasing unmanned aerial vehicle in hand-held mode and apparatus thereof
CN105223965A (en) * 2015-11-05 2016-01-06 北京精航科技有限公司 Unmanned plane voice activated control
CN105388911A (en) * 2015-12-16 2016-03-09 深圳市中航佳智能科技有限公司 Unmanned aerial vehicle intelligent control take-off method
CN105446356A (en) * 2015-12-17 2016-03-30 小米科技有限责任公司 Unmanned plane control method and unmanned plane control device
CN105518559A (en) * 2014-12-15 2016-04-20 深圳市大疆创新科技有限公司 Aircraft, take-off control method and system thereof and landing control method and system thereof
CN105667826A (en) * 2016-03-03 2016-06-15 谭圆圆 Control method and device for unmanned aerial vehicle
CN105843254A (en) * 2016-04-29 2016-08-10 乐视控股(北京)有限公司 UAV flight control mode switching method and device and UAV
CN106054923A (en) * 2016-07-04 2016-10-26 苏州光之翼智能科技有限公司 Asymmetric unmanned aerial vehicle clustering system
WO2016172962A1 (en) * 2015-04-30 2016-11-03 SZ DJI Technology Co., Ltd. System and method for landing a mobile platform via a magnetic field
CN106155070A (en) * 2016-07-04 2016-11-23 零度智控(北京)智能科技有限公司 Unmanned plane takes off control method and device, remote terminal
CN106406350A (en) * 2016-10-28 2017-02-15 易瓦特科技股份公司 Method and system for controlling unmanned aerial vehicle
CN106493106A (en) * 2015-09-06 2017-03-15 慧鸟科技发展(北京)有限公司 A kind of aerial automatic operating system
CN106774321A (en) * 2016-12-19 2017-05-31 成都四威电子有限公司成都星石科技分公司 Accessory system and householder method are taken off and landed to one kind
CN106875655A (en) * 2017-03-21 2017-06-20 广东容祺智能科技有限公司 A kind of unmanned aerial vehicle data communication jamproof system and method
CN107533792A (en) * 2015-03-02 2018-01-02 瓦威亚无人机公司 System for transmitting order and video flowing between remote control of machine and ground station in such as unmanned plane etc.
CN107943093A (en) * 2014-12-15 2018-04-20 深圳市大疆创新科技有限公司 A kind of flying vehicles control method, apparatus and aircraft
CN108885464A (en) * 2017-02-28 2018-11-23 深圳市大疆创新科技有限公司 The modified method in course line, equipment and unmanned plane
CN109557938A (en) * 2018-12-26 2019-04-02 西安天际航通科技有限公司 A kind of system and method that large and medium-sized shipping fixed-wing unmanned plane strange land is landed
CN109871034A (en) * 2019-03-25 2019-06-11 苏州极目机器人科技有限公司 Flight control method, device and unmanned vehicle
CN109947128A (en) * 2019-03-13 2019-06-28 歌尔股份有限公司 Unmanned aerial vehicle (UAV) control method, unmanned aerial vehicle (UAV) control device, unmanned plane and system
CN110209195A (en) * 2019-06-13 2019-09-06 浙江海洋大学 The tele-control system and control method of marine unmanned plane
CN110687928A (en) * 2019-09-09 2020-01-14 苏州臻迪智能科技有限公司 Landing control method, system, unmanned aerial vehicle and storage medium
CN111240359A (en) * 2020-01-17 2020-06-05 广东汇卓航科技有限公司 Remote take-off and landing and double-remote control switching control system for unmanned aerial vehicle
CN111240348A (en) * 2020-01-22 2020-06-05 西安爱生无人机技术有限公司 Unmanned aerial vehicle landing control method based on motion base, computer readable storage medium and control equipment
CN111766896A (en) * 2020-07-10 2020-10-13 珠海紫燕无人飞行器有限公司 Unmanned aerial vehicle control method and system based on movable base
CN113160615A (en) * 2021-03-03 2021-07-23 上海凌苇智能科技合伙企业(有限合伙) Method and system for realizing safety detection before takeoff of unmanned aerial vehicle based on AR technology
CN115167500A (en) * 2022-05-19 2022-10-11 北京远度互联科技有限公司 Unmanned aerial vehicle flight control method, device and system and readable storage medium

Cited By (41)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104584578A (en) * 2012-03-02 2015-04-29 莫戈公司 Real-time aircraft status detection system and method
CN102814047A (en) * 2012-07-19 2012-12-12 南京航空航天大学 Autonomous return system and control method of dual-rotor remote-controlled model helicopter
US10793258B2 (en) 2014-12-15 2020-10-06 SZ DJI Technology Co., Ltd. Aircraft, takeoff control method and system, and landing control method and system
CN107943093A (en) * 2014-12-15 2018-04-20 深圳市大疆创新科技有限公司 A kind of flying vehicles control method, apparatus and aircraft
US11511857B2 (en) 2014-12-15 2022-11-29 SZ DJI Technology Co., Ltd. Aerial vehicle control method and aerial vehicle
US11975818B2 (en) 2014-12-15 2024-05-07 SZ DJI Technology Co., Ltd. Aircraft, takeoff control method and system, and landing control method and system
CN105518559A (en) * 2014-12-15 2016-04-20 深圳市大疆创新科技有限公司 Aircraft, take-off control method and system thereof and landing control method and system thereof
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
CN107533792A (en) * 2015-03-02 2018-01-02 瓦威亚无人机公司 System for transmitting order and video flowing between remote control of machine and ground station in such as unmanned plane etc.
CN104656665A (en) * 2015-03-06 2015-05-27 云南电网有限责任公司电力科学研究院 Novel general obstacle avoidance module for UAV (unmanned aerial vehicle) and steps
CN104656665B (en) * 2015-03-06 2017-07-28 云南电网有限责任公司电力科学研究院 A kind of general avoidance module of new unmanned plane and step
US10509416B2 (en) 2015-04-30 2019-12-17 SZ DJI Technology Co., Ltd. System and method for landing a mobile platform via a magnetic field
WO2016172962A1 (en) * 2015-04-30 2016-11-03 SZ DJI Technology Co., Ltd. System and method for landing a mobile platform via a magnetic field
US11378982B2 (en) 2015-04-30 2022-07-05 SZ DJI Technology Co., Ltd. System and method for landing a mobile platform via a magnetic field
CN105182986A (en) * 2015-08-10 2015-12-23 北京零零无限科技有限公司 Method of retrieving and releasing unmanned aerial vehicle in hand-held mode and apparatus thereof
CN106493106A (en) * 2015-09-06 2017-03-15 慧鸟科技发展(北京)有限公司 A kind of aerial automatic operating system
CN105223965A (en) * 2015-11-05 2016-01-06 北京精航科技有限公司 Unmanned plane voice activated control
CN105388911A (en) * 2015-12-16 2016-03-09 深圳市中航佳智能科技有限公司 Unmanned aerial vehicle intelligent control take-off method
CN105446356A (en) * 2015-12-17 2016-03-30 小米科技有限责任公司 Unmanned plane control method and unmanned plane control device
CN105667826A (en) * 2016-03-03 2016-06-15 谭圆圆 Control method and device for unmanned aerial vehicle
CN105843254A (en) * 2016-04-29 2016-08-10 乐视控股(北京)有限公司 UAV flight control mode switching method and device and UAV
CN106054923A (en) * 2016-07-04 2016-10-26 苏州光之翼智能科技有限公司 Asymmetric unmanned aerial vehicle clustering system
CN106155070B (en) * 2016-07-04 2024-04-30 零度智控(北京)智能科技有限公司 Unmanned plane take-off control method and device and remote control terminal
CN106155070A (en) * 2016-07-04 2016-11-23 零度智控(北京)智能科技有限公司 Unmanned plane takes off control method and device, remote terminal
CN106406350A (en) * 2016-10-28 2017-02-15 易瓦特科技股份公司 Method and system for controlling unmanned aerial vehicle
CN106774321A (en) * 2016-12-19 2017-05-31 成都四威电子有限公司成都星石科技分公司 Accessory system and householder method are taken off and landed to one kind
CN108885464A (en) * 2017-02-28 2018-11-23 深圳市大疆创新科技有限公司 The modified method in course line, equipment and unmanned plane
CN106875655A (en) * 2017-03-21 2017-06-20 广东容祺智能科技有限公司 A kind of unmanned aerial vehicle data communication jamproof system and method
CN109557938A (en) * 2018-12-26 2019-04-02 西安天际航通科技有限公司 A kind of system and method that large and medium-sized shipping fixed-wing unmanned plane strange land is landed
US11573576B2 (en) 2019-03-13 2023-02-07 Goertek Inc. Method for controlling a drone, drone and system
CN109947128B (en) * 2019-03-13 2020-05-15 歌尔股份有限公司 Unmanned aerial vehicle control method, unmanned aerial vehicle control device, unmanned aerial vehicle and system
CN109947128A (en) * 2019-03-13 2019-06-28 歌尔股份有限公司 Unmanned aerial vehicle (UAV) control method, unmanned aerial vehicle (UAV) control device, unmanned plane and system
CN109871034A (en) * 2019-03-25 2019-06-11 苏州极目机器人科技有限公司 Flight control method, device and unmanned vehicle
CN110209195A (en) * 2019-06-13 2019-09-06 浙江海洋大学 The tele-control system and control method of marine unmanned plane
CN110687928A (en) * 2019-09-09 2020-01-14 苏州臻迪智能科技有限公司 Landing control method, system, unmanned aerial vehicle and storage medium
CN111240359A (en) * 2020-01-17 2020-06-05 广东汇卓航科技有限公司 Remote take-off and landing and double-remote control switching control system for unmanned aerial vehicle
CN111240348A (en) * 2020-01-22 2020-06-05 西安爱生无人机技术有限公司 Unmanned aerial vehicle landing control method based on motion base, computer readable storage medium and control equipment
CN111766896A (en) * 2020-07-10 2020-10-13 珠海紫燕无人飞行器有限公司 Unmanned aerial vehicle control method and system based on movable base
CN111766896B (en) * 2020-07-10 2023-12-29 珠海紫燕无人飞行器有限公司 Unmanned aerial vehicle control method and system based on movable base
CN113160615A (en) * 2021-03-03 2021-07-23 上海凌苇智能科技合伙企业(有限合伙) Method and system for realizing safety detection before takeoff of unmanned aerial vehicle based on AR technology
CN115167500A (en) * 2022-05-19 2022-10-11 北京远度互联科技有限公司 Unmanned aerial vehicle flight control method, device and system and readable storage medium

Similar Documents

Publication Publication Date Title
CN102298389A (en) System fully controlled and taken over by ground station during takeoff and landing stages of unmanned plane
Danjun et al. Autonomous landing of quadrotor based on ground effect modelling
CN105235895B (en) Many rotor unmanned aircrafts and its brake hard method with emergency braking apparatus
Bai et al. Robust control of quadrotor unmanned air vehicles
Hoffmann et al. Quadrotor helicopter flight dynamics and control: Theory and experiment
JP4141860B2 (en) Autonomous control device and program for small unmanned helicopter
EP2885676B1 (en) Flying camera with string assembly for localization and interaction
CN107272740B (en) Novel four-rotor unmanned aerial vehicle control system
CN106774409B (en) A kind of semi-autonomous imitative ground flight system and its control method of unmanned plane
EP3538966B1 (en) Vehicle collision avoidance
CN104656660A (en) Control system for micro-unmanned helicopter multi-mode autonomous flight and method thereof
CN204440169U (en) The control system of the multi-modal autonomous flight of Miniature Unmanned Helicopter
JP2004256022A (en) Autonomous control method for small size unmanned helicopter
CN103941742A (en) Unmanned aerial vehicle ground sliding deviation rectification control device and method
KR101769281B1 (en) Method and apparatus for testing autonomic flight control of unmanned aerial vehicle
WO2014209220A1 (en) An unmanned aerial vehicle and a method for landing the same
CN105094141A (en) Digital autopilot system of lightweight fixed-wing aircraft
CN106354148B (en) A kind of UAV Flight Control method and apparatus
Riseborough Automatic take-off and landing control for small UAVs
CN205121348U (en) Unmanned vehicles safety system of descending fast and remote control equipment and unmanned vehicles thereof
JP5493103B2 (en) Simple manual flight control system for unmanned flying vehicles
Mejias et al. Controlled emergency landing of an unpowered unmanned aerial system
CN104317304B (en) Microwave guide based fixed-wing unmanned aerial vehicle autonomous landing control device and method
CN103869811B (en) The remote control of a kind of quadrotor and the monitoring method of servosignal
WO2018032430A1 (en) Intelligent unmanned aerial vehicle 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
C02 Deemed withdrawal of patent application after publication (patent law 2001)
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20111228