Transverse lateral curve flight-path tracking method based on curvature compensation

Abstract

The invention discloses a transverse lateral curve flight-path tracking method based on curvature compensation and belongs to the technical field of flight-path tracking control. The transverse lateral curve flight-path tracking method based on curvature compensation comprises the following steps of: obtaining discrete flight-route point data of a reference flight path by a flight-path planning module; carrying out piecewise interpolation fitting processing on the obtained discrete flight-path point data by a Lagrange piecewise polynomial interpolation method to obtain a curve flight path; calculating the lateral offset distance of an unmanned plane at the present moment, and calculating a curvature value of a point, closest to the plane, on the reference flight path by referencing the coordinates of the point, closest to the plane, on the reference flight path; and completing the whole curve flight-path tracking process by using the obtained lateral offset distance and the curvature value as input variables of a transverse lateral controller of the unmanned plane. According to the transverse lateral curve flight-path tracking method disclosed by the invention, the curve interpolation fitting processing is carried out on the reference flight path, so that the transitional section of the flight path points in the tracking process is smoother and the tracking errors are smaller, therefore, the flight path can be tracked better.

Description

technical field [0001] The invention relates to an aircraft track tracking control method, which belongs to the technical field of track tracking control, and specifically refers to a curvature compensation-based lateral curve track tracking method. Background technique [0002] UAV, also known as unmanned aircraft or remote piloted aircraft, is a non-manned aircraft controlled by radio remote control equipment or pre-programmed. It has many advantages that manned aircraft do not have, and can perform various operations. It has broad military application prospects. [0003] With the continuous expansion of the application field of UAVs, the flight requirements of UAVs are becoming more and more stringent, and accurate and fast tracking of the predetermined trajectory is one of them. The track tracking control of the UAV is mainly realized through the flight control system of the UAV. In this way, how to adjust the flight control system of the UAV to enable the UAV to track...

AI Technical Summary

Problems solved by technology

[0006] Since the tracking track of the drone is a broken line, there will be a large tracking error during the tracking process; especially when the track points are dense, it will cause the drone to be unable to track the planned track

Images