Self-position estimating apparatus and self-position estimating method
A self-position estimating apparatus includes a storage, a local map generator, a self-position estimator, and an adjuster. The storage stores an environmental map representing a position of an obstacle present in a mobile environment. The local map generator generates a local map representing a relative position of an obstacle present around the mobile body, with respect to the mobile body. The self-position estimator estimates, among a plurality of disposing positions on a local map disposing region set in the environmental map, one of the disposing positions where most exact matching is obtained between the local map and the environmental map, as a first self-position. The self-position estimator estimates a rotation angle of the local map at the disposing position as a first posture. The adjuster adjusts a size of the local map disposing region according to a predetermined condition.
1. A self-position estimating apparatus that estimates a self-position and/or a posture of a mobile body in an environment in which the mobile body is present, the self-position estimating apparatus comprising:
a memory that stores an environmental map representing a position of an obstacle present in the environment; and
a controller; wherein
the controller is configured or programmed to include:
a local map generator that generates a local map representing a relative position of the obstacle present around the mobile body, with respect to the mobile body;
a self-position estimator that executes a first estimating mode to estimate, when the local map is disposed and/or rotated at a plurality of disposing positions in a local map disposing region set on the environmental map, one of the disposing positions where most exact matching is obtained between the local map and the environmental map as a first self-position being the self-position of the mobile body in the environment, and/or to estimate a rotation angle of the local map at the disposing position as a first posture of the mobile body at the first self-position; and
an adjuster that adjusts a size of the local map disposing region according to a predetermined condition; and
prior to the adjuster adjusting the size of the local map disposing region, the size of the local map disposing region is set to a predetermined size, which is a size during execution of the first estimating mode.
2. The self-position estimating apparatus according to claim 1 , wherein when the mobile body moves from a non-obstacle region where only a predetermined number of the obstacles are present or the obstacle is not present in the environment to an obstacle region where the obstacle is present, the adjuster enlarges the size of the local map disposing region to be larger than the predetermined size for a predetermined time.
3. The self-position estimating apparatus according to claim 2 , wherein while the mobile body is moving in the non-obstacle region, the self-position estimator does not execute the first estimating mode.
4. The self-position estimating apparatus according to claim 1 , wherein when the mobile body moves from a first region on the environmental map to a second region on the environmental map, the adjuster enlarges the size of the local map disposing region to be larger than the predetermined size for a predetermined time.
5. The self-position estimating apparatus according to claim 4 , wherein while the mobile body is moving in the first region or after the predetermined time passes, the adjuster sets the size of the local map disposing region to the predetermined size.
6. The self-position estimating apparatus according to claim 1 , wherein
the mobile body includes one or more main wheels to move in the environment;
the self-position estimator further executes a second estimating mode to estimate the self-position and/or the posture of the mobile body in the environment as a second self-position and/or a second posture, based on rotation amounts of the main wheels; and
the adjuster enlarges the size of the local map disposing region to be larger than the size during execution of the first estimating mode for at least a predetermined time after a state of executing the second estimating mode is switched to a state of executing only the first estimating mode.
7. The self-position estimating apparatus according to claim 1 , wherein upon start of movement of the mobile body from a halted state, the adjuster enlarges the size of the local map disposing region to be larger than the size during execution of the first estimating mode.
8. The self-position estimating apparatus according to claim 1 , wherein when the mobile body halts, the adjuster reduces the size of the local map disposing region to be smaller than the size during execution of the first estimating mode.
9. The self-position estimating apparatus according to claim 1 , wherein when the mobile body is surrounded by unknown obstacles that are not indicated on the environmental map, the adjuster reduces the size of the local map disposing region to be smaller than a size when the mobile body is not surrounded by the unknown obstacles.
10. The self-position estimating apparatus according to claim 1 , wherein
the memory stores attribute information for defining the size of the local map disposing region at a predetermined position on the environmental map; and
the adjuster sets the size of the local map disposing region according to the attribute information.
11. The self-position estimating apparatus according to claim 1 , wherein when a plurality of conditions, under which the size of the local map disposing region is adjusted, simultaneously occurs, the adjuster sets the size of the local map disposing region according to one of the plurality of conditions.
12. A self-position estimating method that estimates a self-position and/or a posture of a mobile body in an environment in which the mobile body is present, the self-position estimating method comprising:
creating an environmental map representing a position of an obstacle present in the environment;
obtaining a local map representing a relative position of the obstacle present around the mobile body, with respect to the mobile body; and
when the local map is disposed and/or rotated at a plurality of disposing positions in a local map disposing region being set on the environmental map and having a size adjusted according to a predetermined condition, estimating one of the disposing positions where most exact matching is obtained between the local map and the environmental map as the self-position of the mobile body in the environment, and/or estimating a rotation angle of the local map at the disposing position as a posture of the mobile body on the self-position; wherein
prior to adjusting the size of the local map disposing region, the size of the local map disposing region is set to a predetermined size, which is a size during execution of the estimation of the one of the disposing positions and/or the estimation of the rotation angle of the local map.