A flight interval management method based on PID speed regulation and iterative steering
Through the PID speed adjustment and iterative steering method, the accuracy and flexibility of traditional flight interval management in dynamic environments are solved, and dynamic interval management is realized, which reduces workload and improves the accuracy and flexibility of aircraft intervals.
Patent Information
- Application Number
- CN202210783515.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-07-05
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2042-07-05
AI Technical Summary
Traditional flight interval management is difficult to accurately control aircraft intervals in dynamic environments, resulting in increased workload of controllers and pilots. Traditional navigation methods rely on ground navigation platforms, limiting the flexibility of aircraft routes.
The flight interval management method based on PID speed adjustment and iterative steering is adopted to calculate the predicted flight interval and interval error, determine the PID control mode, adjust the aircraft speed, and calculate the new route length and steering point through iterative algorithm to realize dynamic interval management.
It reduces the workload of controllers and pilots, improves the accuracy and flexibility of aircraft spacing, ensures the safety and consistency of aircraft spacing, and reduces dependence on ground navigation stations.
Smart Images

Figure CN115291623B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of civil aviation monitoring, and in particular to a flight interval management method based on PID speed regulation and iterative steering. Background Art
[0002] Flight interval management is used in new generation navigation systems such as RNAV (Regional Area Navigation) and PBN (Performance Based Navigation). Its purpose is to improve the accuracy and consistency of aircraft spacing, provide pilots with interval operation suggestions, ensure minimum interval requirements, and reduce the load on ground controllers. Traditional route navigation methods mainly rely on ground navigation stations, and the starting point, turning point, and end point of the aircraft route are all referenced to the ground navigation station. Therefore, aircraft can only navigate to and from the station through the radio signals of the ground navigation station. The new navigation method allows aircraft to navigate along the waypoints specified by the controller within the range of navigation information without being guided by the ground tower. Aircraft on the same route take different routes, which increases the capacity of aircraft on the same route.
[0003] In traditional navigation, the controller only needs to assign a minimum interval, and the aircraft flies along a fixed route, which makes it easier to control the longitudinal interval of the aircraft. In the new navigation method, the aircraft flies along different routes, and the interval between the aircraft is not a simple distance difference or time difference between the two aircraft. Dynamic interval management (IM) needs to consider the position, speed, wind direction and temperature of the own aircraft and the target aircraft. Usually, the controller specifies a target aircraft for the own aircraft. Before arriving at the same planned terminal point PTP (Planed Termination Point), the controller specifies the same arrival point ABP (Achieve-by Point) for the two aircraft. IM predicts the time difference between the own aircraft and the target aircraft to arrive at ABP based on the aircraft information and the waypoint position, and adjusts the speed of the own aircraft to meet the control interval requirements. If the speed adjustment alone still cannot meet the requirements, the aircraft is allowed to leave the route formed by the waypoints and calculate the new turning point and turning path. Summary of the invention
[0004] In view of this, the present invention aims at the aircraft interval management on the route, adopts integral separation PID to adjust the speed, further adopts the steering method to change the path length, ensures the safe longitudinal interval of the aircraft, and reduces the workload of the controller and the pilot through automatic interval management.
[0005] The first aspect of the invention provides a flight interval management method based on PID speed regulation and iterative steering, the method comprising:
[0006] S1, calculate the TTG of the own aircraft and the target aircraft according to the waypoint information and the arrival point ABP position, and obtain the predicted flight interval PSI;
[0007] S2, according to the predicted flight interval PSI and the interval target Δ calculated in S1, the predicted interval error is calculated; according to the distance from the current aircraft to the arrival point ABP along the route, the error threshold is calculated; according to the magnitude relationship between the predicted interval error and the error threshold, the corresponding PID control mode is determined, and the aircraft interval management IM speed is calculated based on the PID control mode; wherein the interval target Δ is pre-set by the controller;
[0008] S3, judging whether to use the IM steering method according to the IM speed of the aircraft and the speed limit range of the aircraft;
[0009] S4, using an iterative algorithm to calculate the length of the new route after the IM turn; whether the TTG after the turn satisfies the IM tolerance is used as a condition for judging whether the iteration is completed;
[0010] S5, dividing the original route of the aircraft into sections according to the waypoint information, and determining whether a turning point exists in each section; and calculating the position of the IM turning point according to the cosine theorem and the length of the new route after the IM turning.
[0011] Further, the S1, based on the waypoint information and the arrival point ABP position of the own aircraft and the target aircraft, calculates the TTG of the own aircraft and the target aircraft to obtain the predicted flight interval PSI, including:
[0012] The predicted flight interval PSI is calculated according to the following formula:
[0013] PSI(t)=TTG O (t)-TTG T (t)
[0014] Among them, TTG O (t) represents the time when the current position of the aircraft along the route reaches the arrival point ABP; TTG T PSI(t) represents the time when the target aircraft's current position along the route reaches the arrival point ABP; PSI(t) represents the predicted interval between the own aircraft and the target aircraft at time t.
[0015] Furthermore, the S2 further includes:
[0016] At time t, the difference between the interval target Δ and the prediction interval PSI is determined to be the prediction interval error e(t), and the prediction interval error e(t) is expressed as:
[0017] e(t)=Δ-PSI(t)=Δ-(TTG O (t)-TTGT (t))=(TTG T (t)+Δ)-TTG O (t)
[0018] The determining of the corresponding PID control mode according to the magnitude relationship between the prediction interval error and the error threshold comprises:
[0019] Set the deviation threshold ε = e threshold (s O (t)-s ABP (t))>0;
[0020] Among them, s o (t) represents the current position of the aircraft along the track, and the s o (t) is negative before the planned end point; s ABP (t) represents the along-track position of the arrival point;
[0021] When |e(t)|>ε, the PD control mode is adopted; when |e(t)|≤ε, the PID control mode is adopted.
[0022] Furthermore, the S2 further includes:
[0023] Set e(t) = (TTG T (t)+Δ)-TTG O The first term in (t) is the system input value y d (t), and the second term is used as the output value y(t), then the following expression is obtained:
[0024] y d (t) = TTG T (t)+Δ
[0025] y(t)=TTG O (t)
[0026] e(t)=y d (t)-y(t)
[0027] When |e(t)|≤ε, the PID control mode is adopted, including linearly superimposing the deviation through proportional, integral, and differential links to obtain the control quantity u(t), and the expression is as follows:
[0028]
[0029] The transfer function is obtained by the above formula:
[0030]
[0031] Among them, K P is the proportionality coefficient; K Iis the integration time constant; K D is the differential time constant.
[0032] Further, the step S3, judging whether to use the IM steering method according to the IM speed of the aircraft and the speed limit interval of the aircraft, includes:
[0033] The aircraft receives the speed limit from the navigation database. During IM speed control, if the required IM speed exceeds the restricted speed range, the aircraft needs to control the length of its new route through IM steering to meet the interval target with the target aircraft.
[0034] Further, the S4 uses an iterative algorithm to calculate the length of the new route after the IM turn; whether the TTG after the turn satisfies the IM tolerance is used as a condition for judging whether the iteration is completed, including:
[0035] In the iterative process, the minimum and maximum route lengths d after the IM is turned IM min ,d IM max As the initial value, d IM min and d IM max is the length of the new route d IM The two major boundaries;
[0036] Through the d IM min and d IM max Find the average value and get d IM The midpoint value d IM mid , for d IM mid Use the law of cosines to calculate the turning point, then generate the reference track and get the arrival ABP time TTG Omid ; Determine whether the interval after turning meets the IM tolerance; use the following judgment conditions:
[0037]
[0038] Among them, TTG O * =TTG T +Δ indicates the time it takes to reach the destination after the aircraft has completed the specified flight interval. If the above conditions are met, then The calculation of the route length after the turn is completed; if the above conditions are not met, update d as follows IM min and d IM max :
[0039] If TTG O mid -TTG O * <0, then:
[0040] d IM min =d IM mid
[0041] If TTG O mid -TTG O * ≥0, then:
[0042] d IM max =d IM mid
[0043] Recalculate TTG with updated values Omid , until the IM tolerance is met.
[0044] Further, the S5, according to the waypoint information, divides the original route of the aircraft into segments, determines whether a turning point exists in each segment; and calculates the position of the IM turning point according to the cosine theorem and the length of the new route after the IM turning, including:
[0045] By judging each route one by one, determine whether the IM turning point is on the corresponding segment route of the aircraft;
[0046] For the first route, the position of the IM turning point d IMA1 :
[0047]
[0048] Among them, d i represents the straight-line distance between the aircraft and the interception point on the i-th route, φ i ′ represents the angle between the aircraft route and the intercept point on the i-th route, L i represents the distance of the i-th route;
[0049] If the calculated d IMA1 If the remaining distance L1 of the first route is greater than the remaining distance L1 of the first route, the IM turning point is not on the first route, and the second route is checked. At this time, the required route length becomes d IM -L1, substitute into the following formula:
[0050]
[0051] If d IMA2 If it is greater than the length L2 of the second route, continue to check the third route; repeat this process until the direct route to the intercept point is obtained and determine d IMA This is the IM turning point.
[0052] In addition, the third aspect of the present invention provides an electronic device, which includes: one or more processors, and a memory, wherein the memory is used to store one or more computer programs; characterized in that the computer program is configured to be executed by the one or more processors, and the program includes steps for executing the flight interval management method based on PID speed regulation and iterative steering as described above.
[0053] In addition, a fourth aspect of the present invention provides a storage medium storing a computer program; the program is loaded and executed by a processor to implement the steps of the flight interval management method based on PID speed regulation and iterative steering as described above.
[0054] In the scheme of the present invention, the TTG of the own aircraft and the target aircraft are calculated according to the waypoint information of the own aircraft and the target aircraft and the position of the arrival point ABP, and the predicted flight interval PSI is obtained; the predicted interval error is obtained according to the predicted flight interval PSI and the interval target Δ calculated by S1; the error threshold is calculated according to the distance from the current own aircraft along the route to the arrival point ABP; the corresponding PID control mode is determined according to the size relationship between the predicted interval error and the error threshold, and the aircraft interval management IM speed is calculated based on the PID control mode; wherein the interval target Δ is pre-set by the controller; according to the size of the own aircraft IM speed and the speed limit interval of the own aircraft, it is determined whether to use the IM turning method; using an iterative algorithm, the length of the new route after the IM turning is calculated; whether the TTG after the turning satisfies the IM tolerance is used as a condition for determining whether the iteration is completed; according to the waypoint information, the original route of the own aircraft is segmented, and it is determined whether a turning point exists in each segment; the position of the IM turning point is calculated according to the cosine theorem and the length of the new route after the IM turning. By predicting the interval of the aircraft reaching the ABP along the route, then using PID to control the speed, determine whether to turn, and calculate the turning point, flight interval management enables the pilot to obtain and maintain the interval between the aircraft and the target aircraft, achieving dynamic, continuous, and safety-compliant intervals. BRIEF DESCRIPTION OF THE DRAWINGS
[0055] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings required for use in the embodiments are briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present invention and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without creative work.
[0056] Figure 1 It is a flow chart of the flight interval management method based on PID speed regulation and iterative steering disclosed in this embodiment;
[0057] Figure 2A schematic diagram of the prediction interval and interval target disclosed in this embodiment;
[0058] Figure 3 The algorithm flow chart of the integral separation PID control disclosed in this embodiment;
[0059] Figure 4 The simulation result diagram of using conventional PID and integral separation PID control disclosed in this embodiment;
[0060] Figure 5 Flowchart of the iterative algorithm disclosed in this embodiment;
[0061] FIG6 is a use case of shortening the flight interval by turning the aircraft through IM disclosed in this embodiment;
[0062] Figure 7 A diagram showing simulation results of the IM steering algorithm disclosed in this embodiment;
[0063] Figure 8 This embodiment discloses a schematic diagram of the overall implementation structure of flight interval management based on PID speed regulation and iterative steering. DETAILED DESCRIPTION
[0064] Example embodiments will now be described more fully with reference to the accompanying drawings. However, example embodiments can be implemented in a variety of forms and should not be construed as limited to the examples set forth herein; rather, these embodiments are provided so that this application will be more comprehensive and complete and fully convey the concept of the example embodiments to those skilled in the art.
[0065] In addition, described feature, structure or characteristic can be combined in one or more embodiments in any suitable manner. In the following description, many specific details are provided to provide a full understanding of the embodiments of the present application. However, those skilled in the art will appreciate that the technical scheme of the present application can be put into practice without one or more of the specific details, or other methods, components, devices, steps, etc. can be adopted. In other cases, known methods, devices, realizations or operations are not shown or described in detail to avoid blurring the various aspects of the application.
[0066] The block diagrams shown in the accompanying drawings are merely functional entities and do not necessarily correspond to physically independent entities. That is, these functional entities may be implemented in software form, or in one or more hardware modules or integrated circuits, or in different networks and / or processor devices and / or microcontroller devices.
[0067] The flowcharts shown in the accompanying drawings are only exemplary and do not necessarily include all the contents and operations / steps, nor must they be executed in the order described. For example, some operations / steps can be decomposed, and some operations / steps can be combined or partially combined, so the actual execution order may change according to actual conditions.
[0068] The implementation details of the technical solution of the embodiment of the present application are described in detail below:
[0069] This embodiment aims at the aircraft interval management (IM) on the route, and proposes an aircraft interval control method that uses a PID algorithm to adjust the speed and an iterative algorithm to control the steering. First, the scheduled flight paths of the aircraft and the target aircraft are projected onto the horizontal route. The TTG (Time-to-go) difference between the time when the aircraft and the target aircraft arrive at the ABP on the horizontal route is the longitudinal interval between the two aircraft, which must meet the target value given by the controller. In order to achieve and maintain the interval target given by the controller, an integral separation PID algorithm is used to adjust the aircraft speed with the interval error. Since the adjustment of the aircraft speed must meet the operational requirements, if the speed adjustment cannot achieve the interval target, the turning point is calculated, and the interval target is achieved by changing the path length. The iterative algorithm is used to select the turning point, calculate the turning path, interception point, etc., control the time when the aircraft arrives at the ABP, and achieve the purpose of controlling the flight interval.
[0070] As shown in Table 1, this is the naming or definition of the terms used in this embodiment.
[0071]
[0072]
[0073] See also Figure 1 , Figure 1 FIG. 1 is a flow chart of a flight interval management method based on PID speed regulation and iterative steering disclosed in an embodiment of the present invention. Figure 1 As shown, a flight interval management method based on PID speed regulation and iterative steering according to an embodiment of the present invention comprises:
[0074] S1, calculate the TTG of the own aircraft and the target aircraft based on their waypoint information and the ABP position of the arrival point, and obtain the predicted flight interval PSI.
[0075] Specifically, in this embodiment, the flight interval prediction is first performed by projecting the target aircraft position onto the own aircraft route according to the horizontal routes of the own aircraft and the target aircraft. The arrival time (TTG) along the own aircraft route is predicted according to the current aircraft speed, and the flight interval is predicted by the TTG of the own aircraft and the target aircraft.
[0076] Further, if Figure 2 The figure shows the schematic diagram of the predicted interval and interval target of this embodiment. S1, according to the waypoint information and the arrival point ABP position of the own aircraft and the target aircraft, calculates the TTG of the own aircraft and the target aircraft to obtain the predicted flight interval PSI, including executing the predicted flight interval PSI according to the following formula:
[0077] PSI(t)=TTG O (t)-TTG T (t);
[0078] Among them, TTG O (t) represents the time when the current position of the aircraft along the route reaches the arrival point ABP; TTG T PSI(t) represents the time when the target aircraft's current position along the route reaches the arrival point ABP; PSI(t) represents the predicted interval between the own aircraft and the target aircraft at time t.
[0079] S2, according to the predicted flight interval PSI and interval target Δ calculated by S1, calculate the predicted interval error; according to the distance from the aircraft's current route to the arrival point ABP, calculate the error threshold; determine the corresponding PID control mode according to the relationship between the predicted interval error and the error threshold, and calculate the aircraft interval management IM speed based on the PID control mode; wherein the interval target Δ is pre-set by the controller.
[0080] Specifically, this embodiment further performs IM speed control by establishing an integral separation PID control system, and uses the predicted interval error as a basis for selecting and judging the control method. By inputting the predicted interval error e(t) into the system, the integral control is introduced when the error is small, and the integral control is abandoned when the error is large, and the system output controls the IM speed of the aircraft.
[0081] In S2, the IM speed is calculated using integral separation PID control. Figure 2 This is a schematic diagram of the predicted interval and interval target of this embodiment, with Δ representing the time interval between the aircraft and the target aircraft when the target aircraft arrives at the ABP. At time t, the difference between the interval target Δ and the predicted interval PSI is determined as the predicted interval error e(t), and the predicted interval error e(t) is expressed as:
[0082] e(t)=Δ-PSI(t)=Δ-(TTG O (t)-TTG T (t))=(TTG T (t)+Δ)-TTG O (t):
[0083] The method adopted by the present invention is integral separation PID control, which is different from ordinary PID control in that: when the deviation between the expected interval and the actual interval is large, it is necessary to cancel the integral link to eliminate the effect of integral accumulation to avoid large overshoot; when the deviation is small, integral control is added to eliminate static error. Figure 3 As shown in FIG. 1 , it is an algorithm flow chart of the integral separation PID control of this embodiment, wherein e threshold (s ABP (t)-s O (t)) indicates that the deviation threshold is a linear function of the distance from the aircraft to the arrival point. The selection and judgment process for PD control and PID control is as follows:
[0084] The determining of the corresponding PID control mode according to the magnitude relationship between the prediction interval error and the error threshold comprises:
[0085] (1) Set the deviation threshold ε = e threshold (s O (t)-s ABP (t))>0;
[0086] Among them, s o (t) represents the current position of the aircraft along the track, and the s o (t) is negative before the planned end point; s ABP (t) represents the along-track position of the arrival point;
[0087] (2) When |e(t)|>ε, PD control is adopted, and the system responds quickly to prevent large overshoot;
[0088] (3) When |e(t)|≤ε, PID control is adopted to improve control accuracy.
[0089] The step S2 further includes: e(t)=(TTG T (t)+Δ)-TTG O The first term in (t) is the system input value y d (t), and the second term is used as the output value y(t), then the following expression is obtained:
[0090] y d (t) = TTG T (t)+Δ
[0091] y(t)=TTG O (t)
[0092] e(t)=y d (t)-y(t)
[0093] When |e(t)|≤ε, the PID control mode is adopted, including linearly superimposing the deviation through proportional, integral, and differential links to obtain the control quantity u(t), and the expression is as follows:
[0094]
[0095] The transfer function is obtained by the above formula:
[0096]
[0097] Among them, K P is the proportionality coefficient; K I is the integration time constant; K D is the differential time constant.
[0098] In this embodiment, Figure 4 The simulation results of the conventional PID and integral separation PID control are shown in the following figure, assuming that the interval between the aircraft and the target aircraft is 9 km and the current deviation is 1200 m. It can be seen that the control effect of the integral separation PID solves the overshoot oscillation phenomenon of the traditional PID to a large extent, and the control effect is better and meets the requirements.
[0099] S3, judging whether to use the IM steering method according to the IM speed of the aircraft and the speed limit range of the aircraft.
[0100] The S3, judging whether to use the IM steering method according to the IM speed of the own aircraft and the speed limit interval of the own aircraft, comprises: the own aircraft receives the speed limit from the navigation database, and during the IM speed control, if the required IM speed exceeds the restricted speed interval, it is necessary to control the length of the new route of the own aircraft through IM steering, so as to meet the interval target with the target aircraft.
[0101] S4, using an iterative algorithm to calculate the length of the new route after the IM turn; whether the TTG after the turn meets the IM tolerance is used as a condition for judging whether the iteration is completed.
[0102] Specifically, in this embodiment, the length of the new route d is calculated IM . The length of the new route after turning is d IM Due to the influence of wind speed and temperature, the location of the IM turning point and the flight time on the new route cannot be found in a closed form, so an iterative process is used to determine d IM , specifically adopt Figure 5 In the iterative process, the minimum and maximum route lengths after IM turning are taken as initial values, d IM min and d IM max , these two values are the length of the new route d IM The two initial values are calculated using the following formula, where dORIG Indicates the length of the aircraft's route along the original route:
[0103] (1) In the case of route extension, the shortest and longest route lengths are 1% and 50% of the original route lengths respectively. Then:
[0104] d IM min =1.01*d ORIG d IM max =1.50*d ORIG ;
[0105] (2) In the case of shortened routes, the shortest and longest routes are 50% and 1% less than the original route lengths respectively. Then:
[0106] d IM min =0.50*d ORIG d IM max =0.99*d ORIG ;
[0107] Through the d IM min and d IM max Find the average value and get d IM The midpoint value d IM mid , for d IM mid Use the law of cosines to calculate the turning point, then generate the reference track and get the arrival ABP time TTG Omid ; Determine whether the interval after turning satisfies the IM tolerance. The present invention adopts the judgment condition shown in the following formula:
[0108]
[0109] Among them, TTG O * =TTG T +Δ indicates the time it takes to reach the destination after the aircraft has completed the specified flight interval. If the above conditions are met, then The calculation of the route length after the turn is completed; if the above conditions are not met, update d as follows IM min and d IM max :
[0110] If TTG O mid -TTG O * <0, then:
[0111] d IM min =d IM mid
[0112] If TTG O mid -TTG O * ≥0, then:
[0113] d IM max =d IM mid
[0114] Recalculate TTG with updated values Omid , until the IM tolerance is met.
[0115] S5, dividing the original route of the aircraft into sections according to the waypoint information, and determining whether a turning point exists in each section; and calculating the position of the IM turning point according to the cosine theorem and the length of the new route after the IM turning.
[0116] Specifically, in this embodiment, the IM steering algorithm is applicable to two scenarios: 1. Increasing the current flight interval, in this case, a steering method is adopted in which the aircraft deviates from the original route, turns to the IM turning point, and then turns to the interception point at the IM turning point; 2. Shortening the current flight interval, in this case, a steering method is adopted in which the aircraft remains on the original route, and then turns to the interception point at the IM turning point. Figure 6(a)-Figure 6(b) This is a use case where the aircraft shortens the flight interval through IM turning. The intercept point in the figure is defined as: the point where the aircraft executes the turning procedure and the new route intersects the original route.
[0117] like Figure 6(a)-Figure 6(b) As shown in the figure, assuming that there are multiple routes before the interception point, it is necessary to judge each route one by one, using d i represents the straight-line distance between the aircraft and the interception point on the i-th route, φ i ′ represents the angle between the aircraft route and the intercept point on the i-th route, L i Indicates the distance of the i-th route. For the first route, see the dotted triangle in Figure 6(a). According to the cosine theorem, the following formula can be used to determine whether the IM turning point is on the first route of the aircraft:
[0118] For the first route, the position of the IM turning point d IMA1 :
[0119]
[0120] If the calculated d IMA1 If the remaining distance L1 of the first route is greater than the remaining distance L2 of the first route, the IM turning point is not on the first route, and the second route is checked, as shown in the dotted triangle in Figure 6(b); at this time, the required route length becomes d IM -L1, substitute into the following formula:
[0121]
[0122] If d IMA2If it is greater than the length L2 of the second route, continue to check the third route; repeat this process until the direct route to the intercept point is obtained and determine d IMA is the IM turning point. The IM turning point is unique; when d IMA Once the IM turning point is determined, the IM turning point is also determined. Therefore, once a valid d IMA , the process of checking the IM turning point on each route is completed.
[0123] Figure 7 The simulation result diagram of the IM steering algorithm of the present invention is shown below. Assume that both the aircraft and the target aircraft fly at a speed of 250 knots, the current interval is 150NM, and the specified time interval is 40NM. From the results, it can be seen that by using the IM steering algorithm, the aircraft can reach the specified interval target before reaching the interception point.
[0124] In summary, if Figure 8 As shown, it is a schematic diagram of the overall implementation structure of the flight interval management based on PID speed regulation and iterative steering disclosed in this embodiment. The controller transmits information such as the interval target, target aircraft, ABP and PTP position to the aircraft. Based on this information, the aircraft completes the interval control through two means of IM speed control and IM steering. First, the predetermined flight path of the aircraft and the target aircraft is projected onto the horizontal route. The time difference TTG between the aircraft and the target aircraft arriving at the ABP on the horizontal route is the longitudinal interval between the two aircraft, which must meet the target value given by the controller. In order to achieve and maintain the interval target given by the controller, the integral separation PID algorithm is used to adjust the aircraft speed with the interval error. Since the adjustment of the aircraft speed must meet the operational requirements, if the speed regulation cannot achieve the interval target, the turning point is calculated and the interval target is achieved by changing the path length. The iterative algorithm is used to select the turning point, calculate the turning path, interception point, etc., control the time for the aircraft to arrive at the ABP, and achieve the purpose of controlling the flight interval.
[0125] In addition, on the other hand, this embodiment further proposes an electronic device, which includes: one or more processors, and a memory, wherein the memory is used to store one or more computer programs; it is characterized in that the computer program is configured to be executed by the one or more processors, and the program includes steps for executing the flight interval management method based on PID speed regulation and iterative steering as described above.
[0126] In addition, this embodiment also proposes a storage medium on the other hand, wherein the storage medium stores a computer program; the program is loaded and executed by a processor to implement the flight interval management method steps based on PID speed regulation and iterative steering as described above.
[0127] Those of ordinary skill in the art will appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, computer software, or a combination of the two. In order to clearly illustrate the interchangeability of hardware and software, the composition and steps of each example have been generally described in terms of function in the above description. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.
[0128] In the several embodiments provided in the present application, it should be understood that the disclosed devices and methods can be implemented in other ways. For example, the device embodiments described above are only schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. In addition, the mutual coupling or direct coupling or communication connection shown or discussed can be an indirect coupling or communication connection through some interfaces, devices or units, or it can be an electrical, mechanical or other form of connection.
[0129] The units described as separate components may or may not be physically separated. As a unit, it can be appreciated by those skilled in the art that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, computer software, or a combination of the two. In order to clearly illustrate the interchangeability of hardware and software, the composition and steps of each example have been generally described in terms of function in the above description. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.
[0130] In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above integrated unit may be implemented in the form of hardware or in the form of software functional units.
[0131] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention is essentially or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including a number of instructions for a computer device (which can be a personal computer, a server, or a grid device, etc.) to perform all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk and other media that can store program codes.
[0132] The specific implementation methods described above further illustrate the objectives, technical solutions and beneficial effects of the present invention in detail. It should be understood that the above description is only a specific implementation method of the present invention and is not intended to limit the scope of protection of the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the scope of protection of the present invention.
Claims
1. A flight interval management method based on PID speed regulation and iterative steering, characterized in that: The method comprises: S1, calculate the TTG of the own aircraft and the target aircraft according to the waypoint information and the arrival point ABP position, and obtain the predicted flight interval PSI; S2, according to the predicted flight interval PSI and the interval target Δ calculated in S1, the predicted interval error is calculated; according to the distance from the current aircraft to the arrival point ABP along the route, the error threshold is calculated; according to the magnitude relationship between the predicted interval error and the error threshold, the corresponding PID control mode is determined, and the aircraft interval management IM speed is calculated based on the PID control mode; wherein the interval target Δ is pre-set by the controller; S3, judging whether to use the IM steering method according to the IM speed of the aircraft and the speed limit range of the aircraft; S4, using an iterative algorithm to calculate the length of the new route after the IM turn; whether the TTG after the turn satisfies the IM tolerance is used as a condition for judging whether the iteration is completed; S5, dividing the original route of the aircraft into sections according to the waypoint information, and determining whether a turning point exists in each section; calculating the position of the IM turning point according to the cosine theorem and the length of the new route after the IM turning; The step S1 calculates the TTG of the own aircraft and the target aircraft according to the waypoint information and the arrival point ABP position of the own aircraft and the target aircraft to obtain the predicted flight interval PSI, including: The predicted flight interval PSI is calculated according to the following formula: PSI(t)=TTG O (t)-TTG T (t) Among them, TTG O (t) represents the time when the current position of the aircraft along the route reaches the arrival point ABP; TTG T (t) represents the time when the target aircraft's current position along the route reaches the arrival point ABP; PSI(t) represents the predicted interval between the own aircraft and the target aircraft at time t; Said S2 further comprises: At time t, the difference between the interval target Δ and the prediction interval PSI is determined to be the prediction interval error e(t), and the prediction interval error e(t) is expressed as: e(t)=Δ-PSI(t)=Δ-(TTG O (t)-TTG T (t))=(TTG T (t)+Δ)-TTG O (t) The determining of the corresponding PID control mode according to the magnitude relationship between the prediction interval error and the error threshold comprises: Set the deviation threshold ε = e threshold (s o (t)-s ABP (t))>0; Among them, s o (t) represents the current position of the aircraft along the track, and the s o (t) is negative before the planned end point; s ABP (t) represents the along-track position of the arrival point; When |e(t)|>ε, the PD control mode is adopted; when |e(t)|≤ε, the PID control mode is adopted.
2. The flight interval management method based on PID speed regulation and iterative steering according to claim 1, characterized in that: Said S2 further comprises: Set e(t) = (TTG T (t)+Δ)-TTG O The first term in (t) is used as the system input value yd(t), and the second term is used as the output value y(t), then the following expression is obtained: y d (t)=TTG T (t)+Δ y(t)=TTG O (t) e(t)=y d (t)-y(t) When |e(t)|≤ε, the PID control mode is adopted, including linearly superimposing the deviation through proportional, integral, and differential links to obtain the control quantity u(t), and the expression is as follows: The transfer function is obtained by the above formula: Among them, K P is the proportionality coefficient; K I is the integration time constant; K D is the differential time constant.
3. The flight interval management method based on PID speed regulation and iterative steering according to claim 2 is characterized in that: The step S3, judging whether to use the IM steering method according to the IM speed of the aircraft and the speed limit range of the aircraft, comprises: The aircraft receives the speed limit from the navigation database. During IM speed control, if the required IM speed exceeds the restricted speed range, the aircraft needs to control the length of its new route through IM steering to meet the interval target with the target aircraft.
4. The flight interval management method based on PID speed regulation and iterative steering according to claim 3 is characterized in that: S4, using an iterative algorithm to calculate the length of the new route after the IM turns; Whether the TTG after the turn meets the IM tolerance is used as a condition for judging whether the iteration is completed, including: In the iterative process, the minimum and maximum route lengths d after the IM is turned IMmin ,d IMmax As the initial value, d IMmin and d IMmax is the length of the new route d IM The two major boundaries of Through the d IMmin and d IMmax Find the average value and get d IM The midpoint value d IMmid , for d IMmid Use the law of cosines to calculate the turning point, then generate the reference track and get the arrival ABP time TTG Omid ; Determine whether the interval after turning meets the IM tolerance; use the following judgment conditions: Among them, TTG O * =TTG T +Δ indicates that the aircraft has achieved the specified flight interval. If the above conditions are met, then The calculation of the route length after the turn is completed; if the above conditions are not met, update d as follows IMmin and d IMmax : If TTG Omid -TTG O * <0, then: d IMmin =d IMmid If TTG Omid -TTG O * ≥0, then: d IMmax =d IMmid Recalculate TTG with updated values Omid , until the IM tolerance is met.
5. The flight interval management method based on PID speed regulation and iterative steering according to claim 4, characterized in that: The step S5, according to the waypoint information, divides the original route of the aircraft into sections, and determines whether a turning point exists in each section; and calculates the position of the IM turning point according to the cosine theorem and the length of the new route after the IM turns, including: By judging each route one by one, determine whether the IM turning point is on the corresponding segment route of the aircraft; For the first route, the position of the IM turning point d IMA1 : Among them, d i represents the straight-line distance between the aircraft and the interception point on the i-th route, φ i ′ represents the angle between the aircraft route and the intercept point on the i-th route, L i represents the distance of the i-th route; If the calculated d IMA1 If the remaining distance L1 of the first route is greater than the remaining distance L1 of the first route, the IM turning point is not on the first route, and the second route is checked. At this time, the required route length becomes d IM -L1, substitute into the following formula: If d IMA2 If it is greater than the length L2 of the second route, continue to check the third route; repeat this process until the direct route to the intercept point is obtained and determine d IMA This is the IM turning point.
6. An electronic device, comprising: One or more processors, a memory, the memory being used to store one or more computer programs; characterized in that the computer program is configured to be executed by the one or more processors, and the program includes steps for executing the flight interval management method based on PID speed regulation and iterative steering as described in any one of claims 1-5.
7. A storage medium storing a computer program; the program is loaded and executed by a processor to implement the steps of the flight interval management method based on PID speed regulation and iterative steering as described in any one of claims 1 to 5.
