Vehicle position determining method and vehicle position determining device
The method integrates a reference map of stable landmarks with GNSS and IMU systems to improve autonomous vehicle localization accuracy in urban areas by using stable landmarks for correction, addressing inefficiencies in existing methods.
Patent Information
- Application Number
- JP2023516263
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2020-09-10
- Publication Date
- 2024-12-05
- Estimated Expiration
- 2040-09-10
AI Technical Summary
Existing autonomous vehicle localization methods struggle to maintain sublane accuracy in urban environments due to signal impairment and multipath propagation of GNSS, leading to inefficient and inaccurate position determination when GNSS signals are lost.
A method combining a reference map of stable landmarks with GNSS and IMU systems to determine vehicle position, using captured images to identify stable landmarks and apply correction values based on a pre-constructed map, ensuring accurate localization even when GNSS accuracy falls below a threshold.
Enhances localization accuracy in urban environments by leveraging stable landmarks and pre-constructed maps to maintain precise vehicle positioning, reducing reliance on temporary and changing environmental features.
Smart Images

Figure 0007595152000006 
Figure 0007595152000007 
Figure 0007595152000008
Abstract
Description
[Technical field]
[0001] The present invention relates generally to determining vehicle position, and more specifically to precisely locating a vehicle's position based on a combination of Global Navigation Satellite Systems (GNSS), Inertial Measurement Units (IMU), and predefined stable landmarks. [Background technology]
[0002] As autonomous driving becomes more and more of a reality in recent years, the tools and technologies required to implement fully or partially autonomous systems within a vehicle must provide sufficiently accurate and useful data to process and perform various autonomous functions. Of critical importance for an autonomous vehicle system is determining the vehicle's exact position within the environment at any given time. This not only allows the vehicle to travel accurately from its starting point to its destination, but also ensures that the vehicle does not collide with nearby vehicles, pedestrians, infrastructure, etc.
[0003] Autonomous driving systems require localization with sub-lane accuracy (i.e., typically decimeter-level accuracy). Such localization is achievable by using high-precision GNSS techniques, including real-time kinematic (RTK) or precise point positioning (PPP), under clear-sky and clear-line-of-sight conditions such as those found on highways. However, in urban conditions with closely spaced buildings and various other dense infrastructures, GNSS is often adversely affected by signal impairments and multipath propagation. This impedes the ability of GNSS sensors to localize the vehicle with sufficient accuracy. Solutions to this obstacle include implementing additional positioning methods to enhance GNSS-determined positions in disturbed areas. Additional positioning methods include dead reckoning, integration of IMU measurements, visual odometry, simultaneous localization and mapping (SLAM) algorithms based on either camera or LIDAR measurements, map or point cloud matching, feature- and / or landmark-based localization, and combinations of these.
[0004] These methods can be categorized into two separate categories: inertial and map-based methods. Inertial methods include methods that implement IMU, visual odometry, and SLAM algorithms. These are used to determine an estimate of the vehicle position based on current sensor readings, without any prior knowledge of the vehicle's current environment. A drawback of these techniques is that the vehicle position estimate will drift from its exact value when the GNSS signal is lost. This drift increases with the time or distance traveled from the last known exact position.
[0005] In map-based methods (including map or point cloud matching and feature or landmark based localization), prior knowledge of the environment, such as a pre-generated reference map, is used to determine the vehicle position. This allows for compensation of deviations in the vehicle position estimate based on known details of the surrounding environment. When coupled with GNSS, map-based methods provide improved accuracy compared to inertial methods because the position estimate is independent of the time or distance traveled since accurate GNSS signals are no longer available. In some types of traditional map-based methods, a map of a particular area is first generated based on, for example, previously captured images or point cloud data used to build the reference map. Then, when the vehicle is moving through the area and cannot receive GNSS signals accurately, the vehicle captures current images from an on-board imaging device, and the system attempts to match the captured images with the pre-generated map to determine the vehicle's precise position.
[0006] However, current map-based methods are often inefficient and require analyzing multiple reference map possibilities to determine the best match, thereby requiring both time and computational power that is not readily available on a moving vehicle. It is therefore desirable to improve methods for determining vehicle position in urban conditions. Summary of the Invention
[0007] The present disclosure provides a method for determining a vehicle's position based on a combination of the most recent known position, stable landmarks, and a reference map of the vehicle's current surroundings. In one embodiment, a reference map of the vehicle's surroundings is pre-determined, and stable landmarks are identified and located within the map. To determine what qualifies as a stable landmark, multiple images of the area of interest are captured over a period of time, and features that remain constant and do not change are considered stable.
[0008] Once a landmark is identified as stable, the landmark may be used as a reference point in the map to determine the vehicle's position tied to its most recent known position. In one embodiment of the present disclosure, a position vector for the vehicle is determined. This position vector represents the speed and direction the vehicle is traveling. In an urban environment or similar environment where it is difficult to determine a current position vector, a most recent known position vector is determined. Further, a correction to the current position is determined based on the most recent known position vector and stable landmarks in the vehicle's current vicinity.
[0009] Images of the vehicle's surroundings are captured, for example by an on-board camera, and used to determine the vehicle's current position. The captured images may include stable landmarks and data indicative of the camera's orientation to define the vehicle's position. In a further embodiment, an inertial measurement unit (IMU) is implemented to determine the vehicle's position for a period of time after the position accuracy based on GNSS signals falls below a threshold, thereby extending the time that the last known position is deemed accurate. After the accuracy of the data read from the IMU falls below the IMU threshold, a correction to the vehicle's position is calculated based on the reference map and the captured images.
[0010] Other advantages of the above and other embodiments described herein will become apparent to those of ordinary skill in the art upon review of at least this summary, the following detailed description, and the accompanying drawings. [Brief description of the drawings]
[0011] [Figure 1] FIG. 1 is a flowchart of a method for identifying at least one stable landmark according to one embodiment. [Diagram 2] FIG. 2 is a flow chart of a method for determining a position of a vehicle, according to one embodiment. [Diagram 3] FIG. 3 is a block diagram of an apparatus according to one embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0012] In autonomous driving applications, the time that inertial methods remain valid is very limited, so if the positioning accuracy drops below a threshold for a long time, map-based methods can provide better position estimation than inertial methods. However, existing map-based methods have several challenges. Temporal variations in the environment and occlusions caused by other vehicles, temporary infrastructure, etc., are obstacles to efficiently and accurately determining a match between the current captured image and the reference map. Landmarks such as road signs or traffic lights can disappear or be moved. Lane markings can be worn away. The appearance and disappearance of leaves, snow, mud, temporary or semi-permanent traffic signs, etc. can significantly change the environment perceived by the autonomous vehicle's imaging device. Reference maps can quickly become outdated, and relying solely on inaccurate maps leads to inaccurate positioning. Map-matching or feature-matching algorithms can fail due to these unknown changes, leaving the vehicle position unknown or inaccurate. Furthermore, relying solely on map-based methods can cause further challenges. This is because shifting directly from a GNSS position to a map-based position without relying on the last known position requires a positive match of the image to the map within a short period of time, and in many cases, due to the speed of the vehicle, it is difficult, if not impossible, to accurately perform such a rapid match while maintaining an accurate position estimate.
[0013] One embodiment of a vehicle position determination method includes creating a reference map with stable landmarks and determining a precise current position of the vehicle using the reference map in conjunction with a GNSS system and an IMU system. The disclosed method may be used when the accuracy of the vehicle's current position that can be determined from GNSS alone falls below a threshold.
[0014] In the following description, the generation of a reference map that includes stable landmarks is described. The generation of the reference map may be performed for a vehicle other than the vehicle undergoing position determination because the reference map requires the capture of a large number of images over an extended period of time to determine what qualifies as a stable landmark. The generated reference map may then be stored for future access by the vehicle (e.g., for use during the method shown in FIG. 2).
[0015] FIG. 1 is a flow chart of a method 100 for identifying at least one stable landmark according to one embodiment.
[0016] In step 110, multiple images of different geographic areas are captured by imaging devices over a period of time. The imaging devices may include cameras, LIDAR sensors, etc. For example, a vehicle equipped with one or more imaging devices travels through the different geographic areas and captures images from multiple directions and viewpoints in each area over a period of time. In one embodiment, the period of time is at least one year, and images may be captured throughout each season.
[0017] At step 120, georeferenced spatial information associated with one or more landmarks depicted in the captured image is received. The georeferenced spatial information includes points of interest associated with the landmarks in the image associated with physical locations. Such association can be made manually or using automated tagging, for example via computer vision or machine learning. In one embodiment, the georeferenced spatial information is determined based on information gathered from a LIDAR, a mobile mapping system, or information gathered from collected imagery processed into a 3D point cloud using photogrammetry.
[0018] In step 130, georeferenced spatial information in images of the same area is compared over a period of time. For example, a first image of the area may be captured in the fall, a second image in the winter, a third image in the spring, and a fourth image in the summer. Various objects, elements, or points of interest may appear in some images but not in other images. For example, leaves may be present on trees in the spring and summer but not in the fall or winter. Similarly, temporary traffic items such as detour signs or traffic cones may appear in a first image but not in a second, third, or fourth image. In contrast, a tree or a lamppost, for example, may be consistently present in each image of the area.
[0019] In step 140, elements of the image that change over this time period are removed from the georeferenced spatial information. The remaining elements are designated as stable landmarks. In one embodiment, only easily identifiable landmarks (e.g., large rectangular buildings or bridges) are designated as stable landmarks. This allows for more efficient and faster identification.
[0020] In step 150, the georeferenced spatial information of the stable landmarks is pre-processed to associate the georeferenced spatial information with the three-dimensional map. In one embodiment, the three-dimensional map is pre-generated without the stable landmarks. The pre-processing includes matching points of interest of the stable landmarks (e.g., corners, recognized shapes or colors, etc.) to known location coordinates in the three-dimensional map. In one embodiment, the pre-processing of the georeferenced spatial information includes at least one of volumetric structure creation, dense depth calculation, and feature point detection. Thus, the pre-processing includes associating the stable landmarks with known locations in the three-dimensional map. The map may be updated to include the stable landmarks and used as a reference map for determining vehicle position as described herein.
[0021] The map may include images, point cloud data, a combination thereof, etc. In one embodiment, the map further includes feature points associated with each stable landmark, which may include feature descriptors indicating points of interest (such as corners or recognized shapes) of each stable landmark to enable efficient matching of images captured by the vehicle to the map.
[0022] Additionally, the positioning information of the stable landmarks is embedded in a reference map. Thus, the map contains georeferenced spatial image information and links the stable landmarks to a location that is established with respect to an external reference (e.g., latitude and longitude coordinates) and the placement of the stable landmark in the surrounding environment (e.g., the stable landmark is identified in the surrounding environment as being located between two or more other stable landmarks). The location of the stable landmark is identified with decimeter level accuracy. A visual index may be constructed based on the reference map. This index includes an association between an image and its location.
[0023] The reference map and the stable landmarks identified therein may be used by a vehicle in motion to determine its current position when GNSS-based position fixes fall below a required threshold. In one embodiment, the reference map is stored in a remotely accessible storage device or in an accessible on-board storage device such that the map can be accessed by the vehicle's position determination device as needed.
[0024] 2 is a flow chart of a method 200 for determining a vehicle position when the accuracy of a GNSS-based position determination falls below a required threshold while the vehicle is moving through an area. The fall below (or exceeding) the threshold may be due to GNSS signal obstruction from infrastructure or objects in the area, multipath propagation of the GNSS signal, weakening of the received GNSS signal due to the GNSS satellites used for position determination dropping below the horizon, etc. For example, GNSS often uses three or more satellite signals to determine a position. If signals from one or more satellites cannot be received or used by the GNSS receiver of a moving vehicle, such as for the reasons described above, the required threshold will be exceeded and the GNSS will not be sufficient to provide an accurate position determination of the vehicle.
[0025] In step 210, it is determined whether the accuracy of the GNSS based position determination is below a desired threshold. If so, the method proceeds to step 220. If not, the determination in step 210 is repeated. In one embodiment, the determination that the desired threshold has been exceeded is made only after a set period of time. In yet another embodiment, step 210 is an optional step and method 200 is performed continuously, regardless of GNSS signal strength or availability.
[0026] In step 220, a last known position vector of the vehicle is determined. The position vector includes the speed and direction the vehicle is traveling. The last known position vector is based on a last known speed, which may be determined directly from the vehicle or a GNSS receiver, and a last known direction, which may be determined from an on-board compass. In one embodiment, the last known position vector is determined based on a last known position of the vehicle that is deemed sufficiently accurate, such as a GNSS-based position. In one embodiment, the last known position vector is combined with the current vehicle speed to determine an estimated current position.
[0027] In one embodiment, the vehicle's most recent known position vector may be determined based on an inertial measurement unit (IMU) in addition to GNSS signals. The most recent known position vector may be determined based solely on GNSS, with the IMU being used only after a required threshold has been exceeded.
[0028] In a further embodiment, the last known position vector is determined based solely on the IMU after the GNSS-based position fix falls below a required threshold. The IMU may be used in conjunction with the vehicle's internal odometer to determine how far the vehicle has traveled since exceeding the threshold. In yet another embodiment, the IMU is configured to always determine data together with the GNSS, and the last known position vector is always based on data from both the GNSS and the IMU.
[0029] The IMU provides sufficient accuracy for a limited time, for example within 1 decimeter within 5 seconds after a threshold is exceeded, however, in one embodiment, a position vector is determined from the IMU even after the limited time to determine an approximation of the vehicle position instead of the most recently known position vector.
[0030] In step 230, one or more images of the surroundings in which the vehicle is traveling are captured, for example, using an on-board imaging device such as an on-board camera. The surroundings may include a set radius distance around the vehicle or a field of view from an imaging device mounted on the vehicle (e.g., the visible scene in front of or around the vehicle).
[0031] In step 240, stable landmarks around the vehicle are identified from one or more captured images and compared to the reference map. Stable landmarks are identifiable features in an image of the vehicle's environment that are determined to be permanent or semi-permanent and therefore reliable as reference points.
[0032] In one embodiment, the stable landmarks are identified based on a pre-constructed reference map of the vehicle's surroundings, which includes one or more stable landmarks determined to be reliable as reference points, such as the reference map described in FIG. 1. The reference map may be stored locally in the vehicle or remotely, for example, on an external or cloud-based server accessible to the vehicle. The stable landmarks in the reference map are matched to the identified stable landmarks in the captured image using computer vision, machine learning, scale-invariant feature transform (SIFT) feature detection algorithms, or the like.
[0033] In step 250, a correction value is determined based on the last known position vector and the identified stable landmarks. The correction value may be expressed as follows: Let M be a pre-constructed reference map. An estimate of the last known position vector X at time t is known and an image I from an on-board imaging device is captured. A correction value x' for the last known position vector X is determined that maximizes the likelihood of similarity between f(t) and the projection of M onto a virtual camera located at X+x'. The correction value is determined using known optimization algorithms such as least squares adjustment, random sample consensus (RANSAC), etc.
[0034] In one embodiment, a virtual camera is placed at X+x' and an image of the vehicle's surroundings at the corrected position is constructed such that the constructed artificial image is most similar to the real image captured by the real camera. If the correction x' is known, the position is determined to be known with high accuracy and the correction is applied to the last known position vector. If the correction is not known or the likelihood of similarity is below a threshold, the image I is discarded. In such a case, the position estimate may be expanded to an estimate based only on the IMU without the correction x'. The next image is then processed.
[0035] In one embodiment, a plurality of visually similar image frames are retrieved from a database using a visual index, each of which depicts a scene around the vehicle. The visual index is an association with a pre-built reference map, and visually similar images are associated with positions within the reference map. The plurality of visually similar image frames are used to estimate the camera position and determine a correction value x'.
[0036] As an example, visually similar image frames are collected in advance, as described in the method shown in FIG. 1. These images may be captured from a road at set intervals (e.g., every meter) or from all lanes of the road. The visual index thus includes multiple images of a scene from multiple viewpoints. Determining the correction value involves matching a currently captured image with an image in the visual index that is most similar to the currently captured image. Such matching is performed using an image matching algorithm.
[0037] The camera position for a particular reference image may be estimated based on feature matching, resulting in The set of 2D-3D corresponding points is represented by JPEG0007595152000001.jpg775. Using the minimum solver and RANSAC, we estimate the query image ω on the set of inliers such that the reprojection error is given by qEstimate the location of. JPEG0007595152000002.jpg799Here, the reprojection error is small enough (e.g., below the error threshold) that ω r is the position of the reference image stored in the map. π denotes the camera projection image, and ω c denotes the position of the camera relative to the vehicle. Once a sufficiently robust estimate is determined, we define the sum of the reprojection errors for all inliers as ω q can be optimized by
[0038] In a further embodiment, the set of inliers and the position estimates from different reference images are collected and the optimization of the sum of all reprojection errors is performed again.
[0039] At step 260, an updated position is determined based on the corrections. In one embodiment, the updated position includes position specific adjustments (e.g., an updated set of GPS coordinates, etc.). In a further embodiment, the updated position further includes an adjustment for the speed of the vehicle.
[0040] Figure 3 is a block diagram of an apparatus 300 according to an embodiment of the disclosure. In one embodiment, the apparatus 300 can be implemented as a location device for use in a vehicle to determine a current location, as described in conjunction with Figure 2. In a further embodiment, the apparatus 300 can be implemented as a collection device for use in a vehicle to collect images for building a reference map, as described in conjunction with Figure 1.
[0041] The apparatus 300 comprises a processor 310 operatively connected to a data storage device 320 and a memory 330. The processor 310 controls the overall operation of the apparatus 300 by executing computer program instructions that define the operation of the apparatus 300. The computer program instructions may be stored in the data storage device 320 or other computer readable medium and loaded into the memory 330 when execution of the computer program instructions is required. Thus, at least the method steps of Figures 1-3 may be defined by computer program instructions stored in the memory 330 and / or the data storage device 320 and controlled by the processor 310 executing these computer program instructions. For example, the computer program instructions may be embodied as a computer executable code programmed by a person skilled in the art to perform an algorithm defined by at least the method steps of Figures 1-2.
[0042] The apparatus 300 also includes one or more network interfaces for communicating with other devices over a network (not shown). The apparatus 300 further includes a GNSS receiver 340 configured to receive signals from a positioning satellite system, and an optional IMU 360 configured to determine inertial measurements (e.g., acceleration, angular velocity, orientation, etc.) of the vehicle on which the apparatus 300 is installed. The apparatus 300 may further include an imaging device 370, such as a camera or LIDAR sensor, configured to capture still images, video, or both, of the environment around the configured vehicle. The various elements of the apparatus 300 are connected to each other via a bus 380.
[0043] Processor 310 may include both general purpose and special purpose microprocessors and may be the sole processor or one of multiple processors in device 300. Processor 310 may consist of, for example, one or more central processing units (CPUs). Processor 310, data storage device 320, and / or memory 330 may include, be supplemented by, or be embedded in one or more application specific integrated circuits (ASICs) and / or one or more field programmable gate arrays (FPGAs).
[0044] The data storage device 320 and the memory 330 each comprise a tangible, non-transitory computer-readable storage medium. The data storage device 320 and the memory 330 each may include high-speed random access memory, such as dynamic random access memory (DRAM), static random access memory (SRAM), double data rate synchronous dynamic random access memory (DDR RAM), or other random access solid-state memory devices, or may include one or more magnetic disk storage devices, such as an internal hard disk, a removable disk, a magneto-optical disk storage device, an optical disk storage device, a flash memory device, a semiconductor memory device, such as an erasable programmable read-only memory (EPROM), an electrically erasable programmable read-only memory (EEPROM), a compact disk read-only memory (CD-ROM), a digital versatile disk read-only memory (DVD-ROM) disk, or other non-volatile solid-state memory devices.
[0045] Those skilled in the art will readily recognize that an actual computer, computer system, or computing device implementation may have a different structure or include different components, and that apparatus 300 is merely a high-level representation of some of the components for illustrative purposes.
[0046] All of the systems and methods described herein may be implemented using one or more computers using digital circuitry or using known computer processors, memory units, storage devices, computer software and other components. Typically, a computer includes a processor for executing instructions and one or more memories for storing instructions and data. A computer may also include or be connected to one or more mass storage devices, such as one or more magnetic disks, internal hard disks and removable disks, magneto-optical disks, optical disks, and the like.
[0047] All of the systems and methods described herein may be implemented using computers operating in a client-server relationship. Typically in such systems, the client computer is located remotely from the server computer and communicates over a network. The client-server relationship may be defined and controlled by computer programs running on each of the client and server computers. In the present disclosure, the vehicle may be equipped with a standalone network connection or may rely on accessing external data via a secondary device such as a mobile phone.
[0048] All systems and methods described herein may be implemented using a computer program product tangibly embodied in an information carrier (e.g., a non-transitory machine-readable storage device) for execution by a programmable processor. Method steps described herein may be implemented using one or more computer programs executable by such a processor. A computer program may be a set of computer program instructions that can be used directly or indirectly in a computer to perform any action or obtain any result. A computer program may be written in any manner of programming language, such as a compiled or interpreted language, and may be deployed in any manner, such as as a stand-alone program or as a module, component, subroutine or other unit suitable for use in a computing environment.
[0049] The foregoing Detailed Description is to be understood in all respects as illustrative and not restrictive, and the scope of the inventive concepts disclosed herein should be determined not from the Detailed Description, but from the claims which are interpreted in their entirety as permitted by each patent law. It should be understood that the embodiments shown and described herein are merely illustrative of the principles of the inventive concepts, and that various modifications may be made by those skilled in the art without departing from the scope and spirit of the inventive concepts. Those skilled in the art could implement various other feature combinations without departing from the scope and spirit of the inventive concepts.
Claims
1. A method for determining vehicle position performed by a processor executing computer program instructions, comprising: determining a current known position vector of the vehicle, the position vector including the speed and direction the vehicle is traveling; capturing an image within a surrounding area of the vehicle using an imaging device; Identifying stable landmarks within the captured image based on a pre-constructed reference map of the vehicle's surroundings; determining a correction to the position of the vehicle based on the nearest known position vector and the stable landmarks; determining an updated position of the vehicle based on the determined correction value; and Equipped with Determining the correction to the position of the vehicle comprises: matching the captured image with an image in a visual index that is most similar to the captured image; Matching the captured images is based on feature matching and minimizing reprojection error; The reprojection error is where π denotes the projected image of the imaging device, ω c denotes the position of the imaging device relative to the vehicle, ω q denotes the position of a query image, and ω r denotes the position of a reference image stored in the reference map.
13. A vehicle position determination method comprising:
2. Determining the corrections to the vehicle's position occurs when a position accuracy of a Global Navigation Satellite System (GNSS)-based position determination of the vehicle falls below a required threshold.
2. The method according to claim 1 .
3. 2. The method of claim 1, wherein the immediate known position vector of the vehicle is determined based at least in part on an inertial measurement unit (IMU).
4. determining the correction to the vehicle's position when the accuracy of the data read from the IMU falls below a threshold; 4. The method according to claim 3 .
5. The method of claim 1 , wherein the imaging device includes at least one of a camera and a LIDAR sensor.
6. the pre-constructed reference map is based on georeferenced spatial information for a plurality of stable landmarks, the plurality of stable landmarks being determined based on images captured over a period of time; 2. The method according to claim 1 .
7. a Global Navigation Satellite System (GNSS) receiver configured to determine the device's own position; An imaging device; A processor; and a memory storing computer program instructions for determining a position of a vehicle, The computer program instructions, when executed on the processor, cause the processor to perform a number of operations, the number of operations including: determining a current known position vector of the vehicle based on the GNSS receiver, the position vector including the speed and direction the vehicle is traveling; capturing an image within a surrounding area of the vehicle using the imaging device; Identifying stable landmarks within the captured image based on a pre-constructed reference map of the vehicle's surroundings; determining a correction to the position of the vehicle based on the determined nearest known position vector of the vehicle and the identified stable landmarks; determining an updated position of the vehicle based on the determined correction value; and Equipped with Determining the correction to the position of the vehicle comprises: matching the captured image with an image in a visual index that is most similar to the captured image; Matching the captured images is based on feature matching and minimizing reprojection error; The reprojection error is where π denotes the projected image of the imaging device, ω c denotes the position of the imaging device relative to the vehicle, ω q denotes the position of a query image, and ω r denotes the position of a reference image stored in the reference map. An apparatus comprising:
8. Determining the corrections to the vehicle's position occurs when a position accuracy of a Global Navigation Satellite System (GNSS)-based position determination of the vehicle falls below a required threshold.
8. Apparatus according to claim 7, characterized in that
9. the immediate known position vector of the vehicle is determined based at least in part on an inertial measurement unit (IMU); 8. Apparatus according to claim 7, characterized in that
10. determining the correction to the vehicle's position when the accuracy of the data read from the IMU falls below a threshold; 10. The device according to claim 9.
11. The imaging device includes at least one of a camera and a LIDAR sensor.
8. Apparatus according to claim 7, characterized in that
12. the pre-constructed reference map is based on georeferenced spatial information for a plurality of stable landmarks, the plurality of stable landmarks being determined based on images captured over a period of time; 8. Apparatus according to claim 7, characterized in that
13. 1. A non-transitory computer readable medium storing computer program instructions for determining a position of a vehicle, the computer program instructions, when executed on a processor, causing the processor to perform a number of operations, the number of operations including: determining a current known position vector of the vehicle, the position vector including the speed and direction the vehicle is traveling; capturing an image within a surrounding area of the vehicle using an imaging device; Identifying stable landmarks within the captured image based on a pre-constructed reference map of the vehicle's surroundings; determining a correction to the position of the vehicle based on the nearest known position vector and the stable landmarks; determining an updated position of the vehicle based on the determined correction value; and Equipped with Determining the correction to the position of the vehicle comprises: matching the captured image with an image in a visual index that is most similar to the captured image; Matching the captured images is based on feature matching and minimizing reprojection error; The reprojection error is where π denotes the projected image of the imaging device, ω c denotes the position of the imaging device relative to the vehicle, ω q denotes the position of a query image, and ω r denotes the position of a reference image stored in the reference map. A non-transitory computer-readable medium comprising:
14. Determining the correction value for the position of the vehicle is performed when a position accuracy of a Global Navigation Satellite System (GNSS)-based position determination of the vehicle falls below a required threshold.
14. The non-transitory computer readable medium of claim 13.
15. The vehicle's immediate known position vector is determined at least in part based on an inertial measurement unit (IMU).
14. The non-transitory computer readable medium of claim 13.
16. The method of claim 15, wherein determining the correction value for the vehicle position is performed when an accuracy of the data read from the IMU falls below a threshold.
20. The non-transitory computer readable medium of claim 15.
17. The imaging device includes at least one of a camera and a LIDAR sensor.
14. The non-transitory computer readable medium of claim 13.
Citation Information
Patent Citations
Positioning position adjusting method and device
CN111212375A
Method for supplementing GPS or GPS / sensor vehicle positioning using additional in-vehicle image acquisition sensors
DE102011117809A1
Survey system having function of position error correction
JP2005062083A
Vehicle itself position recognition system, vehicle itself position recognition program, and vehicle itself position recognition method
JP2013050411A
Camera attitude estimation device, and program
JP2013140547A
