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.
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
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.
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.
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.
Smart Images

Figure CN115711619B_ABST
Abstract
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).
