Position estimation device and position estimation method
By using the data comparison mechanism of the first coordinate system and the second coordinate system in the vehicle position estimation system, the comparison range during turning is narrowed, and the problem of reducing the accuracy of position estimation when turning is solved, and the accuracy of position estimation and Processing efficiency.
Patent Information
- Application Number
- CN202011488539.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2019-12-23
- Filing Date
- 2020-12-16
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2040-12-16
AI Technical Summary
The prior art tends to lead to a decrease in position estimation accuracy and an increase in processing burden when a vehicle turns.
By adopting the first coordinate system and the second coordinate system data acquisition and comparison mechanism, the position estimation accuracy is improved, especially when turning, errors are reduced.
It effectively suppresses the reduction of position estimation accuracy during turning, and improves the accuracy and processing efficiency of vehicle position estimation.
Smart Images

Figure CN113091756B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a position estimating device and a position estimating method. Background Art
[0002] Patent document 1 is a technology for estimating the vehicle's own position. Patent document 1 states that "the position of a target object existing around the vehicle is detected, and the movement amount of the vehicle is detected, and the position of the target object is accumulated as target object position data based on the movement amount. In addition, a part of the target object position data is grouped according to the turning state of the vehicle, and an adjustment range of the group is set based on the movement amount of the vehicle when the target object position data is detected. In addition, map information including the position of the target object is obtained, and the target object position data and the position of the target object in the map information are compared based on the set adjustment range, thereby estimating the vehicle's own position."
[0003] Prior art literature
[0004] Patent Literature
[0005] Patent Document 1: International Publication No. 2017 / 037753 Summary of the invention
[0006] In the method of Patent Document 1, if the adjustment range of each group is not set strictly, the estimation accuracy of the own position will be reduced. In addition, since the grouping and adjustment range setting processes occur when the vehicle turns, the processing load increases.
[0007] An object of the present invention is to provide a position estimating device and a position estimating method that can more easily suppress a decrease in position estimation accuracy during a turn.
[0008] The position estimation device of the present invention is characterized in that it has: a first coordinate system data acquisition unit, which acquires first coordinate system data representing the position of a target object by coordinates of the first coordinate system; a second coordinate system data acquisition unit, which acquires second coordinate system data representing the position of a target object existing around the position estimation object by coordinates of the second coordinate system, wherein the second coordinate system is set based on the position and posture of the position estimation object at a predetermined starting point timing; a position estimation unit, which compares the respective target objects in the first coordinate system data and the second coordinate system data with each other, and estimates the position of the position estimation object in the first coordinate system based on the comparison result; and a comparison range changing unit, which narrows the range of coordinates in the second coordinate system data used for the comparison performed by the position estimation unit when the position estimation object is turning.
[0009] Effects of the Invention
[0010] According to the present invention, it is possible to more easily suppress a decrease in position estimation accuracy during a turn. BRIEF DESCRIPTION OF THE DRAWINGS
[0011] Figure 1 It is a diagram showing the functional configuration of the vehicle-mounted system according to the embodiment of the present invention.
[0012] Figure 2 This is an explanatory diagram of the reference coordinate system, the vehicle coordinate system, and the local coordinate system.
[0013] Figure 3 This is a diagram for explaining mileage information.
[0014] Figure 4 This is a flowchart of the vehicle position estimation process executed by the vehicle position estimation device.
[0015] Figure 5 FIG. 1 is a diagram schematically showing an example of learned map data and local coordinate system map data.
[0016] Figure 6 This is a diagram schematically showing an example of local coordinate system map data after the comparison coordinate range is limited.
[0017] Figure 7 This is an explanatory diagram of the operation of expanding the comparison coordinate range in the local coordinate system map data.
[0018] Description of Reference Numerals
[0019] 1. Vehicle system
[0020] 2 Vehicles
[0021] 4 Target detection equipment group
[0022] 6 Mobile status detection equipment group
[0023] 10 Vehicle position estimation device (position estimation device)
[0024] 20 Vehicle speed sensor
[0025] 22 Rudder angle sensor
[0026] 31 Learning completed map acquisition unit (first coordinate system data acquisition unit)
[0027] 34 Local coordinate system map acquisition unit (second coordinate system data acquisition unit)
[0028] 36 Odometry
[0029] 38 Position estimation unit
[0030] 40 Movement status determination unit
[0031] 42 Change of control scope
[0032] 50 Learning completed map data (first coordinate system data)
[0033] 58 Local coordinate system map data (second coordinate system data)
[0034] Ca reference coordinate system (first coordinate system)
[0035] Cb Vehicle coordinate system
[0036] Cc local coordinate system (second coordinate system)
[0037] D Direction of travel
[0038] Gf coordinate range (coordinate range)
[0039] Q Mileage Information DETAILED DESCRIPTION
[0040] Hereinafter, embodiments of the present invention will be described with reference to the drawings.
[0041] Figure 1 It is a diagram showing the functional configuration of the vehicle-mounted system 1 according to the present embodiment.
[0042] The vehicle-mounted system 1 is installed in a vehicle 2 ( Figure 2 ) system, comprising a target object detection device group 4, a mobile state detection device group 6, and a vehicle position estimation device 10.
[0043] The target object detection device group 4 has one or more target object detection devices for detecting targets existing around the vehicle 2, and the movement state detection device group 6 has one or more movement state detection devices for detecting the movement state of the vehicle 2. In addition, the vehicle position estimation device 10 is a vehicle-mounted device that estimates the position of the vehicle 2 on which it is carried (hereinafter referred to as "self-position").
[0044] The target object detected by the target object detection device group 4 is any object that can be detected by the detection device in addition to other moving objects such as vehicles and pedestrians. Examples of the target object include various lines painted on the road surface (for example, dividing lines and parking frame lines that mark vehicle lanes), and obstacles that hinder the travel of the vehicle 2 (for example, shoulders and guardrails, walls of buildings, etc.).
[0045] The target object detection device group 4 includes a camera 12 , a sonar 14 , and a radar 16 as target object detection devices.
[0046] The camera 12 is a device for capturing images of the surroundings of the vehicle 2, and outputs the captured images (hereinafter referred to as "captured images") to the vehicle position estimation device 10. One or more cameras 12 are provided on the vehicle 2 so as to capture at least the front, rear, left, and right scenes (that is, the entire surrounding scene).
[0047] The sonar 14 is a device that uses sound waves to detect targets around the vehicle 2 , and the radar 16 is a device that uses radio waves to detect targets around the vehicle 2 . The sonar 14 and the radar 16 output the positions of the targets obtained by detection to the vehicle position estimating device 10 .
[0048] In addition, the target object detection device is not limited to the above-mentioned devices, and any external sensor such as a laser range scanner can also be used.
[0049] The movement state detected by the movement state detection device group 6 includes at least the turning state and the vehicle speed of the vehicle 2 , and includes a vehicle speed sensor 20 and a steering angle sensor 22 as movement state detection devices.
[0050] The vehicle speed sensor 20 detects the vehicle speed of the vehicle 2 and outputs it to the vehicle position estimating device 10 . The steering angle sensor 22 detects the steering angle of the vehicle 2 and outputs it to the vehicle position estimating device 10 .
[0051] The vehicle position estimation device 10 has a computer unit such as an ECU (Electronic Control Unit). The computer unit has a processor such as a CPU and an MPU, a memory device such as a ROM and a RAM (also called a main memory device), a storage device such as an HDD and an SSD (also called an auxiliary memory device), and an interface circuit for connecting various sensors and peripheral devices. The processor executes a computer program stored in the memory device or the storage device, thereby realizing various functional configurations in the vehicle position estimation device 10.
[0052] Specifically, the vehicle position estimation device 10 executes a computer program, and Figure 1 As shown, it functions as a learned map storage unit 30, a learned map acquisition unit 31, a vehicle coordinate system target object position identification unit 32, a local coordinate system map acquisition unit 34, a mileage unit 36, a position estimation unit 38, a movement state determination unit 40, and a comparison range change unit 42.
[0053] Figure 2 It is an explanatory diagram of the reference coordinate system Ca, the vehicle coordinate system Cb, and the local coordinate system Cc.
[0054] In the vehicle position estimation device 10 of the present embodiment, as a coordinate system representing the position of the target object and the vehicle 2 itself, Figure 2 As shown, three coordinate systems are used, namely, a reference coordinate system Ca (first coordinate system), a vehicle coordinate system Cb, and a local coordinate system Cc (second coordinate system).
[0055] The reference coordinate system Ca is a reference plane coordinate system for specifying a position, and the origin Oa, the Xa axis, and the Ya axis are appropriately set. The positions of the target object and the vehicle 2 are expressed by the reference coordinate system coordinates Pa.
[0056] The vehicle coordinate system Cb is a plane coordinate system that expresses the position (relative position) of a target object based on the position and posture (orientation of the vehicle body) of the vehicle 2 at a certain timing.
[0057] That is to say, Figure 2 As shown, in the vehicle coordinate system Cb, the position of the vehicle 2 at a certain time is set as the origin Ob, the front-rear direction of the vehicle 2 is set as the Xb axis, and the left-right direction of the vehicle 2 is set as the Yb axis. The vehicle coordinate system Cb moves in the reference coordinate system Ca so that its origin Ob is attached to the vehicle 2, and the directions of the Xb axis and the Yb axis are rotated at an angle θ corresponding to the orientation of the vehicle body. GL In addition, the coordinates of the vehicle coordinate system Cb are hereinafter referred to as vehicle coordinate system coordinates Pb.
[0058] The local coordinate system Cc is different from the vehicle coordinate system Cb. It is a plane coordinate system in which the position of the origin Oc and the directions of the Xc axis and the Yc axis are unchanged in the reference coordinate system Ca regardless of the movement and posture (the orientation of the vehicle body) of the vehicle 2. In other words, the local coordinate system Cc is a coordinate system in which the origin Oc is located at a fixed coordinate point in the reference coordinate system Ca, and the Xc axis and the Yc axis rotate at a fixed angle θ. CL (It can also be θ CL =0) rotation.
[0059] In this embodiment, the local coordinate system Cc is set based on the position and posture of the vehicle 2 at a predetermined starting timing T0. The starting timing T0 is an appropriate timing before at least the first target object detection timing Ta. In this embodiment, the timing when the engine of the vehicle 2 is started is used as the starting timing T0. In addition, the coordinates of the local coordinate system Cc are hereinafter referred to as local coordinate system coordinates Pc.
[0060] Return to above Figure 1The learned map storage unit 30 stores the learned map data 50 in advance. The learned map data 50 is existing data that records the positions of the target objects (such as road shoulders and vehicle lane dividing lines) on the driving path of the vehicle 2 and its surroundings in the reference coordinate system Ca in advance, and is map data that serves as a reference for position estimation. The learned map data 50 is generated based on the local coordinate system map data 58 described later.
[0061] The learned map acquisition unit 31 reads the learned map data 50 from the learned map storage unit 30 and acquires the learned map data 50, and outputs the learned map data 50 to the position estimation unit 38. In addition, the learned map acquisition unit 31 may acquire the learned map data 50 from another device different from the vehicle position estimation device 10. Examples of the other device include an appropriate storage device provided in the vehicle-mounted system 1 and a computer outside the vehicle 2 that can be communicatively connected via an electrical communication circuit.
[0062] The vehicle coordinate system object position identifying unit 32 identifies the position of an object existing around the vehicle 2 at each predetermined object detection timing Ta based on an input signal from the object detection device group 4. The vehicle coordinate system Cb described above is used for this position.
[0063] The vehicle coordinate system target object position specifying unit 32 includes an image recognition processing unit 52 and a detection result acquisition unit 54. The image recognition processing unit 52 specifies the vehicle coordinate system coordinate Pb representing the target object position by performing image recognition on the image captured by the camera 12. In addition, the detection result acquisition unit 54 specifies the vehicle coordinate system coordinate Pb representing the target object position based on the detection results of the sonar 14 and the radar 16.
[0064] In addition, a known or well-known appropriate recognition method that can recognize a target object mapped in a captured image can be used for image recognition by the image recognition processing unit 52. In addition, internal parameters such as the focal length and the size of the imaging element of the camera 12, and the installation position and installation posture of the camera 12 to the vehicle 2, that is, external parameters, are stored in advance in a memory device such as a ROM, and the image recognition processing unit 52 uses these internal parameters and external parameters to calculate the positional relationship between the target object mapped in the captured image and the camera 12 (that is, the relative position of the target object to the vehicle 2).
[0065] Furthermore, a conversion formula for converting the position of the target object indicated by the detection results of the sonar 14 and the radar 16 into the vehicle coordinate system coordinates Pb in the vehicle coordinate system Cb is obtained in advance, and the detection result acquisition unit 54 specifies the vehicle coordinate system coordinates Pb of the target object using the conversion formula.
[0066] The vehicle coordinate system coordinates Pb of the object identified by the vehicle coordinate system object position identifying unit 32 are sequentially accumulated in a memory device such as a RAM, for example.
[0067] The local coordinate system map acquisition unit 34 generates local coordinate system map data 58 ( Figure 5 ), thereby obtaining the local coordinate system map data 58.
[0068] The local coordinate system map data 58 is data including the positions of the respective objects identified by the vehicle coordinate system object position identifying unit 32 at one or more object detection timings Ta up to a certain point in time. The positions are represented by local coordinate system coordinates Pc of the local coordinate system Cc. That is, the local coordinate system map data 58 is temporary data generated with the above-mentioned starting timing T0 set in the local coordinate system Cc as the starting point.
[0069] Figure 3 It is an explanatory diagram of mileage information Q.
[0070] like Figure 3 As shown, the mileage information Q is information indicating the position Qp and the rotation angle Qθ of the vehicle 2 at a certain timing Tn using the local coordinate system Cc.
[0071] The position Qp of the vehicle 2 corresponds to the origin Ob of the vehicle coordinate system Cb at a certain timing Tn, and the rotation angle Qθ corresponds to the rotation angle of the Xb axis and the Yb axis of the vehicle coordinate system Cb in the local coordinate system Cc. That is, each vehicle coordinate system coordinate Pb of the vehicle coordinate system Cb that is different at each target object detection timing Ta can be converted into a local coordinate system coordinate Pc of the local coordinate system Cc by using the mileage information Q at the corresponding target object detection timing Ta.
[0072] When the local coordinate system map acquisition unit 34 generates and acquires the local coordinate system map data 58, it converts the vehicle coordinate system coordinates Pb of each target object identified by the vehicle coordinate system target object position identification unit 32 into the local coordinate system coordinates Pc using the mileage information Q when the target object is identified. Through this conversion, the local coordinate system map data 58 in which each target object in the different vehicle coordinate systems Cb is mapped into the local coordinate system Cc that is unique to the vehicle 2 can be acquired.
[0073] In addition, the generation of the local coordinate system map data 58 can be performed each time the vehicle coordinate system coordinates Pb of the target object are specified by the vehicle coordinate system target object position specifying unit 32 (that is, each time the target object is detected at a timing Ta), or it can be performed after multiple target object detection timings Ta by aggregating the target objects specified by each target object detection timing Ta as an object.
[0074] return Figure 1 The mileage unit 36 identifies the mileage information Q in synchronization with the target object detection timing Ta, and outputs it to the local coordinate system map acquisition unit 34 .
[0075] Specifically, the mileage unit 36 accumulates the vehicle speeds sequentially detected by the vehicle speed sensor 20 and the steering angles sequentially detected by the steering angle sensor 22 from the above-mentioned starting timing T0 to the current point, thereby calculating the position Qp of the vehicle 2 at the current point in the local coordinate system Cc and the turning angle Qθ of the vehicle body.
[0076] In addition, as a method of obtaining the mileage information Q from the vehicle speed and the steering angle, a well-known or publicly known appropriate dead reckoning technology can be used.
[0077] The position estimation unit 38 compares (also referred to as "matching") common objects recorded in the local coordinate system map data 58 acquired by the local coordinate system map acquisition unit 34 and the learned map data 50 acquired by the learned map acquisition unit 31. The position estimation unit 38 uses the comparison result to identify the reference coordinate system coordinate Pa corresponding to the current position of the vehicle 2 (that is, the origin Ob) in the reference coordinate system Ca of the learned map data 50. The reference coordinate system coordinate Pa becomes the estimation result of the own position of the vehicle 2.
[0078] The movement state determination unit 40 and the comparison range change unit 42 are functional components provided to improve the accuracy of the position estimation performed by the position estimation unit 38 when the vehicle 2 turns.
[0079] The movement state determination unit 40 determines the turning and vehicle speed of the vehicle 2 based on the detection results of the movement state detection device group 6. The turning of the vehicle 2 is determined based on the steering angle, and when the steering angle is greater than a predetermined angle (e.g., 90 degrees), the vehicle 2 is determined to be in a turning state.
[0080] The comparison range changing unit 42 changes a coordinate range (hereinafter referred to as “comparison coordinate range” and denoted by reference symbol Gf) used for comparison with the learned map data 50 in the local coordinate system map data 58 based on the movement state of the vehicle 2 .
[0081] Specifically, when the vehicle 2 is turning, the comparison range changing unit 42 limits the comparison coordinate range Gf to the traveling direction D ( Figure 5 , Figure 6 ) in front of the vehicle 2 to narrow it. In addition, when the vehicle 2 ends the turn, the reference range changing unit 42 releases the restriction of the reference coordinate range Gf and restores it to the state before the restriction. When this is released, the reference range changing unit 42 gradually expands the reference coordinate range Gf to a degree corresponding to the vehicle speed of the vehicle 2.
[0082] Figure 4 This is a flowchart of the vehicle position estimation process executed by the vehicle position estimation device 10 .
[0083] The own position estimation process is a process for estimating the own position of the vehicle 2, and is executed once or multiple times at appropriate timings when the own position estimation using the dead reckoning technique is required. Examples of such timings include, for example, the timing of estimating the own position using the dead reckoning technique when the vehicle 2 is traveling in a tunnel where the radio waves of the GNSS (Global Navigation Satellite System) are difficult to propagate, or the timing of estimating the own position using the dead reckoning technique when it is necessary to control the vehicle (for example, autonomous driving control) with a higher resolution than the positioning resolution of the GNSS.
[0084] In addition, as described above, the local coordinate system map acquisition unit 34 generates local coordinate system map data 58 in sequence from the starting timing T0 (in this embodiment, when the engine of the vehicle 2 is started), thereby the vehicle position estimation device 10 obtains the local coordinate system map data 58, and the local coordinate system map data 58 is updated and recorded in a memory device such as RAM in sequence.
[0085] like Figure 4 As shown, when the vehicle position estimating device 10 estimates the own position of the vehicle 2, the learned map data 50 is read into the position estimating unit 38 (step S1), and the position estimating unit 38 performs a comparison (matching) between the learned map data 50 and the local coordinate system map data 58. During the comparison, first, the comparison range changing unit 42 changes the comparison coordinate range Gf of the local coordinate system map data 58 based on the moving state of the vehicle 2 at that time.
[0086] Specifically, when the movement state judgment unit 40 determines that the vehicle 2 is turning (step S2: yes), the reference range change unit 42 limits the reference coordinate range Gf of the local coordinate system map data 58 to the front of the travel direction D compared to the vehicle 2 at the current point, thereby narrowing the reference coordinate range Gf (step S3).
[0087] The position estimation unit 38 compares the comparison coordinate range Gf of the local coordinate system map data 58 and the common target objects recorded in the learned map data 50 (step S4), and estimates the own position of the vehicle 2 in the reference coordinate system Ca based on the comparison result (step S5).
[0088] Figure 5 : is a diagram schematically showing an example of learned map data 50 and local coordinate system map data 58. In this figure, learned map data 50 and local coordinate system map data 58 are shown, in which the positions of objects (such as shoulders and white lines) around the T-junction are recorded. In addition, in this figure, the line representing the axis K of the road surface of the T-junction and the rectangle representing the vehicle 2 are appropriately shown for easy understanding, and are not graphics recorded in the learned map data 50 and the local coordinate system map data 58.
[0089] In the vehicle position estimation device 10 of the present embodiment, reference data that predefines the relationship between the steering angle and the turning angle Qθ is stored in a memory device or a storage device. When the mobile state judgment unit 40 determines that the vehicle 2 is turning, the mileage unit 36 refers to the reference data and specifies the turning angle Qθ of the vehicle 2 based on the steering angle of the vehicle 2.
[0090] However, due to various important factors such as the accuracy of the reference data, individual differences in the vehicle 2, and the slippage of the vehicle body when turning, errors are likely to occur in the mileage information Q when turning obtained based on dead reckoning, with respect to the turning angle Qθ and the position of the vehicle 2. Due to the occurrence of such errors, errors occur in the positions of the target objects recorded in the local coordinate system map data 58, and there is a discrepancy between the positions of the target objects in the learned map data 50. For example, Figure 5 In the example of FIG. 1 , an error occurs in the target object around the Y-shaped road, and an inconsistency occurs in the angle α formed by the axes K of the road surfaces of the Y-shaped road. Furthermore, when the comparison in step S4 is performed in the state where the inconsistency occurs, the comparison accuracy decreases, resulting in a decrease in the estimation accuracy of the own position in step S5.
[0091] In this embodiment, as described above, when the moving state determination unit 40 determines that the vehicle 2 is turning (step S2: Yes), Figure 6As shown, the comparison coordinate range Gf of the local coordinate system map data 58 is limited to the range ahead of the vehicle 2 in the traveling direction D and is narrowed. Due to this limitation, only the target objects existing in the coordinate range ahead of the vehicle 2 in the traveling direction D in the local coordinate system map data 58 are used for comparison with the learned map data 50, thereby making it difficult to generate errors when comparing the two, and suppressing the reduction in the accuracy of the self-position estimation.
[0092] In addition, the reference coordinate range Gf of the local coordinate system map data 58 is not a range in the opposite direction to the travel direction D of the vehicle 2, that is, it is not a range that the vehicle 2 has already passed, but is set to the range that the vehicle 2 will subsequently enter (the range in front of the travel direction D). Therefore, even when the reference coordinate range Gf is narrowed, the estimated accuracy of its own position relative to the incoming object can be maintained.
[0093] In addition, when the reference coordinate range Gf is limited, the limit M ( Figure 6 ) is defined based on the vehicle 2. In this case, the boundary M may be defined in a manner that crosses the vehicle 2 or in a manner that extends outside the vehicle 2.
[0094] Return to the above Figure 4 When the movement state determination unit 40 determines that the vehicle 2 is not turning (step S2: No) but is just after the turn (step S6: Yes), that is, when the reference coordinate range Gf in the local coordinate system map data 58 is narrowed compared to before the restriction, the reference range changing unit 42 expands the reference coordinate range Gf in the direction opposite to the traveling direction D of the vehicle 2 to a degree corresponding to the vehicle speed and within the limit of the width of the reference coordinate range Gf before the restriction (step S7).
[0095] More specifically, if Figure 7 As shown, the comparison range changing unit 42 moves the boundary M from the position immediately after the turn ends in the direction opposite to the traveling direction D by a distance L according to the vehicle speed to expand the comparison coordinate range Gf.
[0096] Furthermore, the position estimation unit 38 compares the expanded comparison coordinate range Gf in the local coordinate system map data 58 and the common target object recorded in the learned map data 50 (step S4), and estimates the own position of the vehicle 2 in the reference coordinate system Ca based on the comparison result (step S5).
[0097] In this way, the reference coordinate range Gf does not return to the initial range all at once immediately after the turn is completed, thereby preventing the self-position estimation accuracy from being reduced due to the error included in the mileage information Q at the time of the turn immediately after the turn is completed.
[0098] Here, the faster the vehicle speed after the turn, the greater the travel distance per unit time of the vehicle 2. In this case, if the comparison coordinate range Gf is expanded by a fixed amount based on the vehicle 2, the size of the comparison coordinate range Gf is not sufficient for the travel distance of the vehicle 2.
[0099] In contrast, in the present embodiment, the reference coordinate range Gf is gradually expanded to a degree corresponding to the vehicle speed after the vehicle 2 turns, so that a reference coordinate range Gf of a sufficient size suitable for the speed and travel distance of the vehicle 2 can be ensured, and the reduction in the accuracy of the self-position estimation can be prevented. In addition, when the reference coordinate range Gf is expanded, the travel distance can be used instead of the vehicle speed.
[0100] In addition, Figure 4 In the self-position estimation processing shown, when the movement state judgment unit 40 determines that the vehicle 2 is not in the process of turning (step S2: No) and is not immediately after the end of the turn (step S6: Yes), the position estimation unit 38 estimates the self-position (step S5) by comparing the local coordinate system map data 58 and the learned map data 50 (step S4) without being restricted by the comparison coordinate range Gf performed by the comparison range change unit 42.
[0101] The vehicle position estimating device 10 performs a process of learning the learned map data 50 based on the local coordinate system map data 58 at an appropriate timing after the vehicle position estimation process.
[0102] Specifically, the vehicle position estimation device 10 includes a map learning unit 56 ( Figure 1 ), the map learning unit 56 updates the learned map data 50 based on the local coordinate system map data 58 at an appropriate timing to perform learning. In the above learning, when the result of the comparison between the local coordinate system map data 58 and the learned map data 50 is that the consistency of the two is greater than a predetermined value, the map learning unit 56 updates the learned map data 50 with the local coordinate system map data 58. In addition, when the learned map data 50 of the area indicated by the local coordinate system map data 58 is not stored in the learned map storage unit 30, the map learning unit 56 adds the local coordinate system map data 58 of the area to the learned map data 50, thereby learning the map of the area.
[0103] According to the above-mentioned embodiment, the following effects are achieved.
[0104] In the present embodiment, a comparison range changing unit 42 is provided for narrowing a comparison coordinate range Gf used for comparison by the position estimating unit 38 in the local coordinate system map data 58 when the vehicle 2 is turning.
[0105] Thus, only the target objects existing in the narrowed coordinate range in the local coordinate system map data 58 are used for comparison with the learned map data 50 , so that errors are less likely to occur during comparison, and a decrease in the accuracy of the self-position estimation can be suppressed.
[0106] In the present embodiment, the comparison range changing unit 42 limits the comparison coordinate range Gf to a portion ahead of the vehicle 2 in the traveling direction D, thereby narrowing the comparison coordinate range Gf.
[0107] Thus, even when the comparison coordinate range Gf is narrowed, the estimation accuracy of the own position with respect to the oncoming object of the vehicle 2 can be maintained.
[0108] In the present embodiment, the reference range changing unit 42 gradually expands the reference coordinate range Gf when restoring the reference coordinate range Gf after the turn. As a result, the reference coordinate range Gf does not return to the range before the limit all at once immediately after the turn, and the influence of the error contained in the mileage information Q during the turn does not increase, thereby suppressing the reduction in the accuracy of the own position estimation.
[0109] In this embodiment, the comparison range changing unit 42 gradually expands the comparison coordinate range Gf in accordance with the speed of the vehicle 2. A comparison coordinate range Gf of a sufficient size suitable for the speed of the vehicle 2 can be ensured, and a decrease in the estimation accuracy of the own position can be prevented.
[0110] The above-described embodiment is merely an example of one aspect of the present invention, and any modification and application can be made without departing from the gist of the present invention.
[0111] In the above embodiment, the local coordinate map acquisition unit 34 generates and acquires the local coordinate map data 58 , but the present invention is not limited thereto. In other words, the local coordinate map acquisition unit 34 may acquire the local coordinate map data 58 from another device other than the vehicle position estimation device 10 .
[0112] In the above embodiment, the coordinate system set in the vehicle 2 is used as the reference coordinate system Ca, but this is not limiting and a coordinate system such as a geographic coordinate system (that is, a coordinate system not dependent on the vehicle 2) may be used.
[0113] Figure 1 The functional modules shown are schematic diagrams showing the components of the vehicle-mounted system and the vehicle position estimation device according to the main processing contents for easy understanding of the present invention. These components can be classified into more components according to the processing contents. In addition, they can also be classified in such a way that one component performs more processing.
[0114] The present invention is not limited to vehicles, but can be used for self-position estimation of any moving body as a position estimation target object.
Claims
1. A position estimation device, characterized in that: have: a first coordinate system data acquisition unit that acquires first coordinate system data representing a position of a target object using coordinates of the first coordinate system; a second coordinate system data acquisition unit that acquires second coordinate system data representing the position of a target object existing around the position estimation object by coordinates of the second coordinate system, wherein the second coordinate system is set based on the position and posture of the position estimation object at a predetermined starting point timing; a position estimating unit that compares the respective targets in the first coordinate system data and the second coordinate system data with each other and estimates the position of the position estimation object in the first coordinate system based on the comparison result; and a comparison range changing unit configured to narrow a range of coordinates used for comparison performed by the position estimating unit in the second coordinate system data when the position estimation target object is turning. The comparison range changing unit limits the range of the coordinates to a position ahead of the position estimation target object in the moving direction of the position estimation target object.
2. The position estimation device according to claim 1, characterized in that: When the coordinate range is restored after the turn is completed, the comparison range changing unit gradually expands the coordinate range.
3. The position estimation device according to claim 2, characterized in that: The comparison range changing unit gradually expands the range of the coordinates to a degree corresponding to the speed of the position estimation object.
4. A position estimation method, which is performed by a position estimation device for estimating the position of a position estimation object, the position estimation method comprising the following steps: The first step is to obtain first coordinate system data representing the position of the target object by coordinates of the first coordinate system; The second step is to obtain second coordinate system data representing the position of a target object existing around the position estimation object by coordinates of the second coordinate system, wherein: The second coordinate system is set based on the position and posture of the position estimation object at a predetermined starting point timing; and The third step is to compare the respective target objects in the first coordinate system data and the second coordinate system data, and estimate the position of the position estimation object in the first coordinate system based on the comparison result. In the third step, when the position estimation object is turning, the position estimation device narrows the range of coordinates used for comparison in the second coordinate system data. The range of the coordinates is limited to a position ahead of the position estimation target object in the moving direction of the position estimation target object.
