# US 10,119,830 B2 · Control system for work machine, work machine, and management system for work machine

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 10,119,830 B2
- Document ID: US10119830B2
- Status: Granted
- Kind: B2
- Application number: 15/305,669
- Filed: 2016-02-29
- Published: 2017-08-31
- Granted: 2018-11-06
- Earliest claimed: 2016-02-29
- Assignees: Komatsu Ltd.
- Applicants: Komatsu Ltd.
- Inventors: Atsushi Sakai; Daisuke Tanaka; Mitsuhiro Ryuman
- Web page: https://patentgrep.com/patent/US10119830B2

## CPC

- G01C 21/3667: {Display of a road map (G01C21/3614 takes precedence; guidance using 3D or perspective road maps G01C21/3635)}
- G01C 21/005: {with correlation of navigation data from several sources, e.g. map or contour matching (G01C21/30 takes precedence)}
- G01C 21/20: Instruments for performing navigational calculations (G01C21/24, G01C21/26 take precedence)
- G01C 21/3848: {Data obtained from both position sensors and additional sensors}
- G01C 21/3859: {Differential updating map data}
- G05D 1/00: Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots (drive control systems specially adapted for autonomous road vehicles B60W60/00)
- G05D 1/0212: {with means for defining a desired trajectory (involving a plurality of land vehicles G05D1/0287)}
- G05D 1/024: {in combination with a laser (lasers per se H01S)}
- G05D 1/0274: {using mapping information stored in a memory device (navigation using map-matching G01C21/30)}
- G05D 1/0278: {using satellite positioning signals, e.g. GPS}
- G09B 29/004: {Map manufacture or repair; Tear or ink or water resistant maps; Long-life maps (printing processes for maps B41M3/02; by permanently attaching map sections to sheets B42B7/00)}
- G05D 1/027: {comprising intertial navigation means, e.g. azimuth detector (inertial navigation G01C21/16; inertial navigation combined with non-inertial navigation instruments G01C21/165)}
- G05D 1/0272: {comprising means for registering the travel distance, e.g. revolutions of wheels (measuring distance traversed on the ground by vehicles, e.g. using odometers G01C22/00)}
- G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S)
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G09B: EDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS (devices for psychotechnics or for testing reaction times A61B5/16; games, sports, amusements A63; projectors, projector screens G03B)

## Abstract

A control system includes: a detector detecting a position of a work machine running on a running path; a non-contact sensor detecting an object at a side of the running path; a generator generating map data of a work site based on detection data from the detector and the non-contact sensor; a first storage storing past map data generated in the generator based on the detection data from the detector and the non-contact sensor acquired in a predetermined period in a past; a second storage storing current map data generated in the generator based on the detection data from the detector and the non-contact sensor; a first calculator calculating integrated map data by integrating the past map data and the current map data; and a second calculator by matching the integrated map data and the detection data from the non-contact sensor, calculates the position of the work machine.

## Claims

### Claim 1

A control system for a work machine, comprising:
a position detecting device that detects a position of a work machine that runs on a running path of a work site of a mine of which a current landform changes day by day;
a non-contact sensor that detects, in a non-contact manner, an object at a side of the running path on which the work machine runs;
a map data generating unit that generates map data that indicates a map of a work site based on detection data from the position detecting device and detection data from the non-contact sensor;
a first storage unit that stores a plurality of past map data generated by the map data generating unit based on the detection data from the position detecting device and the detection data from the non-contact sensor acquired at different predetermined periods in a past, each of the plurality of past map data being generated at a different predetermined period;
a second storage unit that stores current map data generated in the map data generating unit based on the detection data from the position detecting device and the detection data from the non-contact sensor;
an integrated map data calculation unit that calculates integrated map data by integrating a predetermined number of past map data from the plurality of the past map data stored in the first storage unit and the current map data stored in the second storage unit, the predetermined number being greater than one; and
a position calculation unit that by matching the integrated map data calculated by the integrated map data calculation unit and the detection data from the non-contact sensor, calculates the position of the work machine.

### Claim 2 (depends on 1)

The control system for a work machine according to claim 1, wherein
the past map data and the current map data are each defined by a plurality of grids,
the grids include binary data that indicate a presence/absence of the object, and
the integration of the past map data and the current map data includes calculation of a logical sum of the binary data of the grids that indicate specific positions of the work site in the past map data, and the binary data of the grids that indicate the specific positions of the work site in the current map data.

### Claim 3 (depends on 1)

The control system for a work machine according to claim 1, wherein
when the current map data is stored in the first storage unit, at least one of the plurality of past map data stored in the first storage unit is deleted.

### Claim 4 (depends on 3)

The control system for a work machine according to claim 3, comprising
an updating unit that, when a sum of the number of the current map data and the number of the past map data stored in the first storage unit exceeds a predefined value, deletes at least one of the plurality of past map data stored in the first storage unit and stores the current map data in the first storage unit.

### Claim 5

A work machine comprising a control system, the control system including:
a position detecting device that detects a position of a work machine that runs on a running path of a work site of a mine of which a current landform changes day by day;
a non-contact sensor that detects, in a non-contact manner, an object at a side of the running path on which the work machine runs;
a map data generating unit that generates map data that indicates a map of a work site based on detection data from the position detecting device and detection data from the non-contact sensor;
a first storage unit that stores a plurality of past map data generated by the map data generating unit based on the detection data from the position detecting device and the detection data from the non-contact sensor acquired at different predetermined periods in a past, each of the plurality of past map data being generated at a different predetermined period;
a second storage unit that stores current map data generated in the map data generating unit based on the detection data from the position detecting device and the detection data from the non-contact sensor;
an integrated map data calculation unit that calculates integrated map data by integrating a predetermined number of past map data from the plurality of the past map data stored in the first storage unit and the current map data stored in the second storage unit, the predetermined number being greater than one; and
a position calculation unit that by matching the integrated map data calculated by the integrated map data calculation unit and the detection data from the non-contact sensor, calculates the position of the work machine.

### Claim 6

A management system for a work machine, comprising:
a work machine comprising a control system that includes:
a position detecting device that detects a position of a work machine that runs on a running path of a work site of a mine of which a current landform changes day by day,
a non-contact sensor that detects, in a non-contact manner, an object at a side of the running path on which the work machine runs,
a map data generating unit that generates map data that indicates a map of a work site based on detection data from the position detecting device and detection data from the non-contact sensor,
a first storage unit that stores a plurality of past map data generated by the map data generating unit based on the detection data from the position detecting device and the detection data from the non-contact sensor acquired at different predetermined periods in a past, each of the plurality of past map data being generated at a different predetermined period,
a second storage unit that stores current map data generated in the map data generating unit based on the detection data from the position detecting device and the detection data from the non-contact sensor,
an integrated map data calculation unit that calculates integrated map data by integrating a predetermined number of past map data from the plurality of the past map data stored in the first storage unit and the current map data stored in the second storage unit, the predetermined number being greater than one, and
a position calculation unit that by matching the integrated map data calculated by the integrated map data calculation unit and the detection data from the non-contact sensor, calculates the position of the work machine; and
a management device that outputs course data that defines the running path to the work machine.
