CN117666611B - Online track planning method based on heuristic search and pretightening method - Google Patents
Online track planning method based on heuristic search and pretightening method Download PDFInfo
- Publication number
- CN117666611B CN117666611B CN202311692641.3A CN202311692641A CN117666611B CN 117666611 B CN117666611 B CN 117666611B CN 202311692641 A CN202311692641 A CN 202311692641A CN 117666611 B CN117666611 B CN 117666611B
- Authority
- CN
- China
- Prior art keywords
- track
- aircraft
- angle
- point
- heuristic search
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Traffic Control Systems (AREA)
Abstract
An online track planning method based on heuristic search and pretightening method belongs to the technical field of aircraft control. The method comprises the steps of establishing a dimensionless dynamics model, generating a reference track based on heuristic search, tracking a track based on a pre-aiming method, generating an attack angle instruction, a roll angle instruction and a thrust instruction by an aircraft according to the current state and the reference track in the flight process, and then carrying the instructions into the dynamics model of the aircraft to calculate and obtain the online track of the aircraft. On the basis of a heuristic search and pre-aiming method, the method aims at high-constant-speed cruise constraint such as cruise flight and the like and avoids the requirements of a no-fly zone, firstly generates a reference track, then tracks the reference track to realize online track planning, effectively reduces the complexity of track planning calculation on the premise of ensuring track planning precision, has small algorithm calculation amount, solves the problems of complex calculation and large calculation amount of the traditional suction type combined power aircraft track planning method, and has good application prospect.
Description
Technical Field
The invention relates to an online track planning method based on heuristic search and pretightening method, and belongs to the technical field of aircraft control.
Background
The cruise state constraint of equal high constant speed is required to be met in the cruise process of the air suction type combined power aircraft, and meanwhile, a no-fly zone is required to be avoided. Moreover, the dynamic model of the aircraft is complex, the pneumatic interference is strong, the traditional track planning method is complex in calculation and long in time consumption.
Disclosure of Invention
In order to solve the problems in the background technology, the invention provides an online track planning method based on heuristic search and pretightening method.
The technical scheme is that the online track planning method based on heuristic search and pretightening method comprises the following steps:
S1, establishing a dimensionless dynamic model;
S2, generating a reference track based on heuristic search;
S3, tracking a track based on a pretightening method;
And S4, generating an attack angle instruction, a roll angle instruction and a thrust instruction by the aircraft according to the current state and the reference track in the flight process, then taking the instructions into a dynamics model of the aircraft, and calculating to obtain the online track of the aircraft.
Compared with the prior art, the invention has the beneficial effects that:
On the basis of a heuristic search and pre-aiming method, the method aims at high-constant-speed cruise constraint such as cruise flight and the like and avoids the requirements of a no-fly zone, firstly generates a reference track, then tracks the reference track to realize online track planning, effectively reduces the complexity of track planning calculation on the premise of ensuring track planning precision, has small algorithm calculation amount, solves the problems of complex calculation and large calculation amount of the traditional suction type combined power aircraft track planning method, and has good application prospect.
Drawings
Fig. 1 is a flow chart of the present invention.
Detailed Description
The technical solutions of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention, and it is apparent that the described embodiments are only some embodiments of the invention, but not all embodiments, and all other embodiments obtained by those skilled in the art without making creative efforts based on the embodiments of the present invention are all within the protection scope of the present invention.
An online track planning method based on heuristic search and pretightening method, the method comprises the following steps:
S1, establishing a dimensionless dynamic model;
The kinetic model is as follows:
in the formula (1):
V is the first derivative of V, and V is the flying speed of the aircraft; The first derivative of gamma, gamma is the ballistic dip;
the first derivative of psi is the heading angle of the aircraft; r is the first derivative of r, r is the earth's center distance;
A first derivative of θ, θ being longitude;
the first derivative of phi is phi, and phi is latitude;
P is thrust;
alpha is the angle of attack;
X is aerodynamic resistance;
Y is aerodynamic lift;
m is the aircraft mass;
g r' is the component of gravitational acceleration in the aircraft geocentric sagittal direction;
Gravitational components brought about by earth rotation;
Omega e is the earth rotation angular velocity;
sigma is the roll angle;
The aerodynamic lift Y and the aerodynamic drag X are respectively:
In the formula (2):
c L (α, ma) is the lift coefficient determined by the angle of attack α and mach number Ma;
C D (α, ma) is the drag coefficient determined by the angle of attack α and mach number Ma;
q is dynamic pressure;
s ref is the reference area of the aircraft.
S2, generating a reference track based on heuristic search;
Track planning refers to finding a flight path from a starting point to a target point in a given planning area, wherein the flight path meets constraint conditions, and the flight path is an ordered set of motion states of an aircraft. The constituent elements of the collection are a series of position points, and the adjacent position points are connected by straight lines to form the flight path of the aircraft.
S201, setting a track starting point as S, a track target point as G, and a track intermediate node as P 1,P2,...,Pn-1 to obtain a track node sequence { S, P 1,P2,...,Pn-1, G }, wherein the node sequence is n+1 nodes in total;
S202, setting a three-dimensional representation mode of a track starting point as S= (x 0,y0,z0), setting a three-dimensional representation mode of a track target point as G= (x n,yn,zn), setting a three-dimensional representation mode of a track intermediate node as P i=(xi,yi,zi) (i=1, 2, n-1), and recording an abscissa and an ordinate of the node and an elevation value under the coordinate of each node;
S203, because each node contains coordinate information of a three-dimensional space, the track section can be represented by an adjacent node connecting line;
The equal-altitude flight of the track section adopts two-dimensional track planning to carry out reference track design, and partial expansion nodes are cut off when the nodes are expanded in consideration of the performance constraint of the aircraft with the maximum path deflection angle, the flight directivity and the like, so that the search space is effectively reduced, the planning speed is also improved, and the size of a local reachable area from the current node to the expansion nodes of the aircraft is generally related to the search step under the condition that the maneuverability constraint of the aircraft is met. The method is characterized in that the smaller the searching step length is, the more nodes are searched, the higher the accuracy of obtaining the route is, but the time and the memory consumption are larger due to the limitation of the minimum turning radius. When (when) When the method is used, the expanded nodes are the least, the effect of clipping the search space is the best, and the method is also the most beneficial to improving the algorithm search efficiency. The calculation mode of the minimum turning radius and the maximum lane deflection angle is as follows:
In the formula (3):
R min is the minimum turning radius;
Δψ is the maximum course angle;
g is gravitational acceleration;
n max is the maximum usable normal overload of the aircraft;
l is the search step;
Considering turning angle constraint, voyage constraint and no-fly zone constraint, in the process of expanding the nodes, setting a cost function as follows:
minf(i)=τ1c1(i)+τ2c2(i)+τ3c3(i) (4)
In the formula (4):
τ 1、τ2 and τ 3 are corresponding cost weights respectively;
c 1 (i) is the turn angle constraint cost;
c 2 (i) is the voyage constraint cost;
c 3 (i) is the forbidden zone constraint cost;
the specific calculation process of the turning angle constraint cost, the range constraint cost and the no-fly zone constraint cost is as follows:
In formula (5):
is the direction vector at the ith track point;
Is the direction vector at the i-1 th track point;
Transpose the direction vector at the i-1 th track point;
For the estimated range from the ith track point (x i,yi) to the target point (x n,yn),
L k is the distance between the kth track point and the kth-1 track point;
A=yi-yi-1,B=-(xi-xi-1),C=(xi-xi-1)yi-(yi-yi-1)xi,(xi-1,yi-1) The coordinates of the ith track point are the (i-1) th track point coordinates;
(x c,yc) is the central point coordinate of the no-fly zone.
S204, connecting track segments to form a track for the aircraft to fly;
S205, whether the whole track meets the constraint condition is inspected, namely, whether the track segment or the track point meets the constraint condition is simplified.
S3, tracking a track based on a pretightening method;
S301, taking the current position P i of the aircraft as a circle center, and making a circle according to the pre-aiming distance R as a radius;
S302, two intersection points P i1 and P i2 exist between the circle and the reference track, and the intersection points are to be determined And (3) withThe sum of the included anglesAnd (3) withComparing the included angles, wherein P i-1 is the point of the previous position of the aircraft, and a small-angle point is selected as a pre-aiming point due to the performance limitation of the aircraft;
S303, respectively generating a longitudinal overload control instruction n yc2 and a transverse overload control instruction n zc2 under a trajectory system by taking the current position P i of the aircraft as a starting point and a pre-aiming point as an end point and adopting a proportional guidance mode as follows:
In the formula (7):
Is the high and low angular rate of the sight line;
is the azimuth rate of line of sight;
k y is the longitudinal overload scaling factor;
k g is a gravity compensation coefficient;
k z is the transverse overload scaling factor.
And further performing clipping processing on the overload instruction:
And:
nxc2=(Pcosα-X)/mg (10)
the ballistic down-load is transferred to the position system by coordinate transformation:
in the formula (11):
n xc1、nyc1 and n zc1 are components of the overload in the directions of three coordinate axes under the position system respectively;
n xc2 is the component of the overload in the x-axis direction under ballistic system;
is a transformation matrix of trajectory system to position system,
And S4, after the algorithm design is completed, generating an attack angle instruction, a roll angle instruction and a thrust instruction by the aircraft according to the current state and a reference track in the flight process, bringing the instructions into a dynamics model of the aircraft, and carrying out track calculation by a Longku tower numerical integration method to obtain an online track of the aircraft so as to carry out subsequent flight.
The calculation formulas of the attack angle, the roll angle and the thrust command are as follows:
It will be evident to those skilled in the art that the invention is not limited to the details of the foregoing illustrative embodiments, and that the present invention may be embodied in other specific forms without departing from the spirit or essential characteristics thereof. The present embodiments are, therefore, to be considered in all respects as illustrative and not restrictive, the scope of the invention being indicated by the appended claims rather than by the foregoing description, and all changes which come within the meaning and range of equivalency of the claims are therefore intended to be embraced therein. Any reference sign in a claim should not be construed as limiting the claim concerned.
Furthermore, it should be understood that although the present disclosure describes embodiments, not every embodiment is provided with a separate embodiment, and that this description is provided for clarity only, and that the disclosure is not limited to the embodiments described in detail below, and that the embodiments described in the examples may be combined as appropriate to form other embodiments that will be apparent to those skilled in the art.
Claims (5)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311692641.3A CN117666611B (en) | 2023-12-11 | 2023-12-11 | Online track planning method based on heuristic search and pretightening method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311692641.3A CN117666611B (en) | 2023-12-11 | 2023-12-11 | Online track planning method based on heuristic search and pretightening method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN117666611A CN117666611A (en) | 2024-03-08 |
| CN117666611B true CN117666611B (en) | 2025-05-06 |
Family
ID=90080531
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202311692641.3A Active CN117666611B (en) | 2023-12-11 | 2023-12-11 | Online track planning method based on heuristic search and pretightening method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN117666611B (en) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113093790A (en) * | 2021-03-22 | 2021-07-09 | 北京航空航天大学 | Analytical model-based aircraft reentry glide trajectory planning method |
| CN114779785A (en) * | 2022-05-06 | 2022-07-22 | 浙江工业大学 | A smooth trajectory planning method for mobile robots based on PSO parameter tuning |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US10019006B2 (en) * | 2015-04-08 | 2018-07-10 | University Of Maryland, College Park | Surface vehicle trajectory planning systems, devices, and methods |
| CN107702716B (en) * | 2017-08-31 | 2021-04-13 | 广州小鹏汽车科技有限公司 | Unmanned driving path planning method, system and device |
| CN109703769B (en) * | 2018-01-19 | 2020-05-26 | 北京航空航天大学 | An aerial refueling docking control method based on preview strategy |
| CN113204236B (en) * | 2021-04-14 | 2022-05-20 | 华中科技大学 | Intelligent agent path tracking control method |
| CN115525063B (en) * | 2022-08-12 | 2025-05-27 | 南京航空航天大学 | Trajectory planning method for unmanned helicopters |
-
2023
- 2023-12-11 CN CN202311692641.3A patent/CN117666611B/en active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113093790A (en) * | 2021-03-22 | 2021-07-09 | 北京航空航天大学 | Analytical model-based aircraft reentry glide trajectory planning method |
| CN114779785A (en) * | 2022-05-06 | 2022-07-22 | 浙江工业大学 | A smooth trajectory planning method for mobile robots based on PSO parameter tuning |
Non-Patent Citations (1)
| Title |
|---|
| 一种无人机分层三维航迹规划方法;刘鑫;朱荣刚;刘敏;马冬前;;科学技术与工程;20121218(第35期);9788-9792、9799 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN117666611A (en) | 2024-03-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN103838914B (en) | Analytical algorithm method of gliding section trajectory of hypersonic aerocraft | |
| CN104392047B (en) | Quick trajectory programming method based on smooth glide trajectory analytic solution | |
| CN104778376B (en) | Method for predicting jumping trajectory of hypersonic gliding warhead in near space | |
| CN113093790B (en) | Analytical model-based aircraft reentry glide trajectory planning method | |
| CN114578824B (en) | Unknown environment autonomous exploration method suitable for air-ground dual-purpose robot | |
| CN104536442B (en) | Underwater vehicle path planning method based on dynamic planning | |
| CN115328208A (en) | Unmanned aerial vehicle path planning method for realizing global dynamic path planning | |
| Luo et al. | Trajectory planning of stratospheric airship for station-keeping mission based on improved rapidly exploring random tree | |
| CN116560403A (en) | Intelligent time-coordinated guidance method, system and equipment for multiple hypersonic vehicles | |
| CN111650837A (en) | A fault-tolerant control method with second-order preset performance for trajectory tracking of surface ships when thrusters fail | |
| CN105138808B (en) | Glide trajectories error propagation analysis method based on perturbation theory | |
| CN112629339A (en) | Rocket soft landing trajectory planning method based on direct method | |
| CN119984306A (en) | Path planning method integrating improved A* algorithm and DWA algorithm | |
| CN115686036A (en) | Variable-profile aircraft multi-dimensional composite control method based on preset performance | |
| CN119270877A (en) | Path tracking control method for unmanned ship based on improved LOS guidance law and backstepping method | |
| CN118753503A (en) | Launch and guidance system based on multi-faceted lateral vector propulsion | |
| CN111488646A (en) | Analytic solving method for hypersonic steady gliding trajectory under rotating earth | |
| CN113900448A (en) | A composite guidance method for aircraft prediction and correction based on sliding mode interference observer | |
| CN117666611B (en) | Online track planning method based on heuristic search and pretightening method | |
| CN111006694A (en) | Design method of trajectory generator for long-endurance inertial navigation system based on track planning | |
| CN119984266B (en) | Navigation planning methods for wheeled robots in non-flat environments | |
| CN118915760B (en) | Unmanned ship navigation track planning method, unmanned ship navigation track planning device, unmanned ship navigation track planning equipment and unmanned ship navigation track planning medium | |
| CN105799949B (en) | A kind of pressure heart design method, attitude control method and the system of Asia orbiter | |
| CN115542746B (en) | Energy management and control reentry guidance method and device for hypersonic vehicle | |
| CN109445283B (en) | Control method for fixed-point tracking of under-actuated aerostat on plane |
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 |