Control apparatus for autonomously navigating utility vehicle
First Claim
1. An apparatus for controlling operation of an autonomously navigating utility vehicle equipped with a body and a prime mover mounted on the body to travel about a working area delineated by a boundary wire in order to perform work autonomously, the apparatus comprising:
- magnetic sensors installed spaced apart from each other in a lateral direction of the body of the vehicle, wherein each of the magnetic sensors detects a magnetic field strength generated by electric current passing through the boundary wire;
a position sensor that determines a position of the vehicle; and
an electronic control unit having a CPU and a memory;
the CPU controls the vehicle to circuit along the boundary wire in trace mode based on output from at least one of the magnetic sensors, determines a boundary line for the working area based on output from the position sensor when the vehicle is driven in the trace mode, generates a map of the working area comprised of an array of cells, and stores a count number in the memory for each of the cells indicating a number of times the vehicle passes over each of the cells in work mode;
the CPU, in the work mode, controls the vehicle to travel in the working area, acquires position data of the vehicle based on the output of the position sensor, identifies each of the cells on the map over which the vehicle passes in the work mode based on the position data, and updates the count number in the memory for individual ones of the cells each time the vehicle passes over the individual ones of the cells;
the CPU, in the work mode, determines when the vehicle reaches the boundary wire based on the output of the magnetic sensors, controls the vehicle to stop when reaching the boundary wire, calculates an average of count numbers for the cells in the map, determines whether at least one of the cells has a count number smaller than the average by at least a predetermined value, controls the vehicle to turn toward the inside of the working area at a random angle when none of the cells have a count number that is smaller than the average by at least the predetermined value, selects a target cell from the at least one of the cells when the at least one of the cells has a count number smaller than the average by at least the predetermined value, and controls the vehicle to turn toward a target direction directed at the target cell.
1 Assignment
0 Petitions
Accused Products
Abstract
An apparatus for controlling operation of an autonomously navigating utility vehicle equipped with a prime mover to travel about a working area delineated by a boundary line, there are provided with a map generating unit that that generates a working area map comprised of an array of a plurality of cells, a memory unit that counts and memorizes a number of times the vehicle passes over each of the cells based on the detected vehicle position; a target cell setting unit that selects one of the cells based on the memorized counted number and sets the selected one as a target cell; and a travel controlling unit that controls operation of the prime mover to make the vehicle travel about the working area until the vehicle has reached the boundary line, and make the vehicle turn toward the target cell and then travel straight forward when the vehicle has reached the boundary line.
11 Citations
10 Claims
-
1. An apparatus for controlling operation of an autonomously navigating utility vehicle equipped with a body and a prime mover mounted on the body to travel about a working area delineated by a boundary wire in order to perform work autonomously, the apparatus comprising:
-
magnetic sensors installed spaced apart from each other in a lateral direction of the body of the vehicle, wherein each of the magnetic sensors detects a magnetic field strength generated by electric current passing through the boundary wire; a position sensor that determines a position of the vehicle; and an electronic control unit having a CPU and a memory; the CPU controls the vehicle to circuit along the boundary wire in trace mode based on output from at least one of the magnetic sensors, determines a boundary line for the working area based on output from the position sensor when the vehicle is driven in the trace mode, generates a map of the working area comprised of an array of cells, and stores a count number in the memory for each of the cells indicating a number of times the vehicle passes over each of the cells in work mode; the CPU, in the work mode, controls the vehicle to travel in the working area, acquires position data of the vehicle based on the output of the position sensor, identifies each of the cells on the map over which the vehicle passes in the work mode based on the position data, and updates the count number in the memory for individual ones of the cells each time the vehicle passes over the individual ones of the cells; the CPU, in the work mode, determines when the vehicle reaches the boundary wire based on the output of the magnetic sensors, controls the vehicle to stop when reaching the boundary wire, calculates an average of count numbers for the cells in the map, determines whether at least one of the cells has a count number smaller than the average by at least a predetermined value, controls the vehicle to turn toward the inside of the working area at a random angle when none of the cells have a count number that is smaller than the average by at least the predetermined value, selects a target cell from the at least one of the cells when the at least one of the cells has a count number smaller than the average by at least the predetermined value, and controls the vehicle to turn toward a target direction directed at the target cell. - View Dependent Claims (2, 3, 4, 5)
-
-
6. A method for controlling operation of an autonomously navigating utility vehicle equipped with a body and a prime mover mounted on the body to travel about a working area delineated by a boundary wire in order to perform work autonomously, the method comprising:
-
controlling the vehicle to circuit along the boundary wire in trace mode based on output from at least one of a pair of magnetic sensors installed spaced apart from each other in a lateral direction of the body of the vehicle, wherein each of the magnetic sensors detects a magnetic field strength generated by electric current passing through the boundary wire; determining a boundary line for the working area based on output from a position sensor when the vehicle is driven in the trace mode; generating a map of the working area comprised of an array of cells; storing a count number in memory for each of the cells indicating a number of times the vehicle passes over each of the cells in work mode; controlling, in the work mode, the vehicle to travel in the working area; acquiring, in the work mode, position data of the vehicle based on the output of the position sensor; identifying each of the cells on the map over which the vehicle passes in the work mode based on the position data; updating the count number in the memory for individual ones of the cells each time the vehicle passes over the individual ones of the cells; determining, in the work mode, when the vehicle reaches the boundary wire based on the output of the magnetic sensors controlling the vehicle to stop when reaching the boundary wire; calculating an average of count numbers for the cells in the map; determining whether at least one of the cells has a count number smaller than the average by at least a predetermined value; when none of the cells have a count number that is smaller than the average by at least the predetermined value, controlling the vehicle to turn toward the inside of the working area at a random angle; when the at least one of the cells has a count number smaller than the average by at least the predetermined value, selecting a target cell from the at least one of the cells, and controlling the vehicle to turn toward a target direction directed at the target cell. - View Dependent Claims (7, 8, 9, 10)
-
Specification