CN115857555B - Autonomous flight control method for mobile platform of multi-rotor aircraft - Google Patents
Autonomous flight control method for mobile platform of multi-rotor aircraft Download PDFInfo
- Publication number
- CN115857555B CN115857555B CN202310043797.2A CN202310043797A CN115857555B CN 115857555 B CN115857555 B CN 115857555B CN 202310043797 A CN202310043797 A CN 202310043797A CN 115857555 B CN115857555 B CN 115857555B
- Authority
- CN
- China
- Prior art keywords
- mobile platform
- aircraft
- autonomous
- target
- north
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 60
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 title claims abstract description 27
- 230000001133 acceleration Effects 0.000 claims abstract description 31
- 238000004364 calculation method Methods 0.000 claims description 52
- 230000008569 process Effects 0.000 claims description 20
- 230000009194 climbing Effects 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000036461 convulsion Effects 0.000 claims description 3
- 238000012937 correction Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 230000001174 ascending effect Effects 0.000 claims description 2
- 238000000926 separation method Methods 0.000 claims description 2
- 238000011897 real-time detection Methods 0.000 claims 1
- 238000004891 communication Methods 0.000 description 20
- 238000005259 measurement Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 230000004927 fusion Effects 0.000 description 4
- 230000003993 interaction Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses an autonomous flight system of a mobile platform of a multi-rotor aircraft and a control method, wherein the autonomous flight system comprises the mobile platform and a flight platform, and can be conveniently and rapidly deployed on a mobile carrier (such as a vehicle, a ship and the like) to provide software and hardware support for a plurality of autonomous flight tasks such as autonomous take-off, autonomous following and autonomous landing of the multi-rotor aircraft. The autonomous flight control method realized based on the system adopts a path planning algorithm in a position and speed control loop, plans the flight position, the flight speed and the flight acceleration of the multi-rotor aircraft in advance, and then adds the partial control quantity into a control loop as feedforward control, so that the aircraft can fly to a designated area stably and quickly, the multi-rotor aircraft can land on a mobile platform with limited space stably and accurately due to higher control precision, and the safety is better ensured.
Description
Technical Field
The invention relates to a flight control system and a flight control method, in particular to an autonomous flight system and a control method of a multi-rotor aircraft mobile platform; belongs to the technical field of autonomous flight control of multi-rotor aircraft.
Background
Due to the unique flight characteristics, the multi-rotor aircraft becomes a research hotspot and focus in the industry, and is widely applied to numerous civil and military fields such as aerial photography, border patrol, environment monitoring, military reconnaissance and the like. At present, the technology of autonomous flight of a multi-rotor aircraft on a fixed take-off and landing platform is relatively mature, and take-off and landing stages of the multi-rotor aircraft are completed on a static take-off and landing platform, but in some special scenes, the multi-rotor aircraft is required to complete autonomous flight tasks on a mobile take-off and landing platform (such as a mobile vehicle, a ship body and the like).
In general, the movable landing platform has three-degree-of-freedom linear motion and three-degree-of-freedom angular motion in actual use, and the angular motion is particularly severe under water surfaces and complex road conditions. Therefore, the multi-rotor aircraft has great risk of autonomous take-off and landing on the platform, such as collision with the mobile platform under the safety altitude, so that great property loss and safety accidents are caused; on the other hand, the space of the movable lifting platform is limited, and factors such as the position and the speed of the movable platform are variable, so that the requirement on the landing mode and the precision is high, and the requirement is difficult to meet.
Therefore, how to make the multi-rotor aircraft safely complete autonomous flight tasks such as autonomous take-off, following, autonomous landing and the like on the mobile platform is a technical problem to be solved in the prior art.
Disclosure of Invention
The invention aims to solve the problems in the prior art, and provides an autonomous flight system and a control method suitable for a multi-rotor aircraft mobile platform, which are used for realizing safe and autonomous flight of the multi-rotor aircraft on the mobile platform, ensuring that the aircraft can fly to a designated area stably and rapidly and land on the mobile platform with limited space stably and accurately.
In order to achieve the above object, the present invention adopts the following technical scheme:
the invention firstly discloses an autonomous flight system of a mobile platform of a multi-rotor aircraft, which comprises the following components:
the mobile platform is composed of a Beidou base station module, a mobile platform navigation module, an inertial sensor module and a mobile platform communication module;
the flight platform consists of an airborne Beidou positioning and orientation module, a navigation module, an airborne inertial sensor module, an airborne communication module, a flight guidance module and a flight control module;
and realizing data interaction between the flying platform and the mobile platform through the airborne communication module and the mobile platform communication module.
The Beidou base station module and the inertial sensor module send real-time measurement data of the mobile platform to the mobile platform navigation module; after the data fusion is carried out on the mobile platform navigation module, the data related to the three-dimensional position, the three-dimensional speed, the three-dimensional acceleration, the attitude angle and the heading angle of the mobile platform are packaged and then sent to the mobile platform communication module, meanwhile, RTCM stream data of the Beidou base station module are forwarded to the mobile platform communication module, and the mobile platform communication module sends the received data to the airborne communication module of the flight platform;
the navigation module forwards the RTCM data stream received by the airborne communication module to the airborne Beidou positioning and orientation module, the airborne Beidou positioning and orientation module sends relative position, speed and course related data calculated by difference to the navigation module, and the navigation module carries out data fusion on mobile platform data transmitted by the airborne communication module, measurement data of the airborne Beidou positioning and orientation module and measurement data of the airborne inertial sensor module, and respectively outputs unmanned plane position data and mobile platform pose data to the flight control module and the flight guidance module.
The invention also discloses a mobile platform autonomous flight control method realized based on the system, which specifically comprises the following steps:
(1) Preparation for taking off: setting flight parameters, performing automatic take-off initialization operation, performing take-off self-checking and judging whether to allow entering an automatic take-off process;
the flight parameters are selected according to task demands, if the task demands are limited to 60 meters in height, and if the limiting distance is 100 meters, the corresponding geofence heights are set to 60 and 100 in radius;
(2) Autonomous takeoff: the flying platform is separated from the moving platform, and the aircraft enters an autonomous take-off and climb stage until the height of the aircraft is detected in real timeReaching the set take-off height->Ending the climbing stage of the autonomous take-off process;
(3) Autonomous following: determining horizontal distance of aircraft from mobile platformWhether or not the geofence radius is exceededIf->Entering an autonomous following and maintaining stage, and selecting a corresponding heading channel controller target value according to a corresponding heading following mode;
(4) Autonomous landing: in the initial stage of autonomous landing, firstly determining the horizontal distance between the aircraft and the mobile platformIf the aircraft is smaller than the set threshold value, entering an autonomous landing descending stage until the aircraft lands on the mobile platform, and completing the whole autonomous flight task.
Preferably, the aforementioned flight parameters include at least: flying heightHorizontal distance of aircraft from mobile platformForward horizontal distance of the aircraft from the mobile platform +.>Heading following mode yawMode, geofence height +.>Geofence radius +.>The specific flight tasks and targets of the multi-rotor aircraft are determined through the setting of the parameters.
Further preferably, the aforementioned horizontal distance of the aircraft from the mobile platformWherein->North relative position of the flying platform from the moving platform, < >>The eastern position of the flying platform from the mobile platform; by reasonably setting->The aircraft can be located right above the mobile platform before landing, and the aircraft can be safely landed on the mobile platform.
More preferably, the target course angular velocity is controlled during (2) the autonomous takeoff phase when the flying platform is separated from the mobile platform0, target pitch +.>For the pitch angle of the mobile platform at this time->Target roll angle +.>For the roll angle of the mobile platform at this time +.>Height control objective->At a set take-off height +.>Climbing is carried out;
in the process, the relative ascending speed of the aircraft is detected in real timeIf it exceeds 0.15m/s, if so, the flying platform and the moving platform are considered to be separated intoWork, record heading angle of aircraft and mobile platform at this moment +.>、/>North position->East position->From this the forward position is calculated>And right position->The calculation formula is as follows:
more preferably, during the autonomous take-off climb, the heading channel comprises a heading angle and a heading angular velocity controller, and the control target of the heading angleFor the course angle->The method comprises the steps of carrying out a first treatment on the surface of the The horizontal channel comprises a position controller and a speed controller, wherein the north horizontal position control target is +.>For forward position of aircraft->Right position->North position resolved in real time ++>East horizontal position control target->For the eastern position of the aircraft->The calculation method is as follows:
still further preferably, in the foregoing autonomous following hold phase, the corresponding heading channel controller target value is selected according to the corresponding heading following mode:
(a) If the set heading following mode is the mode of maintaining the current heading direction, the heading angle target value of the heading channelSet to the heading angle of the current aircraft +.>;
(b) If the set course following mode is along the direction of the movable platform, the course angle target value of the course channelThe calculation method of (1) is as follows: />Wherein->Real-time heading angle for mobile platform>The method for calculating the correction function for the target course angle comprises the following steps:
control target for height channelFor the set flying height +>The method comprises the steps of carrying out a first treatment on the surface of the Horizontal channel position control target->、/>Respectively by parameters->、/>The calculation is performed in real time, and the calculation mode is as follows:
Still further preferably, in the autonomous landing initialization stage, the heading channel sets a control target of the heading angleIs thatThe method comprises the steps of carrying out a first treatment on the surface of the Control target of altitude channel->Keep at take-off height +.>Unchanged; horizontal channel north position control target->Is 0; horizontal channel east position control target->Is 0.
Still further preferably, the heading channel sets a control target of the heading angle in an autonomous descent phaseIs that,/>The course angle of the aircraft after the automatic landing initialization stage is finished; control target of altitude channel->Setting to 0.3m, so that the altitude of the multi-rotor aircraft is reduced to 0; horizontal channel north position control target->Is 0; horizontal channel east position control target->Is 0; detecting the altitude of a multi-rotor aircraft in real time>Whether it is smaller than the threshold value 0.3m and the horizontal distance of the aircraft from the mobile platform +.>If the speed is smaller than the threshold value of 0.2m, the flight control unit sends a control signal value power unit to close the output of the power unit, and the multi-rotor aircraft can inertially drop onto the mobile platform to complete the whole autonomous flight task.
In particular, in the present invention, the control targets of the north and east position controllers and the speed controller are innovated. Level controller target(North) and->(eastern direction) obtaining a north speed controller control target ++through a north position controller and an eastern position controller respectively>East speed controller control target +.>。
first, calculating the error between the position control target and the actual position of the aircraft:/>;
Then, calculate the critical value of the position error:/>Wherein->The maximum acceleration which can fly for the set multi-rotor aircraft is generally set to be 4.5m/s/s;
next, according toAnd->Different calculation modes are selected to calculate the feed-forward north target speedThe calculation mode is as follows:
then, calculating expected position targets at different moments:Wherein->For controlling the step length;
then, calculating an output target based on the feedback control position controllerThe calculation method comprises the following steps:wherein->The control parameter is a north position controller of the multi-rotor aircraft, and the value of the control parameter is 1;
finally, calculating the total output target value of the position controller:Wherein->The real-time north speed of the mobile platform.
The horizontal channel east speed controller controls the targetWill beThe above calculation process->、/>、/>Are replaced by->、/>、/>The east speed controller control target +.>Wherein->The real-time east speed of the mobile platform.
Still further preferably, by theAnd->Further obtaining a north acceleration target ++through a north speed controller and an east speed controller respectively>East acceleration control target->The specific calculation process is as follows:
first, calculate the error between the speed control target and the actual position of the aircraft:/>;
Then, a critical value of the speed error is calculated:/>Wherein->The maximum jerk which can fly for the set multi-rotor aircraft is generally set to be 2.5 m/s/s;
next, according toAnd->Different calculation modes are selected to calculate the feedforward north target acceleration +.>The calculation mode is as follows:
then, the expected speed targets at different moments are calculatedThe calculation mode is as follows:wherein->For controlling the step length;
then, calculating an output target based on the feedback control speed controllerThe calculation method is that:Wherein->Control parameters of a north speed controller for a multi-rotor aircraft, the values of which are 2, & lt + & gt>Integration term for north speed controller, +.>A derivative term for the north controller;
finally, calculating the total output target value of the position controller:Wherein->The real-time north acceleration of the mobile platform is realized.
The saidComputing means and->Similarly, only +.>、/>、/>Replaced by->、/>、/>The east speed controller control target +.>Wherein->The acceleration is the real-time east acceleration of the mobile platform.
Still further preferably, the aforementioned north acceleration targetEast acceleration control target->Obtaining a control target of an attitude angle through a coordinate conversion formula of a navigation system and a body system>And->The calculation method comprises the following steps:,/>is a pitch angle control target->Is a roll angle control target. Finally, let(s)>And->And controlling the multi-rotor aircraft to fly in a desired attitude through the attitude controller, and keeping the multi-rotor aircraft at the center position of the mobile platform.
The invention has the advantages that:
(1) The autonomous flight system comprises the mobile platform and the flight platform, can be conveniently and rapidly deployed on a mobile carrier (such as a vehicle, a ship and the like), can be used in any place with Beidou signals, enables the whole flight process to be autonomous without manual intervention, and provides software and hardware support for a plurality of autonomous flight tasks such as autonomous take-off, autonomous following, autonomous landing and the like of the multi-rotor aircraft through data interaction of the mobile platform and the flight platform after the flight tasks are issued, so that the operation efficiency is greatly improved;
(2) The autonomous flight control method adopts a path planning algorithm in a position and speed control loop, plans the flight position, the flight speed and the flight acceleration of the multi-rotor aircraft in advance, and calculates the target of the expected positionFeed-forward north target speed->Feed-forward north target acceleration ++>Then adding the control quantities into a control loop as feedforward control, so as to ensure that the aircraft can fly stably and quickly to a designated area;
(3) In the prior art, the flight control is mostly based on an error control method, so that the rapidity is improved at the expense of stability and control accuracy, and compared with the traditional error control method, the autonomous flight control method is improved, and the control accuracy, stability and rapidity are improved greatly; simultaneously, higher control accuracy can make many rotor crafts can steadily, accurately drop on the limited moving platform in space, and the security has obtained better assurance.
Drawings
FIG. 1 is a schematic diagram of a frame structure of a mobile platform autonomous flight system of a multi-rotor aircraft of the present invention;
FIG. 2 is a schematic diagram of the logical architecture of the mobile platform autonomous flight system of the multi-rotor aircraft of the present invention;
FIG. 3 is a flow chart of a method of autonomous flight control for a mobile platform of a multi-rotor aircraft of the present invention;
FIG. 4 is a logic block diagram of a north position controller of the present invention;
FIG. 5 is a logic block diagram of a north-oriented speed controller of the present invention.
Detailed Description
The invention is described in detail below with reference to the drawings and the specific embodiments.
Example 1
Referring to fig. 1 and 2, the embodiment discloses an autonomous flight system of a mobile platform of a multi-rotor aircraft, which comprises a flight platform and a mobile platform. The mobile platform is composed of a Beidou base station module, a mobile platform navigation module, an inertial sensor module and a mobile platform communication module, and the flying platform is composed of an airborne Beidou positioning and orientation module, a navigation module, an airborne inertial sensor module, an airborne communication module, a flying guidance module and a flying control module. The mobile platform and the flying platform realize data interaction and feedback through the airborne communication module and the mobile platform communication module.
The Beidou base station module and the inertial sensor module of the mobile platform send real-time measurement data such as position, speed, angular velocity and acceleration to the mobile platform navigation module; after data fusion is carried out on the mobile platform navigation module, the mobile platform data of the mobile platform such as three-dimensional position, three-dimensional speed, three-dimensional acceleration, attitude angle and heading angle are packed and sent to the mobile platform communication module, meanwhile, RTCM stream data of the Beidou base station module are forwarded to the mobile platform communication module, and the mobile platform communication module sends the received data to the airborne communication module of the flight platform.
The navigation module forwards the RTCM data stream received by the airborne communication module to the airborne Beidou positioning and orientation module, the airborne Beidou positioning and orientation module sends data such as the relative position, the speed and the course calculated by the difference to the navigation module, the navigation module carries out data fusion on the transmission data of the airborne communication module, the measurement data of the airborne Beidou positioning and orientation module and the measurement data of the airborne inertial sensor module, and the unmanned plane position data and the moving platform pose data are respectively output to the flight control module and the flight guidance module.
The flight guidance module generates different control targets according to different autonomous flight instructions (such as autonomous take-off, autonomous following or autonomous landing) and by combining the pose data of the movable platform to output a flight control module, the flight control module performs control law resolving to generate control signals of an executing mechanism, the control signals are transmitted to the power unit after being acted by the controllers of all channels, and the power unit drives the multi-rotor aircraft to perform autonomous flight.
Example 2
The embodiment discloses an autonomous flight control method for a mobile platform of a multi-rotor aircraft, which can be divided into three main flight phases of autonomous take-off, autonomous following and autonomous landing, as shown in fig. 3, and specifically comprises the following steps:
s1, setting flight parameters:
setting flying height by taking a fixed point on a mobile platform as an origin and following right hand rule(positive upwards), horizontal distance of the aircraft from the mobile platform +.>(right direction is positive), forward horizontal distance of the aircraft from the mobile platform(forward is positive), heading following mode yawMode, geofence altitude +.>Geofence radius->Etc. related flight parameters.
The heading following mode yawMode described herein can be seen hereinafter, specifically in two ways: the current head direction mode and the direction along the moving platform mode are maintained.
S2, initializing an autonomous take-off process:
determining flying heightWhether or not to exceed the geofence height +.>If the number exceeds the number, displaying a corresponding error indication on the ground station, and prohibiting the multi-rotor aircraft from taking off; if the take-off self-checking items (including battery power, flight control board temperature, attitude angle, heading angle and the like are all passed, the self-checking items are allowed to enter an autonomous take-off process.
S3, a separation stage of the flying platform and the moving platform:
at this stage, the course channel has only an angular velocity loop controller for controlling the target course angular velocityIs 0; the pitch channel comprises a pitch angle and pitch angle speed controller for controlling a target pitch angle>For the pitch angle of the mobile platform at this time->The method comprises the steps of carrying out a first treatment on the surface of the The roll channel is similar to the pitch channel, and the target roll angle is controlled>For the roll angle of the mobile platform at this time +.>The method comprises the steps of carrying out a first treatment on the surface of the The altitude channel comprises an altitude controller and a vertical speed controller, and the altitude control target is +.>At a set take-off height +.>Climbing is carried out, during which the relative rise speed of the aircraft is detected in real time>Whether or not it exceeds 0.15m/s. If the heading angle exceeds the heading angle, the aircraft and the mobile platform are considered to be successfully separated, and the heading angle of the aircraft and the mobile platform at the moment is recorded>、/>North position->East positionFrom this the forward position is calculated>And right position->To realize the initial control target setting of the next stage, the calculation formula is as follows:
the aircraft enters the autonomous takeoff climb phase of step S4.
S4, an autonomous take-off climbing stage:
at this stage, the course channel contains a course angle and course angular velocity controller, and a control target of the course angleHeading angle of aircraft at the end of step S3 +.>The method comprises the steps of carrying out a first treatment on the surface of the The horizontal channel comprisesPosition controller and speed controller, the control target of the position controller includes horizontal passage north position control target +.>And horizontal channel east position control target +.>The control targets of the speed controller include north direction speed controller control target +.>And an east speed controller control target.
Wherein, the north horizontal position control targetForward position of the aircraft for the end of step S3 +.>Right position->North position resolved in real time ++>East horizontal position control target->For the eastern position of the aircraft at the end of step S3 +.>The calculation method is as follows:
referring again to FIG. 4, the control target of the north speed controllerThe calculation method of (2) is as follows:
first, calculating the error between the position control target and the actual position of the aircraft:/>Wherein->The relative position of the flying platform from the moving platform in the north direction;
then, calculate the critical value of the position error:/>Wherein->The maximum acceleration which can fly for the set multi-rotor aircraft is generally set to be 4.5m/s/s;
next, according toAnd->Different calculation modes are selected to calculate the feed-forward north target speed +.>The calculation mode is as follows:
then, calculating expected position targets at different moments:/>Wherein->For controlling the step length;
then, calculating an output target based on the feedback control position controllerThe calculation method comprises the following steps:wherein->The control parameter is a north position controller of the multi-rotor aircraft, and the value of the control parameter is 1;
finally, calculating the total output target value of the position controller:Wherein->The real-time north speed of the mobile platform.
Horizontal channel east speed controller control targetControl algorithm and north-oriented speed controller control target of (c)The control algorithm and principle of (2) are exactly the same, only the calculation process is needed to be carried out>、/>、/>Are respectively replaced by、/>、/>The east speed controller control target +.>Wherein->The real-time east speed of the mobile platform.
In the process of the previous stepAnd->Then, the north acceleration target is obtained by the north speed controller and the east speed controller respectively>East acceleration control target->. Referring to fig. 5, the specific calculation process is:
first, calculate the error between the speed control target and the actual position of the aircraft:/>;
Then, a critical value of the speed error is calculated:/>Wherein->The maximum jerk which can fly for the set multi-rotor aircraft is generally set to be 2.5 m/s/s;
next, according toAnd->Different calculation modes are selected to calculate the feedforward north target acceleration +.>The calculation mode is as follows:
then, the expected speed targets at different moments are calculatedThe calculation mode is as follows:wherein->For controlling the step length;
then, calculating an output target based on the feedback control speed controllerThe calculation method comprises the following steps:wherein->Control parameters of a north speed controller for a multi-rotor aircraft, the values of which are 2, & lt + & gt>Integration term for north speed controller, +.>A derivative term for the north controller;
finally, calculating the total output target value of the position controller:Wherein->The real-time north acceleration of the mobile platform is realized.
The control algorithm and principle of the horizontal channel east speed controller are identical to those of the north speed controller,computing means and->Similarly, only +.>、/>、/>Are replaced by->、/>、/>The east speed controller control target +.>WhereinThe acceleration is the real-time east acceleration of the mobile platform.
Finally, the north acceleration target is obtainedEast acceleration control target->Then, the control target of the attitude angle is obtained by a coordinate conversion formula of the navigation system and the machine system>And->。
Namely:,/>is a pitch angle control target->To control the target for the roll angle, thereby determining the control target for the attitude controller. />And->The multi-rotor aircraft is controlled to fly in a desired attitude through the attitude controller to reach a desired position.
The controller of the altitude path, as well as the altitude controller and the altitude control target used in the aforementioned step S3, detects the altitude of the aircraft in real time during this processWhether the set take-off altitude is reached>If the condition is met, the climbing phase of the autonomous take-off process is considered to be ended, the whole autonomous take-off phase is ended, and the multi-rotor aircraft enters an autonomous following initialization phase in the following step S5.
S5, automatically following an initialization stage:
first, calculate the horizontal distance of the aircraft from the mobile platform:/>Wherein, the method comprises the steps of, wherein,north relative position of the flying platform from the moving platform, < >>Is the eastern position (eastern positive) of the flying platform from the mobile platform.
Then, the horizontal distance of the aircraft from the mobile platform is determinedWhether or not the geofence radius is exceeded>If the number exceeds the number, displaying a corresponding alarm indication on the ground station, and prohibiting the multi-rotor aircraft from flying out of the geofence; if->The autonomous follow-up hold phase of step S6 described below is entered.
S6, an autonomous following and maintaining stage:
selecting a corresponding heading channel controller target value according to a corresponding heading following mode;
(1) If the set heading following mode is to keep the current heading direction mode, the heading of the heading channelTarget value of steering angleSet to the heading angle of the current aircraft +.>;
(2) If the set course following mode is along the direction of the movable platform, the course angle target value of the course channelThe calculation method of (1) is as follows: />Wherein->For the real-time heading angle (clockwise positive, range-180 DEG to +180 DEG) of the mobile platform,>the method for calculating the correction function for the target course angle comprises the following steps:
control target for height channelFor the set flying height +>The method comprises the steps of carrying out a first treatment on the surface of the Horizontal channel position control target->、/>Parameter set by step S1, respectively +.>、/>The calculation is performed in real time, and the calculation mode is as follows:
Similarly, this step is also obtained according to the calculation method described in step S4And->Finally->And->The multi-rotor aircraft is controlled to fly in a desired attitude through the attitude controller, and the relative positions of the multi-rotor aircraft and the mobile platform are maintained.
And after receiving the autonomous landing instruction sent by the ground station, the multi-rotor aircraft enters an autonomous landing initialization stage in the step S7.
S7, an autonomous landing initialization stage:
control target for setting course angle by course channelIs->The method comprises the steps of carrying out a first treatment on the surface of the Control target of altitude channel->Keep the take-off altitude set for step S1 +.>Unchanged; horizontal channel north position control target->Is 0; horizontal channel east position control target->Is 0.
Similarly, in determining、/>On the premise of the numerical value, the +.A calculation method of the final attitude angle target in the step S4 is adopted to obtain +.A>And->Finally->And->And controlling the multi-rotor aircraft to fly in a desired attitude through the attitude controller, and keeping the multi-rotor aircraft at the center position of the mobile platform.
In the process, the horizontal distance between the aircraft and the mobile platform is calculated in real timeThe calculation method is the same as step S5, if +.>And if the threshold value is smaller than the set threshold value by 1.5m, the threshold value can be adjusted according to actual requirements in the actual flight process, and the autonomous descent phase of the step S8 is entered.
S8, an autonomous descent phase:
control target for setting course angle by course channelIs->,/>The course angle of the aircraft after the automatic landing initialization stage is finished; control target of altitude channel->Setting to 0.3m, so that the altitude of the multi-rotor aircraft is reduced to 0; horizontal channel north position control target->Is 0; horizontal channel east position control target->Is 0.
Similarly, in determining、/>On the premise of the numerical value, calculating +.f according to the calculation method of the final attitude angle target in step S4>And->Finally->And->And controlling the multi-rotor aircraft to fly in a desired attitude through the attitude controller, and keeping the multi-rotor aircraft at the center position of the mobile platform.
In the process, the altitude of the multi-rotor aircraft is detected in real timeWhether it is smaller than the threshold value 0.3m and the horizontal distance of the aircraft from the mobile platform +.>Whether less than a threshold of 0.2m. If the condition is met, the flight control unit sends a control signal value power unit, the output of the power unit is closed, and the multi-rotor aircraft can inertially drop onto the mobile platform to complete the whole autonomous flight task.
In summary, the autonomous flight system of the invention can be conveniently and rapidly deployed on a mobile carrier (such as a vehicle, a ship and the like), and provides software and hardware support for numerous autonomous flight tasks such as autonomous take-off, autonomous following, autonomous landing and the like of a multi-rotor aircraft. Compared with the traditional error-based control method, the autonomous flight control method realized based on the system has the advantages that the control precision, stability and rapidity are improved greatly, meanwhile, the higher control precision can enable the multi-rotor aircraft to stably and accurately land on a mobile platform with limited space, and the safety is better ensured.
The foregoing has shown and described the basic principles, principal features and advantages of the invention. It will be appreciated by persons skilled in the art that the above embodiments are not intended to limit the invention in any way, and that all technical solutions obtained by means of equivalent substitutions or equivalent transformations fall within the scope of the invention.
Claims (5)
1. The mobile platform autonomous flight control method realized based on the multi-rotor aircraft mobile platform autonomous flight system is characterized by comprising the following steps:
(1) Preparation for taking off: setting flight parameters, performing automatic take-off initialization operation, performing take-off self-checking and judging whether to allow entering an automatic take-off process;
the flight parameters include at least: flying heightFlyingHorizontal distance of the walker from the mobile platform +.>Forward horizontal distance of the aircraft from the mobile platform +.>Heading following mode yawMode, geofence height +.>Geofence radius +.>;
The automatic take-off initialization operation is as follows: determining flying heightWhether or not to exceed the geofence height +.>If the number exceeds the number, displaying a corresponding error indication on the ground station, and prohibiting the multi-rotor aircraft from taking off; if the take-off self-checking items pass through completely, allowing to enter an autonomous take-off process;
(2) Autonomous takeoff: the flying platform is separated from the moving platform, and the aircraft enters an autonomous take-off and climb stage until the height of the aircraft is detected in real timeReaching the set take-off height->Ending the climbing stage of the autonomous take-off process;
in the autonomous take-off stage, when the flying platform is separated from the moving platform, the course angular speed of the target is controlled0, target pitch +.>For the pitch angle of the mobile platform at this time->Target roll angle +.>For the roll angle of the mobile platform at this time +.>Height control objective->At a set take-off height +.>Climbing is carried out; in the process, the relative ascending speed of the aircraft is detected in real timeIf the distance exceeds 0.15m/s, if so, the separation of the flying platform and the moving platform is considered to be successful, and the course angle of the flying platform and the moving platform at the moment is recorded>、/>North position->East position->From this, the forward position is calculatedAnd right position->The calculation formula is as follows:
in the process of autonomous take-off and climbing, a course channel comprises a course angle and a course angular velocity controller, and a course angle control targetFor the course angle->The method comprises the steps of carrying out a first treatment on the surface of the The horizontal channel comprises a position controller and a speed controller, wherein the north horizontal position control target is +.>For forward position of aircraft->Right position->North position resolved in real time ++>East horizontal position control target->For the eastern position of the aircraft->The calculation method is as follows:
(3) Autonomous following: determining aircraft rangeHorizontal distance from mobile platformWhether or not the geofence radius is exceeded>If->Entering an autonomous following and maintaining stage, and selecting a corresponding heading channel controller target value according to a corresponding heading following mode, wherein the specific selection mode is as follows:
(a) If the set heading following mode is the mode of maintaining the current heading direction, the heading angle target value of the heading channelSet to the heading angle of the current aircraft +.>;
(b) If the set course following mode is along the direction of the movable platform, the course angle target value of the course channelThe calculation method of (1) is as follows: />Wherein->Real-time heading angle for mobile platform>The method for calculating the correction function for the target course angle comprises the following steps:
control target for height channelFor the set flying height +>The method comprises the steps of carrying out a first treatment on the surface of the Horizontal channel position control target->、/>Parameter set by step S1, respectively +.>、/>The calculation is performed in real time, and the calculation mode is as follows:
horizontal channel position control targetAnd->The north direction speed controller control target +_ is obtained through the north direction position controller and the east direction position controller respectively>East speed controller control target +.>Wherein->The calculation method of (2) is as follows:
first, calculating the error between the position control target and the actual position of the aircraft:/>;
Then, calculate the critical value of the position error:/>Wherein->Maximum acceleration that can fly for the multi-rotor aircraft that is set;
next, according toAnd->Different calculation modes are selected to calculate the feed-forward north target speedThe calculation mode is as follows:
then, calculating expected position targets at different moments:/>Wherein->For controlling the step length;
then, calculating an output target based on the feedback control position controllerThe calculation method comprises the following steps:wherein->The control parameter is a north position controller of the multi-rotor aircraft, and the value of the control parameter is 1;
finally, calculating the total output target value of the position controller:/>Wherein->The real-time north speed of the mobile platform;
the east speed controller controls the targetIn the calculation of the control algorithm of (a) the above calculation procedure +.>、/>、Are replaced by->、/>、/>The east speed controller control target +.>Wherein->The real-time east speed of the mobile platform;
from the saidAnd->Further obtaining a north acceleration target ++through a north speed controller and an east speed controller respectively>East acceleration control target->The specific calculation process is as follows:
first, calculate the error between the speed control target and the actual position of the aircraft:/>;
Then, calculate the speed errorCritical value of (2):/>Wherein, the method comprises the steps of, wherein,for the maximum jerk that the multi-rotor aircraft can fly, is set to be 2.5m/s 3 ;
Next, according toAnd->Different calculation modes are selected to calculate the feedforward north target accelerationThe calculation mode is as follows:
then, the expected speed targets at different moments are calculatedThe calculation mode is as follows:wherein->For controlling the step length;
then, calculating an output target based on the feedback control speed controllerThe calculation method comprises the following steps:wherein->Control parameters of a north speed controller for a multi-rotor aircraft, the values of which are 2, & lt + & gt>Integration term for north speed controller, +.>A derivative term for the north controller;
finally, calculating the total output target value of the position controller:Wherein->The real-time north acceleration of the mobile platform;
the saidComputing means and->Similarly, only +.>、/>、/>Replaced by->、/>、/>The east speed controller control target +.>WhereinThe real-time east acceleration of the mobile platform;
(4) Autonomous landing: in the initial stage of autonomous landing, firstly determining the horizontal distance between the aircraft and the mobile platformIf the aircraft is smaller than the set threshold value, entering an autonomous landing descending stage until the aircraft lands on the mobile platform, and completing the whole autonomous flight task.
3. The mobile platform autonomous flight control method of claim 1The method is characterized in that in the initial stage of autonomous landing, a heading channel sets a control target of a heading angleIs->The method comprises the steps of carrying out a first treatment on the surface of the Control target of altitude channel->Keep at take-off height +.>Unchanged; horizontal channel north position control target->Is 0; horizontal channel east position control target->Is 0.
4. The autonomous flight control method of claim 1, wherein the heading channel sets a control target of a heading angle during an autonomous descent phaseIs->,/>The course angle of the aircraft after the automatic landing initialization stage is finished; control target of altitude channel->Setting to 0.3m, so that the altitude of the multi-rotor aircraft is reduced to 0; horizontal channel north position control target->Is 0; horizontal channel east position control target->Is 0; real-time detection of altitude of multi-rotor aircraftWhether it is smaller than the threshold value 0.3m and the horizontal distance of the aircraft from the mobile platform +.>If the speed is smaller than the threshold value of 0.2m, the flight control unit sends a control signal value power unit to close the output of the power unit, and the multi-rotor aircraft can inertially drop onto the mobile platform to complete the whole autonomous flight task.
5. The mobile platform autonomous flight control method of claim 1, the north acceleration targetEast acceleration control target->Obtaining a control target of an attitude angle through a coordinate conversion formula of a navigation system and a body system>And->The calculation method comprises the following steps: />,/>Is pitch angleControl objective, & lt>Is a roll angle control target.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310043797.2A CN115857555B (en) | 2023-01-29 | 2023-01-29 | Autonomous flight control method for mobile platform of multi-rotor aircraft |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310043797.2A CN115857555B (en) | 2023-01-29 | 2023-01-29 | Autonomous flight control method for mobile platform of multi-rotor aircraft |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115857555A CN115857555A (en) | 2023-03-28 |
CN115857555B true CN115857555B (en) | 2023-06-27 |
Family
ID=85657337
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310043797.2A Active CN115857555B (en) | 2023-01-29 | 2023-01-29 | Autonomous flight control method for mobile platform of multi-rotor aircraft |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115857555B (en) |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5716032A (en) * | 1996-04-22 | 1998-02-10 | United States Of America As Represented By The Secretary Of The Army | Unmanned aerial vehicle automatic landing system |
CN106227234B (en) * | 2016-09-05 | 2019-09-17 | 天津远度科技有限公司 | Unmanned plane, unmanned plane take off control method and device |
CN110989673B (en) * | 2019-12-16 | 2023-05-05 | 西安因诺航空科技有限公司 | Autonomous tracking take-off and landing system of unmanned rotor platform and control method |
CN111813148B (en) * | 2020-07-22 | 2024-01-26 | 广东工业大学 | Unmanned aerial vehicle landing method, system, equipment and storage medium |
CN114661065A (en) * | 2022-04-02 | 2022-06-24 | 广州极智高新科技有限公司 | Taking-off and landing system and method of fixed-wing unmanned aerial vehicle |
-
2023
- 2023-01-29 CN CN202310043797.2A patent/CN115857555B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN115857555A (en) | 2023-03-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Danjun et al. | Autonomous landing of quadrotor based on ground effect modelling | |
CN110989673B (en) | Autonomous tracking take-off and landing system of unmanned rotor platform and control method | |
RU2615587C9 (en) | Method of accurate landing of unmanned aircraft | |
CN105235895B (en) | Many rotor unmanned aircrafts and its brake hard method with emergency braking apparatus | |
EP0321876B1 (en) | Control system for helicopters | |
CN105259917A (en) | Quick and safe landing device and method for unmanned aerial vehicle | |
CN102298389A (en) | System fully controlled and taken over by ground station during takeoff and landing stages of unmanned plane | |
Jung et al. | A trajectory-tracking controller design using l 1 adaptive control for multi-rotor uavs | |
CN112783181A (en) | Multi-rotor unmanned aerial vehicle cluster vision landing method based on fuzzy control | |
Acuna et al. | Vision-based UAV landing on a moving platform in GPS denied environments using motion prediction | |
Nogar | Autonomous landing of a uav on a moving ground vehicle in a gps denied environment | |
CN114721441A (en) | Multi-information-source integrated vehicle-mounted unmanned aerial vehicle autonomous landing control method and device | |
CN114527780B (en) | Intelligent landing guiding control method and system for carrier-based helicopter | |
CN115016514A (en) | Full-autonomous flight control method for takeoff, cruise and landing of bionic flapping wing aircraft | |
CN115857555B (en) | Autonomous flight control method for mobile platform of multi-rotor aircraft | |
CN112558619A (en) | Ultrasonic-assisted unmanned aerial vehicle autonomous stable landing system and method | |
Pestana et al. | A general purpose configurable navigation controller for micro aerial multirotor vehicles | |
RU2040434C1 (en) | Aircraft automatic landing control system | |
Orsag et al. | State estimation, robust control and obstacle avoidance for multicopter in cluttered environments: Euroc experience and results | |
JP5166349B2 (en) | Fixed wing aircraft, fixed wing aircraft system, and fixed wing aircraft landing method | |
Dung et al. | Robust planning the landing process of unmanned aerial vehicles | |
Carnes et al. | A fully parameterizable implementation of autonomous take-off and landing for a fixed wing UAV | |
Wang et al. | Autonomous control of micro flying robot | |
CN114740876A (en) | Vehicle-mounted tethered unmanned aerial vehicle guidance control system and method | |
CN112198894B (en) | Autonomous moving landing guidance method and system for rotor unmanned aerial vehicle |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |