CN113252048A - Navigation positioning method, navigation positioning system and computer readable storage medium - Google Patents

Navigation positioning method, navigation positioning system and computer readable storage medium Download PDF

Info

Publication number
CN113252048A
CN113252048A CN202110515730.5A CN202110515730A CN113252048A CN 113252048 A CN113252048 A CN 113252048A CN 202110515730 A CN202110515730 A CN 202110515730A CN 113252048 A CN113252048 A CN 113252048A
Authority
CN
China
Prior art keywords
information
navigation
speed
position information
inertial navigation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110515730.5A
Other languages
Chinese (zh)
Other versions
CN113252048B (en
Inventor
王振飞
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Gaoxing Wulian Technology Co ltd
Original Assignee
Gaoxing Wulian Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Gaoxing Wulian Technology Co ltd filed Critical Gaoxing Wulian Technology Co ltd
Priority to CN202110515730.5A priority Critical patent/CN113252048B/en
Publication of CN113252048A publication Critical patent/CN113252048A/en
Application granted granted Critical
Publication of CN113252048B publication Critical patent/CN113252048B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance
    • G01C21/3407—Route searching; Route guidance specially adapted for specific applications
    • G01C21/343—Calculating itineraries, i.e. routes leading from a starting point to a series of categorical destinations using a global route restraint, round trips, touristic trips
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance
    • G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Abstract

The invention provides a navigation positioning method, a navigation positioning system and a computer readable storage medium, and belongs to the technical field of vehicle-mounted navigation positioning of internet of vehicles. The method comprises the steps of utilizing information sensed by an inertial sensor to complete inertial navigation information calculation; calculating speed and position information by using mileage speed acquired by a mileage meter or an OBD through the attitude information calculated by the inertial sensor; based on the position information calculated by inertial navigation and the position information calculated by OBD vehicle speed, a Kalman filter is adopted to realize navigation information fusion processing; and performing feedback compensation on the inertial navigation output information according to a processing result of Kalman filtering to obtain optimal position information. According to the method and the device, the integration of relevant information is realized through the inertial sensor and the speed information provided according to the vehicle-mounted OBD interface and by combining the Kalman filtering technology, so that stable, reliable and continuous navigation positioning information can be provided for the vehicle, and the use experience of a user is improved.

Description

Navigation positioning method, navigation positioning system and computer readable storage medium
Technical Field
The invention relates to the technical field of vehicle-mounted navigation and positioning of Internet of vehicles, in particular to a navigation and positioning method, a navigation and positioning system and a computer readable storage medium.
Background
With the continuous development of the car networking technology, the requirements for the positioning and navigation services of the vehicle are higher and higher. Inertial navigation is an autonomous navigation technology that does not depend on external information or radiates energy to the outside, and is capable of outputting comprehensive navigation information, and is becoming more and more popular in this field. However, the error of the navigation system implemented by the inertial navigation technology increases with the increase of time, and the navigation system cannot provide accurate, reliable and continuous navigation positioning information for the vehicle with the increase of time, so that controlling the error accumulation becomes a key technical problem to be solved by the application of the inertial navigation technology.
In view of the problem of control error accumulation existing in inertial navigation, some internet of vehicles also adopt GPS navigation, which is a system for guiding users to drive according to position information provided by GPS and a planned route before navigation, but it is known that GPS calculates its position by receiving signals sent by satellites, and when the top of GPS equipment such as a terminal is blocked, the GPS equipment cannot position. Therefore, under the condition that the GPS signal is weak or invalid, accurate, reliable and continuous navigation positioning information cannot be provided for the vehicle.
Therefore, the existing navigation positioning methods can not provide accurate, reliable and continuous navigation positioning information for the vehicle.
Disclosure of Invention
In view of the above, the present invention provides a navigation positioning method, a positioning system and a computer readable storage medium, which are used to solve the problem that in the prior art, under the condition of a signal blind area or weak signal, the positioning information output by a GPS is inaccurate or even invalid, which seriously affects the monitoring of a vehicle track and cannot provide stable, reliable and continuous navigation positioning information for a vehicle.
The technical scheme adopted by the invention for solving the technical problems is as follows:
the first aspect of the present invention further provides a navigation positioning method, including the following steps:
completing inertial navigation information calculation by using information sensed by an inertial sensor to acquire position information;
calculating speed and position information by using mileage speed acquired by a mileage meter or an OBD through the attitude information calculated by the inertial sensor;
based on the position information calculated by inertial navigation and the position information calculated by OBD vehicle speed, a Kalman filter is adopted to realize navigation information fusion processing, and optimal position information and sensor error estimation are obtained;
and performing feedback compensation on the inertial navigation output information according to a processing result of Kalman filtering to obtain optimal position information.
In some embodiments, said performing inertial navigation information calculations using information sensed by inertial sensors to obtain position information comprises:
after the vehicle is started, acquiring horizontal acceleration data of the vehicle within a period of time through an accelerometer, and calculating a roll angle and a pitch angle by using the horizontal acceleration data as horizontal initial attitude information of inertial navigation;
adopting the position and the speed of the GPS as the initial position and the initial speed of inertial navigation;
the course angle information of the GPS is utilized to complete the initialization of the course angle information of the inertial navigation, and the attitude matrix is completed by combining the horizontal attitude angle
Figure BDA0003061963530000021
The initialization calculation of (2);
the inertial navigation calculation is carried out by utilizing the information acquired by the inertial sensor at the current moment, and the inertial navigation calculation comprises an attitude matrix
Figure BDA0003061963530000022
And (4) updating and calculating the speed and the position.
In some embodiments, the calculation algorithm of the velocity and position information by the attitude information calculated by the inertial sensor and the mileage speed acquired by the odometer or the OBD is as follows:
Figure BDA0003061963530000031
Figure BDA0003061963530000032
Figure BDA0003061963530000033
wherein the content of the first and second substances,
Figure BDA0003061963530000034
is the speed of the navigation coordinate system;
Figure BDA0003061963530000035
is attitude information;
Figure BDA0003061963530000036
position information at the current moment comprises longitude, latitude and height;
Figure BDA0003061963530000037
position information of the previous moment; h is height information; rMDAnd RNDRespectively calculating the main curvature radius of the meridian circle and the prime curvature radius of the prime circle by utilizing geographic information;
Figure BDA0003061963530000038
the OBD speeds under the navigation coordinate systems at the adjacent moments are respectively; at is the OBD speed update interval, i.e., the time difference between time k-1 and time k.
In some embodiments, the method further comprises the steps of: based on the position information calculated by inertial navigation and the position information calculated by OBD vehicle speed, the method for realizing navigation information fusion processing by adopting a Kalman filter to obtain the optimal position information and estimating the sensor error comprises the following steps:
when the OBD vehicle speed information is not updated in time, the information such as speed, position and the like calculated by adopting inertial navigation is passed
Figure BDA0003061963530000039
The time update is completed.
In some embodiments, the method further comprises the steps of:
on-board diagnostics (OBD) vehicle speed informationUpdating time, based on the position information calculated by OBD vehicle speed and the position information calculated by inertial navigation
Figure BDA00030619635300000310
Completing measurement updating;
wherein the measurement information
Figure BDA00030619635300000311
The error of the OBD estimated position and the inertial navigation estimated position at the same time is shown; xkState quantities including attitude angle error, velocity error, position error and sensor bias error; hkIs a measurement matrix; phi is the state transition matrix, KkIs a gain matrix; gamma is a system structure parameter; where the subscript k denotes time k and k/k-1 denotes the prediction of the value at time k for time k-1.
In some embodiments, the method further comprises the steps of: the method for performing feedback compensation on the inertial navigation output information according to the processing result of Kalman filtering and acquiring the optimal position information comprises the following steps:
feedback correction of the sensor is realized according to the sensor error obtained by Kalman filtering;
and updating the Kalman filter parameters for the next filtering.
A second aspect of the present invention provides a navigation positioning system, comprising: the system comprises an inertial sensor, a mileage gauge or a vehicle-mounted diagnosis system, a position information acquisition module, an information calculation module, an optimal position and error estimation module and a feedback compensation correction module;
the inertial sensor, the mileage recorder or the vehicle-mounted diagnosis system are respectively connected with a position information acquisition module, the position information acquisition module is connected with an information calculation module, the information calculation module is connected with an optimal position and error estimation module, and the optimal position and error estimation module is connected with a feedback compensation correction module;
the position information acquisition module is used for finishing inertial navigation information calculation by utilizing information sensed by the inertial sensor so as to acquire position information;
the information calculation module is used for calculating speed and position information by using the mileage speed acquired by a mileage meter or an OBD through the attitude information calculated by the inertial sensor;
the optimal position and error estimation module is used for realizing navigation information fusion processing by adopting a Kalman filter based on position information calculated by inertial navigation and position information calculated by OBD vehicle speed to obtain optimal position information and sensor error estimation;
and the feedback compensation correction module is used for carrying out feedback compensation correction on the inertial navigation output information according to the Kalman filtering processing result so as to obtain the optimal position information.
In some embodiments, the position information acquisition module comprises a horizontal initial attitude information acquisition unit, an initial position and speed acquisition unit, an attitude matrix initialization calculation unit and an inertial navigation calculation unit;
the horizontal initial attitude information acquisition unit is used for acquiring horizontal acceleration data of the vehicle within a period of time through the accelerometer after the vehicle is started, and calculating a roll angle and a pitch angle by using the horizontal acceleration data as horizontal initial attitude information of inertial navigation;
the initial position and speed acquisition unit is used for adopting the position and speed of the GPS as the initial position and the initial speed of the inertial navigation;
the attitude matrix initialization calculation unit is used for completing initialization of the inertial navigation course angle information by utilizing the course angle information of the GPS and completing the attitude matrix by combining the horizontal attitude angle
Figure BDA0003061963530000051
The initialization calculation of (2);
the inertial navigation computing unit is used for performing inertial navigation computation by using information acquired by the inertial sensor at the current moment, and comprises an attitude matrix
Figure BDA0003061963530000052
And (4) updating and calculating the speed and the position.
In some embodiments, the optimal position and error estimation module includes a time update module and a metrology update module,
the time updating module is used for passing through the speed, position and other information calculated by adopting inertial navigation when the OBD vehicle speed information does not complete time updating
Figure BDA0003061963530000053
Completing time updating;
the measurement updating module is used for updating the position information calculated according to the OBD speed and the position information calculated by inertial navigation at the time of updating the OBD speed information
Figure BDA0003061963530000054
And finishing the measurement updating.
The present application also provides a computer-readable storage medium comprising a processor, a computer-readable storage medium and a computer program stored on the computer-readable storage medium, which computer program, when executed by the processor, performs the steps of the method described above.
According to the navigation positioning method, the navigation positioning system and the computer readable storage medium provided by the embodiment of the invention, fusion of relevant information such as vehicle speed information, position information and the like is realized through the inertial sensor and speed information provided according to an On Board Diagnostics (On Board Diagnostics) interface in combination with a Kalman filtering technology, so that stable, reliable and continuous navigation positioning information can be provided for a vehicle, the navigation positioning method, the navigation positioning system and the computer readable storage medium are not limited by errors caused by the strength of a Global Positioning System (GPS) signal and the service time of the inertial navigation system, and the use experience of a user is greatly improved.
Drawings
FIG. 1 is a flowchart of a navigation positioning method according to an embodiment of the present invention;
FIG. 2 is a flowchart of a navigation positioning method according to another embodiment of the present invention;
FIG. 3 is a flowchart of a method of operation of a navigation positioning method according to yet another embodiment of the present invention;
FIG. 4 is a block diagram of a navigation positioning system according to an embodiment of the present invention;
fig. 5 is a block diagram of a navigation positioning system according to another embodiment of the present invention.
Detailed Description
In order to make the technical problems, technical solutions and advantageous effects to be solved by the present invention clearer and clearer, the present invention is further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
The method aims at solving the problems that the error of a navigation system realized by the existing inertial navigation technology is increased along with the increase of the use time of navigation, so that accurate, reliable and continuous navigation positioning information cannot be provided for a vehicle along with the increase of the use time of navigation, and the accurate, reliable and continuous navigation positioning information cannot be provided for the vehicle in the scene that a GPS signal is weak or invalid. In vehicle-mounted applications, a odometer or an OBD (On Board Diagnostics) can provide independent vehicle speed information as speed reference information, and speed measurement errors do not increase with time, and signals are not blocked and interfered. Therefore, the inertial navigation and the mileage meter have good complementarity, and can provide accurate, reliable and continuous navigation positioning information for the vehicle under the scene that the GPS signal is weak or invalid. The invention provides a navigation positioning method, a navigation positioning system and a computer readable storage medium, which realize information fusion by utilizing speed information provided by an inertial sensor and a mileage meter or a vehicle-mounted OBD (On Board Diagnostics) interface and combining with a Kalman filtering technology, thereby ensuring that stable, reliable and continuous navigation positioning information is provided for a vehicle.
Example one
Referring to fig. 1 to fig. 3, a flowchart of a navigation positioning method according to a first embodiment of the invention is shown.
The method specifically comprises the following steps:
s10, completing inertial navigation information calculation by using information sensed by the inertial sensor to acquire position information;
specifically, inertial Navigation initialization is completed by using accelerometer sensing information and GNSS (Global Navigation Satellite System) information on the vehicle-mounted terminal. After the initialization is completed, the inertial sensor information (acceleration and angular velocity information) is obtained in real time to complete the calculation of the attitude, the velocity and the position, please refer to fig. 2, which specifically includes the following steps:
s101, after a vehicle is started, acquiring horizontal acceleration data of the vehicle within a period of time through an accelerometer, and calculating a roll angle and a pitch angle by using the horizontal acceleration data as horizontal initial attitude information of inertial navigation;
s102, adopting the position and the speed of a GPS as the initial position and the initial speed of inertial navigation;
s103, initializing the inertial navigation course angle information by using the course angle information of the GPS, and finishing an attitude matrix by combining a horizontal attitude angle
Figure BDA0003061963530000071
The initialization calculation of (2);
s104, performing inertial navigation calculation by using information acquired by the inertial sensor at the current moment, wherein the information comprises an attitude matrix
Figure BDA0003061963530000081
Speed of rotation
Figure BDA0003061963530000082
And position
Figure BDA0003061963530000083
S20, calculating speed and position information by the attitude information calculated by the inertial sensor and mileage speed acquired by a mileage meter or an OBD (On Board Diagnostics);
specifically, when a odometer or an OBD (On Board Diagnostics) collects speed information of a vehicle
Figure BDA0003061963530000084
After updating, attitude information calculated by using inertial sensor
Figure BDA0003061963530000085
Velocity of vehicle coordinate system
Figure BDA0003061963530000086
Velocity conversion to navigational coordinate system
Figure BDA0003061963530000087
And based on the speed of the navigation coordinate system
Figure BDA0003061963530000088
The information estimates vehicle position information. The method for converting the vehicle speed coordinate and estimating the vehicle position comprises the following steps:
Figure BDA0003061963530000089
Figure BDA00030619635300000810
Figure BDA00030619635300000811
wherein the content of the first and second substances,
Figure BDA00030619635300000812
is the speed of the navigation coordinate system;
Figure BDA00030619635300000813
is attitude information;
Figure BDA00030619635300000814
position information at the current k moment comprises longitude, latitude and height;
Figure BDA00030619635300000815
position information of the previous moment; h is height information; rMDAnd RNDRespectively calculating the main curvature radius of the meridian circle and the prime curvature radius of the prime circle by utilizing geographic information;
Figure BDA00030619635300000816
the OBD speeds under the navigation coordinate systems at the adjacent moments are respectively; at is the OBD speed update interval, i.e., the time difference between time k-1 and time k.
S30, based on the position information calculated by inertial navigation and the position information calculated by OBD vehicle speed, adopting a Kalman filter to realize navigation information fusion processing, and obtaining optimal position information and sensor error estimation;
specifically, information fusion is carried out by using position information calculated by inertial navigation and position information calculated by OBD vehicle speed based on Kalman filtering, and the method mainly comprises the following steps:
s301, when the OBD vehicle speed information is not updated in time, adopting the speed calculated by inertial navigation
Figure BDA00030619635300000817
Location, etc. information
Figure BDA0003061963530000091
By passing
Figure BDA0003061963530000092
Completing time updating;
s302, at the update time of the OBD vehicle speed information, the position information calculated according to the OBD vehicle speed and the position information calculated by inertial navigation are passed
Figure BDA0003061963530000093
And finishing the measurement updating.
Wherein the measurement information
Figure BDA0003061963530000094
The error of the OBD estimated position and the inertial navigation estimated position at the same time is shown; xkState quantities including attitude angle error, velocity error, position error and sensor bias error; hkIs a measurement matrix; phi is a state transition matrix; kkIs a gain matrix; gamma is a system structure parameter; where the subscript k denotes time k and k/k-1 denotes the prediction of the value at time k for time k-1.
And S40, performing feedback compensation on the inertial navigation output information according to the Kalman filtering processing result to obtain the optimal position information.
Specifically, feedback correction of the sensor is realized according to the sensor error obtained by Kalman filtering (Kalman filtering), and the measurement accuracy of the sensor is improved. And further updating Kalman filter parameters for the next filtering. Therefore, the cyclic calculation is realized, and the real-time integrated navigation function is completed.
Specifically, feedback is performed according to a Kalman filtering result and a set threshold value.
1) When the filtering result is smaller than the threshold value, performing feedback error compensation correction on the sensor error and the navigation parameter;
2) and when the filtering result is larger than the threshold value, performing feedback error compensation on the sensor error and the navigation parameter at least twice, wherein the feedback quantity is not larger than the set threshold value every time, namely, the compensation correction is realized for multiple times according to a certain proportion. The feedback compensation frequency at the stage is consistent with the navigation parameter resolving frequency, namely, the navigation parameter resolving is carried out once while the feedback correction is carried out once.
According to the navigation positioning method, the navigation positioning method is combined with the Kalman filtering technology through the inertial sensor and the speed information provided according to the On Board Diagnostics (OBD) interface, fusion of relevant information is achieved, stable, reliable and continuous navigation positioning information can be provided for a vehicle, limitation of errors caused by the strength of GPS signals and the service time of an inertial navigation system is avoided, and the use experience of a user is greatly improved.
Example two
Referring to fig. 4 and 5, the navigation positioning system according to an embodiment of the present invention includes an inertial sensor 40, a mileage meter 41 (which may also be a vehicle-mounted diagnosis system), a position information obtaining module 501, an information calculating module 502, an optimal position and error estimating module 503, and a feedback compensation correcting module 504. The inertial sensor 40 and the mileage gauge 41 are respectively connected to a position information acquisition module 501, the position information acquisition module 501 is connected to an information calculation module 502, the information calculation module 502 is connected to an optimal position and error estimation module 503, and the optimal position and error estimation module 503 is connected to a feedback compensation correction module 504.
The position information acquiring module 501 is configured to complete inertial navigation information calculation by using information sensed by the inertial sensor 40 to acquire position information;
the position information acquisition module 501 includes a horizontal initial attitude information acquisition unit 5011, an initial position and velocity acquisition unit 5012, an attitude matrix initialization calculation unit 5013, and an inertial navigation calculation unit 5014.
The horizontal initial attitude information obtaining unit 5011 is configured to collect horizontal acceleration data of the vehicle within a period of time through an accelerometer after the vehicle is started, and calculate a roll angle and a pitch angle as horizontal initial attitude information of the inertial navigation by using the horizontal acceleration data.
The initial position and velocity acquisition unit 5012 is configured to use the position and velocity of the GPS as the initial position and initial velocity of the inertial navigation.
The attitude matrix initialization calculation unit 5013 is used for completing initialization of the inertial navigation course angle information by using the course angle information of the GPS and completing the attitude matrix by combining the horizontal attitude angle
Figure BDA0003061963530000111
The initialization calculation of (1).
The inertial navigation computation unit 5014 is configured to perform inertial navigation computation using information collected by the inertial sensor 40 at the current time, and includes an attitude matrix
Figure BDA0003061963530000112
And (4) updating and calculating the speed and the position.
The information calculation module 502 is configured to calculate speed and position information by using the posture information calculated by the inertial sensor 40 and the mileage speed acquired by the odometer or the OBD (On Board Diagnostics, vehicle-mounted diagnostic system) 41.
In particular, speed information as OBD collects
Figure BDA0003061963530000113
After updating, the attitude information calculated by the inertial sensor 40 is used
Figure BDA0003061963530000114
Velocity of vehicle coordinate system
Figure BDA0003061963530000115
Velocity conversion to navigational coordinate system
Figure BDA0003061963530000116
And based on the speed of the navigation coordinate system
Figure BDA0003061963530000117
The information estimates vehicle position information. The method for converting the vehicle speed coordinate and estimating the vehicle position comprises the following steps:
Figure BDA0003061963530000118
Figure BDA0003061963530000119
Figure BDA00030619635300001110
wherein the content of the first and second substances,
Figure BDA00030619635300001111
position information at the current k moment comprises longitude, latitude and height;
Figure BDA00030619635300001112
position information of the previous k-1 moment; h is height information; rMDAnd RNDRespectively calculating the main curvature radius of the meridian circle and the prime curvature radius of the prime circle by utilizing geographic information;
Figure BDA00030619635300001113
the OBD speeds under the navigation coordinate systems at the adjacent moments are respectively; at is the OBD speed update interval, i.e., the time difference between time k-1 and time k.
The optimal position and error estimation module 503 is configured to implement navigation information fusion processing by using a kalman filter based on position information calculated by inertial navigation and position information calculated by an OBD vehicle speed, and obtain optimal position information and sensor error estimation.
The optimal position and error estimation module 503 includes a time update module 5031 and a measurement update module 5032,
the time update module 5031 is configured to pass information such as speed and position calculated by inertial navigation when the OBD vehicle speed information does not complete time update
Figure BDA0003061963530000121
Completing time updating;
the measurement update module 5032 is configured to update the OBD vehicle speed information by calculating position information according to the OBD vehicle speed and position information calculated by inertial navigation at the time of updating the OBD vehicle speed information
Figure BDA0003061963530000122
And finishing the measurement updating.
Wherein the measurement information
Figure BDA0003061963530000123
The error of the OBD estimated position and the inertial navigation estimated position at the same time is shown; xkState quantities including attitude angle error, velocity error, position error and sensor bias error; hkIs a measurement matrix; phi is the state transition matrix, KkIs a gain matrix; gamma is a system structure parameter; where the subscript k denotes time k and k/k-1 denotes the prediction of the value at time k for time k-1.
And the feedback compensation correction module 504 is configured to perform feedback compensation correction on the inertial navigation output information according to a kalman filter processing result, so as to obtain optimal position information.
Specifically, according to a Kalman filtering processing result, feedback compensation is performed on inertial navigation output information to obtain optimal position information. Meanwhile, feedback correction of the sensor is achieved according to the sensor error obtained through filtering, and the measurement accuracy of the sensor is improved. And updating the Kalman filter parameters for the next filtering. Therefore, the cyclic calculation is realized, and the real-time integrated navigation function is completed.
According to the navigation positioning system, the navigation positioning system integrates the speed information, the position information and other related information by the inertial sensor and the speed information provided by the On-Board odometer or the OBD (On-Board Diagnostics) interface in combination with the Kalman filtering technology, so that stable, reliable and continuous navigation positioning information can be provided for a vehicle, the navigation positioning system is not limited by the GPS signal intensity and the use time of the inertial navigation system, and the use experience of a user is greatly improved.
EXAMPLE III
According to an embodiment of the present invention, a computer-readable storage medium is provided, on which a computer program is stored, and the computer program, when executed by a processor, implements the steps in the navigation positioning method, where the specific steps are as described in the first embodiment, and are not described herein again.
The memory in the present embodiment may be used to store software programs as well as various data. The memory may mainly include a storage program area and a storage data area, wherein the storage program area may store an operating system, an application program required for at least one function, and the like; the storage data area may store data created according to the use of the mobile phone, and the like. Further, the memory may include high speed random access memory, and may also include non-volatile memory, such as at least one magnetic disk storage device, flash memory device, or other volatile solid state storage device.
According to an example of this embodiment, all or part of the processes in the methods of the embodiments described above may be implemented by a computer program to instruct related hardware, where the program may be stored in a computer-readable storage medium, and in this embodiment of the present invention, the program may be stored in the storage medium of a computer system and executed by at least one processor in the computer system, so as to implement the processes including the embodiments of the methods described above. The storage medium includes, but is not limited to, a magnetic disk, a flash disk, an optical disk, a Read-Only Memory (ROM), and the like.
The preferred embodiments of the present invention have been described above with reference to the accompanying drawings, and are not to be construed as limiting the scope of the invention. Those skilled in the art can implement the invention in various modifications, such as features from one embodiment can be used in another embodiment to yield yet a further embodiment, without departing from the scope and spirit of the invention. Any modification, equivalent replacement and improvement made within the technical idea of using the present invention should be within the scope of the right of the present invention.

Claims (10)

1. A navigation positioning method is characterized by comprising the following steps:
completing inertial navigation information calculation by using information sensed by an inertial sensor to acquire position information;
calculating speed and position information by using mileage speed acquired by a mileage meter or an OBD through the attitude information calculated by the inertial sensor;
based on the position information calculated by inertial navigation and the position information calculated by OBD vehicle speed, a Kalman filter is adopted to realize navigation information fusion processing, and optimal position information and sensor error estimation are obtained;
and according to the result of processing by Kalman filtering, performing feedback compensation on the inertial navigation output information to obtain optimal position information.
2. The navigation positioning method according to claim 1, wherein the performing inertial navigation information calculation using information sensed by the inertial sensor and obtaining position information comprises:
after the vehicle is started, acquiring horizontal acceleration data of the vehicle within a period of time through an accelerometer, and calculating a roll angle and a pitch angle by using the horizontal acceleration data as horizontal initial attitude information of inertial navigation;
adopting the position and the speed of the GPS as the initial position and the initial speed of inertial navigation;
the course angle information of the GPS is utilized to complete the initialization of the course angle information of the inertial navigation, and the attitude matrix is completed by combining the horizontal attitude angle
Figure FDA0003061963520000011
The initialization calculation of (2);
the inertial navigation calculation is carried out by utilizing the information acquired by the inertial sensor at the current moment, and the inertial navigation calculation comprises an attitude matrix
Figure FDA0003061963520000012
And (4) updating and calculating the speed and the position.
3. The navigation positioning method according to claim 1, wherein the attitude information calculated by the inertial sensor is calculated by using a mileage speed completion speed and position information collected by a odometer or an OBD as follows:
Figure FDA0003061963520000013
Figure FDA0003061963520000014
Figure FDA0003061963520000021
wherein the content of the first and second substances,
Figure FDA0003061963520000022
is the speed of the navigation coordinate system;
Figure FDA0003061963520000023
is attitude information;
Figure FDA0003061963520000024
position information at the current k moment comprises longitude, latitude and height;
Figure FDA0003061963520000025
position information of the previous moment; h is height information; rMDAnd RNDRespectively calculating the main curvature radius of the meridian circle and the prime curvature radius of the prime circle by utilizing geographic information;
Figure FDA0003061963520000026
the OBD speeds under the navigation coordinate systems at the adjacent moments are respectively; at is the OBD speed update interval, i.e., the time difference between time k-1 and time k.
4. The navigation positioning method according to claim 1, wherein the navigation information fusion processing is realized by using a kalman filter based on the position information calculated by the inertial navigation and the position information calculated by the OBD vehicle speed, and the method for obtaining the optimal position information and estimating the sensor error comprises the steps of:
when the OBD vehicle speed information is not updated in time, the information such as speed, position and the like calculated by adopting inertial navigation is passed
Figure FDA0003061963520000027
The time update is completed.
5. The navigational positioning method of claim 4, further comprising the steps of:
position information estimated from OBD vehicle speed and inertial navigation at the time of updating OBD vehicle speed informationCalculated position information by
Figure FDA0003061963520000028
Completing measurement updating;
wherein the measurement information
Figure FDA0003061963520000029
The error of the OBD estimated position and the inertial navigation estimated position at the same time is shown; xkState quantities including attitude angle error, velocity error, position error and sensor bias error; hkIs a measurement matrix; phi is the state transition matrix, KkIs a gain matrix; gamma is a system structure parameter; where the subscript k denotes time k and k/k-1 denotes the prediction of the value at time k for time k-1.
6. The navigation positioning method according to any one of claims 1-5, wherein the method for performing feedback compensation on the inertial navigation output information according to the processing result of Kalman filtering and obtaining the optimal position information comprises the steps of:
feedback correction of the sensor is realized according to the sensor error obtained by Kalman filtering;
and updating the Kalman filter parameters for the next filtering.
7. A navigation positioning system is characterized by comprising an inertial sensor, a mileage recorder or a vehicle-mounted diagnosis system, a position information acquisition module, an information calculation module, an optimal position and error estimation module and a feedback compensation correction module;
the inertial sensor, the mileage recorder or the vehicle-mounted diagnosis system are respectively connected with a position information acquisition module, the position information acquisition module is connected with an information calculation module, the information calculation module is connected with an optimal position and error estimation module, and the optimal position and error estimation module is connected with a feedback compensation correction module;
the position information acquisition module is used for finishing inertial navigation information calculation by utilizing information sensed by the inertial sensor so as to acquire position information;
the information calculation module is used for calculating speed and position information by using the mileage speed acquired by a mileage meter or an OBD through the attitude information calculated by the inertial sensor;
the optimal position and error estimation module is used for realizing navigation information fusion processing by adopting a Kalman filter based on position information calculated by inertial navigation and position information calculated by OBD vehicle speed to obtain optimal position information and sensor error estimation;
and the feedback compensation correction module is used for carrying out feedback compensation correction on the inertial navigation output information according to the Kalman filtering processing result so as to obtain the optimal position information.
8. The system according to claim 7, wherein the position information acquiring module comprises a horizontal initial attitude information acquiring unit, an initial position and speed acquiring unit, an attitude matrix initialization calculating unit and an inertial navigation calculating unit;
the horizontal initial attitude information acquisition unit is used for acquiring horizontal acceleration data of the vehicle within a period of time through the accelerometer after the vehicle is started, and calculating a roll angle and a pitch angle by using the horizontal acceleration data as horizontal initial attitude information of inertial navigation;
the initial position and speed acquisition unit is used for adopting the position and speed of the GPS as the initial position and the initial speed of the inertial navigation;
the attitude matrix initialization calculation unit is used for completing initialization of the inertial navigation course angle information by utilizing the course angle information of the GPS and completing the attitude matrix by combining the horizontal attitude angle
Figure FDA0003061963520000041
The initialization calculation of (2);
the inertial navigation computing unit is used for performing inertial navigation computation by using information acquired by the inertial sensor at the current moment, and comprises an attitude matrix
Figure FDA0003061963520000042
And (4) updating and calculating the speed and the position.
9. The NAPS system of claim 7, wherein the optimal position and error estimation module comprises a time update module and a metrology update module,
the time updating module is used for passing through the speed, position and other information calculated by adopting inertial navigation when the OBD vehicle speed information does not complete time updating
Figure FDA0003061963520000043
Completing time updating;
the measurement updating module is used for updating the position information calculated according to the OBD speed and the position information calculated by inertial navigation at the time of updating the OBD speed information
Figure FDA0003061963520000044
The measurement update is completed, and the measurement update is completed,
wherein the measurement information
Figure FDA0003061963520000045
The error of the OBD estimated position and the inertial navigation estimated position at the same time is shown; xkState quantities including attitude angle error, velocity error, position error and sensor bias error; hkIs a measurement matrix; phi is a state transition matrix; kkIs a gain matrix; gamma is a system structure parameter; where the subscript k denotes time k and k/k-1 denotes the prediction of the value at time k for time k-1.
10. A computer-readable storage medium, comprising a processor, a computer-readable storage medium, and a computer program stored on the computer-readable storage medium, which computer program, when executed by the processor, performs the steps of the method according to any one of claims 1 to 6.
CN202110515730.5A 2021-05-12 2021-05-12 Navigation positioning method, navigation positioning system and computer readable storage medium Active CN113252048B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110515730.5A CN113252048B (en) 2021-05-12 2021-05-12 Navigation positioning method, navigation positioning system and computer readable storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110515730.5A CN113252048B (en) 2021-05-12 2021-05-12 Navigation positioning method, navigation positioning system and computer readable storage medium

Publications (2)

Publication Number Publication Date
CN113252048A true CN113252048A (en) 2021-08-13
CN113252048B CN113252048B (en) 2023-02-28

Family

ID=77222922

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110515730.5A Active CN113252048B (en) 2021-05-12 2021-05-12 Navigation positioning method, navigation positioning system and computer readable storage medium

Country Status (1)

Country Link
CN (1) CN113252048B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113873637A (en) * 2021-10-26 2021-12-31 上海瑾盛通信科技有限公司 Positioning method, positioning device, terminal and storage medium
CN114413898A (en) * 2022-03-29 2022-04-29 深圳市边界智控科技有限公司 Multi-sensor data fusion method and device, computer equipment and storage medium
CN117405145A (en) * 2023-12-14 2024-01-16 深圳市晟丰达科技有限公司 Inertial navigation management method, system and storage medium based on intelligent analysis

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106950586A (en) * 2017-01-22 2017-07-14 无锡卡尔曼导航技术有限公司 GNSS/INS/ Integrated Navigation for Land Vehicle methods for agricultural machinery working
CN108180925A (en) * 2017-12-15 2018-06-19 中国船舶重工集团公司第七0七研究所 A kind of odometer assists vehicle-mounted dynamic alignment method
CN109974697A (en) * 2019-03-21 2019-07-05 中国船舶重工集团公司第七0七研究所 A kind of high-precision mapping method based on inertia system
CN110221333A (en) * 2019-04-11 2019-09-10 同济大学 A kind of error in measurement compensation method of vehicle-mounted INS/OD integrated navigation system
CN110779521A (en) * 2019-11-12 2020-02-11 成都中科微信息技术研究院有限公司 Multi-source fusion high-precision positioning method and device
CN111562603A (en) * 2020-06-30 2020-08-21 高新兴物联科技有限公司 Navigation positioning method, equipment and storage medium based on dead reckoning
CN112066983A (en) * 2020-09-08 2020-12-11 中国人民解放军国防科技大学 Inertial/odometer combined navigation filtering method, electronic equipment and storage medium
CN112762961A (en) * 2020-12-28 2021-05-07 厦门华源嘉航科技有限公司 On-line calibration method for integrated navigation of vehicle-mounted inertial odometer

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106950586A (en) * 2017-01-22 2017-07-14 无锡卡尔曼导航技术有限公司 GNSS/INS/ Integrated Navigation for Land Vehicle methods for agricultural machinery working
CN108180925A (en) * 2017-12-15 2018-06-19 中国船舶重工集团公司第七0七研究所 A kind of odometer assists vehicle-mounted dynamic alignment method
CN109974697A (en) * 2019-03-21 2019-07-05 中国船舶重工集团公司第七0七研究所 A kind of high-precision mapping method based on inertia system
CN110221333A (en) * 2019-04-11 2019-09-10 同济大学 A kind of error in measurement compensation method of vehicle-mounted INS/OD integrated navigation system
CN110779521A (en) * 2019-11-12 2020-02-11 成都中科微信息技术研究院有限公司 Multi-source fusion high-precision positioning method and device
CN111562603A (en) * 2020-06-30 2020-08-21 高新兴物联科技有限公司 Navigation positioning method, equipment and storage medium based on dead reckoning
CN112066983A (en) * 2020-09-08 2020-12-11 中国人民解放军国防科技大学 Inertial/odometer combined navigation filtering method, electronic equipment and storage medium
CN112762961A (en) * 2020-12-28 2021-05-07 厦门华源嘉航科技有限公司 On-line calibration method for integrated navigation of vehicle-mounted inertial odometer

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113873637A (en) * 2021-10-26 2021-12-31 上海瑾盛通信科技有限公司 Positioning method, positioning device, terminal and storage medium
CN114413898A (en) * 2022-03-29 2022-04-29 深圳市边界智控科技有限公司 Multi-sensor data fusion method and device, computer equipment and storage medium
CN114413898B (en) * 2022-03-29 2022-07-29 深圳市边界智控科技有限公司 Multi-sensor data fusion method and device, computer equipment and storage medium
CN117405145A (en) * 2023-12-14 2024-01-16 深圳市晟丰达科技有限公司 Inertial navigation management method, system and storage medium based on intelligent analysis
CN117405145B (en) * 2023-12-14 2024-02-20 深圳市晟丰达科技有限公司 Inertial navigation management method, system and storage medium based on intelligent analysis

Also Published As

Publication number Publication date
CN113252048B (en) 2023-02-28

Similar Documents

Publication Publication Date Title
CN113252048B (en) Navigation positioning method, navigation positioning system and computer readable storage medium
US10240931B2 (en) System and method for navigation by applying corrected bias values to gyroscopic data
US9488480B2 (en) Method and apparatus for improved navigation of a moving platform
US8510044B2 (en) Position sensing device and method
US20090099774A1 (en) Systems and methods for improved position determination of vehicles
WO2015123604A1 (en) Systems and methods for estimating movements of a vehicle using a mobile device
CN102645222A (en) Satellite inertial navigation method and equipment
CN114545472B (en) Navigation method and device of GNSS/INS combined system
JP6149699B2 (en) Vehicle trajectory calculation device
CN112835085B (en) Method and device for determining vehicle position
CN112505737A (en) GNSS/INS combined navigation method based on Elman neural network online learning assistance
JP6248559B2 (en) Vehicle trajectory calculation device
CN113405545A (en) Positioning method, positioning device, electronic equipment and computer storage medium
KR100948089B1 (en) Method for deciding car position by pseudo dead reckoning and car navigation system using the same
CN115060257B (en) Vehicle lane change detection method based on civil-grade inertia measurement unit
CN114234969B (en) Navigation positioning method and device and electronic equipment
CN115407376A (en) Vehicle positioning calibration method and device, computer equipment and storage medium
CN113566850B (en) Method and device for calibrating installation angle of inertial measurement unit and computer equipment
CN114061570A (en) Vehicle positioning method and device, computer equipment and storage medium
CN114019954B (en) Course installation angle calibration method, device, computer equipment and storage medium
CN115112119A (en) Vehicle navigation method based on LSTM neural network assistance
CN114001730B (en) Fusion positioning method, fusion positioning device, computer equipment and storage medium
CN112611377B (en) State prediction method, device and storage medium for car outdoor navigation
US20210318449A1 (en) Method and device for locating a vehicle
JP2021018112A (en) Self position estimation device

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
CB02 Change of applicant information

Address after: 518000 606, block a, sharing building, No. 78, Keyuan North Road, songpingshan community, Xili street, Nanshan District, Shenzhen, Guangdong

Applicant after: Gosuncn IOT Technology Co.,Ltd.

Address before: 518000 Guangdong, Shenzhen, Nanshan District, Guangdong Province, Nanshan District high tech Industrial Park, South Korea 12 road, MINDRAY Building 2 floor B area, zone 12

Applicant before: Gaoxing Wulian Technology Co.,Ltd.

CB02 Change of applicant information
GR01 Patent grant
GR01 Patent grant