GPS positioning method for drift point filtering

By identifying and filtering the drift points transmitted by the serial port GPS module and calculating the distance and direction angles of adjacent GPS data points, the problems of positioning data offset and error are solved, and the accuracy of positioning and navigation and system performance are improved.

CN119001779APending Publication Date: 2024-11-22SHENZHEN FCAR TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411231344.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-04
Publication Date
2024-11-22

AI Technical Summary

Technical Problem

In the prior art, drift points often exist in the data transmitted by the serial port GPS module, which leads to offset and error of the positioning data, affecting the accuracy of positioning calculation and navigation guidance, especially in high speed states and high angle turns.

Method used

By obtaining continuous GPS data points with fixed interval time, calculate the distance and direction angle of two adjacent points. If the distance or direction angle exceeds the threshold, delete these points, retain the intermediate points, calculate the real-time speed, and transmit the accurate data to Host, providing positioning navigation information.

Benefits of technology

Effectively identify and filter drift points, improve the accuracy and reliability of positioning data, reduce errors in navigation guidance, improve system performance and efficiency, and is suitable for special vehicle conditions such as high-speed and large-angle turns.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119001779A_ABST
    Figure CN119001779A_ABST
Patent Text Reader

Abstract

The invention discloses a GPS positioning method for drift point filtering, and belongs to the technical field of GPS positioning. According to the method, the distance between two adjacent GPS data points is calculated in sequence, and if the distance is larger than the maximum threshold value DMAX, the two GPS data points serve as drift points to be deleted; otherwise, the two GPS data points are reserved; when four points (Xn, Yn), (Xn + 1, Yn + 1), (Xn + 2, Yn + 2), (Xn + 3, Yn + 3) with continuous sequence numbers exist in the reserved GPS data points, the direction angle between every two adjacent points is smaller than a threshold angle beta max, the two middle points (Xn + 1, Yn + 1) and (Xn + 2, Yn + 2) are taken as a point A and a point B respectively, and the speed between the point A and the point B is calculated; and packaging and transmitting the calculated data point position, real-time speed and time information to the host through the GPS module.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of GPS positioning technology, in particular to a drift point filtering GPS positioning method. Background Art

[0002] In the prior art, the serial port GPS module has become a common GPS positioning device. The serial port GPS module communicates with the host through the serial port and sends the received GPS satellite signal information to achieve positioning and navigation functions. However, due to abnormalities at the device level, there are often some abnormal points in the transmitted data, also known as drift points, which lead to offset and error of the positioning data, thereby affecting the accuracy of position calculation and navigation guidance.

[0003] Normally, the serial port GPS module calculates and outputs positioning information in the format of NMEA (National Marine Electronics Association). The host establishes serial communication with the serial port GPS module, reads and parses these NMEA sentences, and obtains real-time GPS data for positioning, navigation, timing and other functions. However, due to various reasons, such as environmental interference, signal attenuation or equipment failure, the serial port GPS module may transmit wrong or inaccurate data, including drift points.

[0004] Drift points can have a serious impact on the accuracy and reliability of positioning data. These abnormal points can cause offsets and errors in positioning data, leading to incorrect position calculations and navigation guidance. Therefore, before performing positioning calculations, these drift points must be identified and removed from the data to ensure the accuracy and reliability of positioning data.

[0005] At present, although there are drift point filtering methods, the commonly used drift point filtering methods are not very stable. In special vehicle conditions, such as when the vehicle turns at a large angle at high speed, the positioning data will still be abnormal and the calculated data error will be high. Therefore, a new drift point filtering GPS positioning method is needed to improve the accuracy and reliability of positioning data by identifying and deleting drift points in the data transmitted by the serial port GPS module. Summary of the invention

[0006] In order to solve the above technical problems, the present invention provides a GPS positioning method for drift point filtering, which can automatically exclude drift points in serial port GPS transmission data by analyzing and processing GPS data points, ensuring that only accurate positioning data is used for position calculation and navigation guidance, thereby greatly improving the accuracy of positioning and navigation.

[0007] In order to solve the above technical problems, the present invention provides the following technical solutions:

[0008] A GPS positioning method for drift point filtering comprises the following steps:

[0009] Get a number of continuous GPS data points with fixed intervals, calculate the distance between two adjacent GPS data points in turn, and if the distance is greater than the maximum threshold D MAX , then the two GPS data points are deleted as drift points; otherwise, the two GPS data points are retained;

[0010] When there are 4 points with consecutive serial numbers among the retained GPS data points (X n ,Y n )、(X n+1 ,Y n+1 )、(X n+2 ,Y n+2 )、(X n+3 ,Y n+3 ), calculate the direction angle β between these two adjacent points n , β n+1 and β n+2 , if the three direction angles are less than or equal to the threshold angle β max , then take the middle two points (X n+1 ,Y n+1 )、(X n+2 ,Y n+2 ) are point A and point B, where n is a natural number ≥ 1, X is the latitude value, and Y is the longitude value; if any direction angle is greater than the threshold angle β max , then discard these 4 points and return to the previous step;

[0011] Calculate the speed between points A and B, which is the real-time speed;

[0012] The calculated data point location, real-time speed, and time information are encapsulated through the GPS module and transmitted to the host, providing the host with positioning and navigation information.

[0013] In a further technical solution, the method for calculating the data point distance is as follows:

[0014] Step 1: At a fixed interval T, receive the coordinates of each GPS data point in sequence (X1, Y1), (X2, Y2), (X3, Y3), ..., (X n ,Y n )、(X n+1 ,Y n+1 ), where X is the latitude value and Y is the longitude value;

[0015] Step 2: Calculate the distance D between adjacent points in sequence. The calculation formula is:

[0016]

[0017] Step 3: If D ≥ the maximum threshold D between two points MAX , then discard the points (X1, Y1) and (X2, Y2) and calculate the distance D between the next two adjacent points; if D <D MAX , then save the points (X1, Y1) and (X2, Y2), define the distance D between (X1, Y1) and (X2, Y2) as D1, and calculate the distance D between (X2, Y2) and (X3, Y3). If D ≥ D MAX , then discard (X2, Y2) and (X3, Y3); if D <D MAX , then save (X2, Y2) and (X3, Y3), and define the distance D between (X2, Y2) and (X3, Y3) as D2; and so on until ((X n+1 ,Y n+1 ).

[0018] In a further technical solution, the direction angle β n The calculation formula is:

[0019]

[0020] β n+1 and β n+2 The calculation method of β n same.

[0021] A further technical solution is that the method for updating the maximum threshold is:

[0022] Calculate the four points with consecutive numbers (X n ,Y n )、(X n+1 ,Y n+1 )、(X n+2 ,Y n+2 )、(X n+3 ,Y n+3 ) The distance between two adjacent points is D n , D n+1 , D n+2 ;

[0023] When 2D n+1 >D n+2 >D n+1 And D n+2 >0.5D MAX hour,

[0024]

[0025] When 2D n+1 >D n+2 >D n+1 And D n+2 <0.5D MAXWhen D′ MAX =D MAX ;

[0026] When D n+2 >2D n+1 And D n+2 >0.5D MAX hour,

[0027] When D n+2 >2D n+1 And D n+2 <0.5D MAX hour,

[0028] When D n+2 <D n+1 And D n+2 >0.5D MAX When D′ MAX =D MAX ;

[0029] When D n+2 <D n+1 And D n+2 <0.5D MAX When D′ MAX =0.5D MAX;

[0030] D′ MAX is the updated maximum threshold.

[0031] According to a further technical solution, the fixed interval time T is ≥ 7 seconds.

[0032] According to a further technical solution, the host reads the NMEA sentences output by the GPS module through the serial port, parses the positioning, speed and time information, and displays them on a graphical interface or performs the next step of processing.

[0033] According to a further technical solution, the GPS module updates the positioning navigation information once a second, and the host also updates the display or processing results synchronously to achieve the purpose of real-time tracking.

[0034] According to a further technical solution, the GPS module transmits information to the host via the serial port at a frequency of 1 Hz per second.

[0035] According to a further technical solution, the encapsulation adopts a character string in the NMEA-0183 sentence format.

[0036] The GPS data point information is obtained by the GPS module receiving radio signals from various GPS satellites through the antenna, decoding and tracking these signals internally in the GPS module, and obtaining the GPS data point information.

[0037] Beneficial Effects

[0038] Compared with the prior art, the present invention has the following significant advantages:

[0039] (1) The method of the present invention can eliminate the influence of these abnormal data on positioning calculation by identifying and filtering the drift points in the serial port GPS transmission data, thereby improving the accuracy of positioning. After filtering out the drift points, only reliable positioning data is used for calculation, thereby obtaining more accurate location information.

[0040] (2) The method of the present invention can be effectively applied to data communication between a serial port GPS module and a host, and can automatically detect and filter drift points, thereby improving the accuracy of positioning calculation and navigation guidance. By eliminating drift points, the possible wrong directions and position offsets in navigation guidance are reduced, providing more reliable navigation guidance, allowing users to navigate to their destination more accurately. The method of the present invention will become an important innovation in the field of serial port GPS positioning systems, providing users with more reliable and accurate position positioning and navigation functions.

[0041] (3) The method of the present invention can improve the performance and efficiency of the system by reducing the processing and use of abnormal data. After filtering out the drift points, the system only needs to process reliable positioning data, reducing unnecessary calculations and resource consumption, and improving the response speed and efficiency of the system.

[0042] (4) In the present invention, the drift point is filtered by calculating the distance between two adjacent GPS data points. It only needs to obtain the GPS satellite signals of two adjacent position points, and there is no need to wait for more data or historical trajectory information. Therefore, it can be determined whether there is a drift point in a shorter time.

[0043] (5) The maximum threshold in the present invention can be adjusted in real time according to the change of GPS data points, which makes it possible to flexibly adjust and optimize the drift points according to the specific situation.

[0044] (6) In the present invention, the direction angles between the filtered drift points are calculated and compared with the threshold to select the data points, which can reduce the calculation error of the positioning data under special road conditions such as large angle turns at high speeds, thereby improving the positioning accuracy. BRIEF DESCRIPTION OF THE DRAWINGS

[0045] Figure 1 A schematic diagram of the drift point of the serial port GPS data of the present invention;

[0046] Figure 2 The present invention is a flow chart of a drift point filtering GPS positioning method. DETAILED DESCRIPTION

[0047] To further explain the content of the present invention, the present invention is described in detail below in conjunction with the accompanying drawings and embodiments.

[0048] Example

[0049] like Figure 1-2 As shown, a GPS positioning method for drift point filtering includes the following steps:

[0050] Get a number of continuous GPS data points with a fixed interval time T (T ≥ 7 seconds), calculate the distance between two adjacent GPS data points in turn, and if the distance is greater than the maximum threshold D MAX , then the two GPS data points are deleted as drift points; otherwise, the two GPS data points are retained;

[0051] When there are 4 points with consecutive serial numbers among the retained GPS data points (X n ,Y n )、(X n+1 ,Y n+1 )、(X n+2 ,Y n+2 )、(X n+3 ,Y n+3 ), calculate the direction angle β between these two adjacent points n , β n+1 and β n+2 , if the three direction angles are less than or equal to the threshold angle β max , then take the middle two points (X n+1 ,Y n+1 )、(X n+2 ,Y n+2 ) are point A and point B, where n is a natural number ≥ 1, X is the latitude value, and Y is the longitude value; if any direction angle is greater than the threshold angle β max , then discard these 4 points and return to the previous step;

[0052] Calculate the speed between points A and B. The calculation method is to divide the distance between points A and B by the interval time T, which is the real-time speed.

[0053] The GPS module encapsulates the calculated data point location, real-time speed, and time information into a string in the NMEA-0183 sentence format, and transmits it to the host through the serial port at a frequency of about 1Hz per second, providing the host with positioning and navigation information. This communication method and frequency ensures the stability and update of the data to meet the positioning and navigation needs in various application scenarios.

[0054] The calculation method of the data point distance is as follows:

[0055] Step 1: At a fixed interval T, receive the coordinates of each GPS data point in sequence (X1, Y1), (X2, Y2), (X3, Y3), ..., (X n ,Y n )、(X n+1 ,Y n+1 ), where X is the latitude value and Y is the longitude value;

[0056] Step 2: Calculate the distance D between adjacent points in sequence. The calculation formula is:

[0057]

[0058] Step 3: If D ≥ the maximum threshold D between two points MAX , it proves that one of the two adjacent points is abnormal, discard both points (X1, Y1) and (X2, Y2), and calculate the distance D of the next set of adjacent points; if D <D MAX , then save the points (X1, Y1) and (X2, Y2), define the distance D between (X1, Y1) and (X2, Y2) as D1, and calculate the distance D between (X2, Y2) and (X3, Y3). If D ≥ D MAX , then discard (X2, Y2) and (X3, Y3); if D <D MAX , then save (X2, Y2) and (X3, Y3), and define the distance D between (X2, Y2) and (X3, Y3) as D2; and so on to (X n+1 ,Y n+1 ).

[0059] The direction angle β n The calculation formula is:

[0060]

[0061] β n+1 and β n+2 The calculation method of β n same.

[0062] The updating method of the maximum threshold is:

[0063] Calculate the four points with consecutive numbers (X n ,Y n )、(X n+1 ,Y n+1 )、(X n+2 ,Y n+2 )、(X n+3 ,Y n+3 ) The distance between two adjacent points is D n , D n+1 , D n+2 ;

[0064] When 2D n+1 >D n+2 >D n+1 And D n+2 >0.5D MAX hour,

[0065]

[0066] When 2D n+1 >D n+2 >D n+1 And D n+2 <0.5D MAX When D′ MAX =D MAX;

[0067] When D n+2 >2D n+1 And D n+2 >0.5D MAX hour,

[0068] When D n+2 >2D n+1 And D n+2 <0.5D MAX hour,

[0069] When D n+2 <D n+1 And D n+2 >0.5D MAX When D′ MAX =D MAX ;

[0070] When D n+2 <D n+1 And D n+2 <0.5D MAX When D′ MAX =0.5D MAX;

[0071] D′ MAX is the updated maximum threshold.

[0072] The host reads the NMEA sentences output by the GPS module through the serial port, parses the positioning, speed and time information, and displays them on a graphical interface or performs the next step of processing.

[0073] The GPS module updates the positioning navigation information once a second, and the host also updates the display or processing results synchronously to achieve the purpose of real-time tracking.

[0074] The NMEA-0183 sentence adopted by the information encapsulation of the present invention is a standardized string format. The sentence is usually composed of multiple fields, each of which contains specific information, such as longitude, latitude, speed, direction, date and time, etc. These fields are separated by specific delimiters to ensure the readability and parsability of the data. The GPS module encapsulates and transmits the obtained information such as positioning, real-time speed and time so that other devices can parse and use these data.

[0075] The host device establishes a communication connection with the GPS module through the serial port. After receiving the NMEA sentence, it will use the corresponding parsing algorithm to parse the sentence. During the parsing process, the host will identify the fields containing key information such as position, speed and time, and extract this data.

[0076] By updating the positioning and navigation information every second, the GPS module can provide the latest location, speed, time and other data. After receiving these updates, the host device can immediately update the information on the display interface, allowing the user to understand the current location and navigation status in real time. At the same time, the host can also immediately use this information for subsequent processing, such as navigation guidance, track recording or other applications.

[0077] The above is a schematic description of the present invention and its implementation methods, which is not restrictive. The drawings show only one implementation method of the present invention and are not limited thereto. Therefore, if a person skilled in the art is inspired by it and designs methods and embodiments similar to the technical solution without creativity without departing from the purpose of the invention, they should all fall within the scope of protection of the present invention.

Claims

1. A GPS positioning method for drift point filtering, characterized in that: The steps include: Get a number of continuous GPS data points with fixed intervals, calculate the distance between two adjacent GPS data points in turn, and if the distance is greater than the maximum threshold D MAX , then the two GPS data points are deleted as drift points; otherwise, the two GPS data points are retained; When there are 4 points with consecutive serial numbers among the retained GPS data points (X n ,Y n )、(X n+1 ,Y n+1 )、(X n+2 ,Y n+2 )、(X n+3 ,Y n+3 ), calculate the direction angle β between these two adjacent points n , β n+1 and β n+2 , if the three direction angles are less than or equal to the threshold angle β max , then take the middle two points (X n+1 ,Y n+1 )、(X n+2 ,Y n+2 ) are point A and point B, where n is a natural number ≥ 1, X is the latitude value, and Y is the longitude value; if any direction angle is greater than the threshold angle β max , then discard these 4 points and return to the previous step; Calculate the speed between points A and B, which is the real-time speed; The calculated data point location, real-time speed, and time information are encapsulated through the GPS module and transmitted to the host, providing the host with positioning and navigation information.

2. The GPS positioning method of drift point filtering according to claim 1, characterized in that: The calculation method of the data point distance is as follows: Step 1: At a fixed interval T, receive the coordinates of each GPS data point in sequence (X1, Y1), (X2, Y2), (X3, Y3), ..., (X n ,Y n )、(X n+1 ,Y n+1 ), where X is the latitude value and Y is the longitude value; Step 2: Calculate the distance D between adjacent points in sequence. The calculation formula is: Step 3: If D ≥ the maximum threshold D between two points MAX , then discard the points (X1, Y1) and (X2, Y2) and calculate the distance D between the next two adjacent points; if D <D MAX , then save the points (X1, Y1) and (X2, Y2), define the distance D between (X1, Y1) and (X2, Y2) as D1, and calculate the distance D between (X2, Y2) and (X3, Y3). If D ≥ D MAX , then discard (X2, Y2) and (X3, Y3); if D <D MAX , then save (X2, Y2) and (X3, Y3), and define the distance D between (X2, Y2) and (X3, Y3) as D2; and so on until ((X n+1 ,Y n+1 ).

3. The GPS positioning method of drift point filtering according to claim 1, characterized in that: The direction angle β n The calculation formula is:

4. The GPS positioning method of drift point filtering according to claim 2, characterized in that: The updating method of the maximum threshold is: Calculate the four points with consecutive numbers (X n ,Y n )、(X n+1 ,Y n+1 )、(X n+2 ,Y n+2 )、(X n+3 ,Y n+3 ) The distances between two adjacent points are D n , D n+1 , D n+2 ; When 2D n+1 >D n+2 >D n+1 And D n+2 >0.5D MAX hour, When 2D n+1 >D n+2 >D n+1 And D n+2 <0.5D MAX When D′ MAX =D MAX; When D n+2 >2D n+1 And D n+2 >0.5D MAX hour, When D n+2 >2D n+1 And D n+2 <0.5D MAX hour, When D n+2 <D n+1 And D n+2 >0.5D MAX When D′ MAX =D MAX; When D n+2 <D n+1 And D n+2 <0.5D MAX When D′ MAX =0.5D MAX; D' MAX is the updated maximum threshold.

5. The GPS positioning method of drift point filtering according to claim 1, characterized in that: The fixed interval time T is ≥ 7 seconds.

6. The GPS positioning method of drift point filtering according to claim 1, characterized in that: The host reads the NMEA sentences output by the GPS module through the serial port, parses the positioning, speed and time information, and displays them on a graphical interface or performs the next step of processing.

7. The GPS positioning method of drift point filtering according to claim 1, characterized in that: The GPS module updates the positioning and navigation information once a second, and the host also updates the display or processing results synchronously.

8. The GPS positioning method of drift point filtering according to claim 1, characterized in that: The GPS module transmits information to the host through the serial port at a frequency of 1 Hz per second.

9. The GPS positioning method of drift point filtering according to claim 1, characterized in that: The encapsulation adopts a character string in the NMEA-0183 sentence format.