CN115857555A - Autonomous flight control method for multi-rotor aircraft mobile platform - Google Patents
Autonomous flight control method for multi-rotor aircraft mobile platform Download PDFInfo
- Publication number
- CN115857555A CN115857555A CN202310043797.2A CN202310043797A CN115857555A CN 115857555 A CN115857555 A CN 115857555A CN 202310043797 A CN202310043797 A CN 202310043797A CN 115857555 A CN115857555 A CN 115857555A
- Authority
- CN
- China
- Prior art keywords
- mobile platform
- target
- autonomous
- aircraft
- flight
- 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.)
- Granted
Links
Images
Abstract
The invention discloses an autonomous flight system and a control method for a multi-rotor aircraft mobile platform, wherein the autonomous flight system comprises the mobile platform and a flight platform, and the system 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 of the multi-rotor aircraft, such as autonomous take-off, autonomous following, autonomous landing and the like. The autonomous flight control method 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 part of control quantity into a control loop as feed-forward control, thereby ensuring that the aircraft can stably and quickly fly to an appointed area, ensuring that the multi-rotor aircraft can stably and accurately land on a mobile platform with limited space due to higher control precision, and better ensuring the safety.
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 for a multi-rotor aircraft mobile platform; belong to many rotor crafts and independently fly control technical field.
Background
The multi-rotor aircraft becomes a research hotspot and focus of attention in the industry due to the unique flight characteristics of the multi-rotor aircraft, and is widely applied to various civil and military fields such as aerial photography, border patrol, environmental monitoring, military reconnaissance and the like. At present, the technology of the multi-rotor aircraft for autonomous flight on a fixed take-off and landing platform is relatively mature, the take-off and landing stages of the multi-rotor aircraft are completed on the static take-off and landing platform, but under 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).
Generally, a mobile lifting platform has three-degree-of-freedom linear motion and three-degree-of-freedom angular motion in actual use, and angular motion is particularly severe on water surfaces and complex road conditions. Therefore, the multi-rotor aircraft has great risks in autonomous take-off and landing on the platform, such as extremely easy collision with the mobile platform below the safe height, which causes great property loss and safety accidents; on the other hand, the space of the mobile lifting platform is limited, and factors such as the position and the speed of the mobile platform are variable have higher requirements on the landing mode and the precision, so that the requirements are difficult to meet.
Therefore, how to enable the multi-rotor aircraft to safely complete autonomous flight tasks such as autonomous take-off, following and autonomous landing on a mobile platform is a technical problem to be solved urgently 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, so that the multi-rotor aircraft can safely and autonomously fly on the mobile platform, the aircraft can stably and quickly fly to a designated area, and the aircraft can stably and accurately land on the mobile platform with limited space.
In order to achieve the above object, the present invention adopts the following technical solutions:
the invention first discloses an autonomous flight system of a multi-rotor aircraft mobile platform, which comprises:
the mobile platform consists 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 orienting module, a navigation module, an airborne inertial sensor module, an airborne communication module, a flight guidance module and a flight control module;
and the data interaction between the flight platform and the mobile platform is realized 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; the mobile platform navigation module packages related data of a three-dimensional position, a three-dimensional speed, a three-dimensional acceleration, an attitude angle and a course angle of the mobile platform after data fusion and sends the data to the mobile platform communication module, and simultaneously forwards RTCM streaming data of the Beidou base station module to the mobile platform communication module, and the mobile platform communication module sends the received data to an 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 orienting module, the airborne Beidou positioning and orienting module sends the relative position, speed and course related data calculated by the difference to the navigation module, and the navigation module performs data fusion on the mobile platform data transmitted by the airborne communication module, the measurement data of the airborne Beidou positioning and orienting module and the measurement data of the airborne inertial sensor module and respectively outputs unmanned aerial vehicle position data and the 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 based on the system, which specifically comprises the following steps:
(1) Preparing for taking off: setting flight parameters, carrying out autonomous takeoff initialization operation, carrying out takeoff self-check and judging whether the autonomous takeoff process is allowed or not;
the flight parameters are selected according to the task requirements, if the task requirements are 60 meters in height, and the limited distance is 100 meters, the corresponding geo-fence height and radius are set to be 60 and 100;
(2) And (3) taking off automatically: the flying platform is separated from the mobile platform, and the aircraft enters an autonomous takeoff and climbing stage until the height of the aircraft is detected in real timeReach the set takeoff height->Ending the climbing stage in the process of autonomous takeoff;
(3) Autonomous following: determining the horizontal distance of an aircraft from a mobile platformWhether the geofence radius is exceededIf->Entering an autonomous following and maintaining stage, and selecting a corresponding target value of the course channel controller according to a corresponding course following mode;
(4) Self-landing: firstly, the horizontal distance of the aircraft from the mobile platform is judged in the initialization stage of autonomous landingAnd if the altitude is smaller than the set threshold value, entering an autonomous landing and descending stage until the aircraft lands on the mobile platform to complete the whole autonomous flight task.
Preferably, the aforesaid flight parameters comprise at least: height of takeoffHorizontal distance of the aircraft from the mobile platformThe forward horizontal distance of the aircraft from the mobile platform->Heading-following mode yawMode, geofence height->And geofence radius>And the specific flight tasks, targets and the like of the multi-rotor aircraft are determined through the setting of the parameters.
Further preferably, the aforesaid aircraft is at a horizontal distance from the mobile platformWherein is present>For the north relative position of the flight platform from the mobile platform, is>The east position of the flying platform from the mobile platform; by reasonably setting->The aircraft can be positioned right above the mobile platform before landing, and the aircraft can safely land on the mobile platform.
More preferably, in (2) the autonomous takeoff phase, when the flying platform is separated from the mobile platform, the target course angular speed is controlledIs 0, the target pitch angle->Is the movement at this timeElevation angle of platform>Target roll angle->For the roll angle of the mobile platform at that time->The height control target->At a set takeoff height->Climbing is carried out;
in the process, the relative ascending speed of the aircraft is detected in real timeWhether the speed exceeds 0.15m/s or not, if so, the separation of the flying platform and the moving platform is considered to be successful, and the heading angle of the aircraft and the moving platform at the moment is recorded>、North position->East position->Based thereon, a forward position is calculated>And a right position->The calculation formula is as follows:
more preferably, during the autonomous takeoff climbing process, the heading channel comprises a heading angle and a heading angular speed controller, and a control target of the heading angleIs the heading angle->(ii) a The horizontal path includes a position controller and a speed controller, wherein a north-oriented horizontal position controls the target->Is a forward position of the aircraft>And a right position->Real-time resolved northbound locationEast horizontal position control target>For an aircraft east position>The calculation method is as follows:
still further preferably, in the autonomous following and maintaining stage, the corresponding target value of the heading channel controller is selected according to the corresponding heading following mode:
(a) If the set course following mode is the mode of keeping the current machine head direction, the target value of the course angle of the course channelSet to the current aircraft heading angle +>;
(b) If the set course following mode is along the direction of the moving platform, the target value of the course angle of the course channelThe calculation method comprises the following steps: />Wherein is present>For moving the real-time course angle of the platform, and>the calculation method of the correction function for the target course angle is as follows:
control target for altitude passageFor set takeoff height>(ii) a Horizontal channel position control target->、/>Are respectively based on a parameter->、/>The calculation method is as follows:
Still further preferably, the course corridor sets a control target of the course angle during the initialization phase of autonomous landingIs composed of(ii) a Control target for an altitude channel>Kept at take-off height pick-up>The change is not changed; horizontal passage north position control targetIs 0; east position control target of horizontal channel>Is 0.
Still further preferably, in the autonomous landing and descending stage, the course channel sets a control target of a course angleIs composed of,/>The aircraft course angle after the initialization phase of autonomous landing is finished; control target for an altitude channel>Set to 0.3m, reducing the multi-rotor aircraft height to 0; horizontal channel north position control target->Is 0; east position control target of horizontal channel>Is 0; real-time detection of altitude of multi-rotor aircraft>Whether or not less than a threshold value of 0.3m and the horizontal distance ≥ of the aircraft from the mobile platform>And if the distance is less than 0.2m of the threshold value, the flight control unit sends a control signal value power unit if the condition is met, the output of the power unit is closed, and the multi-rotor aircraft can be subjected to inertial landing on the mobile platform to complete the whole autonomous flight task.
It should be noted that in the present invention, innovations have been made in the control targets of the north and east position controllers and the velocity controller. Horizontal position controller target(northbound) and->(east direction) obtains the control target of the north direction speed controller through the north direction position controller and the east direction position controller respectively>East-direction speed controller control target>。
first, the error between the position control target and the actual position of the aircraft is calculated:;
Then, a critical value of the position error is calculated:Wherein is present>The maximum acceleration that the multi-rotor aircraft can fly is set to be 4.5 m/s;
then, according toAnd &>Selects different calculation manners to calculate the feed-forward northbound target speed>The calculation method is as follows:
then, expected position targets at different times are calculated:Wherein is present>Is a control step length;
then, calculating a feedback-based control position controller output targetThe calculation method comprises the following steps:wherein is present>Controlling parameters for a north position controller of the multi-rotor aircraft, wherein the values of the parameters are 1;
finally, the total output target value of the position controller is calculated:Wherein is present>The real-time northbound speed of the mobile platform.
The horizontal channel east speed controller controls the targetIn the calculation of the control algorithm of (4), the value of the preceding calculation process is evaluated>、/>、/>Are respectively replaced by>、/>、/>Then the east speed controller controls the target>Wherein is present>Real-time east speed for the mobile platform.
Even more preferably, the composition is prepared fromAnd &>Further obtains a north acceleration target and a east acceleration target respectively through a north speed controller and an east speed controller>East acceleration control target>The specific calculation process is as follows:
first, the error between the speed control target and the actual position of the aircraft is calculated:/>;
Then, a threshold value of the speed error is calculated:Wherein is present>The maximum jerk for the multi-rotor aircraft to fly is set to be 2.5 m/s/s;
then, according toAnd &>Is calculated based on the magnitude of the feedforward north target acceleration @, different calculation methods are selected to calculate the feedforward north target acceleration @>The calculation method is as follows:
then, desired speed targets at different times are calculatedThe calculation method is as follows:wherein->Is a control step length;
then, the speed controller output target is calculated based on the feedback controlThe calculation method comprises the following steps:wherein is present>Is a control parameter of a multi-rotor aircraft north speed controller, the value of which is 2 and/or greater>Is the integral term of the northbound speed controller>A derivative term for the northbound controller;
finally, the total output target value of the position controller is calculated:Wherein->Real-time north acceleration for the mobile platform.
The above-mentionedIs calculated and->Similarly, only the above-described process need be combined>、/>、Is replaced by>、/>、/>Then the east speed controller controls the target>Wherein->Real-time east acceleration for the mobile platform.
Still further preferably, the aforementioned north acceleration targetEast acceleration control target>Obtaining a control target of the attitude angle based on a coordinate conversion formula of the navigation system and the body system>And &>The calculation method comprises the following steps:,/>for controlling the pitch angle, is>Is a roll angle control target. Finally, is combined>Andand controlling the multi-rotor aircraft to fly at a desired attitude through the attitude controller, and keeping the multi-rotor aircraft at the central position of the mobile platform.
The invention has the advantages that:
(1) The autonomous flight system comprises a mobile platform and a flight platform, can be conveniently and quickly deployed on a mobile carrier (such as a vehicle, a ship and the like), can be used in any place with a Beidou signal, enables the whole flight process to be completely autonomous, does not need manual intervention, and provides software and hardware support for a plurality of autonomous flight tasks of a multi-rotor aircraft such as autonomous take-off, autonomous following and autonomous landing through data interaction of the mobile platform and the flight platform after a flight task is reached, 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 at the expected positionFeedforward northbound target speed>And feedforward north target acceleration>Then, the control quantities are used as feedforward control to be added into a control loop, so that the aircraft can stably and quickly fly to a specified area;
(3) In the prior art, most of flight control is based on an error control method, the rapidity is improved, and meanwhile, the cost of sacrificing the stability and the control precision is achieved, and the autonomous flight control method is improved, so that compared with the traditional error control method, the control precision, the stability and the rapidity are improved in an all-round way; meanwhile, the multi-rotor aircraft can stably and accurately land on a mobile platform with limited space due to higher control precision, and the safety is better guaranteed.
Drawings
FIG. 1 is a schematic structural diagram of a framework for a multi-rotor aircraft mobile platform autonomous flight system according to the present invention;
FIG. 2 is a schematic logical block diagram of the multi-rotor aircraft mobile platform autonomous flight system of the present invention;
FIG. 3 is a flow chart of a method for autonomous flight control of a mobile platform of a multi-rotor aircraft according to the present invention;
FIG. 4 is a logic block diagram of the north position controller of the present invention;
FIG. 5 is a logic block diagram of the north speed controller of the present invention.
Detailed Description
The invention is described in detail below with reference to the figures and the embodiments.
Example 1
Referring to fig. 1 and 2, the present embodiment discloses a multi-rotor aircraft mobile platform autonomous flight system, which includes a flight platform and a mobile platform. The mobile platform is composed of a Beidou base station module, a movable platform navigation module, an inertial sensor module and a movable platform communication module, and the flight platform is composed of an airborne Beidou positioning and orienting module, a navigation module, an airborne inertial sensor module, an airborne communication module, a flight guidance module and a flight control module. The mobile platform and the flight 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, acceleration and the like to the mobile platform navigation module; the mobile platform navigation module packages and sends information mobile platform data such as three-dimensional position, three-dimensional speed, three-dimensional acceleration, attitude angle and course angle of the mobile platform to the mobile platform communication module after data fusion, simultaneously forwards RTCM (remote terminal measurement) stream data of the Beidou base station module 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 orienting module, the airborne Beidou positioning and orienting module sends data such as relative position, speed and course calculated by difference to the navigation module, the navigation module performs data fusion on transmission data of the airborne communication module, measurement data of the airborne Beidou positioning and orienting module and measurement data of the airborne inertial sensor module, and unmanned aerial vehicle position data and 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 with the position and posture data of the movable platform, the flight control module performs control law resolving to generate control signals of the executing mechanism, the control signals are sent to the power unit after the action of the controllers of all the channels, and the power unit drives the multi-rotor aircraft to autonomously fly.
Example 2
The embodiment discloses a method for controlling autonomous flight of a multi-rotor aircraft mobile platform, which can be divided into three main flight phases of autonomous takeoff, autonomous following and autonomous landing, and comprises the following specific steps as shown in fig. 3:
s1, setting flight parameters:
setting takeoff height by taking a fixed point on the mobile platform as an original point and following a right-hand rule(positive upward), horizontal distance of aircraft from mobile platform &>(Right positive), aircraft Forward horizontal distance @frommobile platform>(forward positive), heading-following mode yawMode, geofence height ≧ greater>Geofence radius->And the like, associated flight parameters.
The heading following mode yawMode described herein can be referred to as follows, specifically two: and maintaining the current machine head direction mode and the direction mode along the movable platform.
S2, initializing an autonomous takeoff process:
determining takeoff heightWhether or not the geofence height is exceeded->If the number of the rotor wing aircraft exceeds the preset threshold value, displaying a corresponding error reporting indication on the ground station, and forbidding the take-off of the multi-rotor wing aircraft; and if the takeoff self-test items (including the battery power, the temperature of the flight control panel, the attitude angle, the heading angle and the like) are all passed, allowing the autonomous takeoff process to be entered.
S3, separating the flight platform from the mobile platform:
at this stage, the course channel only has angular velocity ring controller to control the target course angular velocityIs 0; the pitch channel comprises a pitch angle and pitch angle speed controller for controlling a target pitch angle->Is the pitch angle of the mobile platform at the moment>(ii) a The rolling channel is similar to the pitching channel and controls the target rolling angle->For the roll angle of the mobile platform at that time->(ii) a The height channel comprises a height and vertical speed controller, and the height control target is used for controlling the position of the fan unit>At a set takeoff height>Climbing is carried out, in the course of which the relative speed of ascent ≥ of the aircraft is detected in real time>If it exceeds 0.15m/s. If the heading angle exceeds the preset value, the separation of the flying platform and the moving platform is considered to be successful, and the heading angle of the aircraft and the moving platform at the moment is recorded>、/>North position->East position->Based on which a forward position is calculated>And a 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, in an autonomous takeoff climbing phase:
at this stage, the course channel includes course angle and course angular velocity controller, the control target of course angleIs the heading angle ≥ of the aircraft at the end of step S3>(ii) a The horizontal channel includes a position controller and a speed controller, the control target of the position controller includes a horizontal channel northbound position control target->And horizontal channel east position control targetThe control objective of the speed controller includes a north speed controller control objective->And an east speed controller control target.
Wherein the north-oriented horizontal position controls the targetFor the aircraft forward position ≥ at the end of step S3>And a right position->Real-time resolved north position->East horizontal position control target>East position of the aircraft at the end of step S3>The calculation method is as follows:
referring again to FIG. 4, the control targets for the north speed controllerThe calculation method of (2) is as follows:
first, the error between the position control target and the actual position of the aircraft is calculated:/>Wherein->The north direction relative position of the flying platform and the mobile platform is obtained;
then, a critical value of the position error is calculated:Wherein is present>The maximum acceleration that the multi-rotor aircraft can fly is set to be 4.5 m/s;
then, according toAnd &>Selects different calculation manners to calculate the feed-forward northbound target speed pick>The calculation method is as follows:
then, expected position targets at different times are calculated:Wherein is present>Is a control step length;
then, calculating a feedback-based control position controller output targetThe calculation method comprises the following steps:wherein is present>Controlling parameters for a north position controller of the multi-rotor aircraft, wherein the values of the parameters are 1;
finally, the total output target value of the position controller is calculated:Wherein is present>The real-time northbound speed of the mobile platform.
East speed of horizontal channelController control targetControl algorithm and northbound speed controller control targetThe control algorithm of (4) is exactly the same as the principle, and only needs to be based on the calculation process->、/>、/>Are respectively replaced by>、/>、/>The east speed controller can obtain the control target>Wherein is present>Real-time east speed for the mobile platform.
Is obtained by the stepsAnd &>Then, further get north direction acceleration target and east direction speed controller respectively>East acceleration control target>. Referring to fig. 5, the specific calculation process is:
first, the error between the speed control target and the actual position of the aircraft is calculated:/>;
Then, a threshold value of the speed error is calculated:Wherein is present>The maximum jerk for the multi-rotor aircraft to fly is set to be 2.5 m/s/s;
then, according toAnd &>Is calculated based on the magnitude of the feedforward north target acceleration @, different calculation methods are selected to calculate the feedforward north target acceleration @>The calculation method is as follows:
then, desired speed targets at different times are calculatedThe calculation method is as follows:wherein->Is a control step length;
then, the speed controller output target is calculated based on the feedback controlThe calculation method comprises the following steps:in which>Is a control parameter of a multi-rotor aircraft north speed controller, the value of which is 2 and/or greater>Is the integral term of the northbound speed controller>A differential term of a north controller;
finally, the total output target value of the position controller is calculated:In which>Real-time north acceleration for the mobile platform.
The control algorithm and principle of the east speed controller of the horizontal channel are the same as those of the north speed controller,is calculated and->Similarly, only the above-described process need be combined>、/>、/>Are respectively replaced by>、/>、/>The east speed controller can obtain the control target>Wherein->The real-time east acceleration of the mobile platform.
Finally, the north direction acceleration target is obtainedEast acceleration control target>Then, obtaining a control target of the attitude angle through a coordinate conversion formula of a navigation system and a machine system>And &>。
Namely:,/>for controlling the pitch angle, is>And the control target of the attitude controller is determined according to the roll angle control target. />And &>And controlling the multi-rotor aircraft to fly at a desired attitude through the attitude controller to reach a desired position.
The altitude passage controller, like the altitude controller and altitude control target used in the aforementioned step S3, detects the altitude of the aircraft in real time during this processWhether a set takeoff height has been reached>If the condition is met, the climb phase of the autonomous takeoff process is considered to be finished, and the whole autonomous takeoff phase is finished, and the multi-rotor aircraft enters the autonomous following initialization phase of the following step S5.
S5, an autonomous following initialization stage:
first, the horizontal distance of the aircraft from the mobile platform is calculated:/>Wherein is present>In relation to the north relative position of the flight platform from the mobile platform, in relation to the north of the mobile platform>Is the east position (east is 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 of the flying wings exceeds the preset threshold value, displaying a corresponding alarm indication at the ground station, and forbidding the multi-rotor aircraft to fly out of the geofence; if->Then the autonomous follow-up holding phase of step S6 described below is entered.
S6, an autonomous following and maintaining stage:
selecting a corresponding course channel controller target value according to the corresponding course following mode;
(1) If the set course following mode is the mode of keeping the current machine head direction, the target value of the course angle of the course channelSet to the current aircraft heading angle +>;
(2) If the set course following mode is along the direction of the moving platform, the target value of the course angle of the course channelThe calculation method comprises the following steps: />Wherein is present>Is a real-time course angle (clockwise is positive, the range is-180 degrees to +180 degrees) of the mobile platform, and is used for selecting the position of the mobile platform>The correction function for the target course angle calculation is calculated by the following method:
control target for altitude passageFor a set takeoff height->(ii) a Horizontal channel position control target->、/>The parameter ^ set by step S1 respectively>、/>The calculation method is as follows:
Likewise, this step is also obtained according to the calculation method set forth in step S4And &>And finally->Andand controlling the multi-rotor aircraft to fly at a desired attitude through the attitude controller, and maintaining the relative positions of the multi-rotor aircraft and the mobile platform.
And after the flying platform receives the autonomous landing instruction sent by the ground station, the multi-rotor aircraft enters the autonomous landing initialization stage in the step S7.
S7, an automatic landing initialization stage:
control target for setting course angle of course channelIs->(ii) a Control target of the height channel->The takeoff height pick-up set for step S1 is maintained>The change is not changed; horizontal channel north position control target->Is 0; east position control target of horizontal channel>Is 0.
In the same way, in determining、/>On the premise of the numerical value, obtaining the value based on the calculation method of the last attitude angle target in the step S4>And &>And finally->And &>The multi-rotor aircraft is controlled by the attitude controller to fly at a desired attitude and keep multipleThe rotorcraft is in the central 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 that of the step S5, if +>And (4) the distance is less than the set threshold value of 1.5m, the threshold value can be adjusted according to actual requirements in the actual flight process, and the autonomous landing and descending stage of the step (S8) is started.
S8, an autonomous landing descending stage:
course channel set course angle control targetIs->,/>The aircraft course angle after the initialization stage of autonomous landing is finished; control target of the height channel->Set to 0.3m, reducing the multi-rotor aircraft height to 0; horizontal channel north position control target->Is 0; east position control target of horizontal channel>Is 0.
In the same way, in determining、/>On the premise of numerical value, calculating according to the calculation method of the final attitude angle target in the step S4/>And &>And finally->And &>And controlling the multi-rotor aircraft to fly at a desired attitude through the attitude controller, and keeping the multi-rotor aircraft at the central position of the mobile platform.
In the process, the height of the multi-rotor aircraft is detected in real timeWhether or not less than a threshold value of 0.3m and the horizontal distance ≥ of the aircraft from the mobile platform>If less than the threshold value 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 be in inertial landing on the mobile platform to complete the whole autonomous flight task.
In conclusion, the autonomous flight system 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 of a multi-rotor aircraft, such as autonomous takeoff, autonomous following, autonomous landing and the like. Compared with the traditional control method based on errors, the autonomous flight control method based on the system has the advantages that the control precision, the stability and the rapidity are improved comprehensively and greatly, meanwhile, the multi-rotor aircraft can stably and accurately land on a moving platform with limited space due to high control precision, and the safety is better guaranteed.
The foregoing shows and describes the general principles, principal features and advantages of the invention. It should be understood by those skilled in the art that the above embodiments do not limit the present invention in any way, and all technical solutions obtained by using equivalent alternatives or equivalent variations fall within the scope of the present invention.
Claims (12)
1. A multi-rotor aircraft mobile platform autonomous flight system, comprising:
the mobile platform consists 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 orienting module, a navigation module, an airborne inertial sensor module, an airborne communication module, a flight guidance module and a flight control module;
the data interaction between the flight platform and the mobile platform is realized 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 aircraft to the moving platform navigation module; the mobile platform navigation module packages and sends the mobile platform data of the information related to the three-dimensional position, the three-dimensional speed, the three-dimensional acceleration, the attitude angle and the course angle of the mobile platform to the mobile platform communication module after carrying out data fusion, and simultaneously forwards RTCM streaming data of the Beidou base station module to the mobile platform communication module, and the mobile platform communication module sends the received data to an airborne communication module of the flight platform;
the RTCM data stream received by the airborne communication module is forwarded to the airborne Beidou positioning and orienting module by the navigation module, the relative position, speed and course related data calculated by difference are sent to the navigation module by the airborne Beidou positioning and orienting module, and the transmission data of the airborne communication module, the measurement data of the airborne Beidou positioning and orienting module and the measurement data of the airborne inertial sensor module are subjected to data fusion by the navigation module, and unmanned aerial vehicle position data and movable platform position and pose data are respectively output to the flight control module and the flight guidance module.
2. The system of claim 1, wherein the method for controlling autonomous flight of a mobile platform comprises:
(1) Preparing for taking off: setting flight parameters, carrying out autonomous takeoff initialization operation, carrying out takeoff self-check and judging whether the autonomous takeoff process is allowed to be entered or not;
(2) And (3) taking off automatically: the flying platform is separated from the mobile platform, and the aircraft enters an autonomous takeoff and climbing stage until the height of the aircraft is detected in real timeReach the set takeoff height->Ending the climbing stage in the process of autonomous takeoff;
(3) Autonomous following: determining horizontal distance of an aircraft from a mobile platformWhether or not the geofence radius is exceeded>If->Entering an autonomous following and maintaining stage, and selecting a corresponding target value of the course channel controller according to a corresponding course following mode;
(4) Self-landing: firstly, the horizontal distance of the aircraft from the mobile platform is judged in the initialization stage of autonomous landingAnd if the altitude is smaller than the set threshold value, entering an autonomous landing and descending stage until the aircraft lands on the mobile platform to complete the whole autonomous flight task.
3. The mobile platform autonomous flight control method of claim 2, wherein the flight parameters include at least: height of takeoffHorizontal distance ^ of the aircraft from the mobile platform>The forward horizontal distance of the aircraft from the mobile platform->Heading-following mode yawMode, geofence height->And geofence radius>。
5. The autonomous flight control method for a mobile platform of claim 2, wherein the target course angular velocity is controlled while the mobile platform is separated from the flight platform in the (2) autonomous takeoff phaseIs 0, the target pitch angle->Is the pitch angle of the mobile platform at the moment>Target roll angle->For the roll angle of the mobile platform at that time->The height control target->At a set takeoff height->Climbing is carried out;
in the process, the relative ascending speed of the aircraft is detected in real timeWhether the speed exceeds 0.15m/s, if so, the separation of the flying platform and the moving platform is considered to be successful, and the heading angle of the aircraft at the moment is recorded>Course angle of mobile platformNorth position->East position->Based thereon, a forward position is calculated>And right positionThe calculation formula is as follows:
6. the autonomous flight control method for mobile platforms as claimed in claim 5, wherein during autonomous takeoff and climb, the course channel comprises a course angle and a course angular velocity controller, and a control target of the course angleIs the course angle(ii) a The horizontal path includes a position controller and a speed controller, wherein a north-oriented horizontal position controls the target->Is a forward position of the aircraft>And a right position->Real-time resolved north position->East horizontal position control target>Is an east position of the aircraft>The calculation method is as follows:
7. the autonomous flight control method for a mobile platform according to claim 2, wherein in the autonomous following maintenance phase, a corresponding course channel controller target value is selected according to a corresponding course following mode;
(a) If the set course following mode is the mode of keeping the current machine head direction, the target value of the course angle of the course channelSet to the current aircraft heading angle pick>;
(b) If the set course following mode is along the direction of the moving platform, the target value of the course angle of the course channelThe calculation method comprises the following steps: />Wherein is present>For moving the real-time course angle of the platform, and>the calculation method of the correction function for the target course angle is as follows:
control target for altitude passageFor a set takeoff height->(ii) a Horizontal channel position control target->、/>Are respectively based on a parameter->、/>The calculation method is as follows: />
8. The method of claim 2, wherein the course channel sets the control target of the course angle during the initialization phase of the autonomous landingIs->(ii) a Control target of the height channel->Kept at take-off height pick-up>The change is not changed; horizontal channel north position control target->Is 0; east position control target of horizontal channel>Is 0.
9. The method of claim 2, wherein the course heading comprises a control target with a course angle set for the course heading channel during the autonomous descent phaseIs->,/>The aircraft course angle after the initialization phase of autonomous landing is finished; control target of the height channel->Set to 0.3m, reducing the multi-rotor aircraft height to 0; horizontal channel north position control target->Is 0; east position control target of horizontal channel>Is 0; detecting height ≥ of multi-rotor aircraft in real time>Whether or not less than a threshold value of 0.3m and the horizontal distance ≥ of the aircraft from the mobile platform>If the value is less than 0.2m of the threshold value, if the condition is met, the flight control unit sends a control signal value to the power unit, the output of the power unit is closed, and the multi-rotor aircraft can be subjected to inertial landing to the mobile platformAnd finally, completing the whole autonomous flight task.
10. The method for controlling autonomous flight of a mobile platform according to any one of claims 6 to 9, wherein the horizontal position controller targetsAnd &>The control target of the north speed controller is obtained by the north position controller and the east position controller respectively>East-direction speed controller control target>In which>The calculation method of (2) is as follows:
first, the error between the position control target and the actual position of the aircraft is calculated:/>;
Then, a critical value of the position error is calculated:/>In which>Maximum acceleration for which the multi-rotor aircraft is capable of flying is set;
then, according toAnd &>Selects different calculation manners to calculate the feed-forward northbound target speed>The calculation method is as follows:
then, expected position targets at different times are calculated:Wherein is present>Is a control step length;
then, the output target of the position controller based on feedback control is calculatedThe calculation method comprises the following steps:wherein is present>Controlling parameters for a north position controller of the multi-rotor aircraft, wherein the values of the parameters are 1;
finally, the total output target value of the position controller is calculated:Wherein is present>The real-time north direction speed of the mobile platform;
the horizontal channel east speed controller controls the targetIn the calculation of the control algorithm(s), the above calculation process is performed>、/>、/>Are respectively replaced by>、/>、/>Then the east speed controller controls the target>In which>The real-time east speed for the mobile platform.
11. The method for autonomous flight control of a mobile platform of claim 10, wherein the autonomous flight control is performed by the mobile platformAndfurther obtains the north direction acceleration target and the east direction acceleration target respectively through a north direction speed controller and an east direction speed controller>East acceleration control target>The specific calculation process is as follows:
first, the error between the speed control target and the actual position of the aircraft is calculated:/>;
Then, a threshold value of the speed error is calculated:/>Wherein is present>The maximum jerk for which the multi-rotor aircraft is capable of flying is set;
then, according toAnd &>Is calculated based on the magnitude of the feedforward north target acceleration @, different calculation methods are selected to calculate the feedforward north target acceleration @>The calculation method is as follows:
then, desired speed targets at different times are calculatedThe calculation method is as follows:wherein->Is a control step length;
then, the speed controller output target is calculated based on the feedback controlThe calculation method comprises the following steps:wherein is present>Is a control parameter of a multi-rotor aircraft north speed controller, the value of which is 2 and/or greater>Is the integral term of the northbound speed controller>A derivative term for the northbound controller;
finally, the total output target value of the position controller is calculated:Wherein->Real-time north acceleration of the mobile platform;
12. The mobile platform autonomous flight control method of claim 11, the northbound acceleration targetEast acceleration control target>Obtaining a control target of the attitude angle based on a coordinate conversion formula of the navigation system and the body system>And &>The calculation method comprises the following steps: />,/>For controlling the pitch angle, is>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 true CN115857555A (en) | 2023-03-28 |
CN115857555B 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) |
Citations (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 |
CN106227234A (en) * | 2016-09-05 | 2016-12-14 | 重庆零度智控智能科技有限公司 | Unmanned plane, unmanned plane take off control method and device |
CN110989673A (en) * | 2019-12-16 | 2020-04-10 | 西安因诺航空科技有限公司 | Autonomous tracking take-off and landing system of rotor unmanned aerial vehicle mobile platform and control method |
CN111813148A (en) * | 2020-07-22 | 2020-10-23 | 广东工业大学 | 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
Patent Citations (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 |
CN106227234A (en) * | 2016-09-05 | 2016-12-14 | 重庆零度智控智能科技有限公司 | Unmanned plane, unmanned plane take off control method and device |
CN110989673A (en) * | 2019-12-16 | 2020-04-10 | 西安因诺航空科技有限公司 | Autonomous tracking take-off and landing system of rotor unmanned aerial vehicle mobile platform and control method |
CN111813148A (en) * | 2020-07-22 | 2020-10-23 | 广东工业大学 | 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 |
Also Published As
Publication number | Publication date |
---|---|
CN115857555B (en) | 2023-06-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11260973B2 (en) | Aircraft control apparatus, control system and control method | |
Ahrens et al. | Vision-based guidance and control of a hovering vehicle in unknown, GPS-denied environments | |
US10717525B2 (en) | Aircraft control apparatus, control system and control method | |
CN110989673B (en) | Autonomous tracking take-off and landing system of unmanned rotor platform and control method | |
Laiacker et al. | Vision aided automatic landing system for fixed wing UAV | |
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 | |
CN107491083B (en) | Four-rotor-wing autonomous landing method based on saturation self-adaptive sliding mode control | |
Jung et al. | A trajectory-tracking controller design using l 1 adaptive control for multi-rotor uavs | |
Gautam et al. | Application of guidance laws to quadrotor landing | |
Yun et al. | A leader-follower formation flight control scheme for UAV helicopters | |
CN205121348U (en) | Unmanned vehicles safety system of descending fast and remote control equipment and unmanned vehicles thereof | |
Limnaios et al. | Fuzzy logic controller for a mini coaxial indoor helicopter | |
Nogar | Autonomous landing of a uav on a moving ground vehicle in a gps denied environment | |
CN113253760B (en) | Path planning method and device, movable carrier and storage medium | |
Liu et al. | Control of autonomous airship | |
Pestana et al. | A general purpose configurable navigation controller for micro aerial multirotor vehicles | |
CN115857555A (en) | Autonomous flight control method for multi-rotor aircraft mobile platform | |
Wang et al. | Low altitude and multiple helicopter formation in precision aerial agriculture | |
Munoz et al. | Observer-control scheme for autonomous navigation: Flight tests validation in a quadrotor vehicle | |
Tang et al. | Homing on a moving dock for a quadrotor vehicle | |
JP2019159488A (en) | Flight controller, method, program, and storage medium | |
Iwakura et al. | Movable Range-Finding Sensor System and Precise Automated Landing of Quad-Rotor MAV | |
Nowak et al. | The selected innovative solutions in UAV control systems technologies | |
Ranasinghe et al. | Development of gasoline-electric hybrid propulsion surveillance and reconnaissance VTOL UAV |
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 |