Detailed Description
The core content of the invention is a navigation positioning method for urban complex environment assisted by regional three-dimensional grid multipath modeling. The flow is shown in FIG. 1. The selected sensors are a GNSS receiver (capable of receiving beidou and GNSS signals) and an IMU (Inertial Measurement Unit, IMU). A city complex environment navigation positioning method based on three-dimensional grid multipath modeling comprises the following steps:
step 1, constructing a regional three-dimensional grid model, comprising:
step 1-1, constructing a GNSS training data set, wherein the specific method comprises the following steps:
repeatedly driving in the urban complex environment, collecting the original observed quantity output by the GNSS receiver, and extracting input features from the original observed quantity as samples; the input features include: pseudorange residuals
Carrier to noise ratio
Altitude angle of satellite
And satellite azimuth
The sample is:
;
calibrating the sample with multipath error values, pseudorange error values
The expression is as follows:
wherein c is the speed of light in vacuum,
and
for the satellite and receiver clock differences,
and
the uncorrected residuals in ionospheric and tropospheric delays respectively,
errors due to multipath effects;
the influence on pseudo range error accounts for a great proportion, so the above formula is regarded as multipath error;
after calibration is completed, resolving prior position of GNSS receiver
And (3) bringing a training data set into correspondence with samples of corresponding epochs and multipath error values, and constructing to obtain the training data set, wherein the training samples are expressed as:
。
step 1-2, constructing a regional three-dimensional grid layout, wherein the specific method comprises the following steps:
according to the geographic information of the city area provided by a geographic information system, matching the position data in the training data set to the corresponding area in the city map, and taking the minimum outsourcing square of the corresponding area
A modeling area; one side of the square and the ENU coordinate system
The axes are parallel and the side length is
Rice; dividing a planar hexagonal grid on the modeling area; comprehensively setting the side length of the hexagonal grid according to the size of the modeling area and the positioning precision
(ii) a Wherein, the lower limit value of the side length of the hexagonal grid
The determination principle is as follows: ensuring that more than 80 percent of the total amount of training sample data in the grid is not less than 2000; upper limit of side length
The determination principle is as follows: guarantee
(ii) a If the upper limit value and the lower limit value of the side length are contradictory, the sampling rate is improved, and the method is important in urban complex environmentNewly acquiring GNSS data; starting from the end point along the north-south edges of the square
Taking the interval of (A) as the center point of the hexagon and recording as
, wherein
For this number of points taken on the edge,
(ii) a Then from
Starting in the east-west direction
The length of (c) takes the point, and all points are recorded as:
, wherein
The number of points on one east-west side of the square,
;
to be provided with
As the origin of coordinates, in the ENU coordinate system
Shaft and
the shaft is
Shaft and
axis, taking the origin of coordinates as the center of the hexagon and according to the selected side length of the hexagon
Fix a vertex at
Generating hexagons in each coordinate system on the axis in such a way, and carrying out dense arrangement on the whole modeling area;
densely arranging the above
The two-dimensional grid is formed by extending in the height direction
A grid column, wherein
Height of each grid column
The value of (a) is initially set to 100 meters, and is automatically updated in the subsequent steps according to the actual situation; to be provided with
For spacing, each grid column is divided into
The layer is used for modeling the GNSS signals by taking each three-dimensional grid layer as a unit;
minimum value of (2)
The determination principle is as follows: ensuring that more than 80% of the total amount of training sample data in the grid layer is not less than 500;
maximum value of
The determination principle is as follows: guarantee
(ii) a If spacing
If the maximum value and the minimum value of the GNSS data are contradictory, the sampling rate is increased, and the GNSS data are collected again in the urban environment.
1-3, carrying out random forest-based multipath error modeling one by one on grid layers, wherein the specific method comprises the following steps:
step 1-3-1, determining the grid layer to which each training sample belongs according to the three-dimensional grid layout constructed in step 1-2, wherein the specific method comprises the following steps:
the central point of the plane projection of the hexagonal grid column is
In the ENU coordinate system
Shaft and
the shafts respectively correspond to
Shaft and
axis, taking a training sample in the position
And judging whether the hexagon belongs to the hexagon:
only when both the above-mentioned expressions are satisfied, it is judged
Within the grid posts; performing the determination on each training sample of the training data set to obtain a training data set of each grid column, and updating the height of each grid column
, wherein
The maximum elevation value of the training sample in the training data set in the grid column is calculated, and the number of grid layers is updated simultaneously
(ii) a And dividing the training samples into the grid layers according to the height data of each training sample in the training data set.
Step 1-3-2, performing multipath error model training based on random forests on each grid layer, wherein the specific method comprises the following steps:
dividing the set of training samples to which each grid layer belongs into
Set of subsamples, preface
To obtain
A sub-sample set, trained to obtain
Calculating regression tree output valueMean and mean absolute error MAE; if MAE<0.05, then take the value
Value, otherwise
Repeating iteration; wherein the regression algorithm divides each sub-sample set into
In the non-overlapping areas, a prediction result is obtained for each training sample in the area, and a division method for minimizing residual square sum RSS is found out, wherein the RSS calculation method comprises the following steps:
wherein ,
are divided into non-overlapping regions,
j, the number of regions,
is a first
The label value of each of the training samples,
indicating a predicted value of the jth region; the inner layer summation is to sum the squares of the difference values of the real values and the predicted values of all the training samples in the area, and the outer layer summation is to traverse all the divided areas; the process of minimizing RSS employs a recursive bisection method: when dividing the region, carrying out feature selection and node splitting according to the following formula until the region cannot be split:
wherein ,
the dimension representing the segmentation is the value of the input data,
srepresenting a slicing point;
and
is shown in
To cut the dimension, in
sTwo regions divided for the dividing points;
the sub-sample set is branched in the above manner to obtain a regression tree model prediction rule, and the prediction result is represented by the following formula:
in the formula ,
for the prediction output of the regression tree model,
in order to input the features of the image,
;
for the regression tree model prediction function, will
The predicted outputs of the individual regression trees are averaged to obtain a predicted value of the multipath error as the output of the random forest
;
The multi-path error prediction rule is as follows:
total number of grid layers divided by all grid columns
Representing, modeling the training data of each grid layer to obtain
A multipath error model; the multipath error model accuracy is measured by the root mean square error RMSE:
wherein ,
is a first
The root mean square error of each of the multipath error models,
is a first
Personal trainingThe true value of the multipath error of the training sample,
is a first
The predicted value of the multipath error model of each training sample,
the number of training samples;
the precision parameters include: mean of root mean square errors of all grid models
And standard deviation of
The first step
Normalized processing result of root mean square error of individual grids
Specific gravity of
The calculation methods are listed as follows:
wherein ,
is as follows
The root mean square error of each of the multipath error models,
the minimum of all multipath error models root mean square errors,
the maximum of the root mean square error is modeled for all multipath errors.
1-3-3, completing the construction of a three-dimensional grid model of the region, comprising the following steps of:
and calculating to obtain the layout of the regional three-dimensional grid, the multipath error model of each grid layer, the multipath error prediction rule of the multipath error model and the precision parameters of each multipath error model.
Step 2, calling the regional three-dimensional grid model, comprising:
step 2-1, construction and traversal of a GNSS test data set, wherein the specific method comprises the following steps:
extracting a priori positions of test data from raw observations output by a user GNSS receiver
The position precision factor PDOP, the pseudo-range residual error, the carrier-to-noise ratio, the satellite altitude and the satellite azimuth form a test sample to construct a test data set
;
Traversing after the test data set is constructed, and calculating the following parameters: mean of the position accuracy factors PDOP of all test samples
And standard deviation of
First, a
Normalized processing results of PDOP of each test sample
And specific gravity
The calculation methods are listed below:
wherein ,
in order to test the number of data samples,
is as follows
The PDOP corresponding to each of the test samples,
for the minimum of all the test samples PDOP,
the maximum PDOP for all test samples.
Step 2-2, matching the prior position of each test sample to a corresponding grid layer, calling a multipath error model and judging the usability of the multipath error model, wherein the specific method comprises the following steps:
matching the test data to respective affiliated grid layers one by utilizing the existing three-dimensional grid layout, calling a multipath error model of the corresponding grid layer, and then judging the usability of the model based on the average value and the specific gravity according to the precision and the quality of the grid layer model; for data of a certain epoch, the following decisions are made:
wherein ,
is a first
The root mean square error value of the multipath error model corresponding to the grid to which the test data belongs,
the mean of the root mean square errors of all the multipath error models,
is as follows
The individual test data corresponds to the PDOP of the epoch,
the average value of all sample epochs in the test data set is PDOP; if a certain epoch data satisfies the two formulas, the corresponding multipath error model is judged to be available, the multipath error model is used for predicting the multipath error, and subsequent correction and final positioning calculation are carried out, otherwise, the judgment based on the proportion is carried out as follows:
wherein ,
is as follows
The specific gravity of the individual test data,
if the epoch test sample meets the inequality, the multipath error model is judged to be available so as to carry out multipath prediction and correction, otherwise, the multipath error model is judged to be unavailable, and modeling correction is not carried out.
And 2-3, obtaining a corrected positioning result, and completing the navigation positioning of the urban complex environment based on the three-dimensional grid multipath modeling.
The obtaining of the corrected positioning result includes:
suppose that
An observed pseudorange of one epoch of
The multipath error value predicted by the multipath error model is
And the corrected pseudo range is
Using pseudorange location principles
Instead of the former
And calculating the corrected positioning solution.
Example (b):
as shown in FIG. 1, the present invention is divided into two parts, namely, the construction of the regional three-dimensional grid and the calling of the three-dimensional grid model. By utilizing the space-time repeatability of the satellite-city integral environment, a user can call the constructed three-dimensional grid model to predict multipath errors, so that the pseudo range is corrected. The method comprises the following specific steps:
1) Constructing a three-dimensional grid model of a region
cWhich is the speed of light in a vacuum,
and
for the satellite and receiver clock-offsets,
and
uncorrectable residuals in ionospheric and tropospheric delays respectively,
errors due to multipath effects.In the above-mentioned formula, the compound has the following structure,
the influence on the pseudo range error accounts for a large proportion, so the above formula is regarded as the multipath error, and the sample is calibrated.
After calibration is completed, preprocessing is carried out on the GNSS initial training data set constructed in the steps, and the GNSS receiver resolves the prior position
And (3) bringing the GNSS training data into a training set, and corresponding to samples of corresponding epochs and multipath errors one to construct a GNSS training data set, wherein the training samples are as follows:
。
and secondly, constructing the three-dimensional grid layout of the region. The Geographic Information System (GIS) can provide Geographic Information of an urban area, match position data in the GNSS training data set to a corresponding area in the urban map, and select a minimum square capable of containing the positioning area
A region is modeled. One side of the square and the ENU coordinate system
The axes are parallel and the side length is
And (4) rice. And performing planar hexagonal grid division on the square area. Comprehensively determining the side length of the hexagonal grid according to the size of the modeling area and the required positioning precision
. In the practical application of the method, the air conditioner,
the value of (c) needs to be set manually.Lower limit value of side length of hexagonal grid
The determination principle is as follows: ensuring that more than 80 percent of the total amount of training sample data in the grid is not less than 2000; upper limit of side length
The determination principle is as follows: guarantee
. If the upper and lower limit values are contradictory, the sampling rate needs to be increased, and GNSS data is collected again for training in an urban environment. If set by person
If the value does not meet the requirement, an error is prompted, and the setting needs to be carried out again. Selecting proper side length of hexagonal grid
Due to the square shape
And an edge of ENU coordinate system
The axes are parallel, as shown in FIG. 2, starting from the end points along the north-south (side 1) of the square
Taking the interval of (A) as the center point of the hexagon and recording as
, wherein
For this number of points taken on the edge,
(ii) a Then from
Starting in the direction of the east-west side ((2) side) of the square)
The length of (d) is taken and all points are noted as:
wherein
The number of points taken on the east-west side of a square. To be provided with
As the origin of coordinates, the axes under the ENU coordinate system (east-north-sky coordinate system ENU, local Cartesian coordinates system) and
the shaft is
Shaft and
axis, taking the origin of coordinates as the center of the hexagon and according to the selected side length of the hexagon
Fix a vertex at
On the shaft, as shown in fig. 3. Generating hexagons in each coordinate system in this wayAnd (4) carrying out dense arrangement on the whole modeling area.
Densely arranging the above
The two-dimensional grid is formed by extending in the height direction
A grid column, wherein
And layering is performed. Height of each grid column
Is initially set to 100 meters and is automatically updated in subsequent steps according to actual conditions so as to
For spacing, each grid column is divided into
And the layer is used for modeling the GNSS signals by taking each three-dimensional grid layer as a unit. In the practical application of the method, the air conditioner,
the value of (b) needs to be set manually according to the actual situation and the required accuracy.
Minimum value of (2)
The determination principle is as follows: ensuring that more than 80% of the total amount of training sample data in the grid layer is not less than 500; maximum value of
The determination principle is as follows: guarantee
. If the upper and lower limit values are contradictory, the sampling rate needs to be increased, and GNSS data is collected again for training in an urban environment. If set manually
If the value does not meet the requirement, an error is prompted, and the setting needs to be carried out again.
And thirdly, modeling the multipath error based on the random forest one by one grid layer.
And determining the lattice network layer of each training sample according to the three-dimensional lattice layout constructed in the second step.
As shown in FIG. 3, the central point of the planar projection of the hexagonal grid column is
In the ENU coordinate system
Shaft and
the shafts respectively correspond to
Shaft and
axis, taking a training sample in the position
And judging whether the hexagon belongs to the hexagon:
determining only when both equations are satisfied
Within the grid columns. For the training setPerforms the determination, updates the height of each grid column after obtaining a training data set for each grid column
, wherein
The elevation maximum value of the training data in the grid column is calculated, and the number of grid layers is updated simultaneously
. And dividing the training set into the grid layers according to the height data of each sample of the training set.
As shown in fig. 4, random forest based multipath error model training is performed on a trellis layer by trellis layer basis.
The first step in model training is to divide the sample set into
Set of subsamples, preface
To obtain
A sub-sample set is obtained by training
And (4) calculating a Mean value and an average Absolute Error (MAE) of the output values of the regression tree. If MAE<0.05, then take the value at that time
Value, otherwise
And repeating the iteration. The regression algorithm divides each subsample set into a plurality of non-overlapping regions, and a division method which enables residual square sum RSS to be minimum is found, wherein the RSS calculation method comprises the following steps:
is divided into a plurality of non-overlapping areas,
is the first region, the total number of regions is J,
is as follows
The label value of each of the training samples,
indicating the prediction value of the jth region. The inner layer summation is to sum the squares of the difference values of the real values and the predicted values of all the training samples in the area, and the outer layer summation is to traverse all the divided areas. The process of minimizing RSS employs a recursive bisection method: when dividing the region, carrying out feature selection and node splitting according to the following formula until the splitting cannot be carried out:
wherein ,
representing the dimensions of the segmentation i.e. the values of the input data,
srepresenting a cut point;
and
is shown in
Is divided into cutting dimensions,
sTwo regions divided for the dividing points;
Nthe sub-sample set is branched in the above manner to obtain a regression tree model prediction rule, and the prediction result can be expressed as:
in the formula ,
in order to predict the output for the model,
in order to input the features of the image,
;
a function is predicted for the regression tree model. Each regression tree has a prediction output, will
The predicted outputs of the individual regression trees are averaged to obtain a predicted value of the multipath error as the output of the random forest
。
The multipath error prediction rule can be expressed as follows for a multipath error model prediction function of random forest training:
total number of grid layers
Representing, modeling the data set of each grid layer to obtain
A multipath error model. The multipath error model accuracy is measured by the root mean square error RMSE:
wherein
Is as follows
The root-mean-square error of the individual models,
is a first
The true value of the multipath error for each training sample,
is as follows
The multi-path error model prediction value of each training sample,
is the number of training samples. For subsequent grid availability determination, the following accuracy parameters are calculated: mean value of root mean square errors of multi-path error models of all grid layers
Sum standard deviation
First, a
Normalized processing result of root mean square error of individual grids
Specific gravity of
The calculation methods are listed as follows:
wherein ,
is as follows
The root mean square error of each of the multipath error models,
the minimum of all multipath error models root mean square errors,
the maximum of the root mean square error is modeled for all multipath errors.
And finishing the construction of the regional three-dimensional grid to obtain the layout of the regional three-dimensional grid, the multipath error prediction model of each grid layer, the multipath error prediction rule of the model and the precision parameters of each model.
2) Three-dimensional grid model invocation
Firstly, a GNSS test data set is constructed and traversed. Extracting a priori positions of test data from raw observations output by a user GNSS receiver
Position Precision factor (PDOP), pseudo-range residual error, carrier-to-noise ratio, satellite altitude and satellite azimuth as test samples to construct GNSS test data set
. Wherein the position is a priori
The method is used for grid layer matching, PDOP is used for grid usability judgment, and other data are input into a model to predict multipath errors. For subsequent grid availability judgment, traversing is performed after the data set is constructed, and the following parameters are calculated: mean of all epochs PDOP
And standard deviation of
The first step
Normalization processing result of single epoch PDOP
Specific gravity of
The calculation methods are listed as follows:
wherein
In order to test the number of data samples,
is as follows
One test sample corresponds to the PDOP of an epoch,
for the minimum of all the test samples PDOP,
the maximum PDOP for all test samples.
And secondly, matching the prior positions of the test samples to corresponding grid layers, calling the models and judging the usability of the models. And matching the test data to respective affiliated grid layers one by utilizing the existing three-dimensional grid layout, calling a multipath error prediction model of the corresponding grid layer, and then judging the usability of the model based on the average value and the specific gravity according to the precision of the grid layer model and the quality of GNSS test data. For data of a certain epoch, the following decisions are made:
is a first
The root mean square error value of the GNSS multi-path error model corresponding to the grid to which the test data belongs,
is the average of the root mean square errors of all models,
is as follows
The individual test data corresponds to the PDOP of the epoch,
is the average of all sample epops in the test data set. If a certain epoch data satisfies two formulas at the same time, the corresponding model is judged to be available, the multipath error can be predicted by the model, and subsequent correction and final positioning calculation are carried out, otherwise, the next judgment based on proportion is carried out:
wherein ,
is as follows
The specific gravity of the individual test data,
is a preset specific gravity threshold value, and is based on the precision requirement required by positioning and the specific data quality pair
Is appropriately adjusted. If the epoch test sample satisfies the inequality, the decision model is available for multi-path prediction and correction, otherwise, the decision is unavailable, and modeling correction is not performed.
And thirdly, obtaining a corrected positioning result. Suppose that
An observed pseudorange of one epoch of
The model predicted multipath error value is
And the corrected pseudo range is
Using pseudorange location principles
Instead of the former
And calculating the corrected positioning solution.
In specific implementation, the present application provides a computer storage medium and a corresponding data processing unit, where the computer storage medium is capable of storing a computer program, and the computer program, when executed by the data processing unit, may run the inventive content of the city complex environment navigation positioning method based on three-dimensional grid multi-path modeling and provided by the present invention and some or all steps in each embodiment. The storage medium may be a magnetic disk, an optical disk, a read-only memory (ROM), a Random Access Memory (RAM), or the like.
It is clear to those skilled in the art that the technical solutions in the embodiments of the present invention can be implemented by means of a computer program and its corresponding general-purpose hardware platform. Based on such understanding, the technical solutions in the embodiments of the present invention or portions thereof that contribute to the prior art may be embodied in the form of a computer program, that is, a software product, which may be stored in a storage medium and include several instructions for enabling a device (which may be a personal computer, a server, a single chip microcomputer, an MUU, or a network device) including a data processing unit to execute the method according to the embodiments or some portions of the embodiments of the present invention.
The invention provides a thought and a method of a city complex environment navigation positioning method based on three-dimensional grid multipath modeling, and a plurality of methods and ways for specifically implementing the technical scheme are provided. All the components not specified in the present embodiment can be realized by the prior art.