WO2024041156A1 - Vehicle positioning calibration method and apparatus, computer device, and storage medium - Google Patents

Vehicle positioning calibration method and apparatus, computer device, and storage medium Download PDF

Info

Publication number
WO2024041156A1
WO2024041156A1 PCT/CN2023/102292 CN2023102292W WO2024041156A1 WO 2024041156 A1 WO2024041156 A1 WO 2024041156A1 CN 2023102292 W CN2023102292 W CN 2023102292W WO 2024041156 A1 WO2024041156 A1 WO 2024041156A1
Authority
WO
WIPO (PCT)
Prior art keywords
positioning information
positioning
information
target vehicle
preset condition
Prior art date
Application number
PCT/CN2023/102292
Other languages
French (fr)
Chinese (zh)
Inventor
王瑞平
Original Assignee
深圳市广通远驰科技有限公司
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 深圳市广通远驰科技有限公司 filed Critical 深圳市广通远驰科技有限公司
Publication of WO2024041156A1 publication Critical patent/WO2024041156A1/en

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/40Correcting position, velocity or attitude
    • G01S19/41Differential correction, e.g. DGPS [differential GPS]
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/23Testing, monitoring, correcting or calibrating of receiver elements
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/43Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial

Definitions

  • the present application relates to the technical field of Internet of Vehicles, and in particular to a vehicle positioning calibration method, device, computer equipment, storage medium and computer program product.
  • this application provides a vehicle positioning calibration method.
  • the methods include:
  • the calibration positioning information is obtained according to the first positioning information and the second positioning information.
  • the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device, and the first positioning information and the second positioning information obtained through the multiple vehicle-mounted electronic devices of the target vehicle are obtained, including :
  • the original three-dimensional position information of the target vehicle is calculated based on the six-axis data
  • obtaining the cumulative error of the first positioning information, and adjusting the confidence parameter based on the cumulative error includes:
  • calculating the speed error of the target vehicle based on the second positioning information, and adjusting the weight parameters based on the speed error includes:
  • the second positioning information obtain the positioning of the target vehicle at multiple consecutive moments according to a preset time interval
  • the measured speed of the target vehicle at the current continuous moment is calculated
  • the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, the measured speed of the target vehicle at the current continuous time is determined to be an abnormal speed
  • the weight parameter will be reduced.
  • obtaining calibration positioning information based on the first positioning information and the second positioning information includes:
  • first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude, and a first altitude;
  • the second three-dimensional position information includes a second longitude and a second latitude. and second elevation;
  • the fused longitude, fused latitude and fused altitude are used as the fused three-dimensional position information, and the fused three-dimensional position information is replaced with the first three-dimensional position information in the first positioning information to obtain the calibrated positioning information.
  • the method further includes:
  • the method further includes:
  • the calibration positioning information is obtained according to the first positioning information and the third positioning information.
  • the method further includes:
  • the calibration positioning information is obtained according to the second positioning information and the third positioning information.
  • the method further includes:
  • the third positioning information is used as the calibration positioning information.
  • this application also provides a vehicle positioning calibration device.
  • the device includes:
  • a positioning acquisition module configured to acquire first positioning information and second positioning information obtained through multiple on-board electronic devices of the target vehicle;
  • the first adjustment module is used to obtain the cumulative error of the first positioning information and adjust the confidence parameter according to the cumulative error
  • a second adjustment module configured to calculate the speed error of the target vehicle based on the second positioning information, and adjust the weight parameters based on the speed error
  • the positioning calibration module is used to obtain calibration positioning information according to the first positioning information and the second positioning information if the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition.
  • this application also provides a computer device.
  • the computer device includes a memory and a processor, the memory stores a computer program, and the processor implements the following steps when executing the computer program:
  • the calibration positioning information is obtained according to the first positioning information and the second positioning information.
  • this application also provides a computer-readable storage medium.
  • the computer-readable storage medium has a computer program stored thereon, and when the computer program is executed by the processor, the following steps are implemented:
  • the calibration positioning information is obtained according to the first positioning information and the second positioning information.
  • this application also provides a computer program product.
  • the computer program product includes a computer program that implements the following steps when executed by a processor:
  • the calibration positioning information is obtained according to the first positioning information and the second positioning information.
  • the above-mentioned vehicle positioning and calibration methods, devices, computer equipment, storage media and computer program products have been approved
  • the first positioning information and the second positioning information obtained by multiple on-board electronic devices of the target vehicle; the cumulative error of the first positioning information is obtained, and the confidence parameter is adjusted based on the cumulative error; the speed error of the target vehicle is calculated based on the second positioning information, And adjust the weight parameter according to the speed error; if the confidence parameter meets the first preset condition, and the weight parameter meets the second preset condition, the calibration positioning information is obtained according to the first positioning information and the second positioning information.
  • Figure 1 is an application environment diagram of the vehicle positioning calibration method in one embodiment
  • Figure 2 is a schematic flow chart of a vehicle positioning calibration method in one embodiment
  • Figure 3 is a logical schematic diagram of vehicle positioning calibration in one embodiment
  • Figure 4 is a structural block diagram of a vehicle positioning calibration device in one embodiment
  • Figure 5 is an internal structure diagram of a computer device in one embodiment.
  • the vehicle positioning calibration method provided by the embodiment of the present application can be applied in the application environment as shown in Figure 1.
  • the application processor is a component in the vehicle.
  • the means of transportation can be vehicles, robotic equipment with driving functions, etc., and the vehicles can be trucks, off-road vehicles, dump trucks, tractors, special vehicles, passenger cars, cars, semi-trailers, etc.
  • the satellite signal receiving device (GNSS receiving device), the inertial measurement unit (IMU, Inertial Measurement Unit), the network access device (NAD, Network Access Device), the communication device and the application processor are connected and communicated.
  • the application processor can pass The network access device performs network communication with the real-time dynamic measurement system (RTK system), and the application processor can also perform wireless communication with multiple roadside devices through the communication device.
  • RTK system real-time dynamic measurement system
  • a vehicle positioning calibration method is provided.
  • the application of this method to the application processor in Figure 1 is used as an example to illustrate, including the following steps:
  • Step 202 Obtain first positioning information and second positioning information obtained through multiple vehicle-mounted electronic devices of the target vehicle.
  • the first positioning information can be vehicle dead reckoning positioning information, also known as DR (Dead Reckoning) positioning information
  • the second positioning information can be real-time dynamic measurement positioning information, also known as RTK (Real Time Kinematic) positioning information.
  • the application processor is installed on the target vehicle and communicates with the GNSS receiving device and IMU on the target vehicle.
  • the IMU mainly includes sensors such as gravity, geomagnetism, gyroscope, accelerometer, and electronic compass.
  • the application processor uses the six-axis data of the IMU to correct the original positioning data received by the GNSS receiving device to obtain the DR positioning information of the target vehicle, and obtains the RTK positioning information, DR positioning information and RTK positioning information contains three-dimensional position information consisting of longitude, latitude, and altitude.
  • Step 204 Obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error.
  • the application processor continuously detects the cumulative error of the DR positioning information (first positioning information). When the cumulative error reaches a certain level, it is determined that the error of the DR positioning information is large and the confidence parameter is reduced.
  • Step 206 Calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameters according to the speed error.
  • the application processor determines multiple consecutive positioning positions according to the preset sampling frequency based on the RTK positioning information. position, calculate the displacement of the preset sampling frequency based on the two consecutive positioning positions, and further calculate the average speed of the preset sampling frequency, compare the average speed with the standard speed threshold, and obtain the speed error.
  • the size of the speed error Adjust the weight parameters accordingly. For example, if the speed error is too large, it means that the currently calculated average speed of the preset sampling frequency is inaccurate. It may be that the RTK positioning information is inaccurate and the weight parameters are reduced.
  • Step 208 If the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, obtain calibration positioning information based on the first positioning information and the second positioning information.
  • the first preset condition may be that the confidence parameter is not less than 50%, and the second preset condition may be that the weight parameter is not less than 0.6.
  • the application processor continuously detects the confidence parameter of the DR positioning information and the weight parameter of the RTK positioning information.
  • the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, determines the current If the DR positioning information and RTK positioning information are both valid positioning information, then the calibration positioning information is obtained based on the longitude, latitude, and altitude in the DR positioning information and RTK positioning information.
  • the first positioning information and the second positioning information obtained through multiple vehicle-mounted electronic devices of the target vehicle are obtained; the cumulative error of the first positioning information is obtained, and the confidence parameter is adjusted according to the cumulative error; and the second positioning information is obtained according to the second positioning information.
  • the positioning information calculates the speed error of the target vehicle and adjusts the weight parameter according to the speed error; if the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, the calibration is obtained based on the first positioning information and the second positioning information. Positioning information.
  • the accuracy of vehicle positioning can be improved. Accuracy.
  • the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device, and obtaining the first positioning information and the second positioning information obtained through the multiple vehicle-mounted electronic devices of the target vehicle include: Obtain the original positioning data of the target vehicle obtained through the satellite signal receiving device, and the six-axis data of the target vehicle obtained through the inertial measurement device; calculate the original three-dimensional position information of the target vehicle based on the six-axis data; calculate the original three-dimensional position information of the target vehicle based on the original three-dimensional position information and the original The positioning data obtains the first positioning information; and the second positioning information of the target vehicle obtained from the real-time dynamic measurement system through the network access device is obtained.
  • the GNSS receiving device receives in real time the unified original NMEA (National Marine Electronics Association, a standard format developed for marine electronic equipment) data sent by the GNSS (Global Navigation Satellite System) satellite group from the standard GNSS navigation equipment. as raw positioning data.
  • NMEA National Marine Electronics Association
  • the original positioning data will have low data accuracy, invalid positioning data, and a large positioning error range.
  • the application processor obtains the original NMEA data, it obtains the six-axis data of the target vehicle from the IMU, and performs accuracy correction on the original NMEA data through a three-dimensional recursive algorithm to obtain the first positioning information (ie, DR positioning information).
  • the application processor records six-axis data from the IMU and converts it into Euler angles through the Mahony complementary filtering algorithm. According to the Euler angle and the acceleration information output by the accelerometer, the resume computer reference coordinate system is converted. After an integral operation, three velocity components are obtained, that is, three-dimensional velocity information. Through the second integration operation, three position components (longitude, latitude, altitude) are obtained, thereby obtaining the original three-dimensional position information. The original positioning data is corrected through the original three-dimensional position information to obtain the first positioning information.
  • the medical processor accesses the RTK system server of the positioning service provider through NAD, and obtains the second positioning information (i.e., RTK positioning information) calculated by the RTK system for the current target vehicle.
  • RTK positioning information is the NMEA data after differential processing of the original NMEA data sent by the RTK system to the GNSS satellite group through the inter-satellite double difference model, which is equivalent to the NMEA data corrected by RTK.
  • the original positioning data of the target vehicle obtained through the satellite signal receiving device and the six-axis data of the target vehicle obtained through the inertial measurement device are obtained; the original three-dimensional position information of the target vehicle is calculated based on the six-axis data; and the original three-dimensional position information of the target vehicle is obtained according to the original
  • the three-dimensional position information and the original positioning data are used to obtain the first positioning information; and the second positioning information of the target vehicle obtained from the real-time dynamic measurement system through the network access device is obtained. Two different types of positioning information can be obtained to improve the accuracy of vehicle positioning.
  • the cumulative error of the first positioning information is obtained, and the confidence parameter is adjusted according to the cumulative error, including: if the cumulative error is greater than or equal to the error threshold, reducing the confidence parameter.
  • the application processor continuously detects the cumulative error of the DR positioning information.
  • the confidence parameter is lowered, thereby reducing the number of pairs of DR positioning information with larger errors.
  • the impact of final positioning For example, the application processor continuously detects the cumulative error of the DR positioning information according to the preset detection period. When the cumulative error detected for 10 consecutive times is greater than or equal to the error threshold, the confidence parameter is lowered. This is because the zero bias of the gyroscope in the IMU drifts with time, so the original GNSS data needs to be corrected based on the accumulated error in the gyroscope. However, when the GNSS receiving device cannot receive the GNSS signal (original NMEA data), it cannot correct the IMU accumulated error, causing the error of the DR positioning information to accumulate over time, and there will also be accumulated errors.
  • the frequency of GNSS signal is 10hz.
  • the IMU update frequency is the standard frequency 30khz, and the ratio is 1:3000. That is, after the IMU outputs 3k times, the GNSS signal will be calibrated once.
  • the IMU outputs 3k data continuously for 1 second the GNSS data (10 times) will be in an invalid state and the accumulated error cannot be corrected. After the accumulated error exceeds the preset error threshold, the default confidence value of 1 will be reduced by 0.01.
  • the application processor continuously detects the cumulative error of the DR positioning information. When the cumulative error detected multiple times is less than the error threshold, the confidence parameter is increased. The confidence parameter has a maximum value. value.
  • the confidence parameter is reduced. It can reduce the impact of large error first positioning information on the final positioning and improve the accuracy of vehicle positioning.
  • calculating the speed error of the target vehicle based on the second positioning information and adjusting the weight parameter based on the speed error includes: obtaining the positioning of the target vehicle at multiple consecutive moments according to the second positioning information at preset time intervals; According to the positioning at the current continuous moment, the positioning at the previous continuous moment and the preset time interval, the measured speed of the target vehicle at the current continuous moment is calculated; if the measured speed of the target vehicle at the current continuous moment is not within the standard speed threshold range, it is determined that The measured speed of the target vehicle at the current continuous moment is abnormal speed; if the number of consecutive abnormal speed determinations exceeds the number threshold, the weight parameter is reduced.
  • the standard speed threshold range is used to characterize the reasonable speed range for normal driving of the vehicle.
  • the application processor continues to obtain the positioning in the RTK positioning information, and uses the RTK positioning to calculate the vehicle speed at the current moment.
  • Pk, GNSS and Pk-1 are the GNSS positioning at time k and the filtered positioning result at time k-1 respectively. Compare the two speeds. If v exceeds the standard speed threshold range (actual speed ⁇ redundant value), it is considered that the RTK positioning error of this epoch is too large. After the above process has been abnormal for 5 consecutive times, the RTK positioning information is The weight parameters are reduced by 0.1.
  • the weight parameter is increased and the weight parameter has a maximum value. For example, if RTK positioning is continuously used to calculate the vehicle speed at the current moment 5 times, and one of the times the speed is within the standard speed threshold range, the weight parameter of the RTK positioning information is weighted and the weight parameter is increased by 0.1.
  • the positioning of the target vehicle at multiple consecutive moments is obtained according to a preset time interval; based on the positioning at the current consecutive moment, the positioning at the previous consecutive moment and the preset time interval, the target vehicle is calculated The measured speed at the current continuous time; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, the measured speed of the target vehicle at the current continuous time is determined to be an abnormal speed; if the number of consecutive abnormal speed determinations exceeds the number threshold , reduce the weight parameters. It can reduce the impact of the second positioning information with large errors on the final positioning and improve the accuracy of vehicle positioning.
  • obtaining calibration positioning information based on the first positioning information and the second positioning information includes: obtaining first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude and the first altitude; obtain the second three-dimensional positioning information from the second positioning information, the second three-dimensional position information includes the second longitude, the second latitude and the second altitude; perform federal Kalman filtering on the first longitude and the second longitude.
  • Filter to obtain the fused longitude filter the first latitude and the second latitude to obtain the fused latitude, filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and
  • the three-dimensional position information is fused to replace the first three-dimensional position information in the first positioning information to obtain calibration positioning information.
  • the application processor obtains the first three-dimensional position information (first longitude, first latitude, and first altitude) in the DR positioning information, and the second three-dimensional position information (the second longitude, the first altitude) in the RTK positioning information.
  • Second latitude and second altitude perform a federal Kalman filter once for longitude, latitude and altitude respectively, that is, perform three federal Kalman filters.
  • the federated Kalman filter vector state is: ⁇ Nk, ⁇ Ek, ⁇ Sk, They are northward and eastward position errors, step estimation errors and heading estimation errors respectively.
  • the filtered fused longitude, fused dimension and fused altitude are respectively output to form the fused three-dimensional position information after federated Kalman filtering.
  • the first three-dimensional position information in the DR positioning information is replaced with the fused three-dimensional position information feedback.
  • the final fusion positioning result is output as the final three-dimensional position positioning.
  • the first three-dimensional position information is obtained from the first positioning information.
  • the first three-dimensional position information includes the first longitude, the first latitude and the first altitude;
  • the second three-dimensional positioning information is obtained from the second positioning information.
  • the two- and three-dimensional position information includes the second longitude, the second latitude and the second altitude; the first longitude and the second longitude are filtered through the federated Kalman filter to obtain the fused longitude, and the first latitude and the second latitude are filtered to obtain the fused latitude.
  • filter the first altitude and the second altitude to obtain the fused altitude use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and replace the first three-dimensional position information in the first positioning information with the fused three-dimensional position information, we get Calibrate positioning information.
  • Kalman filtering can be performed on the three-dimensional position information in the effective positioning information to obtain the filtered three-dimensional position information.
  • the filtered three-dimensional position information is used to obtain the calibration positioning information, which improves the accuracy of vehicle positioning.
  • the method further includes: obtaining third positioning information of at least three roadside devices corresponding to the target vehicle.
  • the roadside equipment refers to the roadside unit (RSU, Road Side Unit), which is in V2X (vehicle to everything, that is, the exchange of information between the vehicle and the outside world). It is installed on the roadside and uses cellular vehicle networking (C-V2X) technology. , a device that communicates with the on-board unit (OBU, On Board Unit) to realize vehicle identity recognition.
  • Roadside devices can be vehicles or electronic devices installed on the roadside.
  • the application processor obtains the roadside positioning information of three roadside devices corresponding to the target vehicle through the communication device, and calculates the third positioning information of the target vehicle based on the three roadside positioning information.
  • the communication device can be a PC5 communication chip (V2X communication chip), and the application processor passes PC5 (ProSe5 proximity communication is a form of radio communication) communication, receiving high-precision positioning (latitude and longitude) in BSM (Basic Safety Message) basic safety information sent from other roadside devices (stationary V2X terminal vehicles or V2X roadside facilities) , altitude, 3-axis acceleration, confidence, etc.), according to geometric principles, selecting N+1 points can determine the N-dimensional space, so the 3D position information needs to be determined, and at least 3 additional V2X devices are required on the roadside in addition to positioning the vehicle.
  • Three-dimensional location information Each roadside three-dimensional location information includes longitude, latitude and altitude.
  • the target vehicle position is determined.
  • the specific formula is as follows:
  • X a , Y a , Z a are the longitude, latitude and altitude coordinates (three - dimensional position information) of the target vehicle
  • X 1 , Y 1 , Z 1 , , Z 3 are respectively the roadside three-dimensional position information of the three roadside devices.
  • the application processor calculates X a , Y a , and Z a , which are the third positioning information.
  • the application processor can obtain the real-time antenna signal RSSI value, antenna RF gain value, and V2X system real-time frequency through the network access layer interface API provided by the chip manufacturer, and use the theoretical model to calculate the speed and distance. You can also use the TDOA (Time Difference Of Arrival) measurement method to measure the signal arrival time, so that the distance measurement uses the above formula.
  • TDOA Time Difference Of Arrival
  • third positioning information of at least three roadside devices corresponding to the target vehicle is obtained.
  • the positioning information of the target vehicle can be obtained based on the V2X system, which is convenient for obtaining the positioning of the target vehicle in scenarios where NAD cannot access the network and GNSS has no signal, improving the accuracy of vehicle positioning.
  • the method further includes: if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, obtaining calibration positioning information based on the first positioning information and the third positioning information.
  • the calibration positioning information is obtained according to the second positioning information and the third positioning information. If the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, the third positioning information is used as the calibration positioning information.
  • the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, it means that in the current road environment, NAD cannot access the network and cannot receive RTK system positioning. At this time, RTK positioning information The accuracy is low, so the RTK positioning information cannot be used as effective positioning information.
  • the DR positioning information and the third positioning information are used as the effective positioning information, and the calibration positioning information is obtained based on the first positioning information and the third positioning information. If the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, it means that there is no GNSS signal in the current road environment and the IMU cumulative error is large. At this time, the DR positioning information is accurate.
  • the accuracy is low, so the DR positioning information cannot be used as effective positioning information.
  • the RTK positioning information and the third positioning information are used as the effective positioning information, and the calibration positioning information is obtained based on the second positioning information and the third positioning information. If the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, it means that the current road environment is such that NAD cannot access the network and GNSS has no signal. It cannot receive RTK system positioning and the IMU has accumulated When the error is also large, the accuracy of both DR positioning information and RTK positioning information is low. Therefore, neither DR positioning information nor RTK positioning information can be used as effective positioning information. Only the third positioning information is used as effective positioning information. Directly The third positioning information is output as calibration positioning information.
  • the error size of different types of positioning information is calculated, the confidence or weight corresponding to each positioning information is adjusted, and the effective positioning information is determined based on the confidence and weight, and the calibrated positioning information is obtained based on the effective positioning information. It can improve the accuracy of vehicle positioning.
  • a vehicle positioning calibration method includes:
  • the positioning data obtains the first positioning information; and the second positioning information of the target vehicle obtained from the real-time dynamic measurement system through the network access device is obtained.
  • the positioning of the target vehicle at multiple consecutive moments is obtained according to a preset time interval; based on the positioning at the current consecutive moment, the positioning at the previous consecutive moment and the preset time interval, the position of the target vehicle at the current consecutive moment is calculated. Measure the speed; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, the measured speed of the target vehicle at the current continuous time is determined to be abnormal speed; if the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter is reduced.
  • the first three-dimensional position information includes the first longitude, the first latitude and the third One altitude; obtain the second three-dimensional positioning information from the second positioning information, and the second three-dimensional position information includes the second longitude, the second latitude and the second altitude; filter the first longitude and the second longitude through the federal Kalman filter to obtain To fuse longitude, filter the first latitude and second latitude to obtain the fused latitude, and filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and fuse the three-dimensional
  • the position information replaces the first three-dimensional position information in the first positioning information to obtain calibration positioning information.
  • the first three-dimensional position information includes the first longitude, the first latitude and the first three-dimensional position information.
  • the third three-dimensional position information is obtained from the third positioning information, and the third three-dimensional position information includes the third longitude, the third Latitude and third altitude; obtain the second three-dimensional positioning information from the second positioning information, and the second three-dimensional position information includes the second longitude, the second latitude and the second altitude; perform federal Kalman filtering on the third longitude and the second longitude.
  • Filter to obtain the fused longitude filter the third latitude and the second latitude to obtain the fused latitude, filter the third altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and
  • the three-dimensional position information is fused to replace the first three-dimensional position information in the first positioning information to obtain calibration positioning information.
  • the third positioning information is used as the calibration positioning information.
  • embodiments of the present application also provide a vehicle positioning calibration device for implementing the above-mentioned vehicle positioning calibration method.
  • the solution to the problem provided by this device is the same as that recorded in the above method.
  • the implementation solutions are similar, so the specific limitations in one or more vehicle positioning calibration device embodiments provided below can refer to the above limitations on the vehicle positioning calibration method, and will not be described again here.
  • a vehicle positioning calibration device 400 including: a positioning acquisition module 401, a first adjustment module 402, a second adjustment module 403 and a positioning calibration module 404, wherein:
  • the positioning acquisition module 401 is used to obtain the first positioning information and the second positioning information obtained through multiple on-board electronic devices of the target vehicle;
  • the first adjustment module 402 is used to obtain the cumulative error of the first positioning information, and adjust the confidence parameter according to the cumulative error;
  • the second adjustment module 403 is used to calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameters according to the speed error;
  • the positioning calibration module 404 is used to obtain calibration positioning information according to the first positioning information and the second positioning information if the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition.
  • the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device.
  • the positioning acquisition module 401 is also used to obtain the original positioning data of the target vehicle obtained through the satellite signal receiving device, and through The six-axis data of the target vehicle obtained by the inertial measurement device; the original three-dimensional position information of the target vehicle is calculated based on the six-axis data; the first positioning information is obtained based on the original three-dimensional position information and the original positioning data; the real-time dynamic measurement is obtained from the network access device The second positioning information of the target vehicle obtained in the system.
  • the first adjustment module 402 is also configured to reduce the confidence parameter if the cumulative error is greater than or equal to the error threshold.
  • the second adjustment module 403 is also configured to obtain the positioning of the target vehicle at multiple consecutive moments according to the second positioning information according to a preset time interval; according to the positioning at the current consecutive moment, the positioning at the previous consecutive moment and Preset time intervals, and calculate the measured speed of the target vehicle at the current continuous time; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, it is determined that the measured speed of the target vehicle at the current continuous time is an abnormal speed; if If the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter will be reduced.
  • the positioning calibration module 404 is also configured to obtain first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude and a first altitude; from the second positioning information Obtain the second three-dimensional positioning information, which includes the second longitude, the second latitude and the second altitude; filter the first longitude and the second longitude through the federal Kalman filter to obtain the fused longitude, and filter the first latitude and the second altitude.
  • Filter the second latitude to obtain the fused latitude Filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and replace the fused three-dimensional position information in the first positioning information
  • the first three-dimensional position information is obtained to obtain the calibration positioning information.
  • the position acquisition module 401 is also used to obtain the third position information of at least three roadside devices corresponding to the target vehicle.
  • the positioning calibration module 404 is also configured to obtain calibration positioning information based on the first positioning information and the third positioning information if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition.
  • the positioning calibration module 404 is also used to obtain calibration based on the second positioning information and the third positioning information if the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition. Positioning information.
  • the positioning calibration module 404 is also configured to use the third positioning information as the calibration positioning information if the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition.
  • Each module in the above-mentioned vehicle positioning calibration device can be implemented in whole or in part by software, hardware and combinations thereof.
  • Each of the above modules may be embedded in or independent of the processor of the computer device in the form of hardware, or may be stored in the memory of the computer device in the form of software, so that the processor can call and execute the operations corresponding to the above modules.
  • a computer device is provided.
  • the computer device can be a vehicle-mounted T-BOX (Telematics BOX) or a vehicle-mounted terminal device with network functions and V2X functions. Its internal structure diagram can be shown in Figure 5 .
  • the computer device includes a processor, a memory, an input/output interface (Input/Output, referred to as I/O), and a communication interface.
  • the processor, memory and input/output interface are connected through the system bus, and the communication interface is connected through the input/output interface Connect to the system bus.
  • the processor of the computer device is used to provide computing and control capabilities.
  • the memory of the computer device includes non-volatile storage media and internal memory.
  • the non-volatile storage medium stores operating systems, computer programs and databases.
  • This internal memory provides an environment for the execution of operating systems and computer programs in non-volatile storage media.
  • the computer device's database is used to store positioning data.
  • the input/output interface of the computer device is used to exchange information between the processor and external devices.
  • the communication interface of the computer device is used to communicate with an external terminal through a network connection.
  • the computer program implements a vehicle positioning calibration method when executed by a processor.
  • FIG. 5 is only a block diagram of a partial structure related to the solution of the present application, and does not constitute a limitation on the computer equipment to which the solution of the present application is applied.
  • the specific computer equipment can May include more or fewer parts than shown, or combine certain parts, or have a different arrangement of parts.
  • a computer device including a memory and a processor.
  • a computer program is stored in the memory.
  • the processor executes the computer program, it implements the following steps: Obtaining the first data obtained through multiple vehicle-mounted electronic devices of the target vehicle. First positioning information and second positioning information; obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error; calculate the speed error of the target vehicle based on the second positioning information, and adjust the weight parameter based on the speed error; if the confidence The parameter satisfies the first preset condition, and the weight parameter satisfies the second preset condition, and the calibration positioning information is obtained according to the first positioning information and the second positioning information.
  • the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device.
  • the processor executes the computer program, the following steps are also implemented: Obtain the original positioning of the target vehicle obtained through the satellite signal receiving device. data, and the six-axis data of the target vehicle obtained through the inertial measurement device; calculate the original three-dimensional position information of the target vehicle based on the six-axis data; obtain the first positioning information based on the original three-dimensional position information and original positioning data; obtain the device through network access Second positioning information of the target vehicle obtained from the real-time dynamic measurement system.
  • the processor executes the computer program, the following steps are also implemented: if the cumulative error is greater than or equal to the error threshold, reduce the confidence parameter.
  • the processor executes the computer program, the following steps are also implemented: according to the second positioning information, obtain the positioning of the target vehicle at multiple consecutive moments according to a preset time interval; according to the positioning of the current consecutive moment, the previous consecutive moment Based on the positioning and preset time interval, the measured speed of the target vehicle at the current continuous time is calculated; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, the measured speed of the target vehicle at the current continuous time is determined to be abnormal. Speed; if the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter will be reduced.
  • the processor when the processor executes the computer program, the processor further implements the following steps: obtaining first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude and a first altitude; from The second positioning information obtains the second three-dimensional positioning information.
  • the second three-dimensional position information includes the second longitude, the second latitude and the second altitude; the first longitude and the second longitude are filtered through the federal Kalman filter to obtain the fused longitude.
  • the first three-dimensional position information in a certain positioning information is used to obtain the calibration positioning information.
  • the processor when the processor executes the computer program, the processor also implements the following steps: obtaining third positioning information of at least three roadside devices corresponding to the target vehicle.
  • the processor also implements the following steps when executing the computer program: if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, obtain the information based on the first positioning information and the third positioning information. Calibrate positioning information.
  • the processor also implements the following steps when executing the computer program: if the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, based on the second positioning information and the third Positioning information obtains calibration positioning information.
  • the processor also implements the following steps when executing the computer program: if the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, use the third positioning information as the calibration Positioning information.
  • a computer-readable storage medium is provided with a computer program stored thereon.
  • the computer program When the computer program is executed by a processor, the following steps are implemented: obtaining first positioning information obtained through multiple on-board electronic devices of the target vehicle. and the second positioning information; obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error; calculate the speed error of the target vehicle based on the second positioning information, and adjust the weight parameter based on the speed error; if the confidence parameter satisfies the A preset condition, and the weight parameter satisfies the second preset condition, and the calibration positioning information is obtained according to the first positioning information and the second positioning information.
  • the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device.
  • the computer program is executed by the processor, the following steps are also implemented: Obtain the original data of the target vehicle obtained through the satellite signal receiving device. Positioning data, as well as the six-axis data of the target vehicle obtained through the inertial measurement device; the original three-dimensional position information of the target vehicle is calculated based on the six-axis data; the first positioning information is obtained based on the original three-dimensional position information and the original positioning data; accessed through the network The device obtains the second positioning information of the target vehicle from the real-time dynamic measurement system.
  • the following steps are also implemented: if the cumulative error is greater than or equal to the error threshold, reduce the confidence parameter.
  • the following steps are also implemented: according to the second positioning information, obtain the positioning of the target vehicle at multiple consecutive moments according to a preset time interval; according to the positioning at the current consecutive moment, the previous consecutive moment Moment positioning and preset time intervals are used to calculate the measured speed of the target vehicle at the current continuous time; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, it is determined that the measured speed of the target vehicle at the current continuous time is Abnormal speed; if the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter will be reduced.
  • the computer program when executed by the processor, the computer program also implements the following steps: obtaining first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude, and a first altitude; The second three-dimensional positioning information is obtained from the second positioning information.
  • the second three-dimensional position information includes the second longitude, the second latitude and the second altitude; the first longitude and the second longitude are filtered through the federated Kalman filter to obtain the fused longitude, Filter the first latitude and the second latitude to obtain the fused latitude, filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and replace the fused three-dimensional position information Calibration positioning information is obtained from the first three-dimensional position information in the first positioning information.
  • the computer program when executed by the processor, the computer program further implements the following steps: obtaining third positioning information of at least three roadside devices corresponding to the target vehicle.
  • the following steps are also implemented: if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, based on the first positioning information and the third positioning information Get calibration positioning information.
  • the following steps are also implemented: if the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, based on the second positioning information and the third preset condition, 3. Positioning information to obtain calibration positioning information.
  • the following steps are also implemented: if the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, use the third positioning information as Calibrate positioning information.
  • a computer program product including a computer program that, when executed by a processor, implements the following steps: acquiring first positioning information and second positioning obtained through a plurality of vehicle-mounted electronic devices of a target vehicle. information; obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error; calculate the speed error of the target vehicle based on the second positioning information, and adjust the weight parameter based on the speed error; if the confidence parameter meets the first preset condition , and the weight parameter meets the second preset condition, and the calibration positioning information is obtained according to the first positioning information and the second positioning information.
  • the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device.
  • the following steps are also implemented: Obtain the original data of the target vehicle obtained through the satellite signal receiving device. Positioning data, as well as six-axis data of the target vehicle obtained through an inertial measurement device; according to The six-axis data is calculated to obtain the original three-dimensional position information of the target vehicle; the first positioning information is obtained based on the original three-dimensional position information and the original positioning data; and the second positioning information of the target vehicle obtained from the real-time dynamic measurement system through the network access device is obtained.
  • the following steps are also implemented: if the cumulative error is greater than or equal to the error threshold, reduce the confidence parameter.
  • the following steps are also implemented: according to the second positioning information, obtain the positioning of the target vehicle at multiple consecutive moments according to a preset time interval; according to the positioning at the current consecutive moment, the previous consecutive moment Moment positioning and preset time intervals are used to calculate the measured speed of the target vehicle at the current continuous time; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, it is determined that the measured speed of the target vehicle at the current continuous time is Abnormal speed; if the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter will be reduced.
  • the computer program when executed by the processor, the computer program also implements the following steps: obtaining first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude, and a first altitude; The second three-dimensional positioning information is obtained from the second positioning information.
  • the second three-dimensional position information includes the second longitude, the second latitude and the second altitude; the first longitude and the second longitude are filtered through the federated Kalman filter to obtain the fused longitude, Filter the first latitude and the second latitude to obtain the fused latitude, filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and replace the fused three-dimensional position information Calibration positioning information is obtained from the first three-dimensional position information in the first positioning information.
  • the computer program when executed by the processor, the computer program further implements the following steps: obtaining third positioning information of at least three roadside devices corresponding to the target vehicle.
  • the following steps are also implemented: if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, based on the first positioning information and the third positioning information Get calibration positioning information.
  • the following steps are also implemented: if the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, based on the second positioning information and the third preset condition, 3. Positioning information to obtain calibration positioning information.
  • the following steps are also implemented: if the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, use the third positioning information as Calibrate positioning information.
  • the user information including but not limited to user equipment information, user personal information, etc.
  • data including but not limited to data used for analysis, stored data, displayed data, etc.
  • the computer program can be stored in a non-volatile computer-readable storage.
  • the computer program when executed, may include the processes of the above method embodiments.
  • Any reference to memory, database or other media used in the embodiments provided in this application may include at least one of non-volatile and volatile memory.
  • Non-volatile memory can include read-only memory (ROM), magnetic tape, floppy disk, flash memory, optical memory, high-density embedded non-volatile memory, resistive memory (ReRAM), magnetic variable memory (Magnetoresistive memory) Random Access Memory (MRAM), Ferroelectric Random Access Memory (FRAM), Phase Change Memory (Phase Change Memory, PCM), graphene memory, etc.
  • Volatile memory may include random access memory (Random Access Memory, RAM) or external cache memory.
  • RAM Random Access Memory
  • RAM random access memory
  • RAM Random Access Memory
  • RAM random access memory
  • RAM random access memory
  • RAM random access memory
  • RAM random access memory
  • SRAM static random access memory
  • DRAM Dynamic Random Access Memory
  • the databases involved in the various embodiments provided in this application may include at least one of a relational database and a non-relational database.
  • Non-relational databases may include blockchain-based distributed databases, etc., but are not limited thereto.
  • the processors involved in the various embodiments provided in this application may be general-purpose processors, central processing units Processors, graphics processors, digital signal processors, programmable logic devices, data processing logic devices based on quantum computing, etc., are not limited to these.

Abstract

A vehicle positioning calibration method and apparatus, a computer device, and a storage medium. The method comprises: acquiring first positioning information and second positioning information obtained by means of a plurality of vehicle-mounted electronic devices of a target vehicle (202); acquiring an accumulated error of the first positioning information, and adjusting a confidence level parameter according to the accumulated error (204); calculating a speed error of the target vehicle according to the second positioning information, and adjusting a weight parameter according to the speed error (206); and if the confidence level parameter satisfies a first preset condition and the weight parameter satisfies a second preset condition, acquiring calibration positioning information according to the first positioning information and the second positioning information (208). By using the method, the confidence level or the weight corresponding to each type of positioning information can be adjusted by calculating errors of different types of positioning information, effective positioning information is determined by combining the confidence level and the weight, and calibration positioning information is obtained according to the effective positioning information.

Description

车辆定位校准方法、装置、计算机设备及存储介质Vehicle positioning calibration method, device, computer equipment and storage medium
相关申请Related applications
本申请要求2022年8月25日申请的,申请号为202211029493.2,名称为“车辆定位校准方法、装置、计算机设备、存储介质”的中国专利申请的优先权,在此将其全文引入作为参考。This application claims priority to the Chinese patent application filed on August 25, 2022, with application number 202211029493.2 and titled "Vehicle Positioning Calibration Method, Device, Computer Equipment, Storage Medium", the full text of which is hereby incorporated by reference.
技术领域Technical field
本申请涉及车联网技术领域,特别是涉及一种车辆定位校准方法、装置、计算机设备、存储介质和计算机程序产品。The present application relates to the technical field of Internet of Vehicles, and in particular to a vehicle positioning calibration method, device, computer equipment, storage medium and computer program product.
背景技术Background technique
车辆行驶在无卫星定位信号场所,例如室内停车场、偏远山区,或者定位信号弱的道路场景,例如多树荫、多高楼、多障碍物遮挡区域、立交桥等区域时,无法获得精准的车辆位置信息,从而导致车辆上与定位相关的应用无法使用或者容易出现错误;且如果车辆较长时间行驶在导航信号不良区域,目前普遍应用在车辆上的GNSS+惯性导航定位系统计算的位置会逐渐偏离实际位置,很可能出现导航错误等问题。When the vehicle is driving in places without satellite positioning signals, such as indoor parking lots, remote mountainous areas, or road scenes with weak positioning signals, such as areas with many shade trees, many tall buildings, many obstacles, overpasses, etc., it is impossible to obtain accurate vehicle positions. Information, thus causing positioning-related applications on the vehicle to be unusable or prone to errors; and if the vehicle drives in an area with poor navigation signals for a long time, the position calculated by the GNSS+inertial navigation positioning system currently commonly used in vehicles will gradually deviate from the actual position. location, problems such as navigation errors are likely to occur.
目前的车辆定位受到不同道路场景的影响,定位精度不高。Current vehicle positioning is affected by different road scenarios, and the positioning accuracy is not high.
发明内容Contents of the invention
第一方面,本申请提供了一种车辆定位校准方法。所述方法包括:In a first aspect, this application provides a vehicle positioning calibration method. The methods include:
获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;Obtain first positioning information and second positioning information obtained through multiple on-board electronic devices of the target vehicle;
获取第一定位信息的累计误差,并根据累计误差调整置信度参数;Obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error;
根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;Calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameters according to the speed error;
若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。If the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, the calibration positioning information is obtained according to the first positioning information and the second positioning information.
在其中一个实施例中,多个车载电子设备至少包括卫星信号接收装置、惯性测量装置和网络访问装置,获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息,包括:In one embodiment, the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device, and the first positioning information and the second positioning information obtained through the multiple vehicle-mounted electronic devices of the target vehicle are obtained, including :
获取通过卫星信号接收装置获得的目标车辆的原始定位数据,以及通过惯性测量装置获得的目标车辆的六轴数据;Obtain the original positioning data of the target vehicle obtained through the satellite signal receiving device, and the six-axis data of the target vehicle obtained through the inertial measurement device;
根据六轴数据计算得到目标车辆的原始三维位置信息;The original three-dimensional position information of the target vehicle is calculated based on the six-axis data;
根据原始三维位置信息和原始定位数据得到第一定位信息;Obtain first positioning information based on the original three-dimensional position information and original positioning data;
获取通过网络访问装置从实时动态测量系统中获得的目标车辆的第二定位信息。Obtain the second positioning information of the target vehicle obtained from the real-time dynamic measurement system through the network access device.
在其中一个实施例中,获取第一定位信息的累计误差,并根据累计误差调整置信度参数,包括:In one embodiment, obtaining the cumulative error of the first positioning information, and adjusting the confidence parameter based on the cumulative error includes:
若累计误差大于或等于误差阈值,降低置信度参数。If the cumulative error is greater than or equal to the error threshold, reduce the confidence parameter.
在其中一个实施例中,根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数,包括:In one embodiment, calculating the speed error of the target vehicle based on the second positioning information, and adjusting the weight parameters based on the speed error includes:
根据第二定位信息,按照预设时间间隔获取目标车辆在多个连续时刻的定位;According to the second positioning information, obtain the positioning of the target vehicle at multiple consecutive moments according to a preset time interval;
根据当前连续时刻的定位、前一连续时刻的定位和预设时间间隔,计算得到目标车辆在当前连续时刻的测量速度;Based on the positioning at the current continuous moment, the positioning at the previous continuous moment and the preset time interval, the measured speed of the target vehicle at the current continuous moment is calculated;
若目标车辆在当前连续时刻的测量速度不处于标准速度阈值范围,则判定目标车辆在当前连续时刻的测量速度为异常速度;If the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, the measured speed of the target vehicle at the current continuous time is determined to be an abnormal speed;
若连续判定异常速度的次数超过次数阈值,降低权重参数。If the number of consecutive abnormal speed determinations exceeds the number threshold, the weight parameter will be reduced.
在其中一个实施例中,根据第一定位信息和第二定位信息获取校准定位信息,包括:In one embodiment, obtaining calibration positioning information based on the first positioning information and the second positioning information includes:
从第一定位信息中获取第一三维位置信息,第一三维位置信息包括第一经度、第一纬度和第一海拔;Obtain first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude, and a first altitude;
从第二定位信息获取第二三维定位信息,第二三维位置信息包括第二经度、第二纬度 和第二海拔;Obtain second three-dimensional positioning information from the second positioning information. The second three-dimensional position information includes a second longitude and a second latitude. and second elevation;
通过联邦卡尔曼滤波对第一经度和第二经度进行滤波得到融合经度,对第一纬度和第二纬度进行滤波得到融合纬度,对第一海拔和第二海拔进行滤波得到融合海拔;Filter the first longitude and the second longitude through the federated Kalman filter to obtain the fused longitude, filter the first latitude and the second latitude to obtain the fused latitude, and filter the first altitude and the second altitude to obtain the fused altitude;
将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。The fused longitude, fused latitude and fused altitude are used as the fused three-dimensional position information, and the fused three-dimensional position information is replaced with the first three-dimensional position information in the first positioning information to obtain the calibrated positioning information.
在其中一个实施例中,方法还包括:In one embodiment, the method further includes:
获取目标车辆对应的至少三个路侧设备的第三定位信息。Obtain third positioning information of at least three roadside devices corresponding to the target vehicle.
在其中一个实施例中,方法还包括:In one embodiment, the method further includes:
若置信度参数满足第一预设条件,且权重参数不满足第二预设条件,根据第一定位信息和第三定位信息获取校准定位信息。If the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, the calibration positioning information is obtained according to the first positioning information and the third positioning information.
在其中一个实施例中,方法还包括:In one embodiment, the method further includes:
若置信度参数不满足第一预设条件,且权重参数满足第二预设条件的情况下,根据第二定位信息和第三定位信息获取校准定位信息。If the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, the calibration positioning information is obtained according to the second positioning information and the third positioning information.
在其中一个实施例中,方法还包括:In one embodiment, the method further includes:
若置信度参数不满足第一预设条件,且权重参数不满足第二预设条件的情况下,将第三定位信息作为校准定位信息。If the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, the third positioning information is used as the calibration positioning information.
第二方面,本申请还提供了一种车辆定位校准装置。所述装置包括:In a second aspect, this application also provides a vehicle positioning calibration device. The device includes:
定位获取模块,用于获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;A positioning acquisition module, configured to acquire first positioning information and second positioning information obtained through multiple on-board electronic devices of the target vehicle;
第一调节模块,用于获取第一定位信息的累计误差,并根据累计误差调整置信度参数;The first adjustment module is used to obtain the cumulative error of the first positioning information and adjust the confidence parameter according to the cumulative error;
第二调节模块,用于根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;a second adjustment module, configured to calculate the speed error of the target vehicle based on the second positioning information, and adjust the weight parameters based on the speed error;
定位校准模块,用于若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。The positioning calibration module is used to obtain calibration positioning information according to the first positioning information and the second positioning information if the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition.
第三方面,本申请还提供了一种计算机设备。所述计算机设备包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现以下步骤:In a third aspect, this application also provides a computer device. The computer device includes a memory and a processor, the memory stores a computer program, and the processor implements the following steps when executing the computer program:
获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;Obtain first positioning information and second positioning information obtained through multiple on-board electronic devices of the target vehicle;
获取第一定位信息的累计误差,并根据累计误差调整置信度参数;Obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error;
根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;Calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameters according to the speed error;
若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。If the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, the calibration positioning information is obtained according to the first positioning information and the second positioning information.
第四方面,本申请还提供了一种计算机可读存储介质。所述计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现以下步骤:In a fourth aspect, this application also provides a computer-readable storage medium. The computer-readable storage medium has a computer program stored thereon, and when the computer program is executed by the processor, the following steps are implemented:
获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;Obtain the first positioning information and the second positioning information obtained through multiple on-board electronic devices of the target vehicle;
获取第一定位信息的累计误差,并根据累计误差调整置信度参数;Obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error;
根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;Calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameters according to the speed error;
若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。If the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, the calibration positioning information is obtained according to the first positioning information and the second positioning information.
第五方面,本申请还提供了一种计算机程序产品。所述计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现以下步骤:In a fifth aspect, this application also provides a computer program product. The computer program product includes a computer program that implements the following steps when executed by a processor:
获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;Obtain first positioning information and second positioning information obtained through multiple on-board electronic devices of the target vehicle;
获取第一定位信息的累计误差,并根据累计误差调整置信度参数;Obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error;
根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;Calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameters according to the speed error;
若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。If the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, the calibration positioning information is obtained according to the first positioning information and the second positioning information.
上述车辆定位校准方法、装置、计算机设备、存储介质和计算机程序产品,获取通过 目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;获取第一定位信息的累计误差,并根据累计误差调整置信度参数;根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。本申请的一个或多个实施例的细节在下面的附图和描述中提出。本申请的其它特征、目的和优点将从说明书、附图以及权利要求书变得明显。The above-mentioned vehicle positioning and calibration methods, devices, computer equipment, storage media and computer program products have been approved The first positioning information and the second positioning information obtained by multiple on-board electronic devices of the target vehicle; the cumulative error of the first positioning information is obtained, and the confidence parameter is adjusted based on the cumulative error; the speed error of the target vehicle is calculated based on the second positioning information, And adjust the weight parameter according to the speed error; if the confidence parameter meets the first preset condition, and the weight parameter meets the second preset condition, the calibration positioning information is obtained according to the first positioning information and the second positioning information. The details of one or more embodiments of the application are set forth in the accompanying drawings and the description below. Other features, objects and advantages of the application will become apparent from the description, drawings and claims.
附图说明Description of drawings
为了更清楚地说明本申请实施例或传统技术中的技术方案,下面将对实施例或传统技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据公开的附图获得其他的附图。In order to more clearly explain the technical solutions in the embodiments of the present application or the traditional technology, the drawings needed to be used in the description of the embodiments or the traditional technology will be briefly introduced below. Obviously, the drawings in the following description are only for the purpose of explaining the embodiments or the technical solutions of the traditional technology. For the embodiments of the application, those of ordinary skill in the art can also obtain other drawings based on the disclosed drawings without exerting creative efforts.
图1为一个实施例中车辆定位校准方法的应用环境图;Figure 1 is an application environment diagram of the vehicle positioning calibration method in one embodiment;
图2为一个实施例中车辆定位校准方法的流程示意图;Figure 2 is a schematic flow chart of a vehicle positioning calibration method in one embodiment;
图3为一个实施例中车辆定位校准的逻辑示意图;Figure 3 is a logical schematic diagram of vehicle positioning calibration in one embodiment;
图4为一个实施例中车辆定位校准装置的结构框图;Figure 4 is a structural block diagram of a vehicle positioning calibration device in one embodiment;
图5为一个实施例中计算机设备的内部结构图。Figure 5 is an internal structure diagram of a computer device in one embodiment.
具体实施方式Detailed ways
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。The technical solutions in the embodiments of the present application will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present application. Obviously, the described embodiments are only some of the embodiments of the present application, rather than all of the embodiments. Based on the embodiments in this application, all other embodiments obtained by those of ordinary skill in the art without creative efforts fall within the scope of protection of this application.
本申请实施例提供的车辆定位校准方法,可以应用于如图1所示的应用环境中。其中,应用处理器是交通工具中的一个部件。可以理解的是,交通工具可以是车辆、具有行驶功能的机器人设备等,车辆可以是载货汽车、越野汽车、自卸汽车、牵引车、专用汽车、客车、轿车、半挂车等。卫星信号接收装置(GNSS接收装置)、惯性测量装置(IMU,Inertial Measurement Unit)、网络访问装置(NAD,Network Access Device)、通讯装置之间和应用处理器之间连接通信,应用处理器可以通过网络访问装置与实时动态测量系统(RTK系统)进行网络通信,应用处理器也可以通过通讯装置与多个路侧设备进行无线通信。The vehicle positioning calibration method provided by the embodiment of the present application can be applied in the application environment as shown in Figure 1. Among them, the application processor is a component in the vehicle. It can be understood that the means of transportation can be vehicles, robotic equipment with driving functions, etc., and the vehicles can be trucks, off-road vehicles, dump trucks, tractors, special vehicles, passenger cars, cars, semi-trailers, etc. The satellite signal receiving device (GNSS receiving device), the inertial measurement unit (IMU, Inertial Measurement Unit), the network access device (NAD, Network Access Device), the communication device and the application processor are connected and communicated. The application processor can pass The network access device performs network communication with the real-time dynamic measurement system (RTK system), and the application processor can also perform wireless communication with multiple roadside devices through the communication device.
在一个实施例中,如图2所示,提供了一种车辆定位校准方法,以该方法应用于图1中的应用处理器为例进行说明,包括以下步骤:In one embodiment, as shown in Figure 2, a vehicle positioning calibration method is provided. The application of this method to the application processor in Figure 1 is used as an example to illustrate, including the following steps:
步骤202,获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息。Step 202: Obtain first positioning information and second positioning information obtained through multiple vehicle-mounted electronic devices of the target vehicle.
其中,第一定位信息可以是车辆航位推算定位信息,又称DR(Dead Reckoning)定位信息;第二定位信息可以是实时动态测量定位信息,又称RTK(Real Time Kinematic)定位信息。Among them, the first positioning information can be vehicle dead reckoning positioning information, also known as DR (Dead Reckoning) positioning information; the second positioning information can be real-time dynamic measurement positioning information, also known as RTK (Real Time Kinematic) positioning information.
可选的,应用处理器安装在目标车辆上,并通过与目标车辆上的GNSS接收装置和IMU通信,IMU主要包含重力、地磁、陀螺仪、加速度计、电子罗盘等传感器。应用处理器采用IMU的六轴数据修正GNSS接收装置接收的原始定位数据,从而获取目标车辆的DR定位信息,并通过与目标车辆上的NAD通信,获取目标车辆的RTK定位信息,DR定位信息和RTK定位信息中均包含由经度、纬度、海拔组成的三维位置信息。Optionally, the application processor is installed on the target vehicle and communicates with the GNSS receiving device and IMU on the target vehicle. The IMU mainly includes sensors such as gravity, geomagnetism, gyroscope, accelerometer, and electronic compass. The application processor uses the six-axis data of the IMU to correct the original positioning data received by the GNSS receiving device to obtain the DR positioning information of the target vehicle, and obtains the RTK positioning information, DR positioning information and RTK positioning information contains three-dimensional position information consisting of longitude, latitude, and altitude.
步骤204,获取第一定位信息的累计误差,并根据累计误差调整置信度参数。Step 204: Obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error.
可选的,应用处理器持续检测DR定位信息(第一定位信息)的累计误差,当累计误差达到一定程度时,判定DR定位信息的误差较大,降低置信度参数。Optionally, the application processor continuously detects the cumulative error of the DR positioning information (first positioning information). When the cumulative error reaches a certain level, it is determined that the error of the DR positioning information is large and the confidence parameter is reduced.
步骤206,根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数。Step 206: Calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameters according to the speed error.
可选的,应用处理器根据RTK定位信息,按照预设采样频率确定出多个连续的定位位 置,根据前后两个连续的定位位置计算出预设采样频率的位移,并进一步计算出预设采样频率的平均速度,将平均速度和标准速度阈值进行对比,得到速度误差,根据速度误差的大小情况调整权重参数。例如,若速度误差过大,说明当前计算得到的预设采样频率的平均速度不准确,则可能是RTK定位信息不准确,降低权重参数。Optionally, the application processor determines multiple consecutive positioning positions according to the preset sampling frequency based on the RTK positioning information. position, calculate the displacement of the preset sampling frequency based on the two consecutive positioning positions, and further calculate the average speed of the preset sampling frequency, compare the average speed with the standard speed threshold, and obtain the speed error. According to the size of the speed error Adjust the weight parameters accordingly. For example, if the speed error is too large, it means that the currently calculated average speed of the preset sampling frequency is inaccurate. It may be that the RTK positioning information is inaccurate and the weight parameters are reduced.
步骤208,若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。Step 208: If the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, obtain calibration positioning information based on the first positioning information and the second positioning information.
其中,第一预设条件可以是置信度参数不小于50%,第二预设条件可以是权重参数不小于0.6。The first preset condition may be that the confidence parameter is not less than 50%, and the second preset condition may be that the weight parameter is not less than 0.6.
可选的,应用处理器持续检测DR定位信息的置信度参数和RTK定位信息的权重参数,在置信度参数满足第一预设条件,且权重参数满足第二预设条件的情况下,判定当前的DR定位信息和RTK定位信息均为有效定位信息,则根据DR定位信息和RTK定位信息中的经度、纬度、海拔,获取校准定位信息。Optionally, the application processor continuously detects the confidence parameter of the DR positioning information and the weight parameter of the RTK positioning information. When the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, determines the current If the DR positioning information and RTK positioning information are both valid positioning information, then the calibration positioning information is obtained based on the longitude, latitude, and altitude in the DR positioning information and RTK positioning information.
上述车辆定位校准方法中,获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;获取第一定位信息的累计误差,并根据累计误差调整置信度参数;根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。通过计算不同类型的定位信息的误差大小,调整每种定位信息对应的置信度或权重,并结合置信度和权重确定出有效定位信息,并根据有效定位信息得到校准定位信息,能够提高车辆定位的精度。In the above vehicle positioning calibration method, the first positioning information and the second positioning information obtained through multiple vehicle-mounted electronic devices of the target vehicle are obtained; the cumulative error of the first positioning information is obtained, and the confidence parameter is adjusted according to the cumulative error; and the second positioning information is obtained according to the second positioning information. The positioning information calculates the speed error of the target vehicle and adjusts the weight parameter according to the speed error; if the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition, the calibration is obtained based on the first positioning information and the second positioning information. Positioning information. By calculating the error size of different types of positioning information, adjusting the confidence or weight corresponding to each positioning information, and combining the confidence and weight to determine the effective positioning information, and obtaining the calibrated positioning information based on the effective positioning information, the accuracy of vehicle positioning can be improved. Accuracy.
在一个实施例中,多个车载电子设备至少包括卫星信号接收装置、惯性测量装置和网络访问装置,获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息,包括:获取通过卫星信号接收装置获得的目标车辆的原始定位数据,以及通过惯性测量装置获得的目标车辆的六轴数据;根据六轴数据计算得到目标车辆的原始三维位置信息;根据原始三维位置信息和原始定位数据得到第一定位信息;获取通过网络访问装置从实时动态测量系统中获得的目标车辆的第二定位信息。In one embodiment, the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device, and obtaining the first positioning information and the second positioning information obtained through the multiple vehicle-mounted electronic devices of the target vehicle include: Obtain the original positioning data of the target vehicle obtained through the satellite signal receiving device, and the six-axis data of the target vehicle obtained through the inertial measurement device; calculate the original three-dimensional position information of the target vehicle based on the six-axis data; calculate the original three-dimensional position information of the target vehicle based on the original three-dimensional position information and the original The positioning data obtains the first positioning information; and the second positioning information of the target vehicle obtained from the real-time dynamic measurement system through the network access device is obtained.
可选的,GNSS接收装置实时接收GNSS(Global Navigation Satellite System,全球导航卫星系统)卫星群发出的标准GNSS导航设备统一的原始NMEA(National Marine Electronics Association,海用电子设备制定的标准格式)数据,作为原始定位数据。在存在信号遮挡的场景中,原始定位数据会出现数据精度低,定位数据无效的情况,定位打点误差范围大。应用处理器获取到原始NMEA数据后,从IMU中获取目标车辆的六轴数据,并通过三维递推算法对原始NMEA数据进行精度修正,得到第一定位信息(即DR定位信息)。Optionally, the GNSS receiving device receives in real time the unified original NMEA (National Marine Electronics Association, a standard format developed for marine electronic equipment) data sent by the GNSS (Global Navigation Satellite System) satellite group from the standard GNSS navigation equipment. as raw positioning data. In scenarios where signal occlusion exists, the original positioning data will have low data accuracy, invalid positioning data, and a large positioning error range. After the application processor obtains the original NMEA data, it obtains the six-axis data of the target vehicle from the IMU, and performs accuracy correction on the original NMEA data through a three-dimensional recursive algorithm to obtain the first positioning information (ie, DR positioning information).
具体的,在车辆静止时,应用处理器记录来自IMU中的六轴数据,通过Mahony互补滤波算法转化为欧拉角。根据欧拉角与加速度计输出的加速度信息一起转换简历计算机参考坐标系,进行一次积分运算后,得到3个速度分量,即三维的速度信息。再通过第二次积分运算,得到三个位置分量(经度、维度、海拔),从而得到原始三维位置信息。通过原始三维位置信息修正原始定位数据,得到第一定位信息。Specifically, when the vehicle is stationary, the application processor records six-axis data from the IMU and converts it into Euler angles through the Mahony complementary filtering algorithm. According to the Euler angle and the acceleration information output by the accelerometer, the resume computer reference coordinate system is converted. After an integral operation, three velocity components are obtained, that is, three-dimensional velocity information. Through the second integration operation, three position components (longitude, latitude, altitude) are obtained, thereby obtaining the original three-dimensional position information. The original positioning data is corrected through the original three-dimensional position information to obtain the first positioning information.
进一步的,医用处理器通过NAD访问定位服务商的RTK系统服务器,获取RTK系统对当前目标车辆计算的第二定位信息(即RTK定位信息)。RTK定位信息是RTK系统通过星间双差模型对GNSS卫星群发出原始NMEA数据差分处理后的NMEA数据,相当于是经过RTK修正的NMEA数据。Further, the medical processor accesses the RTK system server of the positioning service provider through NAD, and obtains the second positioning information (i.e., RTK positioning information) calculated by the RTK system for the current target vehicle. RTK positioning information is the NMEA data after differential processing of the original NMEA data sent by the RTK system to the GNSS satellite group through the inter-satellite double difference model, which is equivalent to the NMEA data corrected by RTK.
本实施例中,获取通过卫星信号接收装置获得的目标车辆的原始定位数据,以及通过惯性测量装置获得的目标车辆的六轴数据;根据六轴数据计算得到目标车辆的原始三维位置信息;根据原始三维位置信息和原始定位数据得到第一定位信息;获取通过网络访问装置从实时动态测量系统中获得的目标车辆的第二定位信息。能够获取到两种不同类型的定位信息,便于提高车辆定位的精度。 In this embodiment, the original positioning data of the target vehicle obtained through the satellite signal receiving device and the six-axis data of the target vehicle obtained through the inertial measurement device are obtained; the original three-dimensional position information of the target vehicle is calculated based on the six-axis data; and the original three-dimensional position information of the target vehicle is obtained according to the original The three-dimensional position information and the original positioning data are used to obtain the first positioning information; and the second positioning information of the target vehicle obtained from the real-time dynamic measurement system through the network access device is obtained. Two different types of positioning information can be obtained to improve the accuracy of vehicle positioning.
在一个实施例中,获取第一定位信息的累计误差,并根据累计误差调整置信度参数,包括:若累计误差大于或等于误差阈值,降低置信度参数。In one embodiment, the cumulative error of the first positioning information is obtained, and the confidence parameter is adjusted according to the cumulative error, including: if the cumulative error is greater than or equal to the error threshold, reducing the confidence parameter.
可选的,应用处理器连续检测DR定位信息的累计误差,当多次连续检测到的累计误差均大于或等于误差阈值时,就将置信度参数降低,从而降低误差较大的DR定位信息对最终定位的影响。例如,应用处理器按照预设检测周期连续检测DR定位信息的累计误差,当出现连续10次检测到的累计误差大于或等于误差阈值时,就将置信度参数降低。这是由于IMU中陀螺仪零偏随时间漂移,所以需要根据陀螺仪中累计误差对GNSS原始数据进行纠偏。但是在GNSS接收装置无法接收到GNSS信号(原始NMEA数据)的情况下,无法针对IMU累计误差进行纠偏,导致DR定位信息的误差随着时间不断积累,也会存在累计误差。Optionally, the application processor continuously detects the cumulative error of the DR positioning information. When the cumulative errors detected multiple times are greater than or equal to the error threshold, the confidence parameter is lowered, thereby reducing the number of pairs of DR positioning information with larger errors. The impact of final positioning. For example, the application processor continuously detects the cumulative error of the DR positioning information according to the preset detection period. When the cumulative error detected for 10 consecutive times is greater than or equal to the error threshold, the confidence parameter is lowered. This is because the zero bias of the gyroscope in the IMU drifts with time, so the original GNSS data needs to be corrected based on the accumulated error in the gyroscope. However, when the GNSS receiving device cannot receive the GNSS signal (original NMEA data), it cannot correct the IMU accumulated error, causing the error of the DR positioning information to accumulate over time, and there will also be accumulated errors.
具体的,针对DR定位信息的置信度进行计算,GNSS信号为频率是10hz。IMU更新频率为标准频率30khz,比例为1:3000,即IMU输出3k次后,GNSS信号会校准一次。DR定位信息的三维轨迹推算中,需要在GNSS输出时,不断对递推公式中的初始航向角进行纠偏,从而将t更新为0,减少由于时间造成的噪音误差积累。根据这种方式,如果连续1秒IMU输出3k数据,GNSS数据(10次)处于失效状态,无法纠偏累计误差,累计误差超过预设的误差阈值后,置信度默认值1会递减0.01。Specifically, for calculating the confidence of DR positioning information, the frequency of GNSS signal is 10hz. The IMU update frequency is the standard frequency 30khz, and the ratio is 1:3000. That is, after the IMU outputs 3k times, the GNSS signal will be calibrated once. In the three-dimensional trajectory estimation of DR positioning information, it is necessary to continuously correct the initial heading angle in the recursive formula when GNSS is output, thereby updating t to 0 and reducing the accumulation of noise errors due to time. According to this method, if the IMU outputs 3k data continuously for 1 second, the GNSS data (10 times) will be in an invalid state and the accumulated error cannot be corrected. After the accumulated error exceeds the preset error threshold, the default confidence value of 1 will be reduced by 0.01.
在一个可行的实施方式中,应用处理器连续检测DR定位信息的累计误差,当多次连续检测到的累计误差存在小于误差阈值的情况时,就将置信度参数调高,置信度参数存在最大值。In a feasible implementation, the application processor continuously detects the cumulative error of the DR positioning information. When the cumulative error detected multiple times is less than the error threshold, the confidence parameter is increased. The confidence parameter has a maximum value. value.
本实施例中,若累计误差大于或等于误差阈值,降低置信度参数。能够降低较大误差的第一定位信息对最终定位的影响,提高了车辆定位的精度。In this embodiment, if the cumulative error is greater than or equal to the error threshold, the confidence parameter is reduced. It can reduce the impact of large error first positioning information on the final positioning and improve the accuracy of vehicle positioning.
在一个实施例中,根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数,包括:根据第二定位信息,按照预设时间间隔获取目标车辆在多个连续时刻的定位;根据当前连续时刻的定位、前一连续时刻的定位和预设时间间隔,计算得到目标车辆在当前连续时刻的测量速度;若目标车辆在当前连续时刻的测量速度不处于标准速度阈值范围,则判定目标车辆在当前连续时刻的测量速度为异常速度;若连续判定异常速度的次数超过次数阈值,降低权重参数。In one embodiment, calculating the speed error of the target vehicle based on the second positioning information and adjusting the weight parameter based on the speed error includes: obtaining the positioning of the target vehicle at multiple consecutive moments according to the second positioning information at preset time intervals; According to the positioning at the current continuous moment, the positioning at the previous continuous moment and the preset time interval, the measured speed of the target vehicle at the current continuous moment is calculated; if the measured speed of the target vehicle at the current continuous moment is not within the standard speed threshold range, it is determined that The measured speed of the target vehicle at the current continuous moment is abnormal speed; if the number of consecutive abnormal speed determinations exceeds the number threshold, the weight parameter is reduced.
其中,标准速度阈值范围用于表征车辆正常行驶的合理速度范围。Among them, the standard speed threshold range is used to characterize the reasonable speed range for normal driving of the vehicle.
可选的,应用处理器持续获取RTK定位信息中的定位,运用RTK定位计算当前时刻车辆速度,公式如下:
v=||Pk,GNSS-Pk-1||/Δt,
Optionally, the application processor continues to obtain the positioning in the RTK positioning information, and uses the RTK positioning to calculate the vehicle speed at the current moment. The formula is as follows:
v=||P k,GNSS -P k-1 ||/Δt,
其中,Pk,GNSS和Pk-1分别为k时刻GNSS定位和k-1时刻经过滤波后的定位结果。两者速度进行比较,若v超过标准速度阈值范围(实际速度±冗余值),则认为该历元RTK定位误差过大,在连续经过上述过程5次都为异常后,对RTK定位信息的权重参数进行降权处理,权重参数降低0.1。Among them, Pk, GNSS and Pk-1 are the GNSS positioning at time k and the filtered positioning result at time k-1 respectively. Compare the two speeds. If v exceeds the standard speed threshold range (actual speed ± redundant value), it is considered that the RTK positioning error of this epoch is too large. After the above process has been abnormal for 5 consecutive times, the RTK positioning information is The weight parameters are reduced by 0.1.
在一个可行的实施方式中,若连续判定异常速度的次数未超过次数阈值,调高权重参数,权重参数存在最大值。例如,在连续运用RTK定位计算当前时刻车辆速度5次,其中存在1次速度处于标准速度阈值范围内,对RTK定位信息的权重参数进行加权处理,权重参数调高0.1。In a feasible implementation, if the number of consecutive abnormal speed determinations does not exceed the number threshold, the weight parameter is increased and the weight parameter has a maximum value. For example, if RTK positioning is continuously used to calculate the vehicle speed at the current moment 5 times, and one of the times the speed is within the standard speed threshold range, the weight parameter of the RTK positioning information is weighted and the weight parameter is increased by 0.1.
本实施例中,根据第二定位信息,按照预设时间间隔获取目标车辆在多个连续时刻的定位;根据当前连续时刻的定位、前一连续时刻的定位和预设时间间隔,计算得到目标车辆在当前连续时刻的测量速度;若目标车辆在当前连续时刻的测量速度不处于标准速度阈值范围,则判定目标车辆在当前连续时刻的测量速度为异常速度;若连续判定异常速度的次数超过次数阈值,降低权重参数。能够降低较大误差的第二定位信息对最终定位的影响,提高了车辆定位的精度。 In this embodiment, according to the second positioning information, the positioning of the target vehicle at multiple consecutive moments is obtained according to a preset time interval; based on the positioning at the current consecutive moment, the positioning at the previous consecutive moment and the preset time interval, the target vehicle is calculated The measured speed at the current continuous time; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, the measured speed of the target vehicle at the current continuous time is determined to be an abnormal speed; if the number of consecutive abnormal speed determinations exceeds the number threshold , reduce the weight parameters. It can reduce the impact of the second positioning information with large errors on the final positioning and improve the accuracy of vehicle positioning.
在一个实施例中,根据第一定位信息和第二定位信息获取校准定位信息,包括:从第一定位信息中获取第一三维位置信息,第一三维位置信息包括第一经度、第一纬度和第一海拔;从第二定位信息获取第二三维定位信息,第二三维位置信息包括第二经度、第二纬度和第二海拔;通过联邦卡尔曼滤波对第一经度和第二经度进行滤波得到融合经度,对第一纬度和第二纬度进行滤波得到融合纬度,对第一海拔和第二海拔进行滤波得到融合海拔;将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。In one embodiment, obtaining calibration positioning information based on the first positioning information and the second positioning information includes: obtaining first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude and the first altitude; obtain the second three-dimensional positioning information from the second positioning information, the second three-dimensional position information includes the second longitude, the second latitude and the second altitude; perform federal Kalman filtering on the first longitude and the second longitude. Filter to obtain the fused longitude, filter the first latitude and the second latitude to obtain the fused latitude, filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and The three-dimensional position information is fused to replace the first three-dimensional position information in the first positioning information to obtain calibration positioning information.
可选的,应用处理器获取DR定位信息中的第一三维位置信息(第一经度、第一纬度和第一海拔),以及RTK定位信息中的第二三维位置信息(第二经度、第二纬度和第二海拔),针对经度、纬度和海拔分别进行一次联邦卡尔曼滤波,即进行三次联邦卡尔曼滤波。Optionally, the application processor obtains the first three-dimensional position information (first longitude, first latitude, and first altitude) in the DR positioning information, and the second three-dimensional position information (the second longitude, the first altitude) in the RTK positioning information. Second latitude and second altitude), perform a federal Kalman filter once for longitude, latitude and altitude respectively, that is, perform three federal Kalman filters.
联邦卡尔曼滤波向量状态为:δNk、δEk、δSk、分别为北向、东向位置误差,步长估计误差及航向估计误差。假设步长和航向符合一阶马尔可夫过程,根据DR原理,系统状态方程式为xk=Axk-1+Fωk。其中,xk-1为上一时刻的状态;F和ωk分别为系统噪声矩阵和系统过程噪声;为当前时刻航向角;ΔT为采样间隔;TS、为相关时间。The federated Kalman filter vector state is: δNk, δEk, δSk, They are northward and eastward position errors, step estimation errors and heading estimation errors respectively. Assuming that the step length and heading comply with the first-order Markov process, according to the DR principle, the system state equation is x k =Ax k-1 +Fω k . in, xk-1 is the state at the previous moment; F and ωk are the system noise matrix and system process noise respectively; is the heading angle at the current moment; ΔT is the sampling interval; TS, is the relevant time.
系统观测量为DR与RTK位置差:观测向量zk=[zn ze]T,zn和ze分别为DR与RTK北向和东向位置之差。The system observation quantity is the position difference between DR and RTK: Observation vector zk=[zn ze]T, zn and ze are the differences between the northward and eastward positions of DR and RTK respectively.
系统观测方程式为zk=Hxk+vk。式中vk为观测噪声。The system observation equation is z k =Hx k +v k . in the formula vk is the observation noise.
三次联邦卡尔曼滤波后,分别输出滤波处理后的融合经度、融合维度和融合海拔,组成联邦卡尔曼滤波后的融合三维位置信息。最后,用融合三维位置信息反馈替换DR定位信息中的第一三维位置信息。输出最终的融合定位结果作为最终得三维位置定位。After the three-dimensional federated Kalman filtering, the filtered fused longitude, fused dimension and fused altitude are respectively output to form the fused three-dimensional position information after federated Kalman filtering. Finally, the first three-dimensional position information in the DR positioning information is replaced with the fused three-dimensional position information feedback. The final fusion positioning result is output as the final three-dimensional position positioning.
本实施例中,从第一定位信息中获取第一三维位置信息,第一三维位置信息包括第一经度、第一纬度和第一海拔;从第二定位信息获取第二三维定位信息,第二三维位置信息包括第二经度、第二纬度和第二海拔;通过联邦卡尔曼滤波对第一经度和第二经度进行滤波得到融合经度,对第一纬度和第二纬度进行滤波得到融合纬度,对第一海拔和第二海拔进行滤波得到融合海拔;将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。能够对有效定位信息中的三维位置信息进行卡尔曼滤波,得到滤波后的三维位置信息,采用滤波后的三维位置信息得到校准定位信息,提高了车辆定位的精度。In this embodiment, the first three-dimensional position information is obtained from the first positioning information. The first three-dimensional position information includes the first longitude, the first latitude and the first altitude; the second three-dimensional positioning information is obtained from the second positioning information. The two- and three-dimensional position information includes the second longitude, the second latitude and the second altitude; the first longitude and the second longitude are filtered through the federated Kalman filter to obtain the fused longitude, and the first latitude and the second latitude are filtered to obtain the fused latitude. , filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and replace the first three-dimensional position information in the first positioning information with the fused three-dimensional position information, we get Calibrate positioning information. Kalman filtering can be performed on the three-dimensional position information in the effective positioning information to obtain the filtered three-dimensional position information. The filtered three-dimensional position information is used to obtain the calibration positioning information, which improves the accuracy of vehicle positioning.
在一个实施例中,方法还包括:获取目标车辆对应的至少三个路侧设备的第三定位信息。In one embodiment, the method further includes: obtaining third positioning information of at least three roadside devices corresponding to the target vehicle.
其中,路侧设备是指路侧单元(RSU,Road Side Unit),是V2X(vehicle to everything,即车对外界的信息交换)中,安装在路侧,采用蜂窝车联网(C-V2X)技术,与车载单元(OBU,On Board Unit)进行通讯,实现车辆身份识别的装置。路侧设备可以是车辆或者安装在路边的电子设备。Among them, the roadside equipment refers to the roadside unit (RSU, Road Side Unit), which is in V2X (vehicle to everything, that is, the exchange of information between the vehicle and the outside world). It is installed on the roadside and uses cellular vehicle networking (C-V2X) technology. , a device that communicates with the on-board unit (OBU, On Board Unit) to realize vehicle identity recognition. Roadside devices can be vehicles or electronic devices installed on the roadside.
可选的,应用处理器通过通讯装置分别获取目标车辆对应的三个路侧设备的路侧定位信息,并根据三个路侧定位信息计算得到目标车辆的第三定位信息。Optionally, the application processor obtains the roadside positioning information of three roadside devices corresponding to the target vehicle through the communication device, and calculates the third positioning information of the target vehicle based on the three roadside positioning information.
具体的,通讯装置可以是一种PC5通讯芯片(V2X通讯芯片),应用处理器通过 PC5(ProSe5趋近式通讯是无线电的一种通讯形式)通讯,接收来自其他路侧设备(静止V2X终端车辆或者V2X路侧设施)发送的BSM(BasicSafetyMessage)基础安全信息中的高精度定位(经纬度,海拔,3轴加速度,置信度等),根据几何原理,选取N+1个点可确定N维空间,所以需要确定3D位置信息,需要除定位车辆外的至少额外3个V2X设备的路侧三维位置信息,每一个路侧三维位置信息均包括经度、纬度和海拔。Specifically, the communication device can be a PC5 communication chip (V2X communication chip), and the application processor passes PC5 (ProSe5 proximity communication is a form of radio communication) communication, receiving high-precision positioning (latitude and longitude) in BSM (Basic Safety Message) basic safety information sent from other roadside devices (stationary V2X terminal vehicles or V2X roadside facilities) , altitude, 3-axis acceleration, confidence, etc.), according to geometric principles, selecting N+1 points can determine the N-dimensional space, so the 3D position information needs to be determined, and at least 3 additional V2X devices are required on the roadside in addition to positioning the vehicle. Three-dimensional location information. Each roadside three-dimensional location information includes longitude, latitude and altitude.
通过计算目标车辆到3个RSU之间的距离,确定目标车辆位置,具体公式如下:
By calculating the distance between the target vehicle and the three RSUs, the target vehicle position is determined. The specific formula is as follows:
式中,Xa、Ya、Za为目标车辆的经度、纬度和海拔坐标(三维位置信息),X1、Y1、Z1,X2、Y2、Z2和X3、Y3、Z3分别为三个路侧设备的路侧三维位置信息。获取与三个路侧设备与目标车辆之间的距离d1、d2、d3。应用处理器计算得到Xa、Ya、Za,即为第三定位信息。In the formula, X a , Y a , Z a are the longitude, latitude and altitude coordinates (three - dimensional position information) of the target vehicle, X 1 , Y 1 , Z 1 , , Z 3 are respectively the roadside three-dimensional position information of the three roadside devices. Obtain the distances d 1 , d 2 , and d 3 between the three roadside devices and the target vehicle. The application processor calculates X a , Y a , and Z a , which are the third positioning information.
在V2X系统中,应用处理器即可以通过芯片厂商提供的网络接入层接口API获取实时天线信号RSSI值,天线射频增益值,V2X系统实时频率,使用理论模型计算得到速度和距离。也可以使用TDOA(Time Difference Of Arrival)测量方法测量信号到达时间,从而测距使用上述公式。In the V2X system, the application processor can obtain the real-time antenna signal RSSI value, antenna RF gain value, and V2X system real-time frequency through the network access layer interface API provided by the chip manufacturer, and use the theoretical model to calculate the speed and distance. You can also use the TDOA (Time Difference Of Arrival) measurement method to measure the signal arrival time, so that the distance measurement uses the above formula.
本实施例中,获取目标车辆对应的至少三个路侧设备的第三定位信息。能够基于V2X系统获取目标车辆的定位信息,便于在NAD无法访问网络,且GNSS无信号的场景下获取目标车辆的定位,提高了车辆定位的精度。In this embodiment, third positioning information of at least three roadside devices corresponding to the target vehicle is obtained. The positioning information of the target vehicle can be obtained based on the V2X system, which is convenient for obtaining the positioning of the target vehicle in scenarios where NAD cannot access the network and GNSS has no signal, improving the accuracy of vehicle positioning.
在一个实施例中,方法还包括:若置信度参数满足第一预设条件,且权重参数不满足第二预设条件,根据第一定位信息和第三定位信息获取校准定位信息。In one embodiment, the method further includes: if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, obtaining calibration positioning information based on the first positioning information and the third positioning information.
若置信度参数不满足第一预设条件,且权重参数满足第二预设条件的情况下,根据第二定位信息和第三定位信息获取校准定位信息。若置信度参数不满足第一预设条件,且权重参数不满足第二预设条件的情况下,将第三定位信息作为校准定位信息。If the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, the calibration positioning information is obtained according to the second positioning information and the third positioning information. If the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, the third positioning information is used as the calibration positioning information.
可选的,若置信度参数满足第一预设条件,且权重参数不满足第二预设条件,说明当前的道路环境存在NAD无法访问网络,无法接收RTK系统定位的情况,此时RTK定位信息的准确性较低,因此RTK定位信息不能作为有效定位信息,将DR定位信息和第三定位信息作为有效定位信息,根据第一定位信息和第三定位信息获取校准定位信息。若置信度参数不满足第一预设条件,且权重参数满足第二预设条件的情况下,说明当前的道路环境存在GNSS无信号,IMU累计误差较大的情况,此时DR定位信息的准确性较低,因此DR定位信息不能作为有效定位信息,将RTK定位信息和第三定位信息作为有效定位信息,根据第二定位信息和第三定位信息获取校准定位信息。若置信度参数不满足第一预设条件,且权重参数不满足第二预设条件的情况下,说明当前的道路环境存在NAD无法访问网络且GNSS无信号,既无法接收RTK系统定位,IMU累计误差也较大的情况,此时DR定位信息和RTK定位信息的准确性均较低,因此DR定位信息和RTK定位信息都不能作为有效定位信息,仅将第三定位信息作为有效定位信息,直接输出第三定位信息作为校准定位信息。Optionally, if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, it means that in the current road environment, NAD cannot access the network and cannot receive RTK system positioning. At this time, RTK positioning information The accuracy is low, so the RTK positioning information cannot be used as effective positioning information. The DR positioning information and the third positioning information are used as the effective positioning information, and the calibration positioning information is obtained based on the first positioning information and the third positioning information. If the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, it means that there is no GNSS signal in the current road environment and the IMU cumulative error is large. At this time, the DR positioning information is accurate. The accuracy is low, so the DR positioning information cannot be used as effective positioning information. The RTK positioning information and the third positioning information are used as the effective positioning information, and the calibration positioning information is obtained based on the second positioning information and the third positioning information. If the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, it means that the current road environment is such that NAD cannot access the network and GNSS has no signal. It cannot receive RTK system positioning and the IMU has accumulated When the error is also large, the accuracy of both DR positioning information and RTK positioning information is low. Therefore, neither DR positioning information nor RTK positioning information can be used as effective positioning information. Only the third positioning information is used as effective positioning information. Directly The third positioning information is output as calibration positioning information.
本实施例中,通过计算不同类型的定位信息的误差大小,调整每种定位信息对应的置信度或权重,并结合置信度和权重确定出有效定位信息,并根据有效定位信息得到校准定位信息,能够提高车辆定位的精度。 In this embodiment, the error size of different types of positioning information is calculated, the confidence or weight corresponding to each positioning information is adjusted, and the effective positioning information is determined based on the confidence and weight, and the calibrated positioning information is obtained based on the effective positioning information. It can improve the accuracy of vehicle positioning.
在一个实施例中,如图3所示,一种车辆定位校准方法,包括:In one embodiment, as shown in Figure 3, a vehicle positioning calibration method includes:
获取通过卫星信号接收装置获得的目标车辆的原始定位数据,以及通过惯性测量装置获得的目标车辆的六轴数据;根据六轴数据计算得到目标车辆的原始三维位置信息;根据原始三维位置信息和原始定位数据得到第一定位信息;获取通过网络访问装置从实时动态测量系统中获得的目标车辆的第二定位信息。获取目标车辆对应的至少三个路侧设备的第三定位信息。Obtain the original positioning data of the target vehicle obtained through the satellite signal receiving device, and the six-axis data of the target vehicle obtained through the inertial measurement device; calculate the original three-dimensional position information of the target vehicle based on the six-axis data; calculate the original three-dimensional position information of the target vehicle based on the original three-dimensional position information and the original The positioning data obtains the first positioning information; and the second positioning information of the target vehicle obtained from the real-time dynamic measurement system through the network access device is obtained. Obtain third positioning information of at least three roadside devices corresponding to the target vehicle.
获取第一定位信息的累计误差,若累计误差大于或等于误差阈值,降低置信度参数。Obtain the cumulative error of the first positioning information. If the cumulative error is greater than or equal to the error threshold, reduce the confidence parameter.
根据第二定位信息,按照预设时间间隔获取目标车辆在多个连续时刻的定位;根据当前连续时刻的定位、前一连续时刻的定位和预设时间间隔,计算得到目标车辆在当前连续时刻的测量速度;若目标车辆在当前连续时刻的测量速度不处于标准速度阈值范围,则判定目标车辆在当前连续时刻的测量速度为异常速度;若连续判定异常速度的次数超过次数阈值,降低权重参数。According to the second positioning information, the positioning of the target vehicle at multiple consecutive moments is obtained according to a preset time interval; based on the positioning at the current consecutive moment, the positioning at the previous consecutive moment and the preset time interval, the position of the target vehicle at the current consecutive moment is calculated. Measure the speed; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, the measured speed of the target vehicle at the current continuous time is determined to be abnormal speed; if the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter is reduced.
若置信度参数满足第一预设条件,且权重参数满足第二预设条件,从第一定位信息中获取第一三维位置信息,第一三维位置信息包括第一经度、第一纬度和第一海拔;从第二定位信息获取第二三维定位信息,第二三维位置信息包括第二经度、第二纬度和第二海拔;通过联邦卡尔曼滤波对第一经度和第二经度进行滤波得到融合经度,对第一纬度和第二纬度进行滤波得到融合纬度,对第一海拔和第二海拔进行滤波得到融合海拔;将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。If the confidence parameter satisfies the first preset condition and the weight parameter satisfies the second preset condition, obtain the first three-dimensional position information from the first positioning information. The first three-dimensional position information includes the first longitude, the first latitude and the third One altitude; obtain the second three-dimensional positioning information from the second positioning information, and the second three-dimensional position information includes the second longitude, the second latitude and the second altitude; filter the first longitude and the second longitude through the federal Kalman filter to obtain To fuse longitude, filter the first latitude and second latitude to obtain the fused latitude, and filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and fuse the three-dimensional The position information replaces the first three-dimensional position information in the first positioning information to obtain calibration positioning information.
若置信度参数满足第一预设条件,且权重参数不满足第二预设条件,从第一定位信息中获取第一三维位置信息,第一三维位置信息包括第一经度、第一纬度和第一海拔;从第三定位信息获取第三三维定位信息,第三三维位置信息包括第三经度、第三纬度和第三海拔;通过联邦卡尔曼滤波对第一经度和第三经度进行滤波得到融合经度,对第一纬度和第三纬度进行滤波得到融合纬度,对第一海拔和第三海拔进行滤波得到融合海拔;将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。If the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, obtain the first three-dimensional position information from the first positioning information. The first three-dimensional position information includes the first longitude, the first latitude and the first three-dimensional position information. The first altitude; obtain the third three-dimensional positioning information from the third positioning information, the third three-dimensional position information includes the third longitude, the third latitude and the third altitude; filter the first longitude and the third longitude through the federal Kalman filter Obtain the fused longitude, filter the first latitude and the third latitude to obtain the fused latitude, filter the first altitude and the third altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and fuse The three-dimensional position information replaces the first three-dimensional position information in the first positioning information to obtain calibration positioning information.
若置信度参数不满足第一预设条件,且权重参数满足第二预设条件的情况下,从第三定位信息中获取第三三维位置信息,第三三维位置信息包括第三经度、第三纬度和第三海拔;从第二定位信息获取第二三维定位信息,第二三维位置信息包括第二经度、第二纬度和第二海拔;通过联邦卡尔曼滤波对第三经度和第二经度进行滤波得到融合经度,对第三纬度和第二纬度进行滤波得到融合纬度,对第三海拔和第二海拔进行滤波得到融合海拔;将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。If the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, the third three-dimensional position information is obtained from the third positioning information, and the third three-dimensional position information includes the third longitude, the third Latitude and third altitude; obtain the second three-dimensional positioning information from the second positioning information, and the second three-dimensional position information includes the second longitude, the second latitude and the second altitude; perform federal Kalman filtering on the third longitude and the second longitude. Filter to obtain the fused longitude, filter the third latitude and the second latitude to obtain the fused latitude, filter the third altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and The three-dimensional position information is fused to replace the first three-dimensional position information in the first positioning information to obtain calibration positioning information.
若置信度参数不满足第一预设条件,且权重参数不满足第二预设条件的情况下,将第三定位信息作为校准定位信息。If the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, the third positioning information is used as the calibration positioning information.
本实施例中,能够在不同定位数据源状态失效的道路场景下,采用不同计算方法计算有效定位数据,对车辆进行定位校准,保证车辆在不同的道路场景中定位的准确性。In this embodiment, in road scenarios where the status of different positioning data sources fails, different calculation methods can be used to calculate effective positioning data, and the vehicle can be positioned and calibrated to ensure the accuracy of the vehicle's positioning in different road scenarios.
应该理解的是,虽然如上所述的各实施例所涉及的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,如上所述的各实施例所涉及的流程图中的至少一部分步骤可以包括多个步骤或者多个阶段,这些步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤中的步骤或者阶段的至少一部分轮流或者交替地执行。It should be understood that although the steps in the flowcharts involved in the above-mentioned embodiments are shown in sequence as indicated by the arrows, these steps are not necessarily executed in the order indicated by the arrows. Unless explicitly stated in this article, there is no strict order restriction on the execution of these steps, and these steps can be executed in other orders. Moreover, at least some of the steps in the flowcharts involved in the above embodiments may include multiple steps or stages. These steps or stages are not necessarily executed at the same time, but may be completed at different times. The execution order of these steps or stages is not necessarily sequential, but may be performed in turn or alternately with other steps or at least part of the steps or stages in other steps.
基于同样的发明构思,本申请实施例还提供了一种用于实现上述所涉及的车辆定位校准方法的车辆定位校准装置。该装置所提供的解决问题的实现方案与上述方法中所记载的 实现方案相似,故下面所提供的一个或多个车辆定位校准装置实施例中的具体限定可以参见上文中对于车辆定位校准方法的限定,在此不再赘述。Based on the same inventive concept, embodiments of the present application also provide a vehicle positioning calibration device for implementing the above-mentioned vehicle positioning calibration method. The solution to the problem provided by this device is the same as that recorded in the above method. The implementation solutions are similar, so the specific limitations in one or more vehicle positioning calibration device embodiments provided below can refer to the above limitations on the vehicle positioning calibration method, and will not be described again here.
在一个实施例中,如图4所示,提供了一种车辆定位校准装置400,包括:定位获取模块401、第一调节模块402、第二调节模块403和定位校准模块404,其中:In one embodiment, as shown in Figure 4, a vehicle positioning calibration device 400 is provided, including: a positioning acquisition module 401, a first adjustment module 402, a second adjustment module 403 and a positioning calibration module 404, wherein:
定位获取模块401,用于获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;The positioning acquisition module 401 is used to obtain the first positioning information and the second positioning information obtained through multiple on-board electronic devices of the target vehicle;
第一调节模块402,用于获取第一定位信息的累计误差,并根据累计误差调整置信度参数;The first adjustment module 402 is used to obtain the cumulative error of the first positioning information, and adjust the confidence parameter according to the cumulative error;
第二调节模块403,用于根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;The second adjustment module 403 is used to calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameters according to the speed error;
定位校准模块404,用于若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。The positioning calibration module 404 is used to obtain calibration positioning information according to the first positioning information and the second positioning information if the confidence parameter meets the first preset condition and the weight parameter meets the second preset condition.
在一个实施例中,多个车载电子设备至少包括卫星信号接收装置、惯性测量装置和网络访问装置,定位获取模块401还用于获取通过卫星信号接收装置获得的目标车辆的原始定位数据,以及通过惯性测量装置获得的目标车辆的六轴数据;根据六轴数据计算得到目标车辆的原始三维位置信息;根据原始三维位置信息和原始定位数据得到第一定位信息;获取通过网络访问装置从实时动态测量系统中获得的目标车辆的第二定位信息。In one embodiment, the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device. The positioning acquisition module 401 is also used to obtain the original positioning data of the target vehicle obtained through the satellite signal receiving device, and through The six-axis data of the target vehicle obtained by the inertial measurement device; the original three-dimensional position information of the target vehicle is calculated based on the six-axis data; the first positioning information is obtained based on the original three-dimensional position information and the original positioning data; the real-time dynamic measurement is obtained from the network access device The second positioning information of the target vehicle obtained in the system.
在一个实施例中,第一调节模块402还用于若累计误差大于或等于误差阈值,降低置信度参数。In one embodiment, the first adjustment module 402 is also configured to reduce the confidence parameter if the cumulative error is greater than or equal to the error threshold.
在一个实施例中,第二调节模块403还用于根据第二定位信息,按照预设时间间隔获取目标车辆在多个连续时刻的定位;根据当前连续时刻的定位、前一连续时刻的定位和预设时间间隔,计算得到目标车辆在当前连续时刻的测量速度;若目标车辆在当前连续时刻的测量速度不处于标准速度阈值范围,则判定目标车辆在当前连续时刻的测量速度为异常速度;若连续判定异常速度的次数超过次数阈值,降低权重参数。In one embodiment, the second adjustment module 403 is also configured to obtain the positioning of the target vehicle at multiple consecutive moments according to the second positioning information according to a preset time interval; according to the positioning at the current consecutive moment, the positioning at the previous consecutive moment and Preset time intervals, and calculate the measured speed of the target vehicle at the current continuous time; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, it is determined that the measured speed of the target vehicle at the current continuous time is an abnormal speed; if If the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter will be reduced.
在一个实施例中,定位校准模块404还用于从第一定位信息中获取第一三维位置信息,第一三维位置信息包括第一经度、第一纬度和第一海拔;从第二定位信息获取第二三维定位信息,第二三维位置信息包括第二经度、第二纬度和第二海拔;通过联邦卡尔曼滤波对第一经度和第二经度进行滤波得到融合经度,对第一纬度和第二纬度进行滤波得到融合纬度,对第一海拔和第二海拔进行滤波得到融合海拔;将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。In one embodiment, the positioning calibration module 404 is also configured to obtain first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude and a first altitude; from the second positioning information Obtain the second three-dimensional positioning information, which includes the second longitude, the second latitude and the second altitude; filter the first longitude and the second longitude through the federal Kalman filter to obtain the fused longitude, and filter the first latitude and the second altitude. Filter the second latitude to obtain the fused latitude, filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and replace the fused three-dimensional position information in the first positioning information The first three-dimensional position information is obtained to obtain the calibration positioning information.
在一个实施例中,定位获取模块401还用于获取目标车辆对应的至少三个路侧设备的第三定位信息。In one embodiment, the position acquisition module 401 is also used to obtain the third position information of at least three roadside devices corresponding to the target vehicle.
在一个实施例中,定位校准模块404还用于若置信度参数满足第一预设条件,且权重参数不满足第二预设条件,根据第一定位信息和第三定位信息获取校准定位信息。In one embodiment, the positioning calibration module 404 is also configured to obtain calibration positioning information based on the first positioning information and the third positioning information if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition.
在一个实施例中,定位校准模块404还用于若置信度参数不满足第一预设条件,且权重参数满足第二预设条件的情况下,根据第二定位信息和第三定位信息获取校准定位信息。In one embodiment, the positioning calibration module 404 is also used to obtain calibration based on the second positioning information and the third positioning information if the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition. Positioning information.
在一个实施例中,定位校准模块404还用于若置信度参数不满足第一预设条件,且权重参数不满足第二预设条件的情况下,将第三定位信息作为校准定位信息。In one embodiment, the positioning calibration module 404 is also configured to use the third positioning information as the calibration positioning information if the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition.
上述车辆定位校准装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。Each module in the above-mentioned vehicle positioning calibration device can be implemented in whole or in part by software, hardware and combinations thereof. Each of the above modules may be embedded in or independent of the processor of the computer device in the form of hardware, or may be stored in the memory of the computer device in the form of software, so that the processor can call and execute the operations corresponding to the above modules.
在一个实施例中,提供了一种计算机设备,该计算机设备可以是车载T-BOX(Telematics BOX)或带有网络功能以及V2X功能的车载终端设备,其内部结构图可以如图5所示。该计算机设备包括处理器、存储器、输入/输出接口(Input/Output,简称I/O)和通信接口。其中,处理器、存储器和输入/输出接口通过系统总线连接,通信接口通过输入/输出接口 连接到系统总线。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质和内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的数据库用于存储定位数据。该计算机设备的输入/输出接口用于处理器与外部设备之间交换信息。该计算机设备的通信接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种车辆定位校准方法。In one embodiment, a computer device is provided. The computer device can be a vehicle-mounted T-BOX (Telematics BOX) or a vehicle-mounted terminal device with network functions and V2X functions. Its internal structure diagram can be shown in Figure 5 . The computer device includes a processor, a memory, an input/output interface (Input/Output, referred to as I/O), and a communication interface. Among them, the processor, memory and input/output interface are connected through the system bus, and the communication interface is connected through the input/output interface Connect to the system bus. Wherein, the processor of the computer device is used to provide computing and control capabilities. The memory of the computer device includes non-volatile storage media and internal memory. The non-volatile storage medium stores operating systems, computer programs and databases. This internal memory provides an environment for the execution of operating systems and computer programs in non-volatile storage media. The computer device's database is used to store positioning data. The input/output interface of the computer device is used to exchange information between the processor and external devices. The communication interface of the computer device is used to communicate with an external terminal through a network connection. The computer program implements a vehicle positioning calibration method when executed by a processor.
本领域技术人员可以理解,图5中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。Those skilled in the art can understand that the structure shown in Figure 5 is only a block diagram of a partial structure related to the solution of the present application, and does not constitute a limitation on the computer equipment to which the solution of the present application is applied. The specific computer equipment can May include more or fewer parts than shown, or combine certain parts, or have a different arrangement of parts.
在一个实施例中,提供了一种计算机设备,包括存储器和处理器,存储器中存储有计算机程序,该处理器执行计算机程序时实现以下步骤:获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;获取第一定位信息的累计误差,并根据累计误差调整置信度参数;根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。In one embodiment, a computer device is provided, including a memory and a processor. A computer program is stored in the memory. When the processor executes the computer program, it implements the following steps: Obtaining the first data obtained through multiple vehicle-mounted electronic devices of the target vehicle. First positioning information and second positioning information; obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error; calculate the speed error of the target vehicle based on the second positioning information, and adjust the weight parameter based on the speed error; if the confidence The parameter satisfies the first preset condition, and the weight parameter satisfies the second preset condition, and the calibration positioning information is obtained according to the first positioning information and the second positioning information.
在一个实施例中,多个车载电子设备至少包括卫星信号接收装置、惯性测量装置和网络访问装置,处理器执行计算机程序时还实现以下步骤:获取通过卫星信号接收装置获得的目标车辆的原始定位数据,以及通过惯性测量装置获得的目标车辆的六轴数据;根据六轴数据计算得到目标车辆的原始三维位置信息;根据原始三维位置信息和原始定位数据得到第一定位信息;获取通过网络访问装置从实时动态测量系统中获得的目标车辆的第二定位信息。In one embodiment, the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device. When the processor executes the computer program, the following steps are also implemented: Obtain the original positioning of the target vehicle obtained through the satellite signal receiving device. data, and the six-axis data of the target vehicle obtained through the inertial measurement device; calculate the original three-dimensional position information of the target vehicle based on the six-axis data; obtain the first positioning information based on the original three-dimensional position information and original positioning data; obtain the device through network access Second positioning information of the target vehicle obtained from the real-time dynamic measurement system.
在一个实施例中,处理器执行计算机程序时还实现以下步骤:若累计误差大于或等于误差阈值,降低置信度参数。In one embodiment, when the processor executes the computer program, the following steps are also implemented: if the cumulative error is greater than or equal to the error threshold, reduce the confidence parameter.
在一个实施例中,处理器执行计算机程序时还实现以下步骤:根据第二定位信息,按照预设时间间隔获取目标车辆在多个连续时刻的定位;根据当前连续时刻的定位、前一连续时刻的定位和预设时间间隔,计算得到目标车辆在当前连续时刻的测量速度;若目标车辆在当前连续时刻的测量速度不处于标准速度阈值范围,则判定目标车辆在当前连续时刻的测量速度为异常速度;若连续判定异常速度的次数超过次数阈值,降低权重参数。In one embodiment, when the processor executes the computer program, the following steps are also implemented: according to the second positioning information, obtain the positioning of the target vehicle at multiple consecutive moments according to a preset time interval; according to the positioning of the current consecutive moment, the previous consecutive moment Based on the positioning and preset time interval, the measured speed of the target vehicle at the current continuous time is calculated; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, the measured speed of the target vehicle at the current continuous time is determined to be abnormal. Speed; if the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter will be reduced.
在一个实施例中,处理器执行计算机程序时还实现以下步骤:从第一定位信息中获取第一三维位置信息,第一三维位置信息包括第一经度、第一纬度和第一海拔;从第二定位信息获取第二三维定位信息,第二三维位置信息包括第二经度、第二纬度和第二海拔;通过联邦卡尔曼滤波对第一经度和第二经度进行滤波得到融合经度,对第一纬度和第二纬度进行滤波得到融合纬度,对第一海拔和第二海拔进行滤波得到融合海拔;将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。In one embodiment, when the processor executes the computer program, the processor further implements the following steps: obtaining first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude and a first altitude; from The second positioning information obtains the second three-dimensional positioning information. The second three-dimensional position information includes the second longitude, the second latitude and the second altitude; the first longitude and the second longitude are filtered through the federal Kalman filter to obtain the fused longitude. Filter the first latitude and the second latitude to obtain the fused latitude, filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and replace the fused three-dimensional position information with the fused three-dimensional position information. The first three-dimensional position information in a certain positioning information is used to obtain the calibration positioning information.
在一个实施例中,处理器执行计算机程序时还实现以下步骤:获取目标车辆对应的至少三个路侧设备的第三定位信息。In one embodiment, when the processor executes the computer program, the processor also implements the following steps: obtaining third positioning information of at least three roadside devices corresponding to the target vehicle.
在一个实施例中,处理器执行计算机程序时还实现以下步骤:若置信度参数满足第一预设条件,且权重参数不满足第二预设条件,根据第一定位信息和第三定位信息获取校准定位信息。In one embodiment, the processor also implements the following steps when executing the computer program: if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, obtain the information based on the first positioning information and the third positioning information. Calibrate positioning information.
在一个实施例中,处理器执行计算机程序时还实现以下步骤:若置信度参数不满足第一预设条件,且权重参数满足第二预设条件的情况下,根据第二定位信息和第三定位信息获取校准定位信息。In one embodiment, the processor also implements the following steps when executing the computer program: if the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, based on the second positioning information and the third Positioning information obtains calibration positioning information.
在一个实施例中,处理器执行计算机程序时还实现以下步骤:若置信度参数不满足第一预设条件,且权重参数不满足第二预设条件的情况下,将第三定位信息作为校准定位信息。 In one embodiment, the processor also implements the following steps when executing the computer program: if the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, use the third positioning information as the calibration Positioning information.
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现以下步骤:获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;获取第一定位信息的累计误差,并根据累计误差调整置信度参数;根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。In one embodiment, a computer-readable storage medium is provided with a computer program stored thereon. When the computer program is executed by a processor, the following steps are implemented: obtaining first positioning information obtained through multiple on-board electronic devices of the target vehicle. and the second positioning information; obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error; calculate the speed error of the target vehicle based on the second positioning information, and adjust the weight parameter based on the speed error; if the confidence parameter satisfies the A preset condition, and the weight parameter satisfies the second preset condition, and the calibration positioning information is obtained according to the first positioning information and the second positioning information.
在一个实施例中,多个车载电子设备至少包括卫星信号接收装置、惯性测量装置和网络访问装置,计算机程序被处理器执行时还实现以下步骤:获取通过卫星信号接收装置获得的目标车辆的原始定位数据,以及通过惯性测量装置获得的目标车辆的六轴数据;根据六轴数据计算得到目标车辆的原始三维位置信息;根据原始三维位置信息和原始定位数据得到第一定位信息;获取通过网络访问装置从实时动态测量系统中获得的目标车辆的第二定位信息。In one embodiment, the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device. When the computer program is executed by the processor, the following steps are also implemented: Obtain the original data of the target vehicle obtained through the satellite signal receiving device. Positioning data, as well as the six-axis data of the target vehicle obtained through the inertial measurement device; the original three-dimensional position information of the target vehicle is calculated based on the six-axis data; the first positioning information is obtained based on the original three-dimensional position information and the original positioning data; accessed through the network The device obtains the second positioning information of the target vehicle from the real-time dynamic measurement system.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:若累计误差大于或等于误差阈值,降低置信度参数。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: if the cumulative error is greater than or equal to the error threshold, reduce the confidence parameter.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:根据第二定位信息,按照预设时间间隔获取目标车辆在多个连续时刻的定位;根据当前连续时刻的定位、前一连续时刻的定位和预设时间间隔,计算得到目标车辆在当前连续时刻的测量速度;若目标车辆在当前连续时刻的测量速度不处于标准速度阈值范围,则判定目标车辆在当前连续时刻的测量速度为异常速度;若连续判定异常速度的次数超过次数阈值,降低权重参数。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: according to the second positioning information, obtain the positioning of the target vehicle at multiple consecutive moments according to a preset time interval; according to the positioning at the current consecutive moment, the previous consecutive moment Moment positioning and preset time intervals are used to calculate the measured speed of the target vehicle at the current continuous time; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, it is determined that the measured speed of the target vehicle at the current continuous time is Abnormal speed; if the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter will be reduced.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:从第一定位信息中获取第一三维位置信息,第一三维位置信息包括第一经度、第一纬度和第一海拔;从第二定位信息获取第二三维定位信息,第二三维位置信息包括第二经度、第二纬度和第二海拔;通过联邦卡尔曼滤波对第一经度和第二经度进行滤波得到融合经度,对第一纬度和第二纬度进行滤波得到融合纬度,对第一海拔和第二海拔进行滤波得到融合海拔;将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。In one embodiment, when executed by the processor, the computer program also implements the following steps: obtaining first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude, and a first altitude; The second three-dimensional positioning information is obtained from the second positioning information. The second three-dimensional position information includes the second longitude, the second latitude and the second altitude; the first longitude and the second longitude are filtered through the federated Kalman filter to obtain the fused longitude, Filter the first latitude and the second latitude to obtain the fused latitude, filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and replace the fused three-dimensional position information Calibration positioning information is obtained from the first three-dimensional position information in the first positioning information.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:获取目标车辆对应的至少三个路侧设备的第三定位信息。In one embodiment, when executed by the processor, the computer program further implements the following steps: obtaining third positioning information of at least three roadside devices corresponding to the target vehicle.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:若置信度参数满足第一预设条件,且权重参数不满足第二预设条件,根据第一定位信息和第三定位信息获取校准定位信息。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, based on the first positioning information and the third positioning information Get calibration positioning information.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:若置信度参数不满足第一预设条件,且权重参数满足第二预设条件的情况下,根据第二定位信息和第三定位信息获取校准定位信息。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: if the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, based on the second positioning information and the third preset condition, 3. Positioning information to obtain calibration positioning information.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:若置信度参数不满足第一预设条件,且权重参数不满足第二预设条件的情况下,将第三定位信息作为校准定位信息。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: if the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, use the third positioning information as Calibrate positioning information.
在一个实施例中,提供了一种计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现以下步骤:获取通过目标车辆的多个车载电子设备获得的第一定位信息和第二定位信息;获取第一定位信息的累计误差,并根据累计误差调整置信度参数;根据第二定位信息计算目标车辆的速度误差,并根据速度误差调整权重参数;若置信度参数满足第一预设条件,且权重参数满足第二预设条件,根据第一定位信息和第二定位信息获取校准定位信息。In one embodiment, a computer program product is provided, including a computer program that, when executed by a processor, implements the following steps: acquiring first positioning information and second positioning obtained through a plurality of vehicle-mounted electronic devices of a target vehicle. information; obtain the cumulative error of the first positioning information, and adjust the confidence parameter based on the cumulative error; calculate the speed error of the target vehicle based on the second positioning information, and adjust the weight parameter based on the speed error; if the confidence parameter meets the first preset condition , and the weight parameter meets the second preset condition, and the calibration positioning information is obtained according to the first positioning information and the second positioning information.
在一个实施例中,多个车载电子设备至少包括卫星信号接收装置、惯性测量装置和网络访问装置,计算机程序被处理器执行时还实现以下步骤:获取通过卫星信号接收装置获得的目标车辆的原始定位数据,以及通过惯性测量装置获得的目标车辆的六轴数据;根据 六轴数据计算得到目标车辆的原始三维位置信息;根据原始三维位置信息和原始定位数据得到第一定位信息;获取通过网络访问装置从实时动态测量系统中获得的目标车辆的第二定位信息。In one embodiment, the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device. When the computer program is executed by the processor, the following steps are also implemented: Obtain the original data of the target vehicle obtained through the satellite signal receiving device. Positioning data, as well as six-axis data of the target vehicle obtained through an inertial measurement device; according to The six-axis data is calculated to obtain the original three-dimensional position information of the target vehicle; the first positioning information is obtained based on the original three-dimensional position information and the original positioning data; and the second positioning information of the target vehicle obtained from the real-time dynamic measurement system through the network access device is obtained.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:若累计误差大于或等于误差阈值,降低置信度参数。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: if the cumulative error is greater than or equal to the error threshold, reduce the confidence parameter.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:根据第二定位信息,按照预设时间间隔获取目标车辆在多个连续时刻的定位;根据当前连续时刻的定位、前一连续时刻的定位和预设时间间隔,计算得到目标车辆在当前连续时刻的测量速度;若目标车辆在当前连续时刻的测量速度不处于标准速度阈值范围,则判定目标车辆在当前连续时刻的测量速度为异常速度;若连续判定异常速度的次数超过次数阈值,降低权重参数。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: according to the second positioning information, obtain the positioning of the target vehicle at multiple consecutive moments according to a preset time interval; according to the positioning at the current consecutive moment, the previous consecutive moment Moment positioning and preset time intervals are used to calculate the measured speed of the target vehicle at the current continuous time; if the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, it is determined that the measured speed of the target vehicle at the current continuous time is Abnormal speed; if the number of consecutive abnormal speed determinations exceeds the threshold, the weight parameter will be reduced.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:从第一定位信息中获取第一三维位置信息,第一三维位置信息包括第一经度、第一纬度和第一海拔;从第二定位信息获取第二三维定位信息,第二三维位置信息包括第二经度、第二纬度和第二海拔;通过联邦卡尔曼滤波对第一经度和第二经度进行滤波得到融合经度,对第一纬度和第二纬度进行滤波得到融合纬度,对第一海拔和第二海拔进行滤波得到融合海拔;将融合经度、融合纬度和融合海拔作为融合三维位置信息,并将融合三维位置信息替换第一定位信息中的第一三维位置信息,得到校准定位信息。In one embodiment, when executed by the processor, the computer program also implements the following steps: obtaining first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude, and a first altitude; The second three-dimensional positioning information is obtained from the second positioning information. The second three-dimensional position information includes the second longitude, the second latitude and the second altitude; the first longitude and the second longitude are filtered through the federated Kalman filter to obtain the fused longitude, Filter the first latitude and the second latitude to obtain the fused latitude, filter the first altitude and the second altitude to obtain the fused altitude; use the fused longitude, fused latitude and fused altitude as the fused three-dimensional position information, and replace the fused three-dimensional position information Calibration positioning information is obtained from the first three-dimensional position information in the first positioning information.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:获取目标车辆对应的至少三个路侧设备的第三定位信息。In one embodiment, when executed by the processor, the computer program further implements the following steps: obtaining third positioning information of at least three roadside devices corresponding to the target vehicle.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:若置信度参数满足第一预设条件,且权重参数不满足第二预设条件,根据第一定位信息和第三定位信息获取校准定位信息。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: if the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, based on the first positioning information and the third positioning information Get calibration positioning information.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:若置信度参数不满足第一预设条件,且权重参数满足第二预设条件的情况下,根据第二定位信息和第三定位信息获取校准定位信息。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: if the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, based on the second positioning information and the third preset condition, 3. Positioning information to obtain calibration positioning information.
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:若置信度参数不满足第一预设条件,且权重参数不满足第二预设条件的情况下,将第三定位信息作为校准定位信息。In one embodiment, when the computer program is executed by the processor, the following steps are also implemented: if the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, use the third positioning information as Calibrate positioning information.
需要说明的是,本申请所涉及的用户信息(包括但不限于用户设备信息、用户个人信息等)和数据(包括但不限于用于分析的数据、存储的数据、展示的数据等),均为经用户授权或者经过各方充分授权的信息和数据,且相关数据的收集、使用和处理需要遵守相关国家和地区的相关法律法规和标准。It should be noted that the user information (including but not limited to user equipment information, user personal information, etc.) and data (including but not limited to data used for analysis, stored data, displayed data, etc.) involved in this application are all It is information and data authorized by the user or fully authorized by all parties, and the collection, use and processing of relevant data need to comply with the relevant laws, regulations and standards of relevant countries and regions.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、数据库或其它介质的任何引用,均可包括非易失性和易失性存储器中的至少一种。非易失性存储器可包括只读存储器(Read-Only Memory,ROM)、磁带、软盘、闪存、光存储器、高密度嵌入式非易失性存储器、阻变存储器(ReRAM)、磁变存储器(Magnetoresistive Random Access Memory,MRAM)、铁电存储器(Ferroelectric Random Access Memory,FRAM)、相变存储器(Phase Change Memory,PCM)、石墨烯存储器等。易失性存储器可包括随机存取存储器(Random Access Memory,RAM)或外部高速缓冲存储器等。作为说明而非局限,RAM可以是多种形式,比如静态随机存取存储器(Static Random Access Memory,SRAM)或动态随机存取存储器(Dynamic Random Access Memory,DRAM)等。本申请所提供的各实施例中所涉及的数据库可包括关系型数据库和非关系型数据库中至少一种。非关系型数据库可包括基于区块链的分布式数据库等,不限于此。本申请所提供的各实施例中所涉及的处理器可为通用处理器、中央 处理器、图形处理器、数字信号处理器、可编程逻辑器、基于量子计算的数据处理逻辑器等,不限于此。Those of ordinary skill in the art can understand that all or part of the processes in the methods of the above embodiments can be completed by instructing relevant hardware through a computer program. The computer program can be stored in a non-volatile computer-readable storage. In the media, when executed, the computer program may include the processes of the above method embodiments. Any reference to memory, database or other media used in the embodiments provided in this application may include at least one of non-volatile and volatile memory. Non-volatile memory can include read-only memory (ROM), magnetic tape, floppy disk, flash memory, optical memory, high-density embedded non-volatile memory, resistive memory (ReRAM), magnetic variable memory (Magnetoresistive memory) Random Access Memory (MRAM), Ferroelectric Random Access Memory (FRAM), Phase Change Memory (Phase Change Memory, PCM), graphene memory, etc. Volatile memory may include random access memory (Random Access Memory, RAM) or external cache memory. By way of illustration but not limitation, RAM can be in various forms, such as static random access memory (Static Random Access Memory, SRAM) or dynamic random access memory (Dynamic Random Access Memory, DRAM). The databases involved in the various embodiments provided in this application may include at least one of a relational database and a non-relational database. Non-relational databases may include blockchain-based distributed databases, etc., but are not limited thereto. The processors involved in the various embodiments provided in this application may be general-purpose processors, central processing units Processors, graphics processors, digital signal processors, programmable logic devices, data processing logic devices based on quantum computing, etc., are not limited to these.
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。The technical features of the above-described embodiments can be combined in any way. To simplify the description, not all possible combinations of the technical features in the above-described embodiments are described. However, as long as there is no contradiction in the combination of these technical features, All should be considered to be within the scope of this manual.
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对申请专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。 The above-described embodiments only express several implementation modes of the present application, and their descriptions are relatively specific and detailed, but they should not be construed as limiting the scope of the patent application. It should be noted that, for those of ordinary skill in the art, several modifications and improvements can be made without departing from the concept of the present application, and these all fall within the protection scope of the present application. Therefore, the protection scope of this patent application should be determined by the appended claims.

Claims (15)

  1. 一种车辆定位校准方法,其特征在于,所述方法包括:A vehicle positioning calibration method, characterized in that the method includes:
    获取第一定位信息和第二定位信息,所述第一定位信息和所述第二定位信息通过目标车辆的多个车载电子设备获得;Obtaining first positioning information and second positioning information, the first positioning information and the second positioning information being obtained through multiple vehicle-mounted electronic devices of the target vehicle;
    获取所述第一定位信息的累计误差,并根据所述累计误差调整置信度参数;Obtain the cumulative error of the first positioning information, and adjust the confidence parameter according to the cumulative error;
    根据所述第二定位信息计算所述目标车辆的速度误差,并根据所述速度误差调整权重参数;Calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameter according to the speed error;
    在所述置信度参数满足第一预设条件,且所述权重参数满足第二预设条件的情况下,根据所述第一定位信息和所述第二定位信息获取校准定位信息。When the confidence parameter satisfies the first preset condition and the weight parameter satisfies the second preset condition, calibration positioning information is obtained according to the first positioning information and the second positioning information.
  2. 根据权利要求1所述的方法,其特征在于,所述多个车载电子设备至少包括卫星信号接收装置、惯性测量装置和网络访问装置,所述获取第一定位信息和第二定位信息,包括:The method according to claim 1, wherein the plurality of vehicle-mounted electronic devices at least include a satellite signal receiving device, an inertial measurement device and a network access device, and the obtaining the first positioning information and the second positioning information includes:
    获取所述目标车辆的原始定位数据和六轴数据,所述原始定位数据通过所述卫星信号接收装置获得,所述六轴数据通过所述惯性测量装置获得;Obtain the original positioning data and six-axis data of the target vehicle, the original positioning data is obtained through the satellite signal receiving device, and the six-axis data is obtained through the inertial measurement device;
    根据所述六轴数据计算得到所述目标车辆的原始三维位置信息;Calculate the original three-dimensional position information of the target vehicle based on the six-axis data;
    根据所述原始三维位置信息和所述原始定位数据得到所述第一定位信息;Obtain the first positioning information according to the original three-dimensional position information and the original positioning data;
    获取所述目标车辆的所述第二定位信息,所述第二定位信息通过所述网络访问装置从实时动态测量系统中获得的。The second positioning information of the target vehicle is obtained, and the second positioning information is obtained from the real-time dynamic measurement system through the network access device.
  3. 根据权利要求1所述的方法,其特征在于,所述获取所述第一定位信息的累计误差,并根据所述累计误差调整置信度参数,包括:The method of claim 1, wherein obtaining the cumulative error of the first positioning information and adjusting the confidence parameter according to the cumulative error includes:
    在所述累计误差大于或等于误差阈值的情况下,降低所述置信度参数。If the cumulative error is greater than or equal to the error threshold, the confidence parameter is reduced.
  4. 根据权利要求1所述的方法,其特征在于,所述根据所述第二定位信息计算所述目标车辆的速度误差,并根据所述速度误差调整权重参数,包括:The method of claim 1, wherein calculating the speed error of the target vehicle based on the second positioning information, and adjusting weight parameters based on the speed error includes:
    根据所述第二定位信息,按照预设时间间隔获取所述目标车辆在多个连续时刻的定位;According to the second positioning information, obtain the positioning of the target vehicle at multiple consecutive moments according to a preset time interval;
    根据当前连续时刻的定位、前一连续时刻的定位和预设时间间隔,计算得到所述目标车辆在当前连续时刻的测量速度;Calculate the measured speed of the target vehicle at the current continuous time based on the positioning at the current continuous time, the positioning at the previous continuous time and the preset time interval;
    在所述目标车辆在当前连续时刻的测量速度不处于标准速度阈值范围的情况下,判定所述目标车辆在当前连续时刻的测量速度为异常速度;When the measured speed of the target vehicle at the current continuous time is not within the standard speed threshold range, determine that the measured speed of the target vehicle at the current continuous time is an abnormal speed;
    在连续判定异常速度的次数超过次数阈值的情况下,降低所述权重参数。When the number of consecutive abnormal speed determinations exceeds the number threshold, the weight parameter is reduced.
  5. 根据权利要求1所述的方法,其特征在于,所述根据所述第一定位信息和所述第二定位信息获取校准定位信息,包括:The method according to claim 1, characterized in that, obtaining calibration positioning information according to the first positioning information and the second positioning information includes:
    从所述第一定位信息中获取第一三维位置信息,所述第一三维位置信息包括第一经度、第一纬度和第一海拔;Obtain first three-dimensional position information from the first positioning information, where the first three-dimensional position information includes a first longitude, a first latitude and a first altitude;
    从所述第二定位信息获取第二三维定位信息,所述第二三维位置信息包括第二经度、第二纬度和第二海拔;Obtain second three-dimensional positioning information from the second positioning information, where the second three-dimensional position information includes a second longitude, a second latitude, and a second altitude;
    通过联邦卡尔曼滤波对所述第一经度和所述第二经度进行滤波得到融合经度,对所述第一纬度和所述第二纬度进行滤波得到融合纬度,对所述第一海拔和所述第二海拔进行滤波得到融合海拔;The first longitude and the second longitude are filtered through federated Kalman filtering to obtain a fused longitude, the first latitude and the second latitude are filtered to obtain a fused latitude, and the first altitude and the second longitude are filtered to obtain a fused latitude. Filter the second altitude to obtain the fused altitude;
    将所述融合经度、融合纬度和融合海拔作为融合三维位置信息,并将所述融合三维位置信息替换所述第一定位信息中的第一三维位置信息,得到所述校准定位信息。The fused longitude, fused latitude and fused altitude are used as fused three-dimensional position information, and the first three-dimensional position information in the first positioning information is replaced with the fused three-dimensional position information to obtain the calibrated positioning information.
  6. 根据权利要求1所述的方法,其特征在于,所述方法还包括:The method of claim 1, further comprising:
    获取所述目标车辆对应的至少三个路侧设备的第三定位信息。Obtain third positioning information of at least three roadside devices corresponding to the target vehicle.
  7. 根据权利要求6所述的方法,其特征在于,所述方法还包括:The method of claim 6, further comprising:
    在所述置信度参数满足第一预设条件,且所述权重参数不满足第二预设条件的情况下,根据所述第一定位信息和所述第三定位信息获取校准定位信息。When the confidence parameter meets the first preset condition and the weight parameter does not meet the second preset condition, calibration positioning information is obtained according to the first positioning information and the third positioning information.
  8. 根据权利要求6所述的方法,其特征在于,所述方法还包括: The method of claim 6, further comprising:
    在所述置信度参数不满足第一预设条件,且所述权重参数满足第二预设条件的情况下,根据所述第二定位信息和所述第三定位信息获取校准定位信息。When the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, calibration positioning information is obtained according to the second positioning information and the third positioning information.
  9. 根据权利要求6所述的方法,其特征在于,所述方法还包括:The method of claim 6, further comprising:
    在所述置信度参数不满足第一预设条件,且所述权重参数不满足第二预设条件的情况下,将所述第三定位信息作为校准定位信息。When the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition, the third positioning information is used as calibration positioning information.
  10. 一种车辆定位校准装置,其特征在于,所述装置包括:A vehicle positioning calibration device, characterized in that the device includes:
    定位获取模块,用于获取第一定位信息和第二定位信息,所述第一定位信息和所述第二定位信息通过目标车辆的多个车载电子设备获得;A positioning acquisition module, configured to obtain first positioning information and second positioning information, the first positioning information and the second positioning information being obtained through multiple vehicle-mounted electronic devices of the target vehicle;
    第一调节模块,用于获取所述第一定位信息的累计误差,并根据所述累计误差调整置信度参数;A first adjustment module, configured to obtain the cumulative error of the first positioning information and adjust the confidence parameter according to the cumulative error;
    第二调节模块,用于根据所述第二定位信息计算所述目标车辆的速度误差,并根据所述速度误差调整权重参数;a second adjustment module, configured to calculate the speed error of the target vehicle according to the second positioning information, and adjust the weight parameter according to the speed error;
    定位校准模块,用于若所述置信度参数满足第一预设条件,且所述权重参数满足第二预设条件,根据所述第一定位信息和所述第二定位信息获取校准定位信息。A positioning calibration module, configured to obtain calibration positioning information according to the first positioning information and the second positioning information if the confidence parameter satisfies a first preset condition and the weight parameter satisfies a second preset condition.
  11. 根据权利要求10所述的装置,其特征在于,所述定位获取模块还用于获取目标车辆对应的至少三个路侧设备的第三定位信息。The device according to claim 10, characterized in that the positioning acquisition module is also used to obtain the third positioning information of at least three roadside devices corresponding to the target vehicle.
  12. 根据权利要求11所述的装置,其特征在于,所述定位校准模块还用于在所述置信度参数满足第一预设条件,且所述权重参数不满足第二预设条件的情况下,根据所述第一定位信息和所述第三定位信息获取校准定位信息;The device according to claim 11, wherein the positioning calibration module is further configured to: when the confidence parameter meets a first preset condition and the weight parameter does not meet a second preset condition, Obtain calibration positioning information according to the first positioning information and the third positioning information;
    所述定位校准模块还用于在所述置信度参数不满足第一预设条件,且所述权重参数满足第二预设条件的情况下,根据所述第二定位信息和所述第三定位信息获取校准定位信息;The positioning calibration module is also configured to, when the confidence parameter does not meet the first preset condition and the weight parameter meets the second preset condition, calculate the positioning information based on the second positioning information and the third positioning condition. Information acquisition calibration positioning information;
    所述定位校准模块还用于在所述置信度参数不满足第一预设条件,且所述权重参数不满足第二预设条件的情况下,将所述第三定位信息作为校准定位信息。The positioning calibration module is also configured to use the third positioning information as calibration positioning information when the confidence parameter does not meet the first preset condition and the weight parameter does not meet the second preset condition.
  13. 一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至9中任一项所述的方法的步骤。A computer device includes a memory and a processor, the memory stores a computer program, and is characterized in that when the processor executes the computer program, the steps of the method described in any one of claims 1 to 9 are implemented.
  14. 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至9中任一项所述的方法的步骤。A computer-readable storage medium with a computer program stored thereon, characterized in that when the computer program is executed by a processor, the steps of the method described in any one of claims 1 to 9 are implemented.
  15. 一种计算机程序产品,包括计算机程序,其特征在于,该计算机程序被处理器执行时实现权利要求1至9中任一项所述的方法的步骤。 A computer program product, comprising a computer program, characterized in that, when executed by a processor, the computer program implements the steps of the method according to any one of claims 1 to 9.
PCT/CN2023/102292 2022-08-25 2023-06-26 Vehicle positioning calibration method and apparatus, computer device, and storage medium WO2024041156A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202211029493.2A CN115407376A (en) 2022-08-25 2022-08-25 Vehicle positioning calibration method and device, computer equipment and storage medium
CN202211029493.2 2022-08-25

Publications (1)

Publication Number Publication Date
WO2024041156A1 true WO2024041156A1 (en) 2024-02-29

Family

ID=84161337

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2023/102292 WO2024041156A1 (en) 2022-08-25 2023-06-26 Vehicle positioning calibration method and apparatus, computer device, and storage medium

Country Status (2)

Country Link
CN (1) CN115407376A (en)
WO (1) WO2024041156A1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115407376A (en) * 2022-08-25 2022-11-29 深圳市广通远驰科技有限公司 Vehicle positioning calibration method and device, computer equipment and storage medium
CN116153135B (en) * 2023-04-04 2023-10-20 湖南朗赫科技有限公司 Map navigation method and system applied to underground parking garage

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109932739A (en) * 2017-12-15 2019-06-25 财团法人车辆研究测试中心 The localization method of Adaptive Weight adjustment
KR20200002221A (en) * 2018-06-29 2020-01-08 현대엠엔소프트 주식회사 Method for compensating position of vehicle with gnss/dr system and apparatus thereof
CN112995899A (en) * 2021-05-08 2021-06-18 北京大唐高鸿数据网络技术有限公司 Vehicle-road cooperative positioning method and device, vehicle-mounted positioning system and road side equipment
CN113625323A (en) * 2021-06-18 2021-11-09 北京千方科技股份有限公司 Vehicle real-time positioning system, method and medium based on vehicle-road cooperation and vehicle
CN114114368A (en) * 2021-12-10 2022-03-01 中国电信股份有限公司 Vehicle positioning method, system, device and storage medium
CN114509799A (en) * 2022-01-28 2022-05-17 和芯星通科技(北京)有限公司 Positioning method of vehicle-mounted integrated navigation system and vehicle-mounted integrated navigation device
CN115407376A (en) * 2022-08-25 2022-11-29 深圳市广通远驰科技有限公司 Vehicle positioning calibration method and device, computer equipment and storage medium

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109932739A (en) * 2017-12-15 2019-06-25 财团法人车辆研究测试中心 The localization method of Adaptive Weight adjustment
KR20200002221A (en) * 2018-06-29 2020-01-08 현대엠엔소프트 주식회사 Method for compensating position of vehicle with gnss/dr system and apparatus thereof
CN112995899A (en) * 2021-05-08 2021-06-18 北京大唐高鸿数据网络技术有限公司 Vehicle-road cooperative positioning method and device, vehicle-mounted positioning system and road side equipment
CN113625323A (en) * 2021-06-18 2021-11-09 北京千方科技股份有限公司 Vehicle real-time positioning system, method and medium based on vehicle-road cooperation and vehicle
CN114114368A (en) * 2021-12-10 2022-03-01 中国电信股份有限公司 Vehicle positioning method, system, device and storage medium
CN114509799A (en) * 2022-01-28 2022-05-17 和芯星通科技(北京)有限公司 Positioning method of vehicle-mounted integrated navigation system and vehicle-mounted integrated navigation device
CN115407376A (en) * 2022-08-25 2022-11-29 深圳市广通远驰科技有限公司 Vehicle positioning calibration method and device, computer equipment and storage medium

Also Published As

Publication number Publication date
CN115407376A (en) 2022-11-29

Similar Documents

Publication Publication Date Title
WO2024041156A1 (en) Vehicle positioning calibration method and apparatus, computer device, and storage medium
CN108873038B (en) Autonomous parking positioning method and positioning system
US9921065B2 (en) Unit and method for improving positioning accuracy
US8452535B2 (en) Systems and methods for precise sub-lane vehicle positioning
US20190291742A1 (en) Sensor plausibility using gps road information
US11550067B2 (en) System and method for fusing dead reckoning and GNSS data streams
JP2002303533A (en) Method and device for modifying position in vehicle navigation system and heading error
CN108345021B (en) Doppler radar assisted GPS/INS vehicle speed measurement method
CN102928816A (en) High-reliably integrated positioning method for vehicles in tunnel environment
CN111562603B (en) Navigation positioning method, equipment and storage medium based on dead reckoning
CN108931794B (en) Blind area vehicle positioning system and control method thereof
KR20190040818A (en) 3D vehicular navigation system using vehicular internal sensor, camera, and GNSS terminal
CN114545472A (en) Navigation method and device of GNSS/INS combined system
CN114623823A (en) UWB (ultra wide band) multi-mode positioning system, method and device integrating odometer
Hsu et al. Hong Kong UrbanNav: An open-source multisensory dataset for benchmarking urban navigation algorithms
CN113375664B (en) Autonomous mobile device positioning method based on dynamic loading of point cloud map
CN106886037A (en) Suitable for the POS data method for correcting error of weak GNSS signal condition
CN116558512A (en) GNSS and vehicle-mounted sensor fusion positioning method and system based on factor graph
CN115046547A (en) Automatic driving automobile positioning system and method under complex urban environment
US20220042802A1 (en) Extended dead reckoning accuracy
CN115639585A (en) Multi-sensor fusion positioning method for GPS/IMU and laser radar
CN114915913A (en) UWB-IMU combined indoor positioning method based on sliding window factor graph
Jones et al. Autonomous off-road driving in the DARPA Grand Challenge
TWI724686B (en) Positioning and orientation system and positioning and orientation method using high definition maps
Wachsmuth et al. Development of an error-state Kalman Filter for Emergency Maneuvering of Trucks

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 23856248

Country of ref document: EP

Kind code of ref document: A1