POS high-precision avoidance positioning method

The high-precision occlusion avoidance positioning method for POS, implemented through hardware logic devices, uses caching and filtering techniques to predict the position when satellite signals are lost, solving the positioning problem of POS system in occluded environments and achieving high-precision and continuous positioning results.

CN115685275BActive Publication Date: 2024-11-12GUILIN UNIVERSITY OF TECHNOLOGY
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202211415430.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-11-11
Publication Date
2024-11-12
Estimated Expiration
2042-11-11

AI Technical Summary

Technical Problem

Existing POS systems cannot receive satellite signals in obstructed environments, resulting in the inability to obtain accurate location information and affecting the exploration mission.

Method used

The POS high-precision occlusion avoidance positioning method implemented with hardware logic devices predicts position information when satellite signals are lost by caching GNSS positioning data, filtering and occlusion avoidance algorithms, and combining GNSS positioning unit, IMU attitude measurement unit and IoT unit, using differential correction data and filtering module to achieve high-precision positioning.

Benefits of technology

The system achieves high-precision location information acquisition in obstructed environments, with a positioning accuracy of up to 1 cm. It can operate continuously for long periods of time in harsh environments, improving the reliability and accuracy of positioning.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115685275B_ABST
    Figure CN115685275B_ABST
Patent Text Reader

Abstract

The present invention discloses a POS high-precision avoidance positioning method. It includes step 1: combining single-point positioning data and differential correction data to solve and obtain high-precision position information; step 2: implementing a buffer through the RAM of FPGA to cache the collected position information and sampling time; step 3: if the system detects that the satellite signal is lost, take out 5 position information before the moment of signal loss and 5 position information after the moment of signal reappearance from the RAM, perform filtering processing, and obtain filtered data. Step 4: Use the filtered data to construct an equation to predict the position where the signal is lost. The present invention triggers the avoidance algorithm through FPGA, improves the ability of the POS system to work in areas with weak satellite signals, and reduces the operation time to meet actual needs.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of positioning technology, and in particular to a hardware-implemented POS high-precision avoidance positioning method. Background Art

[0002] Application No. 202211106731.5: A multi-sensor fusion positioning, attitude, and speed measurement method for construction machinery. A multi-sensor fusion positioning, attitude, and speed measurement method is proposed, which can navigate and position construction machinery.

[0003] Application No. 202211024566.9 is a GNSS multi-antenna and INS tightly combined positioning and attitude determination method and device. By forming a tightly combined system with multi-antenna GNSS observation values ​​and INS, high-precision position and attitude information can be obtained.

[0004] Application No. 202010797351.5 is a coal mining machine positioning and attitude determination device and method. The attitude and odometer of the equipment are measured, the coal mining machine attitude matrix is ​​constructed, and the longitude, latitude and altitude of the coal mining machine are calculated.

[0005] Application No. 201911099403.5 is a portable inertial navigation positioning rod and its positioning and attitude determination method. It solves the problem of accuracy divergence caused by the rapid accumulation of navigation errors over time in low-cost micro-electromechanical (MEMS) inertial navigation systems (INS), and realizes accurate positioning of portable navigation positioning or mapping equipment.

[0006] Application No. 202111589804.6 discloses an indoor positioning and attitude determination method and device based on panoramic video. The panoramic image is divided according to a set rule to obtain a cylindrical fisheye image; the cylindrical fisheye image is converted into a spherical fisheye image, and positioning and attitude determination are performed based on the spherical fisheye image.

[0007] A positioning and attitude determination method and device with application number 201810792893.6. Through laser assistance and inertial navigation technology, the divergence speed of system errors is slowed down to achieve continuous laser scanning assisted inertial navigation continuous positioning.

[0008] The above POS (position and orientation system) systems do not have anti-shielding functions and the algorithms are implemented using traditional methods. When the POS system measures the position and attitude information of the mounted device, if the mounted device travels to an area with weak satellite signals, such as tall buildings, it cannot receive satellite signals, which in turn causes the operator to be unable to know the precise position of the mounted device, affecting the detection task. In order to solve the problem of position information loss of the mounted device under occlusion, the present invention proposes a POS high-precision avoidance positioning method, which can predict the positioning data at the point where the satellite signal is lost and predict the lost position information. Summary of the invention

[0009] In view of the above problems, the present invention discloses a POS high-precision avoidance positioning method, which can achieve the acquisition of high-precision position information of the carried equipment in an obstructed environment.

[0010] The design scheme of the present invention is as follows:

[0011] The POS high-precision avoidance positioning method is implemented in the system using hardware logic devices. The system is mainly composed of a central control unit, a GNSS positioning unit, an IMU attitude measurement unit, an Internet of Things unit, and a storage unit. This method is a positioning and attitude device that can obtain high-precision position and attitude information of the carried equipment in an obstructed environment and can run continuously for a long time.

[0012] The specific steps of occlusion avoidance are as follows:

[0013] 1. Calculate the data sampling delay time from the received SV message, and combine it with the receiving time of the SV message header to obtain the accurate sampling time Tsample;

[0014] 2. Arrange a RAM buffer in the FPGA to cache the sampled GNSS positioning data and the sampling time Tsample;

[0015] 3. If the system detects that the positioning information is lost, the first five points are searched from the buffer and temporarily stored in a register;

[0016] 4. When the positioning information is detected again, the register is used to store the first five position information, and the filtering algorithm is used to filter the 10 points in the register to remove noise;

[0017] 5. Use the occlusion avoidance algorithm to calculate the filtered data, calculate the fitting curve equation where the signal is lost, substitute the sampling time Tsample at the unknown point, and calculate the position information of the occlusion point.

[0018] In the POS high-precision avoidance positioning method, the sampling delay information includes: a maximum sampling delay value Tdelay, a sampling message receiving time Tarr, and the sampling time Tsample is expressed as: Tsample=Tarr-Tdelay.

[0019] In the described POS high-precision shielding avoidance positioning method, it is characterized in that the shielding avoidance algorithm can predict the moment Tshield when the position information is lost, and has a shielding avoidance function.

[0020] In the POS high-precision avoidance positioning method, the avoidance positioning method is expressed as:

[0021]

[0022] In the POS high-precision avoidance positioning method, the buffer caches the 5 latest position information and sampling times.

[0023] In the POS high-precision avoidance positioning method, the filtering module can filter the 10 points in the register to remove noise, and the filtering module is composed of a receiving data register, a ROM module, and a related operation module.

[0024] In the described POS high-precision avoidance positioning method, it is characterized in that the central control system is provided with several UART communication interfaces, which can communicate with the GPS positioning control system, attitude measurement, Internet of Things control system, storage system, etc.

[0025] In the POS high-precision avoidance positioning method, it is characterized in that in the GNSS positioning unit, the GNSS module is a full-system eight-frequency high-precision positioning and orientation module, supporting BDS B1 / B2+GPS L1 / L2+GLONASS L1 / L2+Galileo E1 / E5b satellite signals

[0026] In the described POS high-precision avoidance positioning method, it is characterized in that the GNSS module supports single-system independent positioning and multi-system joint positioning, and can realize that all visible satellites of the four systems participate in RTK solution and heading solution.

[0027] In the described POS high-precision avoidance positioning method, it is characterized in that the Internet of Things control system supports mobile 4G / 3G / 2G, Unicom 4G / 3G / 2G, and Telecom 4G / 3G / 2G access, supports TCP connection, dynamic domain name and IP address access.

[0028] In the POS high-precision avoidance positioning method, it is characterized in that the storage unit supports SD card storage and can store data.

[0029] Compared with the existing POS system, the present invention has the following significant features: (1) the differential correction data is integrated to correct the single-point positioning data to obtain high-precision positioning data, and the positioning accuracy can reach 1 cm; (2) the algorithm is implemented using hardware and hardware logic devices, the algorithm has high operating efficiency, and can predict the lost position point when the satellite signal is lost, thereby improving the system's working performance in harsh environments. BRIEF DESCRIPTION OF THE DRAWINGS

[0030] Figure 1 It is a step diagram of the present invention

[0031] Figure 2 This is a diagram showing the actual circuit connection of the present invention.

[0032] Figure 3 These are the working steps of the POS high-precision avoidance positioning method of the present invention. Specific implementation plan

[0033] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the specific implementation details of the POS high-precision avoidance positioning method are described below, and the specific design principle of the present invention is further described in detail in conjunction with the accompanying drawings.

[0034] The POS high-precision avoidance positioning method is implemented in the system using hardware logic devices. The system is mainly composed of a central control unit, a GNSS positioning control unit, an FPGA unit, an IoT control unit, and a storage unit. This method is a positioning and attitude device that can obtain high-precision position and attitude information of the carried equipment in an obstructed environment and can run continuously for a long time.

[0035] Central control unit. The central control unit is responsible for controlling the workflow of the entire system, the startup of each module, the sending of instructions, and the transmission and encryption of data. The POS high-precision avoidance positioning method uses the STM32 microcontroller as the main processing core, serial communication as the main data transmission method, and SD card as the storage medium to complete the acquisition, storage and encryption of the GNSS position information, acceleration, angular velocity and other attitude information of the device. The main control process is as follows:

[0036] Step 1: Obtain the original single-point positioning data and attitude data. Obtain the single-point positioning data through the GNSS module and obtain the attitude data through the IMU module.

[0037] Step 2: Get the differential correction data. Use the IoT module to connect to the CORS server and send the single point positioning data to the CORS server. The CORS server returns the differential correction data of the nearest base station.

[0038] Step 3: Perform differential analysis to fuse the single-point positioning data and differential correction data to obtain real-time high-precision position and attitude information;

[0039] Step 4: Once the position signal is detected to be lost, the position information of the lost location is predicted through a filtering and occlusion avoidance algorithm.

[0040] Step 5: Store and output the collected position and posture information to the serial port.

[0041] The main control chip is STM32, and the UART communication method is mainly used in the whole system to communicate with each module. The four UART communication interfaces of the chip are used, namely COM1, COM2, COM3, and COM5, to integrate the whole system.

[0042] GNSS positioning unit. The GNSS positioning control unit is mainly responsible for sending GNSS module control instructions and transmitting data streams. The GNSS positioning module supports multi-frequency RTK positioning of the entire system and can simultaneously track multiple frequencies such as BDS B1 / B2(B3)+GPS L1 / L2+GLONASS L1 / L2+Galileo E1 / E5b+QSZZ.

[0043] IMU attitude measurement unit. The IMU attitude measurement unit can measure the real-time attitude of the onboard equipment (including a three-axis gyroscope, a three-axis accelerometer, and a three-axis magnetic sensor). The IMU module can achieve 0.1° dynamic roll and pitch accuracy, 0.15° non-reference heading accuracy, and 0.3° magnetic reference heading accuracy, meeting the requirements of high-precision attitude. The attitude data frame structure consists of five parts: frame header, timestamp, data length, data, and checksum. Here, the data frame is checked and parsed in an interruption manner.

[0044] Internet of Things unit. The Internet of Things module is connected to COM2 of the central main control board. The module supports access to China Mobile 4G / 3G / 2G, China Unicom 4G / 3G / 2G, and China Telecom 4G / 3G / 2G. It supports TCP connection, dynamic domain name and IP address access, and multiple working modes: NET / HTTP / MQTT / RNDIS, so that it is very convenient to replace the SIM cards of various operators.

[0045] To obtain RTK data through the Internet of Things, you must first connect to the CORS base station. Commonly used CORS base stations are either self-built mobile stations or CORS systems. The CORS system is a basic infrastructure for surveying and mapping informatization, using RTK (Real-time kinematic) real-time dynamic carrier phase differential technology. The principle is to send the satellite data measured on the base station to the mobile GNSS receiver, and the GNSS positioning device that receives the differential signal processes it in real time to obtain the positioning location information. The connection with the CORS base station must first be connected to the Internet through the TCP / IP protocol, access the website's IP address, send the account password, and establish a connection with the CORS base station. Send the mobile device's GNSS raw data to the CORS base station, and the CORS base station will send the RTK differential data of the nearest position to the client.

[0046] The storage unit of the present invention uses the FATFS file management system as the memory management system and the SD as the storage medium. The FATFS file management system is transplanted to the central control unit, and a series of application interface functions provided to the user by the FATFS file system are called, such as f_open, f_read, f_write and f_close, etc., to realize convenient reading / writing of files.

[0047] For occlusion avoidance processing, if the GNSS satellite signal cannot be received, the 5 position information before the signal is lost and the 5 position information after the signal appears again are selected, and the position information before and after the signal is lost is filtered and pre-processed to remove the noise before the signal is lost. The occlusion avoidance algorithm is then integrated to calculate the data at the loss point to predict the lost position information.

[0048] The specific steps of occlusion avoidance are as follows:

[0049] 1. Calculate the data sampling delay time Tdelay from the received SV message, and combine it with the receiving time Tarr of the SV message header to obtain the accurate sampling time Tsample through the formula Tsample = Tarr - Tdelay;

[0050] To further illustrate, SV is sampled every 200us.

[0051] 2. Arrange a RAM buffer in the FPGA to cache the sampled GNSS positioning data and the sampling time Tarr;

[0052] 3. If the system detects that the positioning information is lost, the first five points are searched from the buffer and calculated and temporarily stored in the register;

[0053] 4. When the positioning information is detected again, the register is used to store the first five position information, and the filter module is used to filter the 10 points in the register to remove noise. The filter module is composed of a receiving data register, a ROM module, and a related operation module. The following is a detailed introduction to each module and their cooperation.

[0054] (1) Construct a receive data register 1 with a length of L1=5 to store the 5 most recently sampled data; construct a receive data register 2 with a length of L2=5 to store the 5 most recently sampled data when the signal just appears.

[0055] (2) Build a ROM module to store the matrix used in the calculation, with a depth of m = 5 and a width of 5*2;

[0056] (3) Use the multiplier adder and matrix operation module to calculate the covariance between the actual value and the predicted value of the system Among them, A is the system state transfer matrix, and Q is the process noise variance matrix.

[0057]

[0058] (4) Calculate the covariance P between the true value of the system and the optimal estimate as above k , where H is the state observation matrix.

[0059]

[0060] (5) The filter gain K of the system is calculated as above, and H is the state observation matrix

[0061]

[0062] (6) As above, we can obtain the system prior state estimate Posterior state estimate Where B is the control input matrix,

[0063]

[0064]

[0065] (7) The filtered data is obtained through the state description equation of the system, where ω k-1 is the process noise, v k is the measurement noise.

[0066] x k =A*x k-1 +B*u k +ω k-1 (6)

[0067] z k =H*x k +v k (7)

[0068] 5. Use the shielding avoidance algorithm to calculate the filtered data, take the two data P(-1) and P(0) before the signal loss, and the two data P(1) and P(2) after the signal loss, store them in the set register, use the matrix operation module to calculate the unknown parameters of the fitting curve equation of the signal loss, bring in the sampling time Tshield at the unknown point, and calculate the position information of the shielding point. Furthermore, the shielding avoidance algorithm is expressed as:

[0069]

[0070] Among them, P(-1) and P(2) are control points that satisfy the following equation, and α is a parameter between 0 and 1, indicating the degree of parallelism between the tail of the curve and the control point.

[0071] P(0)=P0

[0072] P(1)=P1

[0073] P′(0)=α(P1-P -1 )

[0074] P′(1)=α(P2-P0) (9)

[0075] The four position information data before and after the filtered occlusion are used to construct the curve between P(0) and P(1) at the occlusion. The curve equation P(t) at the occlusion is constructed, where P(-1) and P(2) are control points that satisfy the following equation. α is a parameter between 0 and 1, indicating the degree of parallelism between the tail of the curve and the control point. The appropriate value is adjusted and selected to minimize the error of the system.

[0076] The above embodiments are only used to illustrate the present invention, but not to limit the present invention. A person skilled in the art may make various changes and modifications without departing from the spirit and scope of the present invention. Therefore, all equivalent technical solutions also belong to the scope of the present invention, and the patent protection scope of the present invention shall be defined by the claims.

[0077] The technical contents not described in detail in the present invention are all known technologies.

Claims

1. The POS high-precision avoidance positioning method is characterized by: include: Step 1: Calculate the data sampling delay time from the received SV message, and combine it with the receiving time of the SV message header to obtain the accurate sampling time Tsample; Step 2: Arrange a RAM buffer in the FPGA to cache the sampled GNSS positioning data and the sampling time Tsample; Step 3: If the system detects that the positioning information is lost, the first five points are searched from the buffer and temporarily stored in a register; Step 4: When the positioning information is detected again, the register is used to store the first five position information, and the filtering algorithm is used to filter the 10 points in the register to remove noise; Step 5: Use the shielding avoidance algorithm to calculate the filtered data, calculate the fitting curve equation of the signal loss, substitute the sampling time Tshield at the unknown point, and calculate the position information of the shielding point.

2. The POS high-precision avoidance positioning method according to claim 1, characterized in that: The sampling delay information includes: a maximum sampling delay Tdelay, a sampling message receiving time Tarr, and a sampling time Tsample is expressed as: Tsample=Tarr-Tdelay.

3. The POS high-precision avoidance positioning method according to claim 1, characterized in that: The shielding avoidance algorithm can predict the moment Tshield when the position information is lost, and has a shielding avoidance function.

4. The POS high-precision avoidance positioning method according to claim 1, characterized in that: Use the shielding avoidance algorithm to calculate the filtered data, take the two data P(-1) and P(0) before the signal loss and the two data P(1) and P(2) after the signal loss, store them in the set register, use the matrix operation module to calculate the unknown parameters of the fitting curve equation caused by signal loss, bring in the sampling time Tshield at the unknown point, and calculate the position information of the shielding point. The specific calculation formula is: α is a parameter between 0 and 1 that indicates the degree of parallelism between the tail of the curve and the control point.

5. The POS high-precision avoidance positioning method according to claim 1, characterized in that: The buffer caches the 5 most recent position information and sampling times.

6. The POS high-precision avoidance positioning method according to claim 1, characterized in that: The filtering module can filter the 10 points in the register to remove noise. The filtering module is composed of a receiving data register, a ROM module, and a related operation module.

7. The POS high-precision avoidance positioning method according to claim 1, characterized in that: The GNSS positioning data is obtained by using the GNSS positioning unit. The GNSS positioning unit is an eight-frequency high-precision positioning and orientation module for the entire system, supporting BDS B1 / B2+GPS L1 / L2+GLONASS L1 / L2+Galileo E1 / E5b satellite signals.

8. The POS high-precision avoidance positioning method according to claim 1, characterized in that: The GNSS positioning unit is used to obtain GNSS positioning data. The GNSS positioning unit supports single-system independent positioning and multi-system joint positioning, and can enable all visible satellites of the four systems to participate in RTK solution and heading solution.