A dual-base station UWB / INS combination method for personnel positioning in dense forest environment

By adopting the dual-base station UWB/INS combination method in a jungle environment, using the space-space and earth collaborative positioning system and inertial navigation IMU, the problem of difficulty in positioning in the jungle is solved, and high-precision and reliable positioning technology is achieved.

CN115711619BActive Publication Date: 2024-11-19THE 54TH RESEARCH INSTITUTE OF CHINA ELECTRONICS TECHNOLOGY GROUP CORPORATION
View PDF 0 Cites 0 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

Traditional satellite navigation is difficult to achieve high-precision positioning in a dense forest environment. Due to forest shading and signal interference, existing UWB positioning technology is difficult to promote and apply in a dense forest environment.

Method used

The dual-base station UWB/INS combination method is adopted to carry satellite navigation and UWB base stations through drones and vehicles, combined with inertial navigation IMU, a coordinated positioning system is established, and a TWR two-way ranging and track calculation is used to perform global optimization positioning.

Benefits of technology

It realizes absolute positioning of personnel in a dense forest environment, provides reliable high-precision positioning technology, and is suitable for shaded environments such as mountain forests.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115711619B_ABST
    Figure CN115711619B_ABST
Patent Text Reader

Abstract

The present invention discloses a method for positioning personnel in a dense forest environment using a dual-base station UWB / INS combination, and belongs to the field of navigation positioning and information fusion application technology. The present invention utilizes an air-ground-space collaborative positioning system composed of an unmanned aerial vehicle, a vehicle, and personnel entering a dense forest. The unmanned aerial vehicle and the vehicle obtain satellite observations through a GNSS receiver to obtain an absolute positioning result, and the UWB base station and the UWB tag of the personnel entering the dense forest are used to achieve ranging. The dense forest personnel are also equipped with an inertial navigation IMU to achieve personnel track dead reckoning, achieve dense forest personnel positioning analysis, and globally optimize the IMU / UWB state update model. The method of the present invention is simple and easy to implement, and can provide location information guarantee for personnel in a mountainous dense forest environment.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a double-base station UWB / INS combined personnel positioning method in a dense forest environment, belonging to the technical field of navigation positioning and information fusion application. Background Art

[0002] With the establishment of the Beidou navigation system, high-precision positioning services are gradually moving towards more ubiquitous environments and scenarios. However, due to the impact of forest cover on satellite navigation signals, traditional satellite navigation equipment is difficult to obtain effective positioning capabilities. Real-time, continuous, accurate and seamless high-precision navigation and positioning is an important basis for ensuring the safe movement and operation of forest firefighting, forest police, forest rangers, etc. Therefore, high-precision positioning in dense forest environments is a major problem that needs to be solved urgently. In view of the interference of satellite navigation signals, the fragile performance is insufficient, the visual feature tracking is limited by the large scale, lighting and other forest environments, the laser radar scene recognition ability is poor, it is difficult to close the loop global correction, and the low-cost inertial navigation accumulates errors and drifts over time. At this stage, the UWB positioning method with strong penetration is an effective means to solve the problem of high-precision navigation and positioning in dense forest environments.

[0003] At present, although the known UWB positioning technology has achieved certain results, its actual application is limited to structured environments such as indoors, industrial parks, and underground corridors. The optimization of positioning results depends on the density and calibration of UWB base stations, and the technology is difficult to apply and promote in dense forest environments. There is an urgent need to develop research on effective UWB positioning technology for dense forest environments, but there is no relevant application in existing technologies. Summary of the invention

[0004] In view of this, the present invention proposes a dual-base station UWB / INS combined personnel positioning method in a dense forest environment, which breaks through the limitations of traditional satellite navigation shielding environments and achieves absolute positioning in a dense forest environment.

[0005] In order to achieve the above object, the technical solution adopted by the present invention is:

[0006] A dual-base station UWB / INS combined personnel positioning method in a dense forest environment comprises the following steps:

[0007] (1) Establish a benchmark and system for air-ground collaborative positioning in a dense forest environment, including an unmanned aerial vehicle platform, a vehicle platform, and personnel entering the dense forest. Both the unmanned aerial vehicle platform and the vehicle platform are equipped with satellite navigation and UWB base stations. The unmanned aerial vehicle platform flies over the dense forest, the vehicle platform is at the edge of the forest area, and the personnel entering the dense forest are equipped with inertial navigation IMU and UWB tags. The personnel entering the dense forest use the UWB tags to perform TWR two-way ranging with the UWB base station of the unmanned aerial vehicle platform and the UWB base station of the vehicle platform, respectively, and establish analytical equations to obtain the positions of the personnel in the dense forest at different times.

[0008] (2) People entering the dense forest use the inertial navigation IMU to perform dead reckoning to obtain their position changes at different times;

[0009] (3) The position change obtained by TWR two-way ranging is used as the observation value, and the position change obtained by inertial navigation IMU track calculation is used as the state value. An error equation is established, with the observation value as the edge and the state value as the point. Graph optimization is used for global constraints to obtain the accurate position of the person in the dense forest.

[0010] Furthermore, in step (1), the person entering the dense forest uses the UWB tag to perform TWR two-way ranging with the UWB base station of the drone platform and the UWB base station of the vehicle platform, respectively, and establishes an analytical equation. The specific process is as follows:

[0011] The vehicle platform obtains the current absolute position L0 (b0, l0, h0) through satellite navigation and defines it as the base local coordinate origin L0 (0, 0, 0) of the air-ground collaborative positioning system; the UAV platform obtains the current absolute position L1 (b1, l1, h1) through satellite navigation and calculates the base local coordinate L1 (x1, y1, z1) of the UAV in the air-ground collaborative positioning system:

[0012] x1=(b1-b0)λ b

[0013] y1=(l1-l0)λ l

[0014] z1=(h1-h0)

[0015] In the formula, λ b ,λ l They represent the coefficients for converting the latitude and longitude measurements of the geodetic coordinate system into the spatial rectangular coordinate system;

[0016] People entering the dense forest use UWB tags to perform TWR two-way ranging with the UWB base station on the drone platform and the UWB base station on the vehicle platform, and establish the following analytical equation:

[0017]

[0018]

[0019]

[0020]

[0021] In the formula, W0(x 0 ,y 0 ,z 0 ) is the position of the person in the dense forest at time t0, is the distance between the person in the dense forest and the UWB base station on the vehicle platform at time t0, is the distance between the person in the dense forest and the UWB base station of the UAV platform at time t0; W1(x 1 ,y 1 ,z 1 ) is the position of the person in the dense forest at time t1, is the distance between the person in the dense forest and the UWB base station on the vehicle platform at time t1, It is the distance between the personnel in the dense forest and the UWB base station of the UAV platform at time t1.

[0022] Furthermore, the specific process of step (2) is as follows:

[0023] The jungle personnel use the inertial navigation IMU to perform dead reckoning and estimate the motion speed v t+Δt 、Position t+Δt and rotation q t+Δt ;

[0024]

[0025]

[0026]

[0027] In the formula, a t ,ω t They are the IMU raw acceleration and angular velocity measurements at time t respectively; are acceleration measurement bias and random white noise, are the angular velocity measurement deviation and random white noise respectively; g is the gravitational acceleration of the world coordinate system W, is the rotation from the inertial body coordinate system to the world coordinate system;

[0028] The position change of the person in the dense forest from time t0 to time t1 is obtained through the track calculation results as Δr(Δx, Δy, Δz).

[0029] Compared with the prior art, the present invention has the following beneficial effects:

[0030] 1. The present invention utilizes an air-ground-space collaborative positioning system consisting of drones, vehicles and people entering dense forests, and uses the strong penetration of UWB to achieve the transmission of the absolute position of people in dense forest environments, and performs global optimization based on the IMU / UWB fusion state update model of dense forest people.

[0031] 2. The present invention can achieve reliable positioning in dense forest environments.

[0032] 3. The method of the present invention is simple and easy to implement, and can provide positioning technology guarantee for workers in sheltered environments such as mountainous and dense forests. BRIEF DESCRIPTION OF THE DRAWINGS

[0033] Figure 1 A schematic diagram of the principle of the method according to an embodiment of the present invention. DETAILED DESCRIPTION

[0034] In order to better illustrate the purpose and advantages of the present invention, the technical solution of the present invention is further described below.

[0035] A dual-base station UWB / INS combined personnel positioning method in a dense forest environment, the equipment required for this method includes a drone, a vehicle, a GNSS receiver, an inertial navigation IMU, and a long-distance UWB. Figure 1 As shown, UAVs and vehicles obtain satellite observations through GNSS receivers to obtain absolute positioning results, and achieve ranging through UWB base stations and UWB tags of people entering the dense forest. The people in the dense forest are also equipped with inertial navigation IMUs to realize the people's track calculation and achieve positioning analysis of people in the dense forest.

[0036] The method specifically comprises the following steps:

[0037] (1) Establish a UWB / INS combined collaborative positioning benchmark and system for air-ground dual-base stations in a dense forest environment; the specific process is as follows:

[0038] Establish the air-ground-air collaborative positioning benchmark and system in the dense forest environment, define the UAV platform U, define the vehicle platform V, and define the people entering the dense forest as W. Among them, the UAV is equipped with satellite navigation and UWB base stations and flies over the dense forest. The vehicle platform is equipped with satellite navigation and UWB base stations at the edge of the forest area. People entering the dense forest are equipped with inertial navigation IMU and UWB tags.

[0039] The vehicle platform obtains the current absolute position L0 (b0, l0, h0) through satellite navigation and defines it as the base local coordinate origin L0 (0, 0, 0) of the air-ground collaborative positioning system; the UAV platform obtains the current absolute position L1 (b1, l1, h1) through satellite navigation and defines the base local coordinate L1 (x1, y1, z1) of the UAV in the air-ground collaborative positioning system, where:

[0040] x1=(b1-b0)λ b

[0041] y1=(l1-l0)λ l

[0042] z1=(h1-h0)

[0043] In the formula, λ b ,λ l They represent the coefficients for converting the latitude and longitude measurements of the geodetic coordinate system into the spatial rectangular coordinate system;

[0044] The person who enters the dense forest uses the UWB tag to perform TWR (Two Way Ranging) two-way ranging with the UWB base station of the drone platform and the UWB base station of the vehicle platform. Assume that the position of the person in the dense forest at time t0 is W0(x 0 ,y 0 ,z 0 ), and the ranging distance with the UWB base station on the vehicle is The distance between the drone and the UWB base station is The following analytical equation can be established:

[0045]

[0046]

[0047] Similarly, assuming that the position of the person in the dense forest at time t1 is W1(x 1 ,y 1 ,z 1 ), and the ranging distance with the UWB base station on the vehicle is The distance between the drone and the UWB base station is Create the analytical equation:

[0048]

[0049]

[0050] Get the location of people in the dense forest at different times.

[0051] (2) People who enter the dense forest use the inertial navigation IMU to perform dead reckoning to obtain the position changes of people in the dense forest at different times; the specific implementation method is:

[0052] The jungle personnel use the inertial navigation IMU to calculate the trajectory, and the motion state speed v t+Δt 、Position t+Δt and rotation q t+Δt The estimation model is:

[0053]

[0054]

[0055]

[0056] In the formula, a t ,ω t They are the IMU raw acceleration and angular velocity measurements at time t respectively; are acceleration measurement bias and random white noise, are the angular velocity measurement deviation and random white noise respectively; g is the gravitational acceleration of the world coordinate system W, is the rotation from the inertial body coordinate system to the world coordinate system;

[0057] The position change of the person in the dense forest from time t0 to time t1 is obtained through the above track calculation results as Δr(Δx, Δy, Δz).

[0058] (3) The position change obtained by TWR two-way ranging is used as the observation value, and the position change obtained by inertial navigation IMU track calculation is used as the state value. An error equation is established, with the observation value as the edge and the state value as the point. Graph optimization is used for global constraints to obtain the accurate position of the person in the dense forest.

[0059] Ideally, the UWB position change and IMU position change results should be consistent from time t0 to time t1. The system measurement error is defined as δ(δx, δy, δz). The UWB position change is used as the observation value, and the IMU position change is used as the state value. The observation equation is: Z = h(Δr), and the error equation is: δ = Zh(Δr), that is:

[0060]

[0061] The observation equation for continuous positioning of personnel in dense forests satisfies: Z = h(Δr1, Δr2, Δr3, ...), where observation values ​​are defined as edges and state values ​​are defined as points, and graph optimization is used for global constraints.

Claims

1. A dual-base station UWB / INS combined personnel positioning method in a dense forest environment, characterized in that: The steps include: (1) Establish a benchmark and system for air-ground collaborative positioning in a dense forest environment, including an unmanned aerial vehicle platform, a vehicle platform, and personnel entering the dense forest. Both the unmanned aerial vehicle platform and the vehicle platform are equipped with satellite navigation and UWB base stations. The unmanned aerial vehicle platform flies over the dense forest, the vehicle platform is at the edge of the forest area, and the personnel entering the dense forest are equipped with inertial navigation IMU and UWB tags. The personnel entering the dense forest use the UWB tags to perform TWR two-way ranging with the UWB base station of the unmanned aerial vehicle platform and the UWB base station of the vehicle platform, respectively, and establish analytical equations to obtain the positions of the personnel in the dense forest at different times. (2) People entering the dense forest use the inertial navigation IMU to perform dead reckoning to obtain their position changes at different times; (3) The position change obtained by TWR two-way ranging is used as the observation value, and the position change obtained by inertial navigation IMU track calculation is used as the state value. The error equation is established, and the observation value is regarded as the edge and the state value is regarded as the point. Graph optimization is used for global constraints to obtain the accurate position of the person in the dense forest. Among them, in step (1), the person entering the dense forest uses the UWB tag to perform TWR two-way ranging with the UWB base station of the drone platform and the UWB base station of the vehicle platform respectively, and establishes an analytical equation. The specific process is as follows: The vehicle platform obtains the current absolute position L0 (b0, l0, h0) through satellite navigation and defines it as the base local coordinate origin L0 (0, 0, 0) of the air-ground collaborative positioning system; the UAV platform obtains the current absolute position L1 (b1, l1, h1) through satellite navigation and calculates the base local coordinate L1 (x1, y1, z1) of the UAV in the air-ground collaborative positioning system: x1=(b1-b0)λ b y1=(l1-l0)λ l z1=(h1-h0) In the formula, λ b ,λ l They represent the coefficients for converting the latitude and longitude measurements of the geodetic coordinate system into the spatial rectangular coordinate system; People entering the dense forest use UWB tags to perform TWR two-way ranging with the UWB base station on the drone platform and the UWB base station on the vehicle platform, and establish the following analytical equation: In the formula, W0(x 0 ,y 0 ,z 0 ) is the position of the person in the dense forest at time t0, is the distance between the person in the dense forest and the UWB base station on the vehicle platform at time t0, is the distance between the person in the dense forest and the UWB base station of the UAV platform at time t0; W1(x 1 ,y 1 ,z 1 ) is the position of the person in the dense forest at time t1, is the distance between the person in the dense forest and the UWB base station on the vehicle platform at time t1, It is the distance between the personnel in the dense forest and the UWB base station of the UAV platform at time t1.

2. According to claim 1, a dual-base station UWB / INS combined dense forest environment personnel positioning method is characterized in that: The specific process of step (2) is as follows: The jungle personnel use the inertial navigation IMU to perform dead reckoning and estimate the motion speed v t+Δt 、Position t+Δt and rotation q t+Δt ; In the formula, a t ,ω t They are the IMU raw acceleration and angular velocity measurements at time t respectively; are acceleration measurement bias and random white noise, are the angular velocity measurement deviation and random white noise respectively; g is the gravitational acceleration of the world coordinate system W, is the rotation from the inertial body coordinate system to the world coordinate system; The position change of the person in the dense forest from time t0 to time t1 is obtained through the track calculation results as Δr(Δx, Δy, Δz).