US 12,222,730 B2
Control device, moving body, and control method
Masahiro Yamada, Tokyo (JP); Noritaka Yanai, Tokyo (JP); and Kazutaka Shimizu, Yokohama (JP)
Assigned to MITSUBISHI HEAVY INDUSTRIES, LTD., Tokyo (JP)
Appl. No. 17/414,483
Filed by MITSUBISHI HEAVY INDUSTRIES, LTD., Tokyo (JP)
PCT Filed Feb. 20, 2020, PCT No. PCT/JP2020/006783
§ 371(c)(1), (2) Date Jun. 16, 2021,
PCT Pub. No. WO2020/175313, PCT Pub. Date Sep. 3, 2020.
Claims priority of application No. 2019-031490 (JP), filed on Feb. 25, 2019.
Prior Publication US 2022/0057807 A1, Feb. 24, 2022
Int. Cl. G05D 1/00 (2024.01)
CPC G05D 1/0261 (2013.01) 6 Claims
OG exemplary drawing
 
1. A control device that controls a running direction of a running body running along a plurality of magnetic markers arranged at intervals on a track, the control device comprising:
a first sensor that detects the magnetic marker;
a second sensor that detects at least one of a velocity or an acceleration of the running body;
a first lateral position calculation unit that calculates a lateral deviation of the running body from a central axis of the track on the basis of a detection result of the first sensor in a case where the first sensor detects the magnetic marker;
a second lateral position calculation unit that calculates the lateral deviation of the running body on the basis of a detection result of the second sensor in a case where the first sensor does not detect the magnetic marker;
wherein the second lateral position calculation unit calculates the lateral deviation of the running body by subtracting at least one of a lateral velocity or a lateral acceleration that depends on running of the running body on a curved portion of the track, and
wherein the second lateral position calculation unit calculates the at least one of the lateral velocity or the lateral acceleration that depends on running of the running body on the curved portion by referencing a track shape database in which each position on the track and information on the curved portion with respect to the each position are stored in association with each other in advance, and using the information on the curved portion corresponding to a running position of the running body; and
a running direction control unit that controls the running direction of the running body on the basis of the lateral deviation of the running body calculated by either the first lateral position calculation unit or the second lateral position calculation unit.