Estimation device, estimation method, and non-transitory storage medium that calculates an estimate value of a mobile object's position derived from three-dimensional point cloud data matchings
An estimation device used to cause a mobile object to move by driverless driving includes one or more processors configured to: perform first matching using three-dimensional point cloud data on the mobile object acquired by a first distance measurement device, and calculate at least one of a position and an orientation of the mobile object as a first calculation result derived from the first matching; perform second matching using three-dimensional point cloud data on the mobile object acquired by a second distance measurement device, and calculate at least one of a position and an orientation of the mobile object as a second calculation result derived from the second matching; and execute an estimation process of calculating an estimate value by using at least one of the first calculation result and the second calculation result, depending on the first calculation result and the second calculation result.
1 . An estimation device used to cause a mobile object to move by driverless driving, the estimation device comprising one or more processors configured to:
perform first matching using three-dimensional point cloud data on the mobile object acquired by a first distance measurement device, and calculate at least one of a position and an orientation of the mobile object as a first calculation result derived from the first matching;
perform second matching using three-dimensional point cloud data on the mobile object acquired by a second distance measurement device, and calculate at least one of a position and an orientation of the mobile object as a second calculation result derived from the second matching;
calculate an estimate value that is an estimate value of at least one of the position and the orientation of the mobile object and that is used to generate a control command for the driverless driving;
execute an estimation process of calculating the estimate value by using at least one of the first calculation result and the second calculation result, when a difference between the first calculation result and the second calculation result is less than a predetermined standard level; and
generate a deceleration command to cause the mobile object to decelerate or stop, when the difference between the first calculation result and the second calculation result is the predetermined standard level or more.
2 . The estimation device according to claim 1 , wherein in the estimation process, the one or more processors calculate the estimate value by using one calculation result derived from the matching with higher reliability, of the first calculation result and the second calculation result.
3 . The estimation device according to claim 1 , wherein in the estimation process, the one or more processors calculate the estimate value by using an average of the first calculation result and the second calculation result.
4 . An estimation method comprising:
performing first matching using three-dimensional point cloud data on a mobile object acquired by a first distance measurement device, and calculating at least one of a position and an orientation of the mobile object as a first calculation result derived from the first matching;
performing second matching using three-dimensional point cloud data on the mobile object acquired by a second distance measurement device, and calculating at least one of a position and an orientation of the mobile object as a second calculation result derived from the second matching;
calculating an estimate value that is an estimate value of at least one of the position and the orientation of the mobile object and that is used to generate a control command for driverless driving;
executing an estimation process of calculating the estimate value by using at least one of the first calculation result and the second calculation result, when a difference between the first calculation result and the second calculation result is less than a predetermined standard level; and
generating a deceleration command to cause the mobile object to decelerate or stop, when the difference between the first calculation result and the second calculation result is the predetermined standard level or more.
5 . A non-transitory storage medium storing instructions that are executable by one or more processors and that cause the one or more processors to perform functions comprising:
performing first matching using three-dimensional point cloud data on a mobile object acquired by a first distance measurement device, and calculating at least one of a position and an orientation of the mobile object as a first calculation result derived from the first matching;
performing second matching using three-dimensional point cloud data on the mobile object acquired by a second distance measurement device, and calculating at least one of a position and an orientation of the mobile object as a second calculation result derived from the second matching;
calculating an estimate value that is an estimate value of at least one of the position and the orientation of the mobile object and that is used to generate a control command for driverless driving;
executing an estimation process of calculating the estimate value by using at least one of the first calculation result and the second calculation result, when a difference between the first calculation result and the second calculation result is less than a predetermined standard level; and
generating a deceleration command to cause the mobile object to decelerate or stop, when the difference between the first calculation result and the second calculation result is the predetermined standard level or more.