Self-propelled device, and method and travel control computer program of controlling traveling of self-propelled device

Patent metadata

Field	Value
Publication number	US-10935386-B2
Application number	US-201816610319-A
Country	US
Kind code	B2
Filing date	Aug 22, 2018
Priority date	Sep 8, 2017
Publication date	Mar 2, 2021
Grant date	Mar 2, 2021

Abstract

A self-propelled device, control method, and control program therefor are provided. The method and control program each include: position estimation; determining an intersection point of a virtual path connecting start and end points and a straight line passing through a position of the device, orthogonal to the virtual path; determining an offset reference point between the intersection point and the end point; determining at least each of two offset points offset on a corresponding goal point side or a start point side of the offset reference point on the virtual path; determining at least two target points reached by rotating the offset points by 90° about the offset reference point; and causing the device to travel toward the target points.

First claim

The invention claimed is:

1. A method of controlling traveling of a self-propelled device capable of autonomously traveling from a start point to a goal point, the method comprising:
a first step of estimating a position of the self-propelled device;
a second step of determining an intersection point of a virtual path and a straight line, the virtual path connecting the start point and the goal point, and the straight line passing through the position of the self-propelled device and which is orthogonal to the virtual path;
a third step of determining an offset reference point between the intersection point and the goal point on the virtual path;
a fourth step of determining at least an offset point at an offset on one of a side of the goal point and a side of the start point of the offset reference point on the virtual path;
a fifth step of determining at least a target point reached by rotating the offset point by 90° about the offset reference point in one of an anticlockwise direction and a clockwise direction; and
a sixth step of causing the self-propelled device to travel toward the target point.

2. The method of controlling traveling of the self-propelled device according to claim 1 , wherein the fifth step determines a target point reached by rotating the offset point by 90° about the offset reference point in the anticlockwise direction.

3. The method of controlling traveling of the self-propelled device according to claim 2 , wherein, when the self-propelled device is set in advance to travel on a left side of the virtual path:
the fourth step determines at least a front-side offset point at an offset on the side of the goal point of the offset reference point on the virtual path;
the fifth step determines a left target point reached by rotating the front-side offset point by 90° about the offset reference point in the anticlockwise direction; and
the sixth step causes the self-propelled device to travel toward the left target point.

4. The method of controlling traveling of the self-propelled device according to claim 2 , wherein, when the self-propelled device is set in advance to travel on a right side of the virtual path:
the fourth step determines at least a back-side offset point at an offset on the side of the start point of the offset reference point on the virtual path;
the fifth step determines a right target point reached by rotating the back-side offset point by 90° about the offset reference point in the anticlockwise direction; and
the sixth step causes the self-propelled device to travel toward the right target point.

5. The method of controlling traveling of the self-propelled device according to claim 3 , wherein a distance from the offset reference point to the front-side offset point is equal to or smaller than a distance from the intersection point to the offset reference point on the virtual path.

6. The method of controlling traveling of the self-propelled device according to claim 4 , wherein a distance from the offset reference point to the back-side offset point is equal to or smaller than a distance from the intersection point to the offset reference point on the virtual path.

7. The method of controlling traveling of the self-propelled device according to claim 1 , wherein the fourth step determines an offset point at an offset on the side of the goal point of the offset reference point on the virtual path.

8. The method of controlling traveling of the self-propelled device according to claim 7 , wherein, when the self-propelled device is set in advance to travel on a left side of the virtual path:
the fifth step determines a left target point reached by rotating the offset point by 90° about the offset reference point in the anticlockwise direction; and
the sixth step causes the self-propelled device to travel toward the left target point.

9. The method of controlling traveling of the self-propelled device according to claim 7 , wherein, when the self-propelled device is set in advance to travel on a right side of the virtual path:
the fifth step determines a right target point reached by rotating the offset point by 90° about the offset reference point in the clockwise direction; and
the sixth step causes the self-propelled device to travel toward the right target point.

10. The method of controlling traveling of the self-propelled device according to claim 7 , wherein a distance from the offset reference point to the offset point is equal to or smaller than a distance from the intersection point to the offset reference point on the virtual path.

11. The method of controlling traveling of the self-propelled device according to claim 1 , wherein the offset reference point and the offset point converge to the goal point as the self-propelled device approaches the goal point.

12. A self-propelled device capable of autonomously traveling from a start point to a goal point, the self-propelled device comprising:
a wheel, a drive device, and a sensor, the wheel, the drive device, and the sensor configured to move the self-propelled device; and
a control unit configured to:
estimate a position of the self-propelled device,
determine an intersection point of a virtual path and a straight line, the virtual path connecting the start point and the goal point, and the straight line passing through the position of the self-propelled device and which is orthogonal to the virtual path,
determine an offset reference point between the intersection point and the goal point on the virtual path,
determine at least an offset point at an offset on one of the side of the goal point and the side of the start point of the offset reference point on the virtual path,
determine at least a target point reached by rotating the offset point by 90° about the offset reference point in one of an anticlockwise direction and a clockwise direction, and
control the travel circuit so that the self-propelled device travels toward the target point.

13. The self-propelled device according to claim 12 , wherein, when the self-propelled device is set in advance to travel on a left side of the virtual path, the control unit determines at least a front-side offset point at an offset on the side of the goal point of the offset reference point on the virtual path, determines a left target point reached by rotating the front-side offset point by 90° about the offset reference point in the anticlockwise direction, and controls the travel circuit so that the self-propelled device travels toward the left target point.

14. The self-propelled device according to claim 12 , wherein, when the self-propelled device is set in advance to travel on a right side of the virtual path, the control unit determines at least a back-side offset point at an offset on the side of the start point of the offset reference point on the virtual path, determines a right target point reached by rotating the back-side offset point by 90° about the offset reference point in the anticlockwise direction, and controls the travel circuit so that the self-propelled device travels toward the right target point.

15. The self-propelled device according to claim 13 , wherein a distance from the offset reference point to the front-side offset point is equal to or smaller than a distance from the intersection point to the offset reference point on the virtual path.

16. The self-propelled device according to claim 14 , wherein a distance from the offset reference point to the back-side offset point is equal to or smaller than a distance from the intersection point to the offset reference point on the virtual path.

Assignees

• Nsk Ltd

Inventors

• Mori Mayuko
• Tanoue Masaaki
• Tobita Kazuteru
• Ozaki Satoshi

Classifications

• G01C21/206

  specially adapted for indoor navigation · CPC title

• G01C21/34 Primary

  Route searching; Route guidance · CPC title

• G01C21/20 Primary

  Instruments for performing navigational calculations (G01C21/24, G01C21/26 take precedence) · CPC title

• G05D1/02

  Control of position or course in two dimensions · CPC title

• G05D1/0212

  with means for defining a desired trajectory (involving a plurality of land vehicles G05D1/0287) · CPC title