Moving amount estimating apparatus, autonomous mobile body, and moving amount estimating method

Patent metadata

Field	Value
Publication number	US-2016152241-A1
Application number	US-201514933263-A
Country	US
Kind code	A1
Filing date	Nov 5, 2015
Priority date	Nov 28, 2014
Publication date	Jun 2, 2016
Grant date	—

Abstract

A moving amount estimating apparatus includes a position data obtaining unit, a first estimating unit, and a second estimating unit. The position data obtaining unit obtains a plurality of position data used to form a projection object image before and after movement of a mobile body. The first estimating unit calculates a moving amount of a parallel movement and/or a moving amount of a rotational movement of second position data as a moving amount of a mobile body when a plurality of moving position data is calculated such that a first projection object image to be formed by a plurality of first position data matches with a moving projection object image. A second estimating unit compensates for a wheel moving amount based on a comparison between a second reference moving amount based on a rotating amount of a wheel during a predetermined period and a first reference moving amount obtained by calculating the moving amount of the mobile body in the first estimating unit during the predetermined period, and estimates the moving amount of the mobile body.

First claim

What is claimed is:

1 . A moving amount estimating apparatus for estimating a moving amount of a mobile body moving according to rotation of a wheel, the apparatus comprising:
a position data obtaining unit that obtains a plurality of position data to form a projection object image obtained by projecting an object around the mobile body onto a predetermined coordinate; a first estimating unit that calculates, when a first projection object image formed by a plurality of first position data obtained one of before and after the mobile body moves matches with a moving projection object image formed by a plurality of moving position data obtained by a parallel movement and/or a rotational movement of a plurality of second position data obtained the other of before and after the movement on the predetermined coordinate, a moving amount of the parallel movement and/or a moving amount of the rotational movement of the plurality of second position data as a moving amount in which the mobile body moves; and a second estimating unit that compensates for a wheel moving amount to be calculated based on a rotating amount of the wheel based on a comparison between a second reference moving amount calculated based on the rotating amount of the wheel for a predetermined period during which the mobile body is moving and a first reference moving amount that is a calculated value of the moving amount in the first estimating unit when the mobile body moves during the predetermined period so as to estimate the compensated wheel moving amount as the moving amount of the mobile body.

2 . The moving amount estimating apparatus according to claim 1 , further comprising:
a compensation coefficient calculator that calculates a compensation coefficient as a result of comparing the second reference moving amount with the first reference moving amount based on the first reference moving amount and the second reference moving amount, wherein the second estimating unit compensates for the wheel moving amount using the compensation coefficient.

3 . The moving amount estimating apparatus according to claim 2 , further comprising an evaluating unit that evaluates whether the compensation coefficient is calculated appropriately based on a result of comparing a past compensation coefficient calculated during a past period before the predetermined period with the compensation coefficient.

4 . The moving amount estimating apparatus according to claim 3 , wherein when a determination is made that the compensation coefficient is not appropriately calculated, the second estimating unit uses the past compensation coefficient as the compensation coefficient.

5 . The moving amount estimating apparatus according to claim 2 , wherein the compensation coefficient calculator calculates the compensation coefficient based on the first reference moving amount, the second reference moving amount, and an updated coefficient having a predetermined value.

6 . The moving amount estimating apparatus according to claim 2 , wherein the second estimating unit calculates the wheel moving amount based on a reference wheel diameter as a predetermined diameter of the wheel and the rotating amount of the wheel so as to compensate for the wheel moving amount based on the compensation coefficient.

7 . The moving amount estimating apparatus according to claim 2 , wherein the second estimating unit calculates a compensation wheel diameter based on a reference wheel diameter as a predetermined diameter of the wheel and the compensation coefficient so as to calculate the moving amount of the mobile body based on the compensation wheel diameter and the rotating amount of the wheel.

8 . The moving amount estimating apparatus according to claim 7 , further comprising a diameter change calculator that calculates a change in the diameter of the wheel based on a comparison between the compensation wheel diameter and the reference wheel diameter.

9 . The moving amount estimating apparatus according to claim 1 , further comprising a compensation data obtaining command unit that specifies the predetermined period in which the first reference moving amount and the second reference moving amount are calculated.

10 . An autonomous mobile body comprising:
the moving amount estimating apparatus according to claim 1 ; a travelling unit that includes a wheel and is capable of travelling according to rotation of the wheel; a position estimating unit that estimates a current position based on a moving amount to be estimated in the moving amount estimating apparatus; and a travelling controller that controls the travelling unit so that the travelling unit travels from the current position to a predetermined target position.

11 . A moving amount estimating method for estimating a moving amount of a mobile body moving according to rotation of a wheel, the method comprising:
a step of obtaining a plurality of position data to form a projection object image obtained by projecting an object present around the mobile body onto a predetermined coordinate before and after the mobile body moves during a predetermined period; a step of moving a plurality of second position data obtained one of before and after the movement parallelly and/or rotationally on the predetermined coordinate so as to calculate a plurality of moving position data; a step of calculating, when the plurality of moving position data is obtained such that a first projection object image to be formed by a plurality of first position data obtained the other of before and after the movement matches with a moving projection object image to be formed by the plurality of moving position data, a first reference moving amount based on a moving amount of the parallel movement and/or a moving amount of the rotational movement of the plurality of second position data; a step of calculating a second reference moving amount based on the rotating amount of the wheel during the predetermined period; a step of compensating a wheel moving amount to be calculated based on the rotating amount of the wheel based on a comparison between the second reference moving amount and the first reference moving amount; and a step of estimating the compensated wheel moving amount as the moving amount of the mobile body.

Assignees

• Murata Machinery Ltd

Inventors

• Denda Yuki

Classifications

• B60W2556/00

  Input parameters relating to data · CPC title

• G01C22/00

  Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers · CPC title

• G01S17/89

  for mapping or imaging · CPC title

• B60W2530/20

  Tyre data · CPC title

• B60W40/12

  related to parameters of the vehicle itself {, e.g. tyre models} · CPC title