JP2022166248A - 車両の測位方法、装置及び自動運転車両 - Google Patents
車両の測位方法、装置及び自動運転車両 Download PDFInfo
- Publication number
- JP2022166248A JP2022166248A JP2022131184A JP2022131184A JP2022166248A JP 2022166248 A JP2022166248 A JP 2022166248A JP 2022131184 A JP2022131184 A JP 2022131184A JP 2022131184 A JP2022131184 A JP 2022131184A JP 2022166248 A JP2022166248 A JP 2022166248A
- Authority
- JP
- Japan
- Prior art keywords
- global
- information
- local
- pose information
- pose
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 78
- 238000005259 measurement Methods 0.000 claims abstract description 49
- 238000012545 processing Methods 0.000 claims abstract description 38
- 238000007499 fusion processing Methods 0.000 claims abstract description 26
- 230000004927 fusion Effects 0.000 claims description 96
- 238000012937 correction Methods 0.000 claims description 66
- 238000004590 computer program Methods 0.000 claims description 26
- 230000015654 memory Effects 0.000 claims description 26
- 230000000007 visual effect Effects 0.000 claims description 20
- 230000004044 response Effects 0.000 claims description 5
- 238000010586 diagram Methods 0.000 description 19
- 230000008569 process Effects 0.000 description 14
- 230000002159 abnormal effect Effects 0.000 description 13
- 230000000694 effects Effects 0.000 description 12
- 238000004458 analytical method Methods 0.000 description 10
- 238000004891 communication Methods 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 6
- 238000013473 artificial intelligence Methods 0.000 description 5
- 238000006073 displacement reaction Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000018109 developmental process Effects 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 101000822695 Clostridium perfringens (strain 13 / Type A) Small, acid-soluble spore protein C1 Proteins 0.000 description 1
- 101000655262 Clostridium perfringens (strain 13 / Type A) Small, acid-soluble spore protein C2 Proteins 0.000 description 1
- 101000655256 Paraclostridium bifermentans Small, acid-soluble spore protein alpha Proteins 0.000 description 1
- 101000655264 Paraclostridium bifermentans Small, acid-soluble spore protein beta Proteins 0.000 description 1
- 230000002411 adverse Effects 0.000 description 1
- 238000003491 array Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000010801 machine learning Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000011218 segmentation Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
- 230000001755 vocal effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/11—Pitch movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/112—Roll movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0015—Planning or execution of driving tasks specially adapted for safety
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
- G01C21/1656—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with passive imaging devices, e.g. cameras
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/36—Input/output arrangements for on-board computers
- G01C21/3602—Input other than that of destination using image analysis, e.g. detection of road signs, lanes, buildings, real preceding vehicles using a camera
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3833—Creation or updating of map data characterised by the source of data
- G01C21/3844—Data obtained from position sensors only, e.g. from inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/485—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an optical system or imaging system
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/53—Determining attitude
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0251—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F9/00—Arrangements for program control, e.g. control units
- G06F9/06—Arrangements for program control, e.g. control units using stored programs, i.e. using an internal store of processing equipment to receive or retain programs
-
- G—PHYSICS
- G07—CHECKING-DEVICES
- G07C—TIME OR ATTENDANCE REGISTERS; REGISTERING OR INDICATING THE WORKING OF MACHINES; GENERATING RANDOM NUMBERS; VOTING OR LOTTERY APPARATUS; ARRANGEMENTS, SYSTEMS OR APPARATUS FOR CHECKING NOT PROVIDED FOR ELSEWHERE
- G07C5/00—Registering or indicating the working of vehicles
- G07C5/08—Registering or indicating performance data other than driving, working, idle, or waiting time, with or without registering driving, working, idle or waiting time
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0004—In digital systems, e.g. discrete-time systems involving sampling
- B60W2050/0005—Processor details or data handling, e.g. memory registers or chip architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/16—Pitch
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/18—Roll
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/40—High definition maps
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/396—Determining accuracy or reliability of position or pseudorange measurements
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0257—Hybrid positioning
- G01S5/0258—Hybrid positioning by combining or switching between measurements derived from different systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computer Networks & Wireless Communication (AREA)
- Mathematical Physics (AREA)
- Electromagnetism (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Software Systems (AREA)
- Theoretical Computer Science (AREA)
- Human Computer Interaction (AREA)
- General Engineering & Computer Science (AREA)
- Multimedia (AREA)
- Navigation (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
- Image Analysis (AREA)
Abstract
【課題】測位の信頼性を向上させるための車両の測位方法、装置及び車両を提供する。【解決手段】車両には高精度地図がないと、車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて車両の中間ポーズ情報を取得して、中間ポーズ情報をグローバル測位情報として決定し、ローカル測位情報を取得し、グローバルポーズ情報及びローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得、グローバル姿勢角情報及びローカル姿勢角情報に基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得ることを含み、高精度地図に強く依存する必要がなく、様々なシーンに適用することができ、測位適用の柔軟性及び多様性を向上させ、かつ補正処理の方式により車両の位置を決定し、決定された車両の位置に高い正確性及び信頼性を有させ、車両走行の安全性を向上させる。【選択図】図2
Description
本開示は人工知能(Artificial Intelligence、AI)の技術分野における自動運転に関し、自動運転の車両に対する高精度測位に適用することができ、特に車両の測位方法、装置及び自動運転車両に関する。
人工知能技術の発展に伴い、自動運転(無人運転とも呼ばれる)は既に様々な交通機関、特に自動車産業の新たな発展方向となっている。ここで、測位は自動運転における重要な技術の1つである。
従来の技術において、一般的に、車両上のレーザレーダによりリアルタイムに収集された点群データを予め構築された高精度地図とマッチングして、車両の位置を決定する測位方法を用いる。高精度地図は高精度マップとも呼ばれ、自動運転車両で使用される。高精度地図は、精確な車両位置情報と豊富な道路要素データ情報を有し、自動車が路面の複雑な情報、例えば勾配、曲率、針路などを予知することに役立ち、潜在的なリスクをよりよく回避することができる。
しかしながら、道路環境が変化する場合、点群データが高精度地図における対応する領域のデータと大きく異なる可能性があり、決定された車両の位置が十分に正確ではなく、又は車両の位置を決定することができない状況をもたらす可能性がある。
本開示は、測位の信頼性を向上させるための車両の測位方法、装置及び車両を提供する。
本開示の第1の態様によれば、車両の測位方法が提供され、
車両には高精度地図がないことに応答し、前記車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて前記車両の中間ポーズ情報を取得して、前記中間ポーズ情報をグローバル測位情報として決定することであって、前記グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれることと、
ローカルポーズ情報及びローカル姿勢角情報を含む、前記車両のローカル測位情報を取得して、前記グローバルポーズ情報及び前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得て、前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得ることと、を含む。
車両には高精度地図がないことに応答し、前記車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて前記車両の中間ポーズ情報を取得して、前記中間ポーズ情報をグローバル測位情報として決定することであって、前記グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれることと、
ローカルポーズ情報及びローカル姿勢角情報を含む、前記車両のローカル測位情報を取得して、前記グローバルポーズ情報及び前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得て、前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得ることと、を含む。
本開示の第2の態様によれば、車両の測位装置が提供され、
車両には高精度地図がないことに応答し、前記車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて前記車両の中間ポーズ情報を取得するための第1の取得ユニットと、
前記中間ポーズ情報をグローバル測位情報として決定するための決定ユニットであって、前記グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれる決定ユニットと、
前記車両のローカル測位情報を取得するための第2の取得ユニットであって、前記ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれる第2の取得ユニットと、
前記グローバルポーズ情報と前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合ユニットと、
前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得るための補正ユニットとを含む。
車両には高精度地図がないことに応答し、前記車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて前記車両の中間ポーズ情報を取得するための第1の取得ユニットと、
前記中間ポーズ情報をグローバル測位情報として決定するための決定ユニットであって、前記グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれる決定ユニットと、
前記車両のローカル測位情報を取得するための第2の取得ユニットであって、前記ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれる第2の取得ユニットと、
前記グローバルポーズ情報と前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合ユニットと、
前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得るための補正ユニットとを含む。
本開示の第3の態様によれば、電子機器が提供され、
少なくとも1つのプロセッサ、及び
前記少なくとも1つのプロセッサと通信可能に接続されたメモリを含み、ここで、
前記メモリには前記少なくとも1つのプロセッサにより実行できる命令が記憶され、前記命令は前記少なくとも1つのプロセッサにより実行されることにより、前記少なくとも1つのプロセッサに第1の態様に記載の方法を実行させることができる。
少なくとも1つのプロセッサ、及び
前記少なくとも1つのプロセッサと通信可能に接続されたメモリを含み、ここで、
前記メモリには前記少なくとも1つのプロセッサにより実行できる命令が記憶され、前記命令は前記少なくとも1つのプロセッサにより実行されることにより、前記少なくとも1つのプロセッサに第1の態様に記載の方法を実行させることができる。
本開示の第4の態様によれば、コンピュータ命令が記憶された非一時的なコンピュータ可読記憶媒体が提供され、ここで、前記コンピュータ命令はコンピュータに第1の態様に記載の方法を実行させるために用いられる。
本開示の第5の態様によれば、コンピュータプログラム製品が提供され、前記コンピュータプログラム製品は、コンピュータプログラムを含み、前記コンピュータプログラムが可読記憶媒体に記憶され、電子機器の少なくとも1つのプロセッサが前記可読記憶媒体から前記コンピュータプログラムを読み取り、前記少なくとも1つのプロセッサが前記コンピュータプログラムを実行することにより電子機器に第1の態様に記載の方法を実行させる。
本開示の第6の態様によれば、自動運転車両が提供され、
車両には高精度地図がないことに応答し、前記車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて前記車両の中間ポーズ情報を取得して、前記中間ポーズ情報をグローバル測位情報として決定するためのグローバル測位装置であって、前記グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれるグローバル測位装置と、
車両のローカル測位装置を取得するためのローカル測位装置であって、前記ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれるローカル測位装置と、
前記グローバルポーズ情報及び前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得て、前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得るためのポーズグラーフ最適化装置とを含む。
車両には高精度地図がないことに応答し、前記車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて前記車両の中間ポーズ情報を取得して、前記中間ポーズ情報をグローバル測位情報として決定するためのグローバル測位装置であって、前記グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれるグローバル測位装置と、
車両のローカル測位装置を取得するためのローカル測位装置であって、前記ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれるローカル測位装置と、
前記グローバルポーズ情報及び前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得て、前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得るためのポーズグラーフ最適化装置とを含む。
理解すべきものとして、本部分に記載の内容は本開示の実施例の主要又は重要な特徴を特定することを意図するものではなく、本開示の範囲を限定するものでもない。本開示の他の特徴は、以下の明細書によりわかりやすくなる。
図面は本技術案をよりよく理解するために用いられ、本開示を限定するものではない。
本開示の実施例に係る車両の測位方法を実現できるシーン図である。
本開示の第1の実施例に係る模式図である。
本開示の第2の実施例に係る模式図である。
本開示の第3の実施例に係る模式図である。
本開示の第4の実施例に係る模式図である。
本開示の実施例に係る車両の測位方法を実現するための電子機器のブロック図である。
本開示の第5の実施例に係る模式図である。
本開示に係る融合ポーズ情報を決定する原理模式図1である。
本開示に係る融合ポーズ情報を決定する原理模式図2である。
本開示に係る融合ポーズ情報を決定する原理模式図3である。
本開示の第6の実施例に係る模式図である。
以下に図面を参照して本開示の例示的な実施例を説明し、理解に役立つためにここでは本開示の実施例の様々な詳細を含み、それらを例示的なものと考えるべきである。そこで、当業者であれば、ここで説明された実施例に対して様々な変更及び修正を行うことができ、本開示の範囲及び精神から逸脱することはない。同様に、明確かつ簡単に説明するために、以下の説明において公知の機能及び構造についての説明を省略する。
自動運転は主に人工知能、コンピュータビジュアル、レーダ、監視装置及びナビゲーション測位システムの協働を採用することにより、単眼又は多眼カメラを組み合わせてマシンビジョン技術を利用して、車両(即ち自動運転自動車)に交通信号、道路標識、車線、近距離低速障害物をリアルタイムで識別させ、かつ車両の位置などを決定することができるとともに、道路インフラストラクチャ及びクラウドデータベースと通信し、車両に交通規則に従って計画されたルートで走行させることができる。
測位は自動運転における重要な技術の1つであり、測位により決定された車両の位置に基づいて、車両に走行策略、例えば旋回及び減速前進などを自動的に調整させ、車両走行の信頼性及び正確性を向上させることができる。
例示的には、図1に示すように、車両101は道路102を走行し、道路102は車線1021を含み、道路102の少なくとも一側に道路標識103が設けられる。
ここで、道路標識は減速標識であってもよく、道路タイプの標識などであってもよく、ここでは1つずつ列挙しない。
車両には画像収集装置が設けられ、画像収集装置はカメラ(例えば単眼又は多眼カメラ)であってもよく、画像収集装置に基づいて車線の関連情報(例えば座標)、道路標識の関連情報(例えばテキストコンテンツ)を識別することができ、車両は測位技術に基づいて車両の位置(画像収集装置が収集した車両の走行過程における画像を組み合わせて実現してもよい)を決定し、車線の関連情報、道路標識の関連情報を組み合わせて車両の走行を制御し、例えば車両の減速走行を制御し、又は、車両の旋回走行などを制御する。
理解すべきものとして、上記実施例は単に例示的に本実施例の車両の測位方法が適用可能な適用シーンを説明することに用いられ、適用シーンを限定するものと理解することができない。
例えば、図1に示すような適用シーンにおいて、要素例えば道路の少なくとも一側に設けられる路側機器などを増加してもよく、要素を減少させてもよく、例えば道路標識を減少させてもよい。
関連技術において、車両に対して測位を行うときに、一般的に高精度地図と組み合わせて実現する。ここで、高精度地図は、自動マーキング又は人工マーキングの方式により生成されたベクトル化された高精度地図であってもよい。
例えば、高精度地図から車両の現在位置が位置する高精度地図を決定し、つまり全体の高精度地図から車両の位置に対応する一部の高精度地図を決定し、レーダにより収集された点群を取得し、点群と高精度地図との間のマッチングに基づいて車両の位置を取得する。
また例えば、高精度地図から車両の現在位置が位置する高精度地図を決定し、つまり全体の高精度地図から車両の位置に対応する一部の高精度地図を決定し、画像収集装置(例えば単眼又は多眼カメラ)により収集された車両走行の画像を取得し、画像と高精度地図との間のマッチングに基づいて車両の位置を取得する。
しかしながら、上記方法を採用して測位を行うことは、高精度地図に強く依存する必要があり、したがって、適用シーンには厳しい制限があり、高精度地図がないシーンでは、上記測位方法を使用することができず、したがって、上記方法を採用して測位を行うことには、応用の柔軟性及び普遍性に乏しいという技術的問題が存在する。一方、高精度地図の作成及び更新は一般的に道路の変動の実際の時間より遅く、したがって、ある道路の高精度地図がタイムリーに更新されないと、測位の正確性及び信頼性が低いという技術的問題を引き起こす。
上記技術的問題のうちの少なくとも1種を回避するために、本開示の発明者は創造的な労働を通して、以下のような本開示の発明構想を得る。高精度地図がない測位シーンにおいて、全地球航法衛星システム及び/又は慣性計測ユニットに基づいて車両の中間ポーズ情報を取得して、中間ポーズ情報をグローバル測位情報として決定して、ローカル測位情報を取得することにより、グローバル測位情報におけるグローバルポーズ情報及びローカル測位情報におけるローカルポーズ情報に基づいて融合ポーズ情報を決定して、グローバル測位情報におけるグローバル姿勢角情報及びローカル測位情報におけるローカル姿勢角情報に基づいて融合ポーズ情報に対して補正処理を行い、車両の位置を得る。
上記発明構想に基づいて、本開示は車両の測位方法、装置及び車両を提供し、人工知能の技術分野における自動運転を応用し、自動運転の車両の高精度測位に応用することができ、それによりシーン適用の柔軟性を向上させ、かつ測位の信頼性を向上させる。
図2は本開示の第1の実施例に係る模式図であり、図2に示すように、車両の測位方法は、S201~S204を含む。
S201では、車両には高精度地図がないことに応答し、車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて車両の中間ポーズ情報を取得して、中間ポーズ情報をグローバル測位情報として決定する。
S202では、車両のローカル測位情報を取得する。
ここで、グローバル測位情報はグローバルポーズ情報及びグローバル姿勢角情報を含み、ローカル測位情報はローカルポーズ情報及びローカル姿勢角情報を含む。
例示的に、本実施例の実行主体は車両の測位装置(以下に測位装置と略称する)であってもよく、測位装置は車両に設けられたコンピュータ、サーバ、車載端末、プロセッサ、及びチップなどであってもよく、本実施例には限定しない。
測位装置は車両のコンピュータ、サーバ(ローカルサーバ及びクラウドサーバを含み、サーバはクラウドコントロールプラットフォーム、車路協調管理プラットフォーム、センターサブシステム、エッジコンピューティングプラットフォーム、クラウドコンピューティングプラットフォームなどであってもよい)から独立してもよく、路側機器であってもよく、端末機器であってもよく、プロセッサであってもよく、チップなどであってもよく、本実施例は限定しない。
ここで、路側機器は例えば計算機能を有する路側感知機器、路側感知機器に接続された路側計算機器を有し、スマート交通車路協調のシステムアーキテクチャにおいて、路側機器は路側感知機器及び路側計算機器を含み、路側感知機器(例えば路側カメラ)は路側計算機器(例えば路側計算ユニットRSCU)に接続され、路側計算機器はサーバに接続され、サーバは様々な方式で自動運転又は補助運転車両と通信することができる。又は、路側感知機器自体は計算機能を含み、路側感知機器はサーバに直接に接続される。以上の接続は有線又は無線であってもよく、本実施例は限定しない。
グローバル測位情報及びローカル測位情報は相対概念のセットであり、グローバル測位情報はグローバル座標系を基とする測位情報として理解されてもよく、ローカル測位情報はローカル座標系を基とする測位情報として理解されてもよい。
例えば、グローバル座標系は緯度経度の世界座標系であってもよく、ローカル座標系は車両の初期位置を原点とする座標系であってもよい。
ポーズ情報は回転及び変位を含んでもよく、グローバルポーズ情報はグローバル回転及びグローバル変位を含んでもよく、ローカルポーズ情報はローカル回転及びローカル変位を含んでもよい。
姿勢角情報は車両の角度での関連情報、例えばロール角(車両座標系の横軸と水平線との間の夾角を指す)、ピッチ角(車両座標系の縦軸と水平面との夾角を指し、車両座標系の縦軸が慣性座標系平面の上方にある場合、ピッチ角が正であり、そうでなければ負であり、つまり車両軸線に平行して車両前方へ指すベクトルと地面との夾角であり、車両座標系及び慣性座標系はいずれも右手座標系を採用する)、及びヨー角(車両軸が水平面上での投影と地軸との間の夾角)のうちの1種又は複数種を含んでもよい。
それに応じて、グローバル姿勢角情報はグローバルロール角、グローバルピッチ角、及びグローバルヨー角のうちの1種又は複数種を含み、ローカル姿勢角情報はローカルロール角、ローカルピッチ角、及びローカルヨー角のうちの1種又は複数種を含む。
なお、関連技術において、一般的に高精度地図を組み合わせて車両に対する測位を実現する必要があるが、本実施例において、高精度地図がない場合、全地球航法衛星システム及び/又は慣性計測ユニットに基づいて中間ポーズ情報を取得することができ、中間ポーズ情報をグローバル測位情報として決定することができ、それにより関連技術における高精度地図に対する高い依存を回避し、本実施例の車両の測位方法をより多くのシーンに適用させることができ、測位の柔軟性及び汎用性を向上させる。
例えば、本実施例の方法を図1に示すような応用シーンに応用する場合、図1に示す車両にはグローバル測位装置及びローカル測位装置が設けられてもよく、グローバル測位装置はグローバル測位情報を取得するために用いられ、ローカル測位装置はローカル測位情報を取得するために用いられる。
S203では、グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得る。
当該ステップは以下のように理解されることができる。測位装置はグローバルポーズ情報及びローカルポーズ情報を総合的に考慮して、正確性及び信頼性がより高いポーズ情報(つまり融合ポーズ情報)を決定する。
本実施例は融合処理の方法を限定せず、例えば、グローバル座標系及びローカル座標系により、ローカル座標系を基とするローカルポーズ情報をグローバル座標系に変換した後のポーズ情報を決定して、当該変換されたポーズ情報、及びグローバルポーズ情報に基づいて融合ポーズ情報を決定する。
また例えば、グローバル座標系及びローカル座標系により、グローバル座標系を基とするグローバルポーズ情報をローカル座標系に変換した後のポーズ情報を決定して、当該変換されたポーズ情報、及びローカルポーズ情報に基づいて融合ポーズ情報を決定する。
かつ融合処理の過程において、加重平均の方式を採用してもよく、平均の方式を採用して実現してもよい。
説明すべきものとして、グローバルポーズ情報とローカルポーズ情報を融合することにより、融合ポーズ情報は異なる座標系のポーズ情報を考慮し、融合ポーズ情報の信頼性及び有効性を向上させることができる。
S204では、グローバル姿勢角情報とローカル姿勢角情報に基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得る。
ここで、補正処理は融合ポーズ情報に対する補正処理として理解されることができ、融合ポーズ情報の補正により、融合ポーズ情報の信頼性をさらに向上させ、それにより車両の位置の正確性及び信頼性を向上させ、さらに車両が車両の位置に基づいて策略調整を行う場合の信頼性を向上させ、車両の走行安全を確保する。
例えば、本実施例の方法を図1に示すような応用シーンに応用する場合、車両にポーズグラーフ(pose graph)最適化装置を設けてもよく、グローバル測位装置及びローカル測位装置はそれぞれポーズグラーフ最適化装置に接続される。
ここで、グローバル測位装置はグローバル測位情報をポーズグラーフ最適化装置に伝送し、ローカル測位装置はローカル測位情報をポーズグラーフ最適化装置に伝送し、ポーズグラーフ最適化装置はグローバル測位情報及びローカル測位装置に基づいて融合ポーズ情報を生成して、車両の位置を出力する。
上記分析から分かるように、本開示の実施例は車両の測位方法を提供し、以下のステップを含む。車両には高精度地図がないことに応答し、車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて車両の中間ポーズ情報を取得して、中間ポーズ情報をグローバル測位情報として決定し、グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれ、車両のローカル測位情報を取得し、ローカル測位情報にはローカル姿勢情報及びローカル姿勢角情報が含まれ、グローバルポーズ情報及びローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得、グローバル姿勢角情報及びローカル姿勢角情報に基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得る。本実施例において、以下の発明特定事項を導入する。高精度地図がない場合、全地球航法衛星システム及び/又は慣性計測ユニットが取得した中間ポーズ情報をグローバル測位情報として決定し、グローバルポーズ情報及びローカルポーズ情報に対して融合処理を行って融合ポーズ情報を取得して、グローバル姿勢角情報及びローカル姿勢角情報に基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置のを得る。高精度地図に強く依存する必要がなく、様々なシーンに適用することができ、測位適用の柔軟性及び多様性を向上させ、かつ補正処理の方式により車両の位置を決定し、決定された車両の位置に高い正確性及び信頼性を有させ、さらに車両走行の安全性を向上させるという技術的効果がある。
図3は本開示の第2の実施例に係る模式図であり、図3に示すように、車両の測位方法は、S301~S303を含む。
S301では、車両のグローバル測位情報を取得する。
いくつかの実施例において、S301の実現原理について、上記実施例を参照することができる。
他の実施例において、測位装置に高精度地図が含まれているか否かに基づいて異なる方式でグローバル測位情報を取得してもよい。
例示的には、測位装置に高精度地図が含まれていない場合、測位装置は以下の方式を採用してグローバル測位情報を取得してもよい。
1つの例において、車両は全地球航法衛星システムを含み、全地球航法衛星システムはポーズ情報を収集してもよく(他のポーズ情報例えばグローバルポーズ情報と区別するために、全地球航法衛星システムにより収集されたポーズ情報を中間ポーズ情報と呼ぶことができる)、測位装置は、取得された全地球航法衛星システムにより収集された中間ポーズ情報をグローバル測位情報として決定してもよい。
ここで、全地球航法衛星システムは全地球航法衛星システム(Global Navigation Satellite System、GNSS)とも呼ばれ、地球表面又は近地空間の任意の場所に全天候の三次元座標及び速度及び時間情報を提供することができる宇宙ベースの無線航法測位システムである。
他の例示において、車両は慣性計測ユニットを含み、慣性計測ユニット(Inertial Measurement Unit)は車両の三軸姿勢角(又は角速度)及び加速度などを測定する装置であり、1つの慣性計測ユニットは複数(例えば3つ)の加速度計及び複数(例えば3つの)ジャイロを含んでもよい。加速度計は車両の加速度信号を検出することができ、ジャイロは角速度信号を検出することができ、これを解析して車両のポーズ情報を得る(他のポーズ情報例えばグローバルポーズ情報と区別するために、慣性計測ユニットにより収集されたポーズ情報を中間ポーズ情報と呼ぶことができる)。
それに応じて、測位装置は、取得された慣性計測ユニットにより収集された中間ポーズ情報をグローバル測位情報として決定することができる。
理解すべきものとして、他の例において、車両は全地球航法衛星システムを含むだけでなく、さらに慣性計測ユニットを含むことができ、測位装置は、全地球航法衛星システム及び慣性計測ユニットがそれぞれ収集した中間ポーズ情報を組み合わせてグローバル測位情報を決定してもよい。
例えば、全地球航法衛星システムで収集された中間ポーズ情報を主とし、慣性計測ユニットにより収集された中間ポーズ情報を補助とし、慣性計測ユニットにより収集された中間ポーズ情報によって全地球航法衛星システムが収集した中間ポーズ情報を適応的に補正し、それによりグローバル測位情報を得る。
また例えば、慣性計測ユニットで収集された中間ポーズ情報を主とし、全地球航法衛星システムにより収集された中間ポーズ情報を補助とし、全地球航法衛星システムにより収集された中間ポーズ情報によって慣性計測ユニットが収集した中間ポーズ情報を適応的に補正し、それによりグローバル測位情報を得る。
さらに例えば、全地球航法衛星システムが収集した中間ポーズ情報と慣性計測ユニットが収集した中間ポーズ情報を平均処理し、それによりグローバル測位情報を得る。
説明すべきものとして、本実施例において、全地球航法衛星システム及び/又は慣性計測ユニットを組み合わせることにより、グローバル測位情報を取得し、高精度地図に依存する必要がなく、関連技術における高精度地図に対する強い依存性を回避し、本実施例の車両の測位方法をより多くのシーンに適用させることができ、測位の柔軟性及び汎用性を向上させる。
測位装置には高精度地図が含まれると、測位装置は以下の方法を実行してグローバル測位情報を取得してもよい。
ここで、車両は全地球航法衛星システム及び/又は慣性計測ユニットを含み、全地球航法衛星システム及び/又は慣性計測ユニットの用途は上記実施例を参照することができる。
測位装置は車両の走行過程における車線情報を取得し、車線情報と高精度地図に対してマッチング処理を行い、マッチングポーズ情報を得て、前記全地球航法衛星システム及び/又は慣性計測ユニットに基づいて収集された中間ポーズ情報を取得し、それによりマッチングポーズ情報及び中間ポーズ情報に基づいてグローバル測位情報を生成する。
例えば、測位装置は車線検出の方式に基づいて、車両の走行過程における車線情報を取得し、車線情報は車線の三次元座標であってもよく、かつ車線の三次元座標を高精度地図とマッチング処理を行うことにより、マッチングポーズ情報を得、マッチングポーズ情報は車線検出により得られた車線の三次元座標と、高精度地図中の車線の三次元座標との間の回転及び変位を表すために用いられる。
説明すべきものとして、車線情報、高精度地図、及び中間ポーズ情報を組み合わせることにより、グローバル測位情報を生成することは、グローバル測位情報を形成する複数の次元の要因を考慮するため、グローバル測位情報の誤差を低減させ、グローバル測位情報の正確性及び信頼性を向上させるという技術的効果を実現することができる。
上記分析から分かるように、測位装置はグローバル測位情報を決定する場合、決定されたグローバル測位情報の精度を向上させるために、高精度地図を優先的に組み合わせて実現してもよく、高精度地図がないと、又は、高精度地図がタイムリーに更新されないシーンにおいて、全地球航法衛星システム及び/又は慣性計測ユニットに基づいて実現してもよく、それにより高精度地図に対する強い依存性を回避する。
S302では、車両のローカル測位情報を取得する。
いくつかの実施例において、S302の実現原理について、上記実施例を参照することができる。
他の実施例において、車両は画像収集装置を含み、ローカルポーズ情報は画像収集装置が収集した車両の走行過程における画像に基づいて決定された視覚オドメータ情報である。
ここで、視覚オドメータ情報はオドメータ相対ポーズ情報(標準偏差を含んでもよい)を含み、さらにオドメータ姿勢角情報(上記実施例における姿勢角情報の記載を参照する)を含んでもよい。
説明すべきものとして、画像収集装置により視覚オドメータ情報を決定してもよく、画像収集装置を他のコンポーネント、例えば慣性計測ユニットなどと組み合わせて視覚オドメータ情報を決定してもよく、視覚オドメータ情報を具体的に決定する原理について、関連技術を採用して実現してもよく、ここで説明を省略する。
本実施例において、視覚オドメータ情報の取得は高精度地図に依存する必要がなく、そこで、関連技術における高精度地図に対する強い依存性を回避し、それにより本実施例の車両の測位方法をより多くのシーンに適用させることができ、測位の柔軟性及び汎用性を向上させる。
S303では、グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得る。
ここで、グローバル測位情報はグローバルポーズ情報及びグローバル姿勢角情報を含み、ローカル測位情報はローカルポーズ情報及びローカル姿勢角情報を含む。
いくつかの実施例において、S303の実現原理について、上記実施例を参照することができ、ここでは説明を省略する。
他の実施例において、グローバルポーズ情報は前のフレームのグローバルポーズ情報及び現在のフレームのグローバルポーズ情報を含み、前のフレームと現在のフレームが車両の走行過程における画像における隣接する2つのフレームであり、S303は以下のステップを含んでもよい。
第1のステップでは、前のフレームのグローバルポーズ情報と現在のフレームのグローバルポーズ情報に基づいて、隣接する2つのフレーム間の車両の第1のフレーム間の相対ポーズを決定する。
ここで、第1のフレーム間の相対ポーズは、車両が前のフレームのグローバルポーズ情報から現在のフレームのグローバルポーズ情報まで走行する間のポーズ情報であると理解されてもよい。
ここで、k-1は前のフレームであり、k現在のフレームであり、Gはグローバルであり、Rは回転であり、tは変位である。
第2のステップでは、第1のフレーム間の相対ポーズ及びローカルポーズ情報に基づいてグローバルポーズ情報のグローバル信頼度を決定する。
ここで、グローバル信頼度は、グローバルポーズ情報の信頼性の程度を表すために用いられる。相対的に、グローバル信頼度が高ければ高いほど、グローバルポーズ情報の信頼性の程度が高くなり、そしてグローバルポーズ情報に基づいて決定された車両の位置の信頼性も高くなる。逆に、グローバル信頼度が小さければ小さいほど、グローバルポーズ情報の信頼性の程度が低くなり、グローバルポーズ情報に基づいて決定された車両の位置の信頼性も低くなる。
上記分析から分かるように、グローバルポーズ情報は全地球航法衛星システム及び/又は慣性計測ユニットに基づいて決定されてもよく、決定されたグローバル信頼度が高ければ、全地球航法衛星システム及び/又は慣性計測ユニットに基づいて決定されたグローバルポーズ情報は高い適用可能性を有することを表し、又は、全地球航法衛星システム及び/又は慣性計測ユニットが正常に動作できることを表すことができる。
いくつかの実施例において、第2のステップは以下のようなサブステップを含んでもよい。
第1のサブステップでは、第1のフレーム間の相対ポーズ及びローカルポーズ情報に基づいて第2のフレーム間の相対ポーズを決定する。
ここで、第2のフレーム間の相対ポーズは、グローバルポーズ情報とローカルポーズ情報との間の差異を表すために用いられる。
いくつかの実施例において、第1のサブステップは以下のような細分化ステップを含んでもよい。
第1の細分化ステップでは、前のフレームのローカルポーズ情報と現在のフレームのローカルポーズ情報に基づいて、隣接する2つのフレーム間の車両の第3のフレーム間の相対ポーズを決定する。
ここで、Lはローカルである。
第2の細分化ステップでは、第1のフレーム間の相対ポーズと第3のフレーム間の相対ポーズとの間の差異ポーズを決定して、差異ポーズを第2のフレーム間の相対ポーズとして決定する。
説明すべきものとして、本実施例において、隣接する2つのフレーム間の車両のローカルポーズ情報の変化、及び第1のフレーム間の相対ポーズを組み合わせて、第2のフレーム間の相対ポーズを決定することにより、第2のフレーム間の相対ポーズを車両の実際の動作状況に合わせることができ、それにより第2のフレーム間の相対ポーズが高い信頼性及び正確性を有するという技術的効果がある。
第2のサブステップでは、第2のフレーム間の相対ポーズに基づいてグローバル信頼度を決定する。
本実施例において、グローバルポーズ情報とローカルポーズ情報との間の差異に基づいて、グローバル信頼度を決定することにより、グローバル信頼度に対する決定をグローバルとローカルとの間の車両の走行状況の差異と高度に関連し、それによりグローバル信頼度が高い正確性及び信頼性を有するという技術的効果がある。
第3のステップでは、グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、グローバルポーズ情報及びローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得る。
ここで、測位装置は需要、履歴、及び試験などの方式に基づいてグローバル信頼度閾値を設定してもよく、本実施例は限定しない。
例えば、精度需要が相対的に高い測位シーンに対して、グローバル信頼度閾値を相対的に大きい値に設定してもよく、逆に、精度需要が相対的に低い測位シーンに対して、グローバル信頼度閾値を相対的に小さい値に設定してもよい。
上記分析から、式2を組み合わせて、式3に基づいてグローバル信頼度がグローバル信頼度閾値に達することを決定することができる。
上記式3が成立すれば、グローバル信頼度がグローバル信頼度閾値に達し(つまりそれ以上である)、逆に、上記式3が成立しなければ、グローバル信頼度がグローバル信頼度閾値に達しない(つまりそれより小さい)。
当該ステップは以下のように理解できる。測位装置はグローバル信頼度とグローバル信頼度閾値との間の大きさを判断し、グローバル信頼度がグローバル信頼度閾値以上であれば、グローバルポーズ情報の信頼性の程度が高く、つまりグローバルポーズ情報は全地球航法衛星システム及び/又は慣性計測ユニットが正常に動作する場合に取得されたものであることを表し、グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得る。
説明すべきものとして、本実施例において、グローバル信頼度がグローバル信頼度閾値に達する場合、グローバルポーズ情報は高い信頼性を有し、高い信頼性を有するグローバルポーズ情報とローカルポーズ情報を融合することにより、融合ポーズ情報を生成し、融合ポーズ情報に高い信頼性を有させ、さらに融合ポーズ情報に基づいてより高い精度を持つ車両の位置を決定するという技術的効果を満たす。
いくつかの実施例において、第3のステップは以下のステップを含んでもよい。グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、ローカルポーズ情報に対応するローカル信頼度を取得し、ローカル信頼度が予め設定されたローカル信頼度閾値に達すると、グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得る。
同様に、ローカル信頼度は、ローカルポーズ情報の信頼性の程度を表すために用いられる。相対的に、ローカル信頼度が高ければ高いほど、ローカルポーズ情報の信頼性の程度が高くなり、そしてローカルポーズ情報に基づいて決定された車両の位置の信頼性も高くなる。逆に、ローカル信頼度が小さければ小さいほど、ローカルポーズ情報の信頼性の程度が低くなり、ローカルポーズ情報に基づいて決定された車両の位置の信頼性も低くなる。
ローカル信頼度閾値の設定原理について、上記グローバル信頼度閾値を設定する原理を参照することができ、ここでは説明を省略する。
本実施例において、測位装置はグローバル信頼度がグローバル信頼度閾値に達したと決定した後、さらにローカル信頼度を取得することにより、ローカル信頼度とローカル信頼度閾値との間の大きさを判定し、ローカル信頼度がローカル信頼度閾値以上であれば、グローバルポーズ情報及びローカルポーズ情報に基づいて融合ポーズ情報を生成する。
上記分析から分かるように、ローカルポーズ情報は、画像収集装置及び慣性計測ユニットで構成された装置(ローカル視覚オドメトリ装置と呼ばれてもよい)に基づいて決定されるものであってもよい。それに応じて、ローカル信頼度がローカル信頼度閾値に達すると、ローカル視覚オドメトリ装置が高い適用可能性を有することを表し、又は、ローカル視覚オドメトリ装置が正常に動作することを表すことができる。
同様に、本実施例において、ローカル信頼度がローカル信頼度閾値に達する場合、ローカルポーズ情報は高い信頼性を有し、高い信頼性を有するグローバルポーズ情報と高い信頼性を有するローカルポーズ情報を融合することにより、融合ポーズ情報を生成し、融合ポーズ情報に高い信頼性を有させ、さらに融合ポーズ情報に基づいてより高い精度を持つ車両の位置を決定するという技術的効果を満たす。
他の実施例において、測位装置はグローバル信頼度がグローバル信頼度閾値より小さいと判断すれば、つまり全地球航法衛星システム及び/又は慣性計測ユニットが正常に動作できない可能性がある場合、ローカルポーズ情報を融合ポーズ情報として決定してもよく、それによりグローバルポーズ情報の信頼性が高くないか又は異常である場合、依然としてローカルポーズ情報により車両の位置を決定することができ、測位できないという欠点を回避し、測位の柔軟性及び多様性を向上させるという技術的効果がある。
ここで、全地球航法衛星システム及び/又は慣性計測ユニットが正常に動作した後、測位装置はグローバルポーズ情報及びローカルポーズ情報を組み合わせて融合ポーズ情報を決定する。
他の実施例において、測位装置はグローバル信頼度がグローバル信頼度閾値より小さいと判断すれば、つまり全地球航法衛星システム及び/又は慣性計測ユニットが正常に動作できない可能性がある場合、ローカルポーズ情報に対応するローカル信頼度を取得してもよく、ローカル信頼度が予め設定されたローカル信頼度閾値に達すると、ローカルポーズ情報を融合ポーズ情報として決定してもよい。
本実施例において、グローバル信頼度がグローバル信頼度閾値より小さい場合、ローカルポーズ情報を融合ポーズ情報として直接的に決定する上記実施例に基づいて、さらにローカル信頼度とローカル信頼度閾値との間の大きさ関係を組み合わせて、ローカルポーズ情報を融合ポーズ情報として決定することは、融合ポーズ情報に高い信頼性を有させ、それにより測位の精度にできるだけで測位の需要を満たさせ、車両の走行安全を確保するという技術的効果がある。
他のいくつかの実施例において、グローバル信頼度がグローバル信頼度閾値に達し、ローカル信頼度がローカル信頼度閾値に達しない場合、グローバルポーズ情報を融合ポーズ情報として決定して、視覚オドメトリ装置が正常に動作した後に、グローバルポーズ情報及びローカルポーズ情報を組み合わせて融合ポーズ情報を決定する。
他のいくつかの実施例において、グローバル信頼度がグローバル信頼度閾値より小さく、かつローカル信頼度がローカル信頼度閾値より小さい場合、測位装置は測位異常をプロンプトするためのプロンプトメッセージを出力することができ、それにより運転者又は他の乗客に車両を検出するように注意し、又は他の対応する処理を行うことにより、測位できないことによる車両の安全事故などの弊害を回避し、車両走行の安全性を向上させる。
上記分析から分かるように、本実施例において、融合ポーズ情報を決定する方式は以下の4種を含んでもよい。
第1種では、グローバルポーズ情報及びローカルポーズ情報の信頼性がいずれも高いシーンにおいて、グローバルポーズ情報及びローカルポーズ情報に基づいて融合ポーズ情報を決定してもよい。
第2種では、グローバルポーズ情報の信頼性が高く、ローカルポーズ情報の信頼性が低いシーンにおいて、グローバルポーズ情報を融合ポーズ情報として決定してもよい。
第3種では、グローバルポーズ情報の信頼性が低く、ローカルポーズ情報の信頼性が高いシーンにおいて、ローカルポーズ情報を融合ポーズ情報として決定してもよい。
第4種では、グローバルポーズ情報の信頼性が低くて、ローカルポーズ情報の信頼性が低いシーンにおいて、測位異常のプロンプトメッセージを送信してもよい。
説明すべきものとして、上記4種の方式を組み合わせて車両に対して測位を行うことにより、車両測位の柔軟性と多様性を実現することができ、かつ上記4種の融合ポーズ情報を決定する方式においてスムーズに切り替えることを実現し、車両の測位に対するスムーズな切り替えを実現することができ、それにより測位過程の全体性と完全性、及び測位方法の多様性と柔軟性を実現することができ、さらに車両測位の正確性及び信頼性を向上させ、車両の走行安全を確保することができるという技術的効果がある。
いくつかの実施例において、グローバルポーズ情報とローカルポーズ情報の融合処理は、最大事後推定の過程として理解されることができる。
例えば、式4により融合ポーズ情報を決定してもよい。
ここで、
は最大事後推定値であり、
はローカルポーズ情報の尤度値であり、所定状態
でのローカルポーズ情報の条件付き確率を表すために用いられ、
はグローバルポーズ情報の尤度値であり、所定状態
でのグローバルポーズ情報の条件付き確率を表すために用いられる。
式6を解く場合、事後推定の方式を採用してもよく、負対数を利用してローカルポーズ情報の二乗和を決定し、非線形最小二乗問題を生成して、反復アルゴリズムを利用して最終結果を決定し、具体的な計算過程は関連技術を参照することができ、ここでは説明を省略する。
S304では、グローバルロール角及びローカルロール角に基づいて第1の補正パラメータを決定して、グローバルピッチ角及びローカルピッチ角に基づいて第2の補正パラメータを決定する。
例えば、グローバルロール角とローカルロール角との間の差に基づいて第1の補正パラメータを決定し、グローバルピッチ角とローカルピッチ角との間の差に基づいて第2の補正パラメータを決定してもよい。
S305では、第1の補正パラメータと第2の補正パラメータに基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得る。
説明すべきものとして、本実施例において、第1の補正パラメータ及び第2の補正パラメータを組み合わせて融合ポーズ情報を補正することは、ロール角及びピッチ角での車両の制約を実現することに相当し、ロール角及びピッチ角での車両の「スロードリフト」を回避し、決定された車両の位置の正確性を向上させるという技術的効果を有する。
上記分析から分かるように、いくつかの実施例において、グローバル姿勢角情報はさらにグローバルヨー角を含んでもよく、ローカル姿勢角情報はさらにローカルヨー角を含んでもよく、第1の補正パラメータを決定する上で、さらにグローバルヨー角とローカルヨー角に基づいて第3の補正パラメータを決定して、第3の補正パラメータを組み合わせて融合ポーズ情報に対して補正処理を行ってもよい。
例えば、第1の補正パラメータと第3の補正パラメータを組み合わせて融合ポーズ情報に対して補正処理を行ってもよく、第2の補正パラメータと第3の補正パラメータを組み合わせて融合ポーズ情報に対して補正処理を行ってもよく、さらに第1の補正パラメータ、第2の補正パラメータ、及び第3の補正パラメータを組み合わせて融合ポーズ情報に対して補正処理を行うことにより、補正処理の柔軟性及び多様性を向上させるという技術的効果を実現する。
図4は本開示の第3の実施例の模式図であり、図4に示すように、車両の測位装置400は、
車両には高精度地図がないことに応答し、車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて車両の中間ポーズ情報を取得するための第1の取得ユニット401と、
中間ポーズ情報をグローバル測位情報として決定するための決定ユニット402であって、グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれる決定ユニット402と、
車両のローカル測位情報を取得するための第2の取得ユニット403であって、ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれる第2の取得ユニット403と、
グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合ユニット404と、
グローバル姿勢角情報とローカル姿勢角情報に基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得るための補正ユニット405と、を含む。
車両には高精度地図がないことに応答し、車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて車両の中間ポーズ情報を取得するための第1の取得ユニット401と、
中間ポーズ情報をグローバル測位情報として決定するための決定ユニット402であって、グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれる決定ユニット402と、
車両のローカル測位情報を取得するための第2の取得ユニット403であって、ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれる第2の取得ユニット403と、
グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合ユニット404と、
グローバル姿勢角情報とローカル姿勢角情報に基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得るための補正ユニット405と、を含む。
図5は本開示の第4の実施例の模式図であり、図5に示すように、車両の測位装置500は、
車両には高精度地図がないことに応答し、車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて車両の中間ポーズ情報を取得するための第1の取得ユニット501と、
中間ポーズ情報をグローバル測位情報として決定するための決定ユニット502であって、グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれる決定ユニット502と、
車両のローカル測位情報を取得するための第2の取得ユニット503であって、ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれる第2の取得ユニット503と、
グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合ユニット504とを含む。
車両には高精度地図がないことに応答し、車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて車両の中間ポーズ情報を取得するための第1の取得ユニット501と、
中間ポーズ情報をグローバル測位情報として決定するための決定ユニット502であって、グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれる決定ユニット502と、
車両のローカル測位情報を取得するための第2の取得ユニット503であって、ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれる第2の取得ユニット503と、
グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合ユニット504とを含む。
いくつかの実施例において、車両は全地球航法衛星システム及び/又は慣性計測ユニットを含み、車両には高精度地図が記憶されると、第1の取得ユニット501は、
車両の走行過程における車線情報を取得するための第1の取得サブユニット5011と、
車線情報と高精度地図に対してマッチング処理を行い、マッチングポーズ情報を得るためのマッチングサブユニット5012と、
全地球航法衛星システム及び/又は慣性計測ユニット基づいて収集された中間ポーズ情報を取得するための第2の取得サブユニット5013と、
マッチングポーズ情報及び中間ポーズ情報に基づいてグローバル測位情報を生成するための生成サブユニット5014と、を含む。
車両の走行過程における車線情報を取得するための第1の取得サブユニット5011と、
車線情報と高精度地図に対してマッチング処理を行い、マッチングポーズ情報を得るためのマッチングサブユニット5012と、
全地球航法衛星システム及び/又は慣性計測ユニット基づいて収集された中間ポーズ情報を取得するための第2の取得サブユニット5013と、
マッチングポーズ情報及び中間ポーズ情報に基づいてグローバル測位情報を生成するための生成サブユニット5014と、を含む。
いくつかの実施例において、車両は画像収集装置を含み、ローカルポーズ情報は画像収集装置が収集した車両の走行過程における画像に基づいて決定された視覚オドメータ情報である。
いくつかの実施例において、グローバル姿勢角情報はグローバルロール角及びグローバルピッチ角を含み、ローカル姿勢角情報はローカルロール角及びローカルピッチ角を含む。
図5を参照して分かるように、いくつかの実施例において、グローバルポーズ情報は前のフレームのグローバルポーズ情報及び現在のフレームのグローバルポーズ情報を含み、前のフレームと現在のフレームが車両の走行過程における画像における隣接する2つのフレームであり、融合ユニット504は、
前のフレームのグローバルポーズ情報と現在のフレームのグローバルポーズ情報に基づいて、隣接する2つのフレーム間の車両の第1のフレーム間の相対ポーズを決定するための第3の決定サブユニット5041と、
第1のフレーム間の相対ポーズ及びローカルポーズ情報に基づいてグローバルポーズ情報のグローバル信頼度を決定するための第4の決定サブユニット5042と、を含む。
前のフレームのグローバルポーズ情報と現在のフレームのグローバルポーズ情報に基づいて、隣接する2つのフレーム間の車両の第1のフレーム間の相対ポーズを決定するための第3の決定サブユニット5041と、
第1のフレーム間の相対ポーズ及びローカルポーズ情報に基づいてグローバルポーズ情報のグローバル信頼度を決定するための第4の決定サブユニット5042と、を含む。
いくつかの実施例において、第4の決定サブユニット5042は、
第1のフレーム間の相対ポーズとローカルポーズ情報に基づいて第2のフレーム間の相対ポーズを決定するための第1の決定モジュールを含み、第2のフレーム間の相対ポーズは、グローバルポーズ情報とローカルポーズ情報との間の差異を表すために用いられる。
第1のフレーム間の相対ポーズとローカルポーズ情報に基づいて第2のフレーム間の相対ポーズを決定するための第1の決定モジュールを含み、第2のフレーム間の相対ポーズは、グローバルポーズ情報とローカルポーズ情報との間の差異を表すために用いられる。
いくつかの実施例において、ローカルポーズ情報は前のフレームのローカルポーズ情報及び現在のフレームのローカルポーズ情報を含み、第1の決定モジュールは、
前のフレームのローカルポーズ情報と現在のフレームのローカルポーズ情報に基づいて、隣接する2つのフレーム間の車両の第3のフレーム間の相対ポーズを決定するための第1の決定サブモジュールと、
第1のフレーム間の相対ポーズと第3のフレーム間の相対ポーズとの間の差異ポーズを決定して、差異ポーズを第2のフレーム間の相対ポーズとして決定するための第2の決定サブモジュールと、
第2のフレーム間の相対ポーズに基づいてグローバル信頼度を決定するための第2の決定モジュールと、
グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、グローバルポーズ情報と前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合サブユニット5043と、を含む。
前のフレームのローカルポーズ情報と現在のフレームのローカルポーズ情報に基づいて、隣接する2つのフレーム間の車両の第3のフレーム間の相対ポーズを決定するための第1の決定サブモジュールと、
第1のフレーム間の相対ポーズと第3のフレーム間の相対ポーズとの間の差異ポーズを決定して、差異ポーズを第2のフレーム間の相対ポーズとして決定するための第2の決定サブモジュールと、
第2のフレーム間の相対ポーズに基づいてグローバル信頼度を決定するための第2の決定モジュールと、
グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、グローバルポーズ情報と前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合サブユニット5043と、を含む。
いくつかの実施例において、グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、融合サブユニット5043は、
グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、ローカルポーズ情報に対応するローカル信頼度を取得するための取得モジュールと、
ローカル信頼度が予め設定されたローカル信頼度閾値に達すると、グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合モジュールと、
グローバル姿勢角情報とローカル姿勢角情報に基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得るための補正ユニット505と、を含む。
グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、ローカルポーズ情報に対応するローカル信頼度を取得するための取得モジュールと、
ローカル信頼度が予め設定されたローカル信頼度閾値に達すると、グローバルポーズ情報とローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合モジュールと、
グローバル姿勢角情報とローカル姿勢角情報に基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得るための補正ユニット505と、を含む。
図5を参照して分かるように、いくつかの実施例において、補正ユニット505は、
グローバルロール角及びローカルロール角に基づいて第1の補正パラメータを決定するための第1の決定サブユニット5051と、
グローバルピッチ角及びローカルピッチ角に基づいて第2の補正パラメータを決定するための第2の決定サブユニット5052と、
第1の補正パラメータと第2の補正パラメータに基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得るための補正サブユニット5053と、
グローバル信頼度がグローバル信頼度閾値より小さければ、ローカルポーズ情報に基づいて車両の位置を決定するための第5の決定サブユニット5054と、を含む。
グローバルロール角及びローカルロール角に基づいて第1の補正パラメータを決定するための第1の決定サブユニット5051と、
グローバルピッチ角及びローカルピッチ角に基づいて第2の補正パラメータを決定するための第2の決定サブユニット5052と、
第1の補正パラメータと第2の補正パラメータに基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得るための補正サブユニット5053と、
グローバル信頼度がグローバル信頼度閾値より小さければ、ローカルポーズ情報に基づいて車両の位置を決定するための第5の決定サブユニット5054と、を含む。
本開示の実施例によれば、本開示はさらに電子機器、可読記憶媒体及びコンピュータプログラム製品を提供する。
本開示の実施例によれば、本開示はさらにコンピュータプログラム製品が提供され、コンピュータプログラム製品は、コンピュータプログラムを含み、コンピュータプログラムが可読記憶媒体に記憶され、電子機器の少なくとも1つのプロセッサが可読記憶媒体からコンピュータプログラムを読み取り、少なくとも1つのプロセッサがコンピュータプログラムを実行することにより電子機器に上記いずれかの実施例に係る技術案を実行させる。
図6は、本開示の実施例を実施するために使用されることができる例示的な電子機器600の模式的なブロック図を示す。電子機器は様々な形式のデジタルコンピュータ、例えば、ラップトップ型コンピュータ、デスクトップコンピュータ、作業台、パーソナルデジタルアシスタント、サーバ、ブレードサーバ、大型コンピュータ、及び他の適切なコンピュータを示すことを意図する。電子機器はさらに様々な形式の移動装置を表してもよく、例えば、パーソナルデジタルアシスタント、携帯電話、スマートフォン、ウェアラブル装置及び他の類似のコンピューティング装置であってもよい。本明細書に示された部材、それらの接続と関係、及びそれらの機能は例示に過ぎず、かつ本明細書に記載された及び/又は要求された本開示の実現を限定するものではない。
図6に示すように、機器600はコンピューティングユニット601を含み、それはリードオンリーメモリ(ROM)602に記憶されたコンピュータプログラム又は記憶ユニット608からランダムアクセスメモリ(RAM)603にロードされたコンピュータプログラムに基づいて、様々な適切な動作及び処理を実行することができる。RAM603において、さらに機器600の操作に必要な様々なプログラム及びデータを記憶してもよい。コンピューティングユニット601、ROM602、及びRAM603は、バス604により互に接続される。入/出力(I/O)インタフェース605もバス604に接続される。
機器600における複数の部材は、I/Oインタフェース605に接続され、例えばキーボード、マウスなどである入力ユニット606、例えば様々なタイプのディスプレイ、スピーカなどである出力ユニット607、例えば磁気ディスク、光ディスクなどである記憶ユニット608、及び例えばネットワークカード、モデム、無線通信トランシーバなどである通信ユニット609を含む。通信ユニット609は、機器600がインターネットなどのコンピュータネットワーク及び/又は様々の電気通信網を介して他の機器と情報/データを交換することを可能にする。
コンピューティングユニット601は、処理及びコンピューティング能力を有する様々の汎用及び/又は専用の処理コンポーネントであってもよい。コンピューティングユニット601のいくつかの例は、中央処理ユニット(CPU)、グラフィクスプロセッシングユニット(GPU)、様々の種類の専用の人工知能(AI)コンピューティングチップ、様々な機械学習モデルアルゴリズムを実行するコンピューティングユニット、デジタル信号プロセッサ(DSP)、任意の適切なプロセッサ、コントローラ、マイクロコントローラなどを含むが、これらに限定されるものではない。コンピューティングユニット601は上記説明された各方法及び処理、例えば車両の測位方法を実行する。例えば、いくつかの実施例において、車両の測位方法はコンピュータソフトウェアプログラムとして実現され、機械可読媒体、例えば記憶ユニット608に有形的に含まれてもよい。いくつかの実施例において、コンピュータプログラムの一部又は全部はROM602及び/又は通信ユニット609を介して機器600にロード及び/又はインストールされてもよい。コンピュータプログラムがRAM603にロードされて、コンピューティングユニット601により実行される場合、上記記載された車両の測位方法の1つ又は複数のステップを実行することができる。代替的に、他の実施例において、コンピューティングユニット601は他の任意の適切な方式(例えば、ファームウェアにより)により車両の測位方法を実行するように構成されてもよい。
本明細書で説明したシステム及び技術の様々な実施形態はデジタル電子回路システム、集積回路システム、フィールドプログラマブルゲートアレイ(FPGA)、専用集積回路(ASIC)、専用標準製品(ASSP)、システムオンチップのシステム(SOC)、負荷プログラマブルロジック装置(CPLD)、コンピュータハードウェア、ファームウェア、ソフトウェア、及び/又はそれらの組み合わせにおいて実現されてもよい。これらの様々な実施形態は、1つ又は複数のコンピュータプログラムにおいて実施することを含んでもよく、当該1つ又は複数のコンピュータプログラムは少なくとも1つのプログラム可能なプロセッサを含むプログラム可能なシステムで実行及び/又は解釈され、当該プログラム可能なプロセッサは専用又は汎用のプログラム可能なプロセッサであってもよく、記憶システム、少なくとも1つの入力装置、及び少なくとも1つの出力装置からデータ及び命令を受信して、データ及び命令を当該記憶システム、当該少なくとも1つの入力装置、及び当該少なくとも1つの出力装置に伝送してもよい。
本開示の方法を実施するためのプログラムコードは1つ又は複数のプログラミング言語の任意の組み合わせで記述されることができる。これらのプログラムコードは汎用コンピュータ、専用コンピュータ又は他のプログラム可能なデータ処理装置のプロセッサ又はコントローラに提供されることができ、それによりプログラムコードはプロセッサ又はコントローラにより実行されるときにフローチャート及び/又はブロック図に規定された機能/操作が実施される。プログラムコードは完全に機器で実行されもよく、部分的に機器で実行されてもよく、独立したソフトウェアパッケージとして、部分的に機器で実行され、かつ部分的に遠隔機器で実行され、又は完全に遠隔機器又はサーバで実行されてもよい。
本開示の明細書において、機械可読媒体は有形の媒体であってもよく、それは命令実行システム、装置又は機器が使用する又は命令実行システム、装置又は機器と組み合わせて使用するプログラムを含むか又は記憶してもよい。機械可読媒体は機械可読信号媒体又は機械可読記憶媒体であってもよい。機械可読媒体は電子的、磁気的、光学的、電磁的、赤外線的、又は半導体システム、装置又は機器、又は上記内容の任意の適切な組み合わせを含むがそれらに限定されない。機械可読記憶媒体のより具体的な例は1つ以上の線に基づく電気的接続、携帯式コンピュータディスク、ハードディスク、ランダムアクセスメモリ(RAM)、リードオンリーメモリ(ROM)、消去可能なプログラマブルリードオンリーメモリ(EPROM又はフラッシュメモリ)、光ファイバ、携帯式コンパクトディスクリードオンリーメモリ(CD-ROM)、光記憶装置、磁気記憶装置、又は上記コンテンツの任意の適切な組み合わせを含む。
ユーザとの対話を提供するために、コンピュータにここで説明されたシステム及び技術を実施することができ、当該コンピュータは、ユーザに情報を表示するための表示装置(例えば、CRT(陰極線管)又はLCD(液晶ディスプレイ)モニタ)、及びキーボードとポインティング装置(例えば、マウス又はトラックボール)を有し、ユーザは当該キーボード及び当該ポインティング装置を介して入力をコンピュータに提供することができる。他の種類の装置はさらにユーザとの対話を提供するために用いられる。例えば、ユーザに提供されたフィードバックは任意の形式のセンシングフィードバック(例えば、視覚フィードバック、聴覚フィードバック、又は触覚フィードバック)であってもよく、かつ任意の形式(声入力、音声入力又は、触覚入力を含む)でユーザからの入力を受信してもよい。
ここで説明されたシステム及び技術を、バックグラウンド部材を含むコンピューティングシステム(例えば、データサーバとする)、又はミドルウェア部材を含むコンピューティングシステム(例えば、アプリケーションサーバ)、又はフロントエンド部材を含むコンピューティングシステム(例えば、グラフィカルユーザインタフェース又はウェブブラウザを有するユーザコンピュータであり、ユーザが当該グラフィカルユーザインタフェース又は当該ネットワークブラウザを介してここで説明されたシステム及び技術の実施形態と対話することができる)、又はこのようなバックグラウンド部材、ミドルウェア部材、又はフロントエンド部材の任意の組み合わせを含むコンピューティングシステムに実施してもよい。任意の形式又は媒体のデジタルデータ通信(例えば、通信ネットワーク)によりシステムの部材を互いに接続してもよい。通信ネットワークの例は、ローカルエリアネットワーク(LAN)、ワイドエリアネットワーク(WAN)及びインターネットを含む。
コンピュータシステムはクライアント及びサーバを含んでもよい。クライアントとサーバとは一般的に離れており、かつ普通に通信ネットワークを介して対話を行う。クライアントとサーバとの関係は、対応するコンピュータで実行され、かつ互いにクライアント-サーバの関係を有するコンピュータプログラムによって生成される。サーバはクラウドサーバであってもよく、クラウドコンピューティングサーバ又はクラウドホストとも呼ばれ、クラウドコンピューティングサービスシステムのうちの1つのホスト製品であり、それにより従来の物理ホストとVPSサービス(「Virtual Private Server」、又は「VPS」と略称する)において存在する管理難度が大きく、サービス拡張性が弱いという欠陥を解決する。サーバは分散式システムのサーバであってもよく、又はブロックチェーンを組み合わせたサーバであってもよい。
図7は本開示の第5の実施例の模式図であり、図7に示すように、車両700は装置701~703を含む。
グローバル測位装置701は車両のグローバル測位情報を取得するために用いられる。ここで、グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれる。
いくつかの実施例において、グローバル測位装置701は、全地球航法衛星システム及び/又は慣性計測ユニットを含む。
ここで、全地球航法衛星システム及び/又は慣性計測ユニットに基づいてグローバル測位情報を取得する原理は、上記実施例を参照してもよく、ここでは説明を省略する。
ローカル測位装置702は車両のローカル測位情報を取得するために用いられる。ここで、ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれる。
いくつかの実施例において、ローカル測位装置702は視覚オドメトリ装置を含み、かつ視覚オドメトリ装置は画像収集装置、全地球航法衛星システム、慣性計測ユニットに基づいて構築されてもよい。視覚オドメトリ装置がローカル測位情報を取得する原理について、上記実施例を参照することができ、ここでは説明を省略する。
ポーズグラーフ最適化装置703は、グローバルポーズ情報及びローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得て、グローバル姿勢角情報及びローカル姿勢角情報に基づいて、融合ポーズ情報に対して補正処理を行い、車両の位置を得るために用いられる。
いくつかの実施例において、図7に示すように、ポーズグラーフ最適化装置703は、ステートマシンコンポーネント7031及びポーズ融合コンポーネント7032を含んでもよい。
ステートマシンコンポーネント7031は、グローバル測位装置701のグローバル状態属性、ローカル測位装置702のローカル状態属性を決定して、グローバル状態属性及びローカル状態属性に基づいて融合ポーズ情報を決定するために用いられる。
ここで、状態属性は正常状態及び異常状態を含み、それに応じて、グローバル状態属性はグローバル正常状態及びグローバル異常状態を含み、ローカル状態属性はローカル正常状態及びローカル異常状態を含む。
上記実施例の分析を参照して、グローバル測位装置701のグローバル状態属性がグローバル正常状態であれば、グローバル測位装置701の動作が正常であることを示し、より確実なグローバル測位情報を提供することができ、逆に、グローバル測位装置701のグローバル状態属性がグローバル異常状態であれば、グローバル測位装置701は異常に動作することを表し、より確実なグローバル測位情報を提供することができない。
同様に、ローカル測位装置702のローカル状態属性がローカル正常状態であれば、ローカル測位装置702の動作が正常であると表し、より確実なローカル測位情報を提供することができ、逆に、ローカル測位情報702のローカル状態属性がローカル異常状態であれば、ローカル測位装置702の動作が異常であると表し、より確実なローカル測位情報を提供することができない。
ポーズ融合コンポーネント7032は、グローバルポーズ情報及び/又はローカルポーズ情報に基づいて融合して融合ポーズ情報を得るために用いられる。
上記分析を参照し、例えば、グローバル測位装置701のグローバル状態属性がグローバル正常状態であり、かつローカル測位装置702のローカル状態属性がローカル正常状態であると、ポーズ融合コンポーネント7032はグローバルポーズ情報及びローカルポーズ情報を融合することによって融合ポーズ情報を得る。
例示的には、車両についての各測位は1つの測位ノードと呼ばれることができ、図8に示すように、3つの測位ノードが例示的に示され、それぞれ測位ノード1、測位ノード2、測位ノード3と表記する。
図8に示すように、測位ノード1は初期測位ノードであり、測位ノード1において、測位ノード1におけるグローバル測位情報1及びローカル測位情報1に基づいて、測位ノード1における車両の位置を決定することができる。
図8及び式6を組み合わせて分かるように、測位ノード2において、ローカル測位情報1及びローカル測位情報2に基づいて、測位ノード1と測位ノード2との間の相対姿勢制約12を確立して、当該相対姿勢制約12、測位ノード2におけるグローバル測位情報2及びローカル測位情報2に基づいて、測位ノード2における車両の位置を決定することができる。
いくつかの実施例において、図8に示すように、測位ノード3において、ローカル測位情報2及びローカル測位情報3に基づいて、測位ノード2と測位ノード3との間の相対姿勢制約23を確立し、ローカル測位情報1及びローカル測位情報3に基づいて、測位ノード1と測位ノード3との間の相対姿勢制約13を確立して、相対姿勢制約23、相対姿勢制約13、測位ノード3におけるグローバル測位情報3及びローカル測位情報3に基づいて、測位ノード3における車両の位置を決定することができる。
理解すべきものとして、より多くの測位ノードの実現原理は上記実現原理と同じであり、ここで1つずつ列挙しない。
また例えば、グローバル測位装置701のグローバル状態属性がグローバル正常状態であり、ローカル測位装置702のローカル状態属性がローカル異常状態であれば、ポーズ融合コンポーネント7032はグローバルポーズ情報に基づいて融合ポーズ情報を決定する。
例示的には、図9に示すように、図8に基づいて測位ノード4を追加する。
測位ノード4の場合、ローカル状態属性がローカル異常状態であるため、測位ノード4の場合、グローバルポーズ情報に基づいて融合ポーズ情報を決定する。
さらに例えば、グローバル測位装置701のグローバル状態属性がグローバル異常状態であり、ローカル測位装置702のローカル状態属性がローカル正常状態であれば、ポーズ融合コンポーネント7032はローカルポーズ情報に基づいて融合して融合ポーズ情報を得る。
例示的には、図10に示すように、図8に基づいて測位ノード5を追加する。
測位ノード5の場合、グローバル状態属性がグローバル異常状態であるため、測位ノード5の場合、ローカルポーズ情報に基づいて融合ポーズ情報を決定する。
上記分析と図10を組み合わせて分かるように、他のいくつかの実施例では、測位ノード5において、ローカル測位情報3及びローカル測位情報5に基づいて、測位ノード3と測位ノード5との間の相対姿勢制約35を確立し、ローカル測位情報2及びローカル測位情報5に基づいて、測位ノード2と測位ノード5との間の相対姿勢制約25を確立して、相対姿勢制約35、相対姿勢制約25、測位ノード5におけるローカル測位情報5に基づいて、測位ノード5における車両の位置を決定することができる。
さらに例えば、グローバル測位装置701のグローバル状態属性がグローバル異常状態であり、かつローカル測位装置702のローカル状態属性がローカル異常状態であれば、ポーズ融合コンポーネント7032はプロンプトメッセージを出力することにより、測位できないことをプロンプトする。
ここで、ポーズ融合コンポーネント7032はさらにグローバル測位装置701が出力したグローバル姿勢角情報、及びローカル測位装置702が出力したローカル姿勢角情報に基づいて融合ポーズ情報に対して補正処理を行って、車両の位置を得ることができる。
いくつかの実施例において、車両にはさらにアップコンバート装置が設けられてもよく、アップコンバート装置はポーズグラーフ最適化装置の出力周波数に対してアップコンバート処理を行うことにより、周波数レベルの測位要求を満たすために用いられる。
例えば、ポーズグラーフ最適化装置から出力された周波数が15HZであれば、アップコンバート装置はポーズグラーフ最適化装置の周波数を125HZに上げることができる。
図11は本開示の第6の実施例に係る模式図であり、図11に示すように、本開示における電子機器1100は、プロセッサ1101及びメモリ1102を含んでもよい。
メモリ1102は、プログラムを記憶するために用いられる。メモリ1102は、揮発性メモリ(英語:volatile memory)、例えば、スタティックランダムアクセスメモリ(英語:static random-access memory、略称:SRAM)、ダブルデータレート同期ダイナミックランダムアクセスメモリ(英語:Double Data Rate Synchronous Dynamic Random Access Memory、略称:DDR SDRAM)などのランダムアクセスメモリ(英語:random-access memory、略称:RAM)を含んでもよい。メモリは不揮発性メモリ(英語:non-volatile memory)、例えばフラッシュメモリ(英語:flash memory)を含んでもよい。メモリ1102はコンピュータプログラム(例えば上記方法を実現するアプリケーションプログラム、機能モジュールなど)、コンピュータ命令などを記憶するために用いられ、上記コンピュータプログラム、コンピュータ命令などを1つ又は複数のメモリ1102に分けて記憶してもよい。また、上記コンピュータプログラム、コンピュータ命令、データなどは、プロセッサ1101によって呼び出されてもよい。
上記コンピュータプログラム、コンピュータ命令などを1つ又は複数のメモリ1102に分けて記憶してもよい。また、上記コンピュータプログラム、コンピュータ命令、データなどは、プロセッサ1101によって呼び出されてもよい。
プロセッサ1101は、メモリ1102に記憶されたコンピュータプログラムを実行することにより、上記実施例に係る方法における各ステップを実現するために用いられる。
具体的には前の方法実施例における関連する説明を参照することができる。
プロセッサ1101とメモリ1102は独立した構造であってもよく、一体に集積された集積構造であってもよい。プロセッサ1101とメモリ1102が独立した構造である場合、メモリ1102、プロセッサ1101はバス1103により結合されて接続されてもよい。
本実施例の電子機器は上記方法における技術案を実行することができ、その具体的な実現過程及び技術的原理は同じであり、ここでは説明を省略する。
理解すべきものとして、以上に示した様々な形式のフローを使用し、ステップを並べ替えるか、追加するか又は削除してもよい。例えば、本開示に記載の各ステップは並列的に実行されてもよく、順に実行されてもよく、異なる順序で実行されてもよく、本開示に開示される技術案の所望の結果を実現することができれば、本明細書はここで限定されない。
上記具体的な実施形態は、本開示の保護範囲を限定するものではない。当業者であれば理解すべきものとして、設計要求及び他の要因に基づいて、様々な修正、組み合わせ、サブコンビネーション及び代替を行うことができる。本開示の精神と原則内で行われた任意の修正、均等置換及び改善などは、いずれも本開示の保護範囲内に含まれるべきである。
Claims (26)
- 車両には高精度地図がないことに応答し、前記車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて前記車両の中間ポーズ情報を取得して、前記中間ポーズ情報をグローバル測位情報として決定することであって、前記グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれることと、
ローカルポーズ情報及びローカル姿勢角情報を含む、前記車両のローカル測位情報を取得して、前記グローバルポーズ情報及び前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得ることと、
前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得ることと、を含む、
車両の測位方法。 - 前記グローバル姿勢角情報はグローバルロール角及びグローバルピッチ角を含み、前記ローカル姿勢角情報はローカルロール角及びローカルピッチ角を含む、
請求項1に記載の方法。 - 前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得ることは、
前記グローバルロール角及び前記ローカルロール角に基づいて第1の補正パラメータを決定して、前記グローバルピッチ角及び前記ローカルピッチ角に基づいて第2の補正パラメータを決定することと、
前記第1の補正パラメータ及び前記第2の補正パラメータに基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得ることと、を含む、
請求項2に記載の方法。 - 前記グローバルポーズ情報は前のフレームのグローバルポーズ情報及び現在のフレームのグローバルポーズ情報を含み、前のフレームと現在のフレームが前記車両の走行過程における画像における隣接する2つのフレームであり、前記グローバルポーズ情報及び前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得ることは、
前記前のフレームのグローバルポーズ情報と前記現在のフレームのグローバルポーズ情報に基づいて、隣接する2つのフレーム間の前記車両の第1のフレーム間の相対ポーズを決定することと、
前記第1のフレーム間の相対ポーズ及び前記ローカルポーズ情報に基づいて前記グローバルポーズ情報のグローバル信頼度を決定し、前記グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、前記グローバルポーズ情報及び前記ローカルポーズ情報に対して融合処理を行い、前記融合ポーズ情報を得ることと、を含む、
請求項1に記載の方法。 - 前記第1のフレーム間の相対ポーズ及び前記ローカルポーズ情報に基づいて前記グローバルポーズ情報のグローバル信頼度を決定することは、
前記第1のフレーム間の相対ポーズと前記ローカルポーズ情報に基づいて第2のフレーム間の相対ポーズを決定することであって、前記第2のフレーム間の相対ポーズは、前記グローバルポーズ情報と前記ローカルポーズ情報との間の差異を表すために用いられることと、
前記第2のフレーム間の相対ポーズに基づいて前記グローバル信頼度を決定することと、を含む、
請求項4に記載の方法。 - 前記ローカルポーズ情報は、前のフレームのローカルポーズ情報及び現在のフレームのローカルポーズ情報を含み、前記第1のフレーム間の相対ポーズと前記ローカルポーズ情報に基づいて第2のフレーム間の相対ポーズを決定することは、
前記前のフレームのローカルポーズ情報と前記現在のフレームのローカルポーズ情報に基づいて、隣接する2つのフレームの間の前記車両の第3のフレーム間の相対ポーズを決定することと、
前記第1のフレーム間の相対ポーズと前記第3のフレーム間の相対ポーズとの間の差異ポーズを決定して、前記差異ポーズを第2のフレーム間の相対ポーズとして決定することと、を含む、
請求項5に記載の方法。 - 前記グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、前記グローバルポーズ情報及び前記ローカルポーズ情報に対して融合処理を行い、前記融合ポーズ情報を得ることは、
前記グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、前記ローカルポーズ情報に対応するローカル信頼度を取得し、前記ローカル信頼度が予め設定されたローカル信頼度閾値に達すると、前記グローバルポーズ情報と前記ローカルポーズ情報に対して融合処理を行い、前記融合ポーズ情報を得ることを含む、
請求項4に記載の方法。 - 前記グローバル信頼度が前記グローバル信頼度閾値より小さければ、前記ローカルポーズ情報に基づいて前記車両の位置を決定することを、さらに含む、
請求項4に記載の方法。 - 車両には高精度地図が記憶されることに応答し、前記車両の走行過程における車線情報を取得し、前記車線情報及び前記高精度地図に対してマッチング処理を行い、マッチングポーズ情報を得ることと、
前記全地球航法衛星システム及び/又は慣性計測ユニットに基づいて収集された中間ポーズ情報を取得して、前記マッチングポーズ情報及び前記中間ポーズ情報に基づいて前記グローバル測位情報を生成することと、をさらに含む、
請求項1に記載の方法。 - 前記車両は画像収集装置を含み、前記ローカルポーズ情報は、前記画像収集装置が収集した前記車両の走行過程における画像に基づいて決定された視覚オドメータ情報である、
請求項1に記載の方法。 - 車両には高精度地図がないことに応答し、前記車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて前記車両の中間ポーズ情報を取得するための第1の取得ユニットと、
前記中間ポーズ情報をグローバル測位情報として決定するための決定ユニットであって、前記グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれる決定ユニットと、
前記車両のローカル測位情報を取得するための第2の取得ユニットであって、前記ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれる第2の取得ユニットと、
前記グローバルポーズ情報と前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得るための融合ユニットと、
前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得るための補正ユニットとを含む、
車両の測位装置。 - 前記グローバル姿勢角情報はグローバルロール角及びグローバルピッチ角を含み、前記ローカル姿勢角情報はローカルロール角及びローカルピッチ角を含む、
請求項11に記載の装置。 - 前記補正ユニットは、
前記グローバルロール角及び前記ローカルロール角に基づいて第1の補正パラメータを決定するための第1の決定サブユニットと、
前記グローバルピッチ角及び前記ローカルピッチ角に基づいて第2の補正パラメータを決定するための第2の決定サブユニットと、
前記第1の補正パラメータと前記第2の補正パラメータに基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得るための補正サブユニットと、を含む、
請求項12に記載の装置。 - 前記グローバルポーズ情報は前のフレームのグローバルポーズ情報及び現在のフレームのグローバルポーズ情報を含み、前のフレームと現在のフレームが前記車両の走行過程における画像における隣接する2つのフレームであり、前記融合ユニットは、
前記前のフレームのグローバルポーズ情報と前記現在のフレームのグローバルポーズ情報に基づいて、隣接する2つのフレーム間の前記車両の第1のフレーム間の相対ポーズを決定するための第3の決定サブユニットと、
前記第1のフレーム間の相対ポーズ及び前記ローカルポーズ情報に基づいて前記グローバルポーズ情報のグローバル信頼度を決定するための第4の決定サブユニットと、
前記グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、前記グローバルポーズ情報と前記ローカルポーズ情報に対して融合処理を行い、前記融合ポーズ情報を得るための融合サブユニットと、を含む、
請求項11に記載の装置。 - 前記第4の決定サブユニットは、
前記第1のフレーム間の相対ポーズと前記ローカルポーズ情報に基づいて第2のフレーム間の相対ポーズを決定するための第1の決定モジュールであって、前記第2のフレーム間の相対ポーズは、前記グローバルポーズ情報と前記ローカルポーズ情報との間の差異を表すために用いられる第1の決定モジュールと、
前記第2のフレーム間の相対ポーズに基づいて前記グローバル信頼度を決定するための第2の決定モジュールと、を含む、
請求項14に記載の装置。 - 前記ローカルポーズ情報は、前のフレームのローカルポーズ情報及び現在のフレームのローカルポーズ情報を含み、前記第1の決定モジュールは、
前記前のフレームのローカルポーズ情報と前記現在のフレームのローカルポーズ情報に基づいて、隣接する2つのフレーム間の前記車両の第3のフレーム間の相対ポーズを決定するための第1の決定サブモジュールと、
前記第1のフレーム間の相対ポーズと前記第3のフレーム間の相対ポーズとの間の差異ポーズを決定して、前記差異ポーズを前記第2のフレーム間の相対ポーズとして決定するための第2の決定サブモジュールと、を含む、
請求項15に記載の装置。 - 前記グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、前記融合サブユニットは、
前記グローバル信頼度が予め設定されたグローバル信頼度閾値に達すると、前記ローカルポーズ情報に対応するローカル信頼度を取得するための取得モジュールと、
前記ローカル信頼度が予め設定されたローカル信頼度閾値に達すると、前記グローバルポーズ情報と前記ローカルポーズ情報に対して融合処理を行い、前記融合ポーズ情報を得るための融合モジュールと、を含む、
請求項14に記載の装置。 - 前記補正ユニットは、
前記グローバル信頼度が前記グローバル信頼度閾値より小さければ、前記ローカルポーズ情報に基づいて前記車両の位置を決定するための第5の決定サブユニットをさらに含む、
請求項14に記載の装置。 - 前記車両には高精度地図が記憶されると、前記第1の取得ユニットは、
前記車両の走行過程における車線情報を取得するための第1の取得サブユニットと、
前記車線情報と前記高精度地図に対してマッチング処理を行い、マッチングポーズ情報を得るためのマッチングサブユニットと、
前記全地球航法衛星システム及び/又は慣性計測ユニット基づいて収集された中間ポーズ情報を取得するための第2の取得サブユニットと、
前記マッチングポーズ情報及び前記中間ポーズ情報に基づいて前記グローバル測位情報を生成するための生成サブユニットと、を含む、
請求項11に記載の装置。 - 前記車両は画像収集装置を含み、前記ローカルポーズ情報は、前記画像収集装置が収集した前記車両の走行過程における画像に基づいて決定された視覚オドメータ情報である、
請求項11に記載の装置。 - 少なくとも1つのプロセッサ、及び
前記少なくとも1つのプロセッサと通信可能に接続されたメモリを含み、ここで、
前記メモリには前記少なくとも1つのプロセッサにより実行できる命令が記憶され、前記命令は前記少なくとも1つのプロセッサにより実行されることにより、前記少なくとも1つのプロセッサに請求項1~10のいずれか一項に記載の方法を実行させることができる、
電子機器。 - コンピュータ命令が記憶された非一時的なコンピュータ可読記憶媒体であって、前記コンピュータ命令は前記コンピュータに請求項1~10のいずれか一項に記載の方法を実行させるために用いられる、
非一時的なコンピュータ可読記憶媒体。 - コンピュータプログラムを含み、前記コンピュータプログラムがプロセッサによって実行されるとき、請求項1~10のいずれか一項に記載の方法のステップを実現する、
コンピュータプログラム製品。 - 車両には高精度地図がないことに応答し、前記車両における全地球航法衛星システム及び/又は慣性計測ユニットに基づいて前記車両の中間ポーズ情報を取得して、前記中間ポーズ情報をグローバル測位情報として決定するためのグローバル測位装置であって、前記グローバル測位情報にはグローバルポーズ情報及びグローバル姿勢角情報が含まれるグローバル測位装置と、
車両のローカル測位装置を取得するためのローカル測位装置であって、前記ローカル測位情報にはローカルポーズ情報及びローカル姿勢角情報が含まれるローカル測位装置と、
前記グローバルポーズ情報及び前記ローカルポーズ情報に対して融合処理を行い、融合ポーズ情報を得て、前記グローバル姿勢角情報及び前記ローカル姿勢角情報に基づいて、前記融合ポーズ情報に対して補正処理を行い、前記車両の位置を得るためのポーズグラーフ最適化装置と、を含む、
自動運転車両。 - 前記ローカル測位装置は視覚オドメトリ装置を含む、
請求項24に記載の車両。 - 前記視覚オドメトリ装置は、画像収集装置、全地球航法衛星システム、慣性計測ユニットを含む、
請求項25に記載の車両。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111152008.6A CN113899363B (zh) | 2021-09-29 | 2021-09-29 | 车辆的定位方法、装置及自动驾驶车辆 |
CN202111152008.6 | 2021-09-29 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2022166248A true JP2022166248A (ja) | 2022-11-01 |
Family
ID=79189309
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2022131184A Pending JP2022166248A (ja) | 2021-09-29 | 2022-08-19 | 車両の測位方法、装置及び自動運転車両 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11953609B2 (ja) |
EP (1) | EP4005897A3 (ja) |
JP (1) | JP2022166248A (ja) |
KR (1) | KR20220052312A (ja) |
CN (1) | CN113899363B (ja) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115220449B (zh) * | 2022-07-14 | 2023-11-21 | 小米汽车科技有限公司 | 路径规划的方法、装置、存储介质、芯片及车辆 |
CN115371677A (zh) * | 2022-08-16 | 2022-11-22 | 澳克诺(上海)汽车科技有限公司 | 一种车辆室内外定位切换方法及装置 |
FR3141911A1 (fr) * | 2022-11-10 | 2024-05-17 | Renault S.A.S | Procédé et système de gestion de la vitesse longitudinale d’un véhicule |
CN117804452A (zh) * | 2023-12-07 | 2024-04-02 | 盐城中科高通量计算研究院有限公司 | 一种基于蒙特卡洛算法的充电平台车辆定位方法 |
CN117422764B (zh) * | 2023-12-19 | 2024-04-16 | 深圳大学 | 空地视角图像协同的车载系统定位方法、终端及存储介质 |
CN117471513B (zh) * | 2023-12-26 | 2024-03-15 | 合众新能源汽车股份有限公司 | 一种车辆定位方法、定位装置、电子设备及存储介质 |
CN117553811B (zh) * | 2024-01-08 | 2024-04-19 | 武汉大学 | 基于路侧相机与车载gnss/ins的车路协同定位导航方法及系统 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020067439A (ja) * | 2018-10-26 | 2020-04-30 | 富士通株式会社 | 移動体位置推定システムおよび移動体位置推定方法 |
Family Cites Families (40)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6240367B1 (en) * | 1998-11-27 | 2001-05-29 | Ching-Fang Lin | Full fusion positioning method for vehicle |
JP5017392B2 (ja) * | 2010-02-24 | 2012-09-05 | クラリオン株式会社 | 位置推定装置および位置推定方法 |
US9031782B1 (en) * | 2012-01-23 | 2015-05-12 | The United States Of America As Represented By The Secretary Of The Navy | System to use digital cameras and other sensors in navigation |
CN103777220B (zh) * | 2014-01-17 | 2016-04-27 | 西安交通大学 | 基于光纤陀螺、速度传感器和gps的实时精确位姿估计方法 |
US9285460B2 (en) * | 2014-04-14 | 2016-03-15 | Saab Vricon Systems Ab | Method and system for estimating information related to a vehicle pitch and/or roll angle |
US20160084937A1 (en) * | 2014-09-22 | 2016-03-24 | Invensense Inc. | Systems and methods for determining position information using acoustic sensing |
CN206224239U (zh) * | 2016-12-05 | 2017-06-06 | 聊城大学 | 一种多传感器融合的拖拉机导航控制系统 |
CN106840179B (zh) * | 2017-03-07 | 2019-12-10 | 中国科学院合肥物质科学研究院 | 一种基于多传感器信息融合的智能车定位方法 |
EP3642683B1 (en) | 2017-06-22 | 2022-12-14 | Agjunction LLC | 3-d image system for vehicle control |
CN107478214A (zh) * | 2017-07-24 | 2017-12-15 | 杨华军 | 一种基于多传感器融合的室内定位方法及系统 |
GB2567845B (en) * | 2017-10-26 | 2023-02-01 | Focal Point Positioning Ltd | A method and system for combining sensor data |
CN108040324B (zh) * | 2017-11-16 | 2020-05-01 | 南方科技大学 | 一种救生舱机器人的定位方法及定位系统 |
US10206066B1 (en) * | 2018-03-22 | 2019-02-12 | Mapsted Corp. | Method and system for server based mobile device monitoring in crowd-sourced pedestrian localization |
CN108827306B (zh) * | 2018-05-31 | 2022-01-07 | 北京林业大学 | 一种基于多传感器融合的无人机slam导航方法及系统 |
CN109116397B (zh) * | 2018-07-25 | 2022-12-30 | 吉林大学 | 一种车载多相机视觉定位方法、装置、设备及存储介质 |
WO2020168464A1 (en) | 2019-02-19 | 2020-08-27 | SZ DJI Technology Co., Ltd. | Local sensing based autonomous navigation, and associated systems and methods |
CN109974704B (zh) | 2019-03-01 | 2021-01-08 | 深圳市智能机器人研究院 | 一种全局定位与局部定位互校准的机器人及其控制方法 |
CN110095116A (zh) * | 2019-04-29 | 2019-08-06 | 桂林电子科技大学 | 一种基于lift的视觉定位和惯性导航组合的定位方法 |
CN110207714B (zh) * | 2019-06-28 | 2021-01-19 | 广州小鹏自动驾驶科技有限公司 | 一种确定车辆位姿的方法、车载系统及车辆 |
CN110262525B (zh) * | 2019-08-15 | 2019-11-22 | 雷沃重工股份有限公司 | 用于农用机械的自动导航驾驶系统及方法 |
CN111551186A (zh) * | 2019-11-29 | 2020-08-18 | 福瑞泰克智能系统有限公司 | 一种车辆实时定位方法、系统及车辆 |
KR20210073281A (ko) | 2019-12-10 | 2021-06-18 | 삼성전자주식회사 | 운동 정보 추정 방법 및 장치 |
CN111046125A (zh) * | 2019-12-16 | 2020-04-21 | 视辰信息科技(上海)有限公司 | 一种视觉定位方法、系统及计算机可读存储介质 |
CN111413721B (zh) * | 2020-01-14 | 2022-07-19 | 华为技术有限公司 | 车辆定位的方法、装置、控制器、智能车和系统 |
CN111340867B (zh) * | 2020-02-26 | 2022-10-18 | 清华大学 | 图像帧的深度估计方法、装置、电子设备及存储介质 |
US11852751B2 (en) * | 2020-03-02 | 2023-12-26 | Beijing Baidu Netcom Science And Technology Co., Ltd. | Method, apparatus, computing device and computer-readable storage medium for positioning |
CN111511017B (zh) * | 2020-04-09 | 2022-08-16 | Oppo广东移动通信有限公司 | 定位方法及装置、设备、存储介质 |
US11435485B2 (en) * | 2020-05-22 | 2022-09-06 | The Board Of Regents Of The University Of Oklahoma | Multi-inertial measurement unit fusion for fine-resolution position estimation |
CN111649739B (zh) * | 2020-06-02 | 2023-09-01 | 阿波罗智能技术(北京)有限公司 | 定位方法和装置、自动驾驶车辆、电子设备和存储介质 |
CN111780756A (zh) * | 2020-07-20 | 2020-10-16 | 北京百度网讯科技有限公司 | 车辆航位推算方法、装置、设备以及存储介质 |
CN111982102B (zh) * | 2020-08-11 | 2022-09-06 | 天津泰达滨海清洁能源集团有限公司 | 一种复杂环境下基于bp-ekf的uwb-imu定位方法 |
EP3967976B1 (en) * | 2020-09-11 | 2023-06-14 | STMicroelectronics (Grand Ouest) SAS | A method for motion estimation in a vehicle, corresponding device and computer program product |
CN112484722B (zh) | 2020-11-19 | 2023-06-06 | 易思维(杭州)科技有限公司 | 结合惯性导航系统的视觉传感器全局定位方法 |
CN112197770B (zh) * | 2020-12-02 | 2021-03-12 | 北京欣奕华数字科技有限公司 | 一种机器人的定位方法及其定位装置 |
EP4222609A1 (en) * | 2020-12-17 | 2023-08-09 | Swift Navigation, Inc. | System and method for fusing dead reckoning and gnss data streams |
CN112817019B (zh) * | 2020-12-30 | 2024-03-12 | 北京理工大学 | 一种基于姿态信息的可控震源车工作点定位误差补偿方法 |
US11821994B2 (en) * | 2021-06-29 | 2023-11-21 | New Eagle, Llc | Localization of autonomous vehicles using camera, GPS, and IMU |
CN113820735B (zh) * | 2021-08-31 | 2023-12-01 | 上海华测导航技术股份有限公司 | 位置信息的确定方法、位置测量设备、终端及存储介质 |
CN114323033B (zh) * | 2021-12-29 | 2023-08-29 | 北京百度网讯科技有限公司 | 基于车道线和特征点的定位方法、设备及自动驾驶车辆 |
CN115032672A (zh) * | 2022-04-28 | 2022-09-09 | 岚图汽车科技有限公司 | 一种基于定位子系统的融合定位方法及系统 |
-
2021
- 2021-09-29 CN CN202111152008.6A patent/CN113899363B/zh active Active
-
2022
- 2022-04-01 US US17/711,339 patent/US11953609B2/en active Active
- 2022-04-05 EP EP22166719.9A patent/EP4005897A3/en active Pending
- 2022-04-07 KR KR1020220043409A patent/KR20220052312A/ko not_active Application Discontinuation
- 2022-08-19 JP JP2022131184A patent/JP2022166248A/ja active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020067439A (ja) * | 2018-10-26 | 2020-04-30 | 富士通株式会社 | 移動体位置推定システムおよび移動体位置推定方法 |
Also Published As
Publication number | Publication date |
---|---|
EP4005897A3 (en) | 2022-10-19 |
US11953609B2 (en) | 2024-04-09 |
CN113899363A (zh) | 2022-01-07 |
CN113899363B (zh) | 2022-10-21 |
EP4005897A2 (en) | 2022-06-01 |
KR20220052312A (ko) | 2022-04-27 |
US20220229193A1 (en) | 2022-07-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2022166248A (ja) | 車両の測位方法、装置及び自動運転車両 | |
KR102581263B1 (ko) | 위치 추적 방법, 장치, 컴퓨팅 기기 및 컴퓨터 판독 가능한 저장 매체 | |
EP4030393B1 (en) | Method and apparatus for detecting bumpy region of road surface, electronic device, storage medium, computer program product, and vehicle | |
EP3920003A1 (en) | Positioning method and apparatus, autonomous driving vehicle, electronic device and storage medium | |
JP7356528B2 (ja) | 地図データ処理方法及び装置 | |
CN111561937A (zh) | 用于精确定位的传感器融合 | |
EP3842752A1 (en) | Vehicle positioning method, apparatus, electronic device, vehicle and storage medium | |
CN111427061A (zh) | 一种机器人建图方法、装置,机器人及存储介质 | |
CN109781117B (zh) | 一种组合定位方法和系统 | |
WO2024027350A1 (zh) | 车辆定位方法、装置、计算机设备、存储介质 | |
EP3789797B1 (en) | Method and apparatus for evaluating data, device, and computer-readable storage medium | |
CN113483774B (zh) | 导航方法、装置、电子设备及可读存储介质 | |
US20200210701A1 (en) | Method for improving robustness of visual-inertial navigation system, and robot thereof | |
CN115792985A (zh) | 一种车辆定位方法、装置、电子设备、存储介质及车辆 | |
CN113218380B (zh) | 一种电子罗盘的校正方法、装置、电子设备及存储介质 | |
CN114088104B (zh) | 一种自动驾驶场景下的地图生成方法 | |
CN113566847B (zh) | 导航校准方法和装置、电子设备、计算机可读介质 | |
CN114779705A (zh) | 用于控制自动驾驶车辆的方法、装置、电子设备及系统 | |
CN113390422B (zh) | 汽车的定位方法、装置及计算机存储介质 | |
CN111461982B (zh) | 用于拼接点云的方法和装置 | |
CN113551678A (zh) | 构建地图的方法、构建高精度地图的方法及移动设备 | |
CN115127561A (zh) | 对象定位方法、设备、自动驾驶车辆和边缘计算平台 | |
CN117870650A (zh) | 一种ar定位地图更新的方法和装置 | |
CN117537807A (zh) | 可移动机构的定位方法、装置、介质及电子设备 | |
CN117387644A (zh) | 定位方法、装置、电子设备、存储介质及程序产品 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220819 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230907 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20231017 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20240521 |