Work machine control system, work machine, and work machine control method
A work machine control system includes: a position sensor that detects the position of a work machine travelling on a traveling path; a non-contact sensor that detects the position of an object around the work machine; and a map data creation unit that creates map data on the basis of a detection point of the object and detection data of the position sensor, the detection point being detected by the non-contact sensor and satisfying a defined matching condition.
1. A work machine control system comprising:
a work machine;
a position sensor that detects a position of a work machine traveling on a traveling path;
a non-contact sensor that detects a position of an object around the work machine;
a map data creation unit that creates map data, which is a plurality of grids representing a surface of the object, on a basis of a detection point, which is defined by one grid which is binary data indicating an existence of the surface or a non-existence of the surface of the object and detection data of the position sensor, the detection point being detected by the non-contact sensor and satisfying a defined matching condition for the map data in a defined area containing grids indicating the existence of the surface of the object or non-existence of the surface of the object, the detection point includes an existing detection point forming the map data stored in a map data storage unit, and a current state detection point detected by the non-contact sensor;
the map data storage unit that stores the map data;
a defined area setting unit that sets a defined area completely around the work machine and moves the defined area in synchronization with the work machine while keeping a shape and a size of the defined area constant; and
a counting processing unit that counts a number of detection times at which the same current state detection point has been detected by a plurality of scans of the non-contact sensor in the defined area;
wherein the matching condition, for the map data in the defined area containing grids indicating the existence of the surface of the object or non-existence of the surface of the object, includes that a matching ratio between the existing detection points forming map data stored in the map data storage unit and the current state detection points forming map data is equal to or lower than a threshold of the matching ratio.
2. The work machine control system according to claim 1 , wherein
the map data creation unit creates the map data using the current state detection point that does not match the existing detection point when the matching ratio is equal to or lower than the threshold of the matching ratio.
3. The work machine control system according to claim 1 , wherein
the matching ratio includes a matching ratio between a plurality of the existing detection points forming the map data and a plurality of the current state detection points detected by one scan of the non-contact sensor.
4. The work machine control system according to claim 1 , wherein
the detection point includes a plurality of current state detection points detected by a plurality of scans of the non-contact sensor, and
the matching condition includes that the number of detection times at which the same current state detection point has been detected is equal to or higher than a threshold of the number of detection times.
5. The work machine control system according to claim 4 , wherein
the traveling path includes a tilt change position, and
the current state detection point includes a current state detection point of an object in front of the work machine traveling on the traveling path.
6. The work machine control system according to claim 4 , wherein
the map data creation unit creates the map data using the current state detection point at which the number of detection times is equal to or higher than the threshold of the number of detection times.
7. The work machine control system according to claim 1 , further comprising:
a collation position data calculation unit that collates detection data of the non-contact sensor with the map data created by the map data creation unit, and calculates collation position data indicating a collation position of the work machine.
8. The work machine control system according to claim 7 , further comprising:
a travel control device that controls a traveling state of the work machine on a basis of the collation position data calculated by the collation position data calculation unit when detection accuracy of the position sensor decreases.
9. A work machine control method comprising:
providing a work machine;
detecting a position of the work machine traveling on a traveling path with a position sensor;
detecting a position of an object around the work machine with a non-contact sensor; and
creating map data, which is a plurality of grids representing a surface of the object, on a basis of a detection point, which is defined by one grid which is binary data indicating an existence of the surface or a non-existence of the surface of the object and detection data of the position sensor, the detection point being detected by the non-contact sensor and satisfying a defined matching condition for the map data in a defined area containing grids indicating the existence of the surface of the object or non-existence of the surface of the object, the detection point includes an existing detection point forming the map data stored in a map data storage unit, and a current state detection point detected by the non-contact sensor;
storing map data in the map data storage unit;
defining an area completely around the work machine and moving the defined area in synchronization with the work machine while keeping a shape and a size of the defined area constant; and
counting a number of detection times at which the same current state detection point has been detected by a plurality of scans of the non-contact sensor in the defined area;
wherein the matching condition, for the map data in the defined area containing grids indicating the existence of the surface of the object or non-existence of the surface of the object, includes that a matching ratio between the existing detection points forming map data stored in the map data storage unit and the current state detection points forming map data is equal to or lower than a threshold of the matching ratio.