Output device, control method, program, and storage medium

The output device enhances self-position estimation accuracy by using voxel data with added accuracy and weighting information to optimize vehicle positioning and reduce occlusion, addressing the issue of low accuracy in map information.

JP2024169478AInactive Publication Date: 2024-12-05PIONEER IP
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
JP2024158762
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Priority Date
2017-05-31
Filing Date
2024-09-13
Publication Date
2024-12-05
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

The accuracy of self-position estimation in vehicles is compromised when using map information with low accuracy location data, leading to reduced matching precision.

Method used

An output device that includes voxel data with added accuracy and weighting information, allowing for improved position estimation by comparing measured object positions with voxel data and adjusting vehicle movement to optimize measurement range and reduce occlusion.

Benefits of technology

Enhances the accuracy of self-position estimation by prioritizing highly reliable voxels and adjusting vehicle positioning to improve matching precision.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024169478000001_ABST
    Figure 2024169478000001_ABST
Patent Text Reader

Abstract

To provide an output device suitable for increasing position estimation accuracy.SOLUTION: An onboard device 1 acquires reliability information on voxel data corresponding to voxels around a route from a map DB10 including voxel data when determining position estimation accuracy has decreased. Then, the onboard device 1 sets a voxel suitable for estimating the own vehicle position as a reference voxel Btag on the basis of the acquired reliability information and outputs control information for correcting a target track of the vehicle so as for the vehicle to pass the position suitable for measuring the reference voxel Btag to an electronic control device of the vehicle.SELECTED DRAWING: Figure 7
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a technique for controlling a vehicle. [Background technology]

[0002] Conventionally, there has been known a technology for estimating a vehicle's own position by collating (matching) shape data of surrounding objects measured using a measuring device such as a laser scanner with map information in which the shapes of surrounding objects are stored in advance. For example, Patent Document 1 discloses an autonomous mobile system that determines whether a detected object in a voxel obtained by dividing a space according to a predetermined rule is a stationary object or a moving object, and matches map information with measurement data for voxels in which stationary objects exist. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] International Publication WO2013 / 076829 Summary of the Invention [Problem to be solved by the invention]

[0004] The accuracy of position information related to stationary structures stored in map information varies, and when matching is performed for stationary structures whose position information is recorded in the map information with low accuracy, the matching accuracy using the map information becomes low, and as a result, the accuracy of self-location estimation decreases. Patent Document 1 does not disclose anything about such a problem.

[0005] The present invention has been made to solve the above-mentioned problems, and has as its main object to provide an output device suitable for improving the accuracy of position estimation, etc. [Means for solving the problem]

[0006] The invention described in claim 1 is an output device comprising an acquisition unit that acquires at least accuracy information regarding the positional information and weighting information regarding the possibility of occlusion, which are assigned to voxel data in which positional information of objects for each voxel, which is a unit area, is recorded; a position estimation unit that estimates the position of the moving body by comparing the output of a measurement unit that measures the positions of objects around the moving body with the positional information included in the voxel data; and an output unit that outputs control information for moving the moving body so that a voxel determined based on the accuracy information and the weighting information acquired by the acquisition unit is positioned within the measurement range of the measurement unit.

[0007] The invention described in claim 4 is an output device comprising an acquisition unit that acquires at least accuracy information regarding the positional information and weighting information regarding the possibility of occlusion, which are assigned to voxel data in which positional information of objects for each voxel, which is a unit area, is recorded; an output unit that outputs control information for moving a moving body so as to approach a voxel determined based on the accuracy information and the weighting information acquired by the acquisition unit; and a measurement unit that measures the positions of objects surrounding the moving body, wherein the weighting information is determined based on the height indicated by the positional information. The invention described in claim 5 is an output device comprising: an acquisition unit that acquires at least weighting information regarding the possibility of occlusion that is assigned to voxel data in which positional information of objects for each voxel, which is a unit area, is recorded; a position estimation unit that estimates the position of the moving body by comparing the output of a measurement unit that measures the positions of objects in the vicinity of the moving body with the positional information included in the voxel data; and an output unit that outputs control information for moving the moving body so that a voxel determined based on the weighting information acquired by the acquisition unit is positioned within the measurement range of the measurement unit. The invention described in claim 6 is an output device comprising an acquisition unit that acquires at least accuracy information regarding position information that is assigned to voxel data in which position information of an object for each voxel, which is a unit area, is recorded, an output unit that outputs control information for moving a moving body so as to approach a voxel determined based on the accuracy information acquired by the acquisition unit, and a measurement unit that measures the position of an object in the vicinity of the moving body, wherein the accuracy information is determined based on the distance from a measurement vehicle that performs measurements to generate the position information to the object to be measured and the position estimation accuracy of the measurement vehicle.

[0008] The invention described in claim 7 is a control method executed by an output device, comprising: an acquisition step of acquiring at least accuracy information regarding the positional information and weighting information regarding the possibility of occlusion, which are assigned to voxel data in which positional information of objects for each voxel, which is a unit area, is recorded; a position estimation step of estimating the position of the moving body by comparing the output of a measurement unit that measures the positions of objects in the vicinity of the moving body with the positional information included in the voxel data; and an output step of outputting control information for moving the moving body so that a voxel determined based on the accuracy information and the weighting information acquired by the acquisition unit is positioned within the measurement range of the measurement unit. In addition, the invention described in claim 8 is a control method executed by an output device, comprising an acquisition process of acquiring at least accuracy information regarding position information that is assigned to voxel data in which position information of an object for each voxel, which is a unit area, is recorded, an output process of outputting control information for moving a moving body so as to approach a voxel determined based on the accuracy information acquired by the acquisition process, and a measurement process of measuring the positions of objects in the vicinity of the moving body, wherein the accuracy information is determined based on the distance from a measurement vehicle that performs measurement to generate the position information to the object to be measured and the position estimation accuracy of the measurement vehicle.

[0009] The invention described in claim 9 is a program executed by a computer, which causes the computer to function as an acquisition unit that acquires at least accuracy information regarding the positional information and weighting information regarding the possibility of occlusion, which are assigned to voxel data in which positional information of objects for each voxel, which is a unit area, is recorded; a position estimation unit that estimates the position of the moving body by comparing the output of a measurement unit that measures the positions of objects around the moving body with the positional information included in the voxel data; and an output unit that outputs control information for moving the moving body so that a voxel determined based on the accuracy information and the weighting information acquired by the acquisition unit is positioned within the measurement range of the measurement unit. Furthermore, the invention described in claim 10 is a program executed by a computer, which causes the computer to function as an acquisition unit that acquires at least accuracy information regarding the position information that is assigned to voxel data in which position information of an object for each voxel, which is a unit area, is recorded, an output unit that outputs control information for moving a moving body so as to approach a voxel determined based on the accuracy information acquired by the acquisition unit, and a measurement unit that measures the positions of objects in the vicinity of the moving body, and the accuracy information is determined based on the distance from a measurement vehicle that performs measurements to generate the position information to the object to be measured and the position estimation accuracy of the measurement vehicle. [Brief description of the drawings]

[0010] [Figure 1] 1 is a schematic configuration of a driving assistance system. [Diagram 2] The block diagram of the on-board device is shown. [Diagram 3] 2 shows an example of a schematic data structure of voxel data. [Figure 4] 1 is a diagram showing the positional relationship between a map maintenance vehicle equipped with a lidar and an object present within the measurement range of the map maintenance vehicle. FIG. [Diagram 5] A concrete example of NDT scan matching is given below. [Figure 6] A concrete example of NDT scan matching where weighting values ​​are set for each voxel is shown. [Figure 7] 5 is a flowchart showing a process executed by the vehicle-mounted device. [Figure 8] This shows an overhead view of a vehicle on a three-lane road with features on the left and right sides of the road. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0011] According to a preferred embodiment of the present invention, an output device includes an acquisition unit that acquires at least accuracy information related to the location information, the accuracy information being added to map information in which the location information of an object is recorded, and an output unit that outputs control information for controlling a moving object based on the accuracy information acquired by the acquisition unit. With this aspect, the output device can suitably control the moving object based on the accuracy information added to the map information.

[0012] In one aspect of the output device, the output device further includes a position estimation unit that estimates the position of the moving object by comparing an output of a measurement unit that measures the positions of objects in the vicinity of the moving object with the position information included in the map information. With this aspect, the output device moves the moving object to a position where the comparison between the output of the measurement unit and the position information of the map information can be performed with high accuracy based on the accuracy information added to the map information, thereby suitably improving the accuracy of the position estimation.

[0013] In another aspect of the output device, the map information includes location information for each area obtained by dividing a space according to a predetermined rule, and the location estimation unit weights an evaluation value that evaluates the degree of matching for each area based on the accuracy information. With this aspect, the output device can increase the weighting of areas including location information with high reliability to suitably improve the location estimation accuracy.

[0014] In another aspect of the output device, the map information includes position information for each area obtained by dividing a space according to a predetermined rule, and the output unit outputs control information for moving the moving object to a position where the area determined based on the accuracy information is measured by the measurement unit. With this aspect, the output device can suitably control the moving object to measure the area determined based on the accuracy information.

[0015] In another aspect of the output device, the output unit outputs control information for moving the moving object to a lane closest to the area determined based on the accuracy information, or for moving the moving object to a side closer to the area within the lane the moving object is traveling in. With this aspect, the output device can control the moving object to reliably and highly accurately measure the area determined based on the accuracy information.

[0016] In a preferred example of the above output device, the accuracy information may be determined based on a distance from a measurement vehicle that performs measurements to generate the position information to the object to be measured and on the position estimation accuracy of the measurement vehicle.

[0017] In another aspect of the output device, the map information is provided with weighting information related to a possibility of occlusion, and the output unit outputs control information for controlling a moving object based on the accuracy information and the weighting information. With this aspect, the output device can output control information for controlling a moving object by taking into account both the accuracy information and the weighting information related to occlusion.

[0018] In another aspect of the output device, the output device further includes a position estimation unit that estimates the position of the moving body by comparing an output of a measurement unit that measures the positions of objects around the moving body with the position information included in the map information, the map information includes position information for each area obtained by dividing a space according to a predetermined rule, and the position estimation unit weights an evaluation value that evaluates the degree of matching for each area based on the accuracy information and the weighting information. With this aspect, the output device can increase the weighting of areas having position information with high reliability based on two perspectives, occlusion and accuracy, and suitably improve the accuracy of position estimation.

[0019] In a preferred example of the above output device, the weighting information may be determined based on a height indicated by the position information.

[0020] According to another preferred embodiment of the present invention, the output device includes an acquisition unit that acquires at least weighting information regarding a possibility of occlusion that is assigned to map information in which position information of an object is recorded, and an output unit that outputs control information for controlling a moving object based on the weighting information acquired by the acquisition unit. With this aspect, the output device can suitably control the moving object based on the weighting information assigned to the map information.

[0021] According to another preferred embodiment of the present invention, a control method executed by an output device includes an acquisition step of acquiring at least accuracy information related to the position information, the accuracy information being assigned to map information in which the position information of an object is recorded, and an output step of outputting control information for controlling a moving object based on the accuracy information acquired by the acquisition step. By executing this control method, the output device can suitably control the moving object based on the accuracy information assigned to the map information.

[0022] According to another preferred embodiment of the present invention, a program executed by a computer causes the computer to function as an acquisition unit that acquires at least accuracy information related to the position information, the accuracy information being assigned to map information in which the position information of an object is recorded, and an output unit that outputs control information for controlling a moving object based on the accuracy information acquired by the acquisition unit. By executing this program, the computer can suitably control the moving object based on the accuracy information assigned to the map information. Preferably, the program is stored in a storage medium. EXAMPLES

[0023] Hereinafter, preferred embodiments of the present invention will be described with reference to the drawings.

[0024] Fig. 1 is a schematic diagram of a driving assistance system according to the present embodiment. The driving assistance system shown in Fig. 1 includes an on-board device 1 that is mounted on a vehicle and controls driving assistance for the vehicle, a Lidar (Light Detection and Ranging, or Laser Illuminated Detection and Ranging) 2, a gyro sensor 3, a vehicle speed sensor 4, and a GPS receiver 5.

[0025] The vehicle-mounted device 1 is electrically connected to the lidar 2, the gyro sensor 3, the vehicle speed sensor 4, and the GPS receiver 5, and estimates the position of the vehicle on which the vehicle-mounted device 1 is mounted (also called "vehicle position") based on the outputs of these sensors. Then, based on the estimation result of the vehicle position, the vehicle-mounted device 1 performs automatic driving control of the vehicle so that the vehicle travels along a route to a set destination. The vehicle-mounted device 1 stores a map database (DB: DataBase) 10 including voxel data. The voxel data is data that records position information and the like of stationary structures for each region (also called "voxel") when a three-dimensional space is divided into a plurality of regions. The voxel data includes data that represents measured point cloud data of stationary structures in each voxel using a normal distribution, and is used for scan matching using NDT (Normal Distributions Transform) as described later.

[0026] The lidar 2 measures the distance to an object in the outside world discretely by emitting a pulsed laser in a predetermined angular range in the horizontal and vertical directions, and generates three-dimensional point cloud information indicating the position of the object. In this case, the lidar 2 has an irradiation unit that irradiates a laser beam while changing the irradiation direction, a light receiving unit that receives reflected light (scattered light) of the irradiated laser beam, and an output unit that outputs scan data based on the light receiving signal output by the light receiving unit. The scan data is generated based on the irradiation direction corresponding to the laser beam received by the light receiving unit and the response delay time of the laser beam specified based on the above-mentioned light receiving signal. In general, the closer the distance to the object, the higher the accuracy of the distance measurement value of the lidar, and the farther the distance, the lower the accuracy. The lidar 2, the gyro sensor 3, the vehicle speed sensor 4, and the GPS receiver 5 each supply output data to the vehicle-mounted device 1. The vehicle-mounted device 1 is an example of an "output device" in the present invention, and the lidar 2 is an example of a "measurement unit" in the present invention.

[0027] 2 is a block diagram showing the functional configuration of the vehicle-mounted device 1. The vehicle-mounted device 1 mainly includes an interface 11, a storage unit 12, an input unit 14, a control unit 15, and an information output unit 16. These elements are connected to each other via a bus line.

[0028] The interface 11 acquires output data from sensors such as the rider 2, the gyro sensor 3, the vehicle speed sensor 4, and the GPS receiver 5, and supplies the data to the control unit 15. The interface 11 also supplies signals related to vehicle travel control generated by the control unit 15 to an electronic control unit (ECU) of the vehicle. The signals transmitted from the control unit 15 to the electronic control unit of the vehicle via the interface 11 are an example of "control information" in the present invention.

[0029] The storage unit 12 stores programs executed by the control unit 15 and information necessary for the control unit 15 to execute predetermined processes. In this embodiment, the storage unit 12 stores a map DB 10 including voxel data. The map DB 10 may be updated periodically. In this case, for example, the control unit 15 receives partial map information related to the area to which the vehicle position belongs from a server device that manages map information via a communication unit (not shown), and reflects the partial map information in the map DB 10.

[0030] The input unit 14 is a button, a touch panel, a remote controller, a voice input device, etc. for a user to operate, and accepts inputs specifying a destination for route search, inputs specifying on / off of autonomous driving, etc. The information output unit 16 is, for example, a display, a speaker, etc. that perform output based on the control of the control unit 15.

[0031] The control unit 15 includes a CPU that executes a program and controls the entire vehicle-mounted device 1. In this embodiment, the control unit 15 has a vehicle position estimation unit 17 and an automatic driving control unit 18. The control unit 15 is an example of an "acquisition unit," a "position estimation unit," an "output unit," and a "computer" that executes a program in the present invention.

[0032] The vehicle position estimation unit 17 estimates the vehicle position by performing scan matching based on the NDT, based on the point cloud data output from the LIDAR 2 and the voxel data corresponding to the voxels to which the point cloud data belongs.

[0033] The automatic driving control unit 18 refers to the map DB 10 and transmits a signal required for automatic driving control to the vehicle based on the set route and the vehicle position estimated by the vehicle position estimation unit 17. The automatic driving control unit 18 sets a target trajectory based on the set route, and transmits a guide signal to the vehicle to control the position of the vehicle so that the vehicle position estimated by the vehicle position estimation unit 17 is shifted from the target trajectory within a predetermined width. In addition, in this embodiment, when the automatic driving control unit 18 determines that the vehicle position estimation accuracy by the vehicle position estimation unit 17 has decreased below a predetermined accuracy, the automatic driving control unit 18 refers to the voxel data and selects a voxel suitable for performing vehicle position estimation. Then, the automatic driving control unit 18 regards the selected voxel as a voxel to be used as a reference in the vehicle position estimation (also referred to as a "reference voxel Btag"), and corrects the target trajectory of the vehicle so as to move the vehicle to a position suitable for detecting the reference voxel Btag by the lidar 2.

[0034] [Data structure of voxel data] The voxel data used in the scan matching based on the NDT will now be described. Fig. 3 shows an example of a schematic data structure of the voxel data.

[0035] The voxel data includes information on parameters when expressing a point group in a voxel with a normal distribution, and in this embodiment, as shown in Fig. 3, includes a voxel ID, a voxel coordinate, a mean vector, a covariance matrix, and reliability information. Here, "voxel coordinate" indicates the absolute three-dimensional coordinate of a reference position such as the center position of each voxel. Each voxel is a cube obtained by dividing a space into a lattice shape, and since the shape and size are determined in advance, it is possible to specify the space of each voxel by the voxel coordinate. The voxel coordinate may be used as a voxel ID.

[0036] The "mean vector" and "covariance matrix" refer to the mean vector and covariance matrix that correspond to the parameters when expressing the point group in the target voxel as a normal distribution, and the coordinates of any point "i" in any voxel "k" are

[0037]

number

[0038]

number

[0039]

number

[0040] The "reliability information" includes a first weighting value, which is a weighting value based on the possibility of occlusion (blocking by an obstacle), and a second weighting value, which is a weighting value based on the precision (accuracy) of the voxel data (particularly the mean vector and covariance matrix) of the target voxel. In this embodiment, the first weighting value is set to a larger value for a voxel that is less likely to be occluded. The first weighting value is an example of "weighting information" in the present invention.

[0041] The second weighting value is set, for example, based on the vehicle position estimation accuracy of the map maintenance vehicle when collecting measurement data used by the map maintenance vehicle to generate voxel data, and the measurement accuracy of a measurement device (e.g., a lidar) that outputs the measurement data. For example, the accuracy is calculated as the square root of the sum of the squares of the vehicle position estimation accuracy of the map maintenance vehicle and the measurement accuracy of the measurement device, and the reciprocal of the square of the accuracy is set as the second weighting value. In this embodiment, the second weighting value is set to a larger value as the vehicle position estimation accuracy of the map maintenance vehicle when collecting the measurement data is higher, and the measurement accuracy of the measurement device that outputs the measurement data is higher. Here, when the measurement device is a lidar, the above-mentioned measurement accuracy is higher as the distance from the measurement position to the measurement target object is shorter. Therefore, the second weighting value is determined, for example, based on the distance between the vehicle position estimated when the map maintenance vehicle is traveling and the position indicated by the voxel coordinates of the target voxel, and the vehicle position estimation accuracy. In addition, in vehicle position estimation such as RTK-GPS, it is possible to obtain information on the estimation accuracy of the vehicle position in addition to the information on the estimated vehicle position. The second weighting value is an example of the "accuracy information" in the present invention.

[0042] Here, an example of setting the first weighting value and the second weighting value will be described.

[0043] Fig. 4 is a diagram showing an example of the positional relationship between a map maintenance vehicle equipped with a LIDAR and objects present within the measurement range of the map maintenance vehicle. In the example of Fig. 4, a low-rise building 21, which is a ground feature (stationary structure), exists around the road on which the vehicle is traveling, and a high-rise building 22 exists behind the low-rise building 21. Also, a pedestrian 23 riding a motorcycle exists in front of the low-rise building 21. Here, the map maintenance vehicle acquires measurement data indicating the position within frames 30-32 using a measurement device such as a LIDAR.

[0044] In this case, the part of the low-rise building 21 surrounded by the frame 30 is located at a relatively low position, and is a position where occlusion by moving objects such as pedestrians 23 is likely to occur. Therefore, a relatively small value is set as the first weighting value of the voxel data at the position overlapping with the frame 30. On the other hand, since the part of the low-rise building 21 surrounded by the frame 30 is located at a relatively close position to the map maintenance vehicle, it is predicted that the accuracy of the measurement data acquired by the measurement device is high. Therefore, a relatively large value (i.e., a value indicating high accuracy) is set as the second weighting value of the voxel data at the position overlapping with the frame 30. Although the part of the low-rise building 21 surrounded by the frame 31 is located slightly higher than the map maintenance vehicle, there remains a possibility of occlusion by a tall vehicle such as a truck. In addition, since it is located slightly away from the map maintenance vehicle, the accuracy of the measurement data acquired by the measurement device is slightly lower than that of the part surrounded by the frame 30. Therefore, a medium value is set as the first weighting value of the voxel data at the position overlapping with the frame 31, and a medium value is set as the second weighting value.

[0045] On the other hand, the part of the high-rise building 22 surrounded by the frame 32 is located at a relatively high position, and is a position where occlusion by moving objects such as pedestrians 23 and other vehicles is unlikely to occur. Therefore, a relatively large first weighting value is set for the voxel data at the position overlapping with the frame 32. In addition, since the part of the high-rise building 22 surrounded by the frame 32 is located at a relatively far position from the map maintenance vehicle, it is predicted that the accuracy of the measurement data acquired by a measurement device such as a LIDAR will be low. Therefore, a relatively small second weighting value (i.e., a value indicating low accuracy) is set for the voxel data at the position overlapping with the frame 32.

[0046] In this way, preferably, the first weighting value is set to be larger the higher the target voxel is located relative to the ground surface, and the second weighting value is set to be larger the closer the voxel is to the map maintenance vehicle at the time of measurement.

[0047] [Scan Matching Overview] Next, the scan matching by NDT using voxel data will be described. In this embodiment, as described later, the vehicle-mounted device 1 calculates the value of the evaluation function (evaluation value) obtained by NDT scan matching by weighting it using the reliability information included in the voxel data. As a result, the vehicle-mounted device 1 suitably improves the position estimation accuracy based on the NDT scan matching.

[0048] Scan matching using NDT assuming a vehicle estimates the following estimation parameter “P”, which is based on the amount of movement within the road plane (here, xy coordinates) and the vehicle orientation.

[0049]

number

[0050] Using the above-mentioned estimated parameter P, the coordinates of any point in the point cloud data obtained by LIDAR 2 [x k (i), y k (i), z k (i)] T When the coordinates are converted, the converted coordinates are "X' k (i)" is expressed by the following equation (3).

[0051]

number

[0052]

number

[0053]

number

[0054] On the other hand, the evaluation function E k is expressed by the following equation (6).

[0055]

number

[0056] Then, the vehicle-mounted device 1 calculates the estimation parameters P that maximize the overall evaluation function E by using any root-finding algorithm such as the Newton method. Then, the vehicle-mounted device 1 applies the estimation parameters P to the vehicle position predicted from the output of the GPS receiver 5 or the like, thereby estimating the vehicle position with high accuracy.

[0057] Next, a specific example of NDT scan matching will be described. For convenience of explanation, the following will be described using a two-dimensional plane as an example.

[0058] In Fig. 5(A), the point clouds measured by a lidar or the like when a map maintenance vehicle was traveling in four adjacent voxels "B1" to "B4" are shown by circles, and the two-dimensional normal distribution created from equations (1) and (2) based on these point clouds is shown by gradation. The mean and variance of the normal distribution shown in Fig. 5(A) correspond to the mean vector and covariance matrix of the voxel data, respectively.

[0059] Fig. 5(B) is a diagram in which the point cloud acquired by the LIDAR 2 while the vehicle-mounted device 1 is traveling is indicated by stars in Fig. 5(A). The positions of the point cloud of the LIDAR 2 indicated by the stars are aligned with the voxels B1 to B4 based on the estimated positions based on the output of the GPS receiver 5, etc. In the example of Fig. 5(B), there is a deviation between the point cloud measured by the map maintenance vehicle (circles) and the point cloud acquired by the vehicle-mounted device 1 (stars).

[0060] Fig. 5(C) is a diagram showing a state after the point cloud (stars) acquired by the vehicle-mounted device 1 is moved based on the matching result of NDT scan matching. In Fig. 5(C), a parameter P that maximizes the evaluation function E shown in formulas (4) and (5) is calculated based on the mean and variance of the normal distribution shown in Fig. 5(A) and (B), and the calculated parameter P is applied to the point cloud of stars shown in Fig. 5(B). In this case, the deviation between the point cloud (circles) measured by the map maintenance vehicle and the point cloud (stars) acquired by the vehicle-mounted device 1 is suitably reduced.

[0061] Here, when the evaluation functions "E1" to "E4" corresponding to the voxels B1 to B4 and the overall evaluation function E are calculated by the conventionally used general formula (6), these values ​​are as follows. E1=1.3290 E2=1.1365 E3=1.1100 E4=0.9686 E =4.5441 In this example, there is no large difference between the evaluation functions E1 to E4 of each voxel, but there are some differences depending on the number of points included in the voxel.

[0062] In this embodiment, a first weighting value and a second weighting value are set for each voxel. Therefore, by increasing the weighting of a highly reliable voxel, it is possible to increase the degree of matching of the voxel. As an example, a specific example in which the first weighting value is set for each voxel will be described below with reference to FIG. 6.

[0063] FIG. 6(A) is a diagram showing the matching result when the first weighting values ​​for voxels B1 to B4 are all set to the same value (i.e., the same diagram as FIG. 5(C)). FIG. 6(B) is a diagram showing the matching result when the first weighting value for voxel B1 is set to 10 times the weighting values ​​of the other voxels. FIG. 6(C) is a diagram showing the matching result when the first weighting value for voxel B3 is set to 10 times the weighting values ​​of the other voxels. Note that in both examples, the second weighting values ​​are all set to the same value.

[0064] In the example of FIG. 6(B), the values ​​of the evaluation functions E1 to E4 corresponding to the voxels B1 to B4 and the overall evaluation function E are as follows: E1=0.3720 E2=0.0350 E3=0.0379 E4=0.0373 E =0.4823

[0065] In this way, in the example of Fig. 6(B), matching is performed so that the value of the evaluation function E1 corresponding to voxel B1 becomes high, and the degree of matching in voxel B1 is improved. Therefore, the deviation between the circle and the star in voxel B1 is reduced. In addition, since normalization is performed by the number of point clouds, the evaluation function value becomes smaller, but each evaluation function value has a ratio similar to the weighting value.

[0066] In the example of FIG. 6C, the values ​​of the evaluation functions E1 to E4 corresponding to the voxels B1 to B4 and the overall evaluation function E are as follows: E1=0.0368 E2=0.0341 E3=0.3822 E4=0.0365 E =0.4896

[0067] In the example of FIG. 6C, matching is performed so that the value of the evaluation function E3 corresponding to voxel B3 is high, and the degree of matching in voxel B3 is increased. Therefore, the deviation between the circle and the star in voxel B3 is small. In this way, by appropriately setting the first weighting value, the degree of matching for voxels with a low possibility of occlusion occurrence can be appropriately increased, in other words, the degree of matching for voxels with a high possibility of occlusion occurrence can be appropriately decreased. Similarly, by appropriately setting the second weighting value, the degree of matching for voxels with relatively high measurement accuracy can be increased and the degree of matching for voxels with relatively low measurement accuracy can be decreased.

[0068] [Vehicle control according to reference voxels] 7 is a flowchart showing a procedure for vehicle control according to the reference voxel Btag. The control unit 15 repeatedly executes the process of the flowchart in FIG.

[0069] First, the vehicle position estimation unit 17 estimates the vehicle position based on NDT matching (step S100). In this case, the vehicle position estimation unit 17 acquires the vehicle speed from the vehicle speed sensor 4 and the angular velocity in the yaw direction from the gyro sensor 3, and calculates the moving distance and the direction change of the vehicle based on the acquisition results. After that, the vehicle position estimation unit 17 adds the calculated moving distance and the direction change to the estimated vehicle position one time before (the initial value is, for example, the output value of the GPS receiver 5, etc.) to calculate the predicted position. Then, the vehicle position estimation unit 17 refers to the map DB 10 based on the calculated predicted position to acquire voxel data of voxels existing around the vehicle position. Furthermore, the vehicle position estimation unit 17 divides the scan data obtained from the LIDAR 2 for each voxel based on the calculated predicted position, and performs calculation of NDT scan matching using an evaluation function. In this case, the vehicle position estimation unit 17 calculates the evaluation function E k and a comprehensive evaluation function E, and calculates estimated parameters P that maximize the comprehensive evaluation function E. Then, the vehicle position estimating unit 17 applies the estimated parameters P to the predicted position described above to calculate an estimated vehicle position at the current time.

[0070] Next, the autonomous driving control unit 18 determines whether the position estimation accuracy has decreased (step S101). For example, the autonomous driving control unit 18 determines that the position estimation accuracy has decreased when the comprehensive evaluation function E corresponding to the estimation parameter P calculated in step S100 is smaller than a predetermined threshold value. Then, when the autonomous driving control unit 18 determines that the position estimation accuracy has decreased (step S101; Yes), it advances the process to step S102. On the other hand, when the autonomous driving control unit 18 determines that the position estimation accuracy has not decreased (step S101; No), it ends the process of the flowchart.

[0071] In step S102, the autonomous driving control unit 18 refers to the map DB 10 and acquires reliability information of voxel data corresponding to voxels around the route (step S102). In this case, for example, the autonomous driving control unit 18 acquires reliability information of voxel data registered in the map DB 10 that is within a predetermined distance in the road width direction from a road on the route and within a predetermined distance from the estimated vehicle position.

[0072] Then, the autonomous driving control unit 18 determines whether or not a voxel suitable for estimating the vehicle position exists based on the reliability information acquired in step S102 (step S103). For example, the autonomous driving control unit 18 determines whether or not a voxel of voxel data having reliability information in which the first weighting value is greater than a predetermined value and the second weighting value is less than a predetermined value exists. In another example, the autonomous driving control unit 18 calculates a reliability index value based on an equation, table, or case classification using the first weighting value and the second weighting value as parameters, and determines whether or not a voxel of voxel data having reliability information in which the calculated reliability index value is greater than a predetermined value exists.

[0073] Then, when the autonomous driving control unit 18 determines that a voxel suitable for estimating the vehicle position exists (step S103; Yes), the autonomous driving control unit 18 regards the voxel suitable for estimating the vehicle position as the reference voxel Btag, and corrects the target trajectory of the vehicle so that the vehicle passes through a position suitable for measuring the reference voxel Btag (step S104). In this case, for example, the autonomous driving control unit 18 corrects the target trajectory of the vehicle so that the reference voxel Btag passes through a position closest to the reference voxel Btag among positions where the reference voxel Btag is within the measurement range of the LIDAR 2 and where no occlusion occurs in the reference voxel Btag. In this way, the autonomous driving control unit 18 can suitably improve the detection accuracy of the reference voxel Btag by the LIDAR 2 and suitably improve the position estimation accuracy by NDT matching by bringing the vehicle closer to the reference voxel Btag within a range where the reference voxel Btag can be measured.

[0074] In addition, when there are multiple voxels suitable for estimating the vehicle position, the autonomous driving control unit 18 may set, for example, the voxel closest to the estimated vehicle position as the reference voxel Btag. In another example, the autonomous driving control unit 18 may set, as the reference voxel Btag, the voxel corresponding to the reliability information having the highest reliability index value calculated based on the first weighting value and the second weighting value.

[0075] On the other hand, if the autonomous driving control unit 18 determines that there is no voxel suitable for estimating the vehicle position (step S103; No), it ends the processing of the flowchart.

[0076] Next, a specific example based on the process of the flowchart in FIG. 7 will be described with reference to FIG.

[0077] 8 shows an overhead view of a vehicle on a three-lane road when feature 40 is present ahead on the left side of the road and feature 41 is present ahead on the right side of the road. In Fig. 8, a solid arrow "L1" indicates the target trajectory before the flowchart in Fig. 7 is executed, and a dashed arrow "L2" indicates the target trajectory after the flowchart in Fig. 7 is executed.

[0078] In the example of FIG. 8, after determining that the position estimation accuracy has decreased (see step S101), the autonomous driving control unit 18 acquires reliability information of voxel data corresponding to voxels around the route including voxels overlapping with the feature 40 and the feature 41 (see step S102). Then, the autonomous driving control unit 18 refers to the reliability information of the acquired voxel data and determines that the voxel B1 including a part of the feature 40 is a suitable voxel for vehicle position estimation (see step S103). Therefore, the autonomous driving control unit 18 regards the voxel B1 as the reference voxel Btag and specifies a suitable position "P1" for measuring the voxel B1. In this case, the position P1 is, for example, the position closest to the voxel B1 among the positions on the road where the voxel B1 can be measured by the lidar 2. Then, the autonomous driving control unit 18 changes the target trajectory indicated by the solid line L1 to the trajectory indicated by the dashed line L2 passing through the position P1.

[0079] In this way, the autonomous driving control unit 18 changes the lane of the vehicle to the lane closest to the reference voxel Btag, or biases the vehicle's traveling position within the lane to the side closer to the reference voxel Btag on the lane in which the vehicle is traveling. This allows the autonomous driving control unit 18 to accurately measure the reference voxel Btag corresponding to highly reliable voxel data at a short distance using the LIDAR 2, thereby suitably improving the vehicle position estimation accuracy.

[0080] As described above, when the vehicle-mounted device 1 according to this embodiment determines that the position estimation accuracy has decreased, it acquires reliability information of voxel data corresponding to voxels around the route from the map DB 10 including the voxel data. Then, based on the acquired reliability information, the vehicle-mounted device 1 sets a voxel suitable for vehicle position estimation as a reference voxel Btag, and outputs control information to the electronic control device of the vehicle for correcting the target trajectory of the vehicle so that the vehicle passes through a position suitable for measuring the reference voxel Btag. This allows the vehicle-mounted device 1 to suitably control the vehicle's travel so as to improve the position estimation accuracy.

[0081] [Variations] Preferred modified examples of the embodiment will be described below. The following modified examples may be applied to the embodiment in combination.

[0082] (Variation 1) Instead of storing the map DB 10 in the storage unit 12, the vehicle-mounted device 1 may have a server device (not shown) that has the map DB 10. In this case, the vehicle-mounted device 1 acquires necessary voxel data by communicating with the server device via a communication unit (not shown).

[0083] (Variation 2) The first weighting value and the second weighting value are recorded as reliability information in the voxel data included in the map DB 10. Alternatively, only either the first weighting value or the second weighting value may be recorded as reliability information in the voxel data.

[0084] In this case, the vehicle-mounted device 1 calculates an evaluation function E based on either the first weighting value or the second weighting value. k and determine the reference voxel Btag. Even in this mode, the vehicle-mounted device 1 can increase the matching degree of the highly reliable voxel, select the highly reliable voxel as the reference voxel Btag, and perform vehicle control to increase the accuracy of vehicle position estimation, as in the embodiment.

[0085] (Variation 3) The configuration of the driving assistance system shown in Fig. 1 is an example, and the configuration of a driving assistance system to which the present invention can be applied is not limited to the configuration shown in Fig. 1. For example, instead of having the on-board device 1, the driving assistance system may have an electronic control unit (ECU) of the vehicle that executes the processes of the vehicle position estimation unit 17 and the automatic driving control unit 18 of the on-board device 1. In this case, the map DB 10 may be stored in, for example, a storage unit in the vehicle, and the electronic control unit of the vehicle may receive update information for the map DB 10 from a server device (not shown).

[0086] (Variation 4) As shown in FIG. 3, the voxel data is not limited to a data structure including a mean vector and a covariance matrix. For example, the voxel data may include point cloud data measured by a map maintenance vehicle used to calculate the mean vector and the covariance matrix. In this case, the point cloud data included in the voxel data is an example of the "position information of an object" in the present invention. In addition, this embodiment is not limited to scan matching by NDT, and other scan matching such as ICP (Iterative Closest Point) may be applied. Even in this case, as in the embodiment, the vehicle-mounted device 1 can appropriately improve the position estimation accuracy by weighting the evaluation function for each voxel that evaluates the degree of matching using the first weighting value and the second weighting value. Furthermore, when the position estimation accuracy is reduced, the vehicle-mounted device 1 can appropriately improve the position estimation accuracy by determining the reference voxel Btag based on the first weighting value and the second weighting value of the voxels around the route and controlling the vehicle based on the reference voxel Btag, as in the embodiment. [Explanation of symbols]

[0087] 1 Onboard device 10 Map DB 11 Interface 12 Storage section 14 Input section 15 Control section 16 Information output section

Claims

[Claim 1] an acquisition unit that acquires at least precision information regarding position information and weighting information regarding a possibility of occlusion, the precision information being assigned to voxel data in which position information of an object for each voxel, which is a unit region, is recorded; a position estimation unit that estimates the position of the moving object by comparing an output of a measurement unit that measures the position of an object around the moving object with the position information included in the voxel data; an output unit that outputs control information for moving a moving body so that a voxel determined based on the accuracy information and the weighting information acquired by the acquisition unit is positioned within a measurement range of the measurement unit; and An output device comprising:

Citation Information

Patent Citations

  • Self position estimation program, self position estimation method and self position estimation apparatus

    JP2008020225A

  • Driving support system and driving support method

    JP2014048205A

  • Travel guide system, travel guide method, and computer program

    JP2014153192A

  • Autonomous mobile system

    WO2013076829A1