Patent Application
20210112708
The present invention relates to an autonomous running working machine and a control system.
As one of autonomous running working machines that work while autonomously running, robot lawn mowers that independently run in lawn areas and mow lawns (also called “autonomous lawn mowers” or “unmanned lawn mowers”) are known (see, for example, Patent Literatures 1 to 3).
In addition, the robot lawn mower generally stores area data on a lawn mowing area that is a work target area for a lawn mowing work, and a running path of the robot lawn mower during lawn mowing has been determined based on this area data. Further, during the lawn mowing work, the robot lawn mower autonomously runs according to a predetermined running path while estimating its own position by an odometry (self-position estimation) function.
Now, if the robot lawn mower slips while autonomously running, the robot lawn mower may deviate from the defined running path due to an error generated in the odometry value and the slip may cause a lawn removal.
Conventionally, a technique has thus been proposed in which a robot lawn mower monitors generation of a slip during autonomous running, and reduces the running speed when a certain degree slip is detected, to prevent generation of a slip equal to or larger than it.
However, in the conventional technique, since the autonomous running is controlled only after a large slip is detected, it is difficult to avoid the slip generation itself.
Further, this problem is not limited to robot lawn mowers, but is a problem common to autonomous running working machines that perform a work while autonomously running.
An object of the present invention is to provide an autonomous running working machine and a control system capable of reducing generation of slip during autonomous running.
An aspect of the present invention is an autonomous running working machine for executing a predetermined work while autonomously running, where the autonomous running working machine includes: a positional information acquisition unit for acquiring positional information; a slip rate acquisition unit for acquiring a slip rate indicating a degree of a slip; a storing unit for storing control information, the positional information acquired by the positional information acquisition unit being associated with the slip rate acquired by the slip rate acquisition unit in the control information; and a running control unit for controlling the autonomous running based on the control information stored in the storing unit.
Another aspect of the present invention is the autonomous running working machine, including a running path setting unit for setting information defining a running path, wherein the running control unit controls the autonomous running based on the control information and the running path defined by the information set by the running path setting unit.
Yet another aspect of the present invention is the autonomous running working machine, wherein the running path includes a work path at a time of performing the predetermined work, and the running control unit executes deceleration according to the slip rate while executing autonomous running along the work path.
Yet another aspect of the present invention is the autonomous running working machine, including a speed information acquisition unit for acquiring a running speed, and a slip generation speed acquisition unit for acquiring a running speed when a slip rate indicating a first-degree slip is acquired, wherein the running control unit executes deceleration to a speed lower than the running speed acquired by the slip generation speed acquisition unit in a case of entering a point with the slip rate indicating the first-degree slip.
Yet another aspect of the present invention is the autonomous running working machine, wherein, at a time of passing a point with the slip rate indicating the first-degree slip, the storing unit stores a running speed at which the slip degree generated at the point is decreased, and, in a case of entering the point with the slip rate indicating the first-degree slip, the running control unit executes deceleration at least to the running speed stored in the storing unit.
Yet another aspect of the present invention is the autonomous running working machine, wherein, in a case where a turning point included in a work path defined by information set by the running path setting unit is at a position with the slip rate indicating generation of the first-degree slip, the running control unit executes autonomous running on a work path where the turning point is deviated from the position.
Yet another aspect of the present invention is the autonomous running working machine, wherein the running control unit executes the autonomous running such that a frequency of passing a point with a slip rate indicating generation of slip equal to or smaller than a second degree is higher than a frequency of passing a point with the slip rate indicating generation of the first-degree slip.
Yet another aspect of the present invention is the autonomous running working machine, including a speed information acquisition unit for acquiring a running speed, and a slip generation speed acquisition unit for acquiring a running speed when a slip rate indicating a first-degree slip is acquired, wherein the running path includes a work path at a time of performing the predetermined work, and in a case where a work path defined by information set by the running path setting unit includes a point with the slip rate indicating generation of the first-degree slip, the running control unit sets a path avoiding the point as the work path.
Yet another aspect of the present invention is the autonomous running working machine, wherein, in a case where a return path for returning to a predetermined position includes a point with a slip rate indicating generation of a first-degree slip, the running control unit executes return by autonomous running on a path that does not include the point.
Yet another aspect of the present invention is a control system for an autonomous running working machine that executes a predetermined work while autonomously running, where the control system includes: a positional information acquisition unit for acquiring positional information of the autonomous running working machine; a slip rate acquisition unit for acquiring a slip rate indicating a slip degree of the autonomous running working machine; a storing unit for storing control information, the positional information acquired by the positional information acquisition unit being associated with the slip rate acquired by the slip rate acquisition unit in the control information; and a running control unit for controlling autonomous running of the autonomous running working machine based on the control information stored in the storing unit.
According to the aspects of the present invention, the generation of slip during autonomous running can be reduced.
Embodiments of the present invention are described below with reference to the drawings.
The unmanned lawn mowing system 1 includes a robot lawn mower 2, an area wire 6 that demarcates a lawn mowing area 4 for a lawn mowing work, and a station 8.
The robot lawn mower 2 is an autonomous running type working machine that mows turfgrass while autonomously running in the lawn mowing area 4 in unmanned operation.
The area wire 6 is a member laid along a boundary A by a dealer or the like so that the robot lawn mower 2 can detect the boundary A of the lawn mowing area 4. In this embodiment, the laid area wire 6 is magnetic, and the robot lawn mower 2 detects the magnetism of the area wire 6 to detect the boundary A of the lawn mowing area 4.
The station 8 has a charging device 8A that charges the robot lawn mower 2 and is installed in the lawn mowing area 4. This station 8 is also a standby place for the robot lawn mower 2 when it is not in work. At the end of the lawn mowing work, the robot lawn mower 2 returns to the station 8 by autonomous running and is appropriately charged at the station 8.
The robot lawn mower 2 has a box-shaped main body 12, and the main body 12 has steerable front wheels 14A provided on the left and right in the front, and rear wheels 14B, which are drive wheels, provided on the left and right in the rear. Further, the main body 12 includes a steering mechanism 16, a drive mechanism 18, a lawn mowing mechanism 20, a motor 22, a battery unit 24, a sensor unit 28, a control unit 30, an operation unit 32, and display unit 34.
The control unit 30 is a device that controls each unit provided in the main body 12 and realizes a function of independently executing lawn mowing work and autonomous running together. The control unit 30 has a computer including a processor 40 such as CPU and MPU, a memory device 42 such as ROM and RAM, and a storage device 44 such as HDD and SSD, and the processor 40 executes a computer program stored in the memory device 42, the storage device 44, or the like to realizes various functions. The functional configuration of the control unit 30 is described below. The control unit 30 may include a plurality of computers, and the respective computers may cooperate to realize various functions.
The operation unit 32 includes various operators (buttons, ten-keys, touch panel . . . ) to accept user operations, and outputs the operations to the control unit 30. The display unit 34 includes a display panel or the like and displays various information.
The steering mechanism 16 is a mechanism that steers the front wheels 14A, and includes a steering motor and a gear transmission mechanism that moves the front wheels 14A in the left and right directions by rotation of the steering motor. The drive mechanism 18 is a mechanism that drives the rear wheels 14B, and includes a power transmission mechanism that transmits the power of the motor 22 to the rear wheels 14B for driving. The lawn mowing mechanism 20 is a working unit for performing lawn mowing, and includes a cutting blade 20A for lawn mowing and a connecting mechanism that connects the cutting blade 20A to a motor 22 in an interlocking manner. The battery unit 24 includes a battery 24A and supplies the electric power of the battery 24A to each unit such as the motor 22.
The sensor unit 28 includes various sensors necessary for autonomously running in the lawn mowing area 4 and avoiding obstacles (houses, trees, or the like) at the same time. In this embodiment, the sensor unit 28 includes at least an area detection sensor unit 28A, an odometry detection sensor unit 28B, a slip rate detection sensor unit 28C, and a speed detection sensor unit 28D.
The area detection sensor unit 28A includes various detection devices for detecting the boundary A of the lawn mowing area 4, and, in this embodiment, includes a magnetic sensor for detecting the magnetism of the area wire 6.
The odometry detection sensor unit 28B includes various detection devices for detecting the current position of the robot lawn mower 2, and, in this embodiment, includes a drive wheel vehicle speed sensor 47 for detecting each of the vehicle speeds of the left and right rear wheels 14B (hereinafter referred to as “drive wheel vehicle speeds”) which are the drive wheels. During autonomous running, the control unit 30 determines the moving distance of the robot lawn mower 2 based on the integral value of the drive wheel vehicle speed, and also determines the turning direction based on the difference between the drive wheel vehicle speeds of the left and right rear wheels 14B. Then, the control unit 30 sequentially identifies the relative position of the robot lawn mower 2 with respect to a base point (the station 8 in this embodiment) where the robot lawn mower 2 has started running, based on the moving distance and turning direction. In addition, the odometry detection sensor unit 28B may include an acceleration sensor or a gyro sensor, and the control unit 30 may correct the current position based on the drive wheel vehicle speed, using the detection values of these sensors, to improve the detection accuracy of the current position. The odometry detection sensor unit 28B may also include a GPS receiver that receives a GPS (Global Positioning System) signal, and the control unit 30 may detect the current position based on the GPS signal.
The slip rate detection sensor unit 28C includes various detection devices for detecting a slip rate λ. The slip rate λ is a value that quantifies the degree of the slip generated when the robot lawn mower 2 runs, and in this embodiment, the slip rate λ is defined by the following equation.
Slip rate λ=(driven wheel vehicle speed-drive wheel vehicle speed)/drive wheel vehicle speed
The driven wheel vehicle speed is the vehicle speed of the front wheel 14A that is a driven wheel. According to this definition, the value of the slip rate λ increases and approaches “1” as a large slip is generated.
The slip rate detection sensor unit 28C includes a driven wheel vehicle speed sensor 48 for detecting the driven wheel vehicle speed, and shares the drive wheel vehicle speed sensor 47, which the odometry detection sensor unit 28B includes therein, as a detection device for detecting the vehicle speed of the drive wheels. Then, the control unit 30 sequentially calculates the slip rate λ based on the detection values of the drive wheel vehicle speed sensor 47 and the driven wheel vehicle speed sensor 48 during running.
Note that the slip rate λ is not limited to the above equation, and may be determined by the following equation, for example.
Slip rate λ=(vehicle body speed-wheel vehicle speed)/vehicle body speed
Further, any other quantification method can be used for the slip rate λ. In this case, the slip rate detection sensor unit 28C is provided with a detection device necessary for detecting the physical quantity used in the quantification method.
The speed detection sensor unit 28D includes various detection devices for detecting a running speed V of the robot lawn mower 2. In this embodiment, the running speed V is determined based on the drive wheel vehicle speed. Therefore, in this embodiment, the speed detection sensor unit 28D shares the drive wheel vehicle speed sensor 47, which the odometry detection sensor unit 28B includes therein, as a detection device for detecting the running speed. Note that the running speed may be determined based on the driven wheel vehicle speed, or may be determined based on a detection signal of any other speed sensor.
The sensor unit 28 is not limited to the above detection device, and may be appropriately provided with any detection device as required, such as a detection device for detecting obstacles (for example, a contact detection sensor).
As shown in the figure, the control unit 30 includes a positional information acquisition unit 50, a slip rate acquisition unit 52, a speed information acquisition unit 54, a slip rate distribution generation unit 55, a running path setting unit 56, a storing unit 58, and a running control unit 60. These functional units are realized by the processor 40 executing computer programs.
The positional information acquisition unit 50 sequentially acquires positional information P based on the detection signal of the detection device which the odometry detection sensor unit 28B includes therein while the robot lawn mower 2 is autonomously running. In this embodiment, the positional information P is information indicating a relative position with respect to the station 8 as described above.
The slip rate acquisition unit 52 sequentially acquires a slip rate λ based on a detection signal of the detection device which the slip rate detection sensor unit 28C includes therein, while the robot lawn mower 2 is autonomously running.
The speed information acquisition unit 54 sequentially acquires a running speed V based on the detection signal of the detection device which the speed detection sensor unit 28D includes therein, while the robot lawn mower 2 is autonomously running. Further, in this embodiment, the speed information acquisition unit 54 includes a slip generation speed acquisition unit 54A. The slip generation speed acquisition unit 54A acquires the running speed at the time when the slip having a first degree or more is generated (hereinafter, referred to as “slip generation running speed VX”). The first-degree slip refers to a slip that causes an error, to the extent that return by autonomous running to the station 8 is impossible, in the positional information P acquired by the positional information acquisition unit 50, or a slip that causes a lawn removal. A value indicating the first-degree slip is set in advance as a first predetermined value λth1 of the slip rate λ. Here, in the following description, a point where the slip rate λ is equal to or larger than the first predetermined value λth1 is referred to as a “high slip point Pk”.
The slip rate distribution generation unit 55 generates slip rate distribution data 70 indicating the distribution of the slip rate λ in the lawn mowing area 4.
As shown in the figure, in the slip rate distribution data 70, positional information P and slip rate λ are recorded in association with each other. Further, in the slip rate distribution data 70, the slip generation running speed Vλ at the high slip point Pk and the number of passes N that the high slip point Pk has been passed during lawn mowing work are recorded in association with each other.
This slip rate distribution data 70 consolidates the slip rate λ at each point in the lawn mowing area 4, the slip generation running speed Vλ when a slip is actually generated at the high slip point Pk, and the number of passes N that the high slip point Pk has been passed.
Further, in the slip rate distribution data 70, the number of passes N that a low slip point Pt has been passed during lawn mowing work is also recorded in association with the positional information P. The low slip point Pt is a point where the slip rate λ is a second predetermined value λth2 or less. As the second predetermined value λth2, a slip rate λ is set, in which the slip is in a degree that gives little error to the positional information P acquired by the positional information acquisition unit 50 and does not cause lawn removal.
The slip rate distribution data 70 enables comparing the number of passes N at each of the high slip points Pk and the low slip points Pt to determine whether the running path is biased to the low slip point Pt.
Further, the first predetermined value λth1 is set as the second predetermined value λth2, so that the points other than the high slip point Pk can be considered to be the low slip point Pt.
Here, in this embodiment, when the robot lawn mower 2 passes the high slip point Pk during lawn mowing work, it reduces the running speed V to a speed lower than the slip generation running speed Vλ and passes there to prevent generation of the first-degree slip. In the slip rate distribution data 70, if the slip rate λ is equal to or less than the second predetermined value λth2 when the robot lawn mower 2 passes the high slip point Pk with the running speed V reduced, the running speed V is recorded as the slip reduction running speed Vs. Accordingly, when the robot lawn mower 2 passes the high slip point Pk, it can pass there at the slip reduction running speed Vs to decrease the slip generation.
Returning to
When slip rate distribution data 70 have been already stored in the storing unit 58, the slip rate distribution generation unit 55 sequentially updates and records the slip rate distribution data 70 while the robot lawn mower 2 is autonomously running.
Specifically, when the slip rate λ and the slip generation running speed Vλ (in a case of that slip rate λ first predetermined value λth1) for the new positional information P are acquired, the slip rate distribution generation unit 55 adds these to the slip rate distribution data 70. Further, when the slip rate λ or the slip generation running speed Vλ different from the already recorded values are acquired for the existing positional information P, the slip rate distribution generation unit 55 updates the slip rate distribution data 70 with these values. Further, when the robot lawn mower 2 passes the high slip point Pk or the low slip point Pt, the slip rate distribution generation unit 55 updates and records the number of passes N at the high slip point Pk or the low slip point Pt. Further, when the slip reduction running speed Vs is acquired for the existing high slip point Pk, the slip rate distribution generation unit 55 updates and records this.
Such an update and record operation can always keep the slip rate distribution data 70 with the latest information even if, for example, the distribution of the slip rate λ in the lawn mowing area 4 may change due to the presence or absence of rainfall or the replanting of turfgrass.
Further, any other information than the above such as the running speed V may be recorded in the slip rate distribution data 70 in association with the positional information P.
The running path setting unit 56 sets information that defines what trajectory the robot lawn mower 2 draws to autonomously run in the lawn mowing area 4 during lawn mowing work, that is, a work path D during the lawn mowing work (
More specifically, in this embodiment, as patterns of running trajectory (that is, lawn mowing path) that the robot lawn mower 2 draws in lawn mowing area 4 during lawn mowing work, there are three types of patterns (hereinafter referred to as “running patterns”), a “random pattern”, a “zigzag pattern”, and a “mix pattern”, defined in advance.
As shown in
The zigzag pattern is a pattern in which the first turning angle θa in the random pattern is reduced. That is, the zigzag pattern is a lawn mowing path pattern, as shown in
The mix pattern is a lawn mowing path pattern, where the robot lawn mower 2 repeats a random pattern and a zigzag pattern alternately every fixed time or every fixed mileage during lawn mowing work.
Returning to
The lawn mowing path pattern and parameters define the lawn mowing path of the robot lawn mower 2 during lawn mowing work. The lawn mowing path pattern and parameters are stored in the storing unit 58 as running path data 71.
The parameter setting unit 56B is not limited to the turning angle, and may set an optional parameter such as the turning direction (clockwise or counterclockwise) at the time of turning.
The storing unit 58 stores control information 74, which is information required for controlling the autonomous running of the robot lawn mower 2 that decreases the slip generation, and the running path data 71. The control information 74 includes at least the slip rate distribution data 70 described above.
The running control unit 60 controls the steering mechanism 16 and the driving of the drive mechanism 18 to control the autonomous running of the robot lawn mower 2. More specifically, the running control unit 60 performs autonomous running control during lawn mowing work (hereinafter referred to as “lawn mowing running control”) and autonomous running control during return to station 8 after finishing the lawn mowing work (hereinafter referred to as “return running control”), as autonomous running control.
In the lawn mowing running control, the running control unit 60 controls the robot lawn mower 2 to run along the lawn mowing path defined by the running path data 71. That is, the running control unit 60 causes the robot lawn mower 2 to go straight until the area detection sensor unit 28A detects the boundary A of the lawn mowing area 4, and to turn the robot lawn mower 2 at the first turning angle θa or the second turning angle θb when the boundary A is detected.
In the return running control, the running control unit 60 identifies the return path E (
Furthermore, the running control unit 60 also performs control for decreasing the generation of the above-described first-degree slip (that is, the slip in which the slip rate λ is equal to or more than the first predetermined value λth1) in each of lawn mowing running control and return running control. For such control, the running control unit 60 includes a lawn mowing running change control unit 80 and a return running change control unit 82.
The lawn mowing running change control unit 80 and the return running change control unit 82 both execute control based on the control information 74 to decrease the generation of the first-degree slip during autonomous running, where the lawn mowing running change control unit 80 decreases the generation of the first-degree slip during running of the lawn mowing work, and the return running change control unit 82 decreases the generation of the first-degree slip during the return running.
More specifically, the lawn mowing running change control unit 80 executes deceleration control, turning point change control, and passing point change control during the lawn mowing running to reduce the generation of the first-degree slip.
The deceleration control is control for reducing the running speed V to at least a speed slower than the slip generation running speed Vλ when the robot lawn mower 2 passes the high slip point Pk. That is, during lawn mowing running, the lawn mowing running change control unit 80 sequentially determines whether the point to pass from now on is a high slip points Pk in the slip rate distribution data 70, based on the positional information P acquired by the positional information acquisition unit 50, and the slip rate distribution data 70. Then, when the point is a high slip point Pk, the lawn mowing running change control unit 80 executes control where it reduces the running speed V to a speed slower than the slip generation running speed VX, while passing the high slip point Pk. As a result, the generation of the first-degree slip due to pass of the high slip point Pk is reduced.
Further, when the slip rate λ acquired at a time of passing the high slip point Pk is equal to or less than the second predetermined value λth2 (that is, the slip is equal to or less than a second degree), the running speed V at this time is recorded as the slip reduction running speed Vs in the slip rate distribution data 70 by the slip rate distribution generation unit 55. Then, the lawn mowing running change control unit 80 reduces the running speed V to the slip reduction running speed Vs to pass the high slip point Pk next time. In this way, the degree of slip generated at a time of passing the high slip point Pk can be surely decreased to the second degree or less.
In this embodiment, when the slip rate λ acquired at a time of passing the high slip point Pk is equal to or larger than the second predetermined value λth2 (that is, the slip is equal to or larger than the second degree) and smaller than the first predetermined value λth1, the running speed V at this time is memorized in, for example, the slip rate distribution data 70, as a running speed at the last passing, in association with the high slip point Pk. Then, each time when the robot lawn mower 2 passes the high slip point Pk where the slip reduction running speed Vs is not recorded, the robot lawn mower 2 passes there at a running speed V lower than the running speed at the last passing. The robot lawn mower 2 repeatedly performs such speed control every time it passes the high slip point Pk, so that it can surely reduce the running speed V when passing through the high slip point Pk to the slip reduction running speed Vs where the slip rate λ is equal to or less than the second predetermined value λth2.
The turning point change control is control such that the robot lawn mower 2 avoids turning at the high slip point Pk. This turning point change control is executed when the robot lawn mower 2 is turned at the boundary A of the lawn mowing area 4 at the first turning angle θa or the second turning angle θb defined in the running path data 71. In turning point change control, the lawn mowing running change control unit 80 identifies the work path D along which the robot lawn mower 2 goes straight after turning, and determines whether the vicinity of the intersection between the work path D and the boundary A of the lawn mowing area 4 corresponds to the high slip point Pk, based on the slip rate distribution data 70. In a case of corresponding to the high slip point Pk, the lawn mowing running change control unit 80 identifies a turning angle at which the intersection of the work path D and the boundary A deviates from the high slip point Pk, and changes the first turning angle θa or the second turning angle θb to that turning angle to turn the robot lawn mower 2. This control can reduce the first-degree slip that may be generated when the robot lawn mower 2 turns at the high slip point Pk.
The passing point change control is a control for reducing the frequency with which the robot lawn mower 2 passes the high slip point Pk. This passing point change control is executed when the robot lawn mower 2 is turned at the boundary A of the lawn mowing area 4 at the first turning angle θa or the second turning angle θb defined in the running path data 71. In passing point change control, the lawn mowing running change control unit 80 identifies the work path D in which the robot lawn mower 2 goes straight after turning, and identifies whether there is the high slip point Pk on the work path D based on the slip rate distribution data 70. When there is a high slip point Pk and the number of passes N at the high slip point Pk exceeds the number of passes N at all other low slip points Pt by the running of the robot lawn mower 2, the lawn mowing running change control unit 80 identifies a turning angle that includes any of the low slip points Pt on the work path D. Then, the lawn mowing running change control unit 80 changes the first turning angle θa or the second turning angle θb to the turning angle to cause the robot lawn mower 2 to turn and then go straight on the running path. As a result, the frequency with which the robot lawn mower 2 passes the low slip point Pt is kept higher than the frequency with which the robot lawn mower 2 passes the high slip point Pk, and the risk of the first-degree slip generation is decreased.
The return running change control unit 82 changes the start position of return running to execute start position change control for changing the return path E such that the robot lawn mower 2 does not pass the high slip point Pk when returning. This start position change control is executed when the robot lawn mower 2 is turned toward the station 8 after the lawn mowing work is finished. In the start position change control, the return running change control unit 82 determines whether there is a high slip point Pk on the return path E that linearly connects the current position and the station 8 based on the slip rate distribution data 70. When there is a high slip point Pk, the return running change control unit 82 identifies a position where the robot lawn mower 2 can go straight to return to the station 8 without passing the high slip point Pk, and moves the robot lawn mower 2 to the position. As a result, the robot lawn mower 2 does not pass the high slip point Pk during the return running, and the generation of the first-degree slip is decreased.
Next, the operation of the robot lawn mower 2 is described below.
The robot lawn mower 2 stands by at the station 8 before starting lawn mowing work. Then, the robot lawn mower 2 starts the lawn mowing work based on, for example, a user operation or a timer setting in which the lawn mowing work date and time is designated in advance. When the robot lawn mower 2 starts lawn mowing work (step Sa1), it autonomously runs along the defined work path D based on the running path data 71, while executing lawn mowing running control for driving the lawn mowing mechanism 20 to perform lawn mowing (step Sa2). After that, when the lawn mowing work is completed (step Sa3: YES), the robot lawn mower 2 executes return running control to autonomously run along the return path E toward the station 8 (step Sa4).
In addition, in the determination of step Sa3, the following case can also be determined as a termination condition for the lawn mowing work. It is namely one of the cases where the remaining capacity of the battery 24A decreases to fall below a predetermined threshold, the error in the current position increases to exceed the predetermined threshold, and the current position is incorrect or cannot be determined for the reason such as that the user has lifted the robot lawn mower 2. Then, in step Sa3, if any of these termination conditions is satisfied, the robot lawn mower 2 may return to the station 8 even if the lawn mowing work is not completed.
In the robot lawn mower 2 of this embodiment, as mentioned above, the slip rate distribution generation unit 55 generates the slip rate distribution data 70, and updates and records it during lawn mowing running control (step Sa2). In parallel with this, the lawn mowing running change control unit 80 executes slip reduction control for decreasing the generation of the first-degree slip.
In this slip reduction control, the lawn mowing running change control unit 80 executes the above-described deceleration control, turning point change control, and passing point change control.
That is, as shown in
When the robot lawn mower 2 enters the high slip point Pk (step Sb1: YES), the lawn mowing running change control unit 80 executes deceleration control to make the running speed V slower than at least the slip generation running speed Vλ (step Sb2), and when the robot lawn mower 2 finishes passing the high slip point Pk (step Sb3: YES), the lawn mowing running change control unit 80 restores the running speed V (step Sb4). Further, in step Sb2, when the slip reduction running speed Vs has been recorded in the slip rate distribution data 70, the lawn mowing running change control unit 80 reduces speed to the slip reduction running speed Vs.
As a result, when the robot lawn mower 2 indicated by the arrow Xa in
Returning to
Specifically, the lawn mowing running change control unit 80 first identifies the work path D drawn when the robot lawn mower 2 turns at the defined first turning angle θa or the second turning angle θb (step Sb6).
Next, the lawn mowing running change control unit 80 determines whether the next turning point Ps on the work path D (that is, vicinity of the intersection of the work path D and the boundary A) is a high slip point Pk and whether the frequency of passing the high slip point Pk included in the work path D is higher than the frequency of passing the low slip point Pt, based on the slip rate distribution data 70 (step Sb7).
When the next turning point Ps is a high slip point Pk, or when the frequency of passing the high slip point Pk is higher than the frequency of passing the low slip point Pt (step Sb7: YES), the lawn mowing running change control unit 80 changes the turning angle to an angle leading to a work path D in which the turning point Ps deviates from the high slip point Pk and the frequency of passing the high slip point Pk is not higher than the frequency of passing the low slip point Pt (for example, the work path D that passes the low slip point Pt) (step Sb8).
The robot lawn mower 2 turns at this turning angle so that the robot lawn mower 2 shown by the arrow Xb in
The slip reduction control is repeatedly and continuously executed during the lawn mowing running control (
In this slip reduction control, the return running change control unit 82 first executes the above-mentioned start position change control.
That is, as shown in
According to the above-described embodiment, the following effects can be obtained.
In this embodiment, the robot lawn mower 2 includes a running control unit 60 that controls autonomous running based on control information 74 that includes slip rate distribution data 70 in which the positional information P is associated with the slip rate λ.
This enables an autonomous running that takes a slip-prone point into consideration during autonomous running to prevent the generation of a slip with a certain degree (the first degree in this embodiment), reducing or preventing the lawn removal or the increase in the error of the positional information due to the slip.
In this embodiment, the robot lawn mower 2 is configured to autonomously run based on the control information 74 and the defined running path.
Accordingly, when the robot lawn mower 2 autonomously runs along the defined running path, the generation of slip is prevented.
In this embodiment, the robot lawn mower 2 is configured to autonomously run along the work path D and to decelerate according to the slip rate λ, during lawn mowing work.
As a result, the robot lawn mower 2 is decelerated according to the slip rate λ during lawn mowing work, so that the robot lawn mower 2 can be surely decelerated at the high slip point Pk. This can reduce the slip at a time of passing the high slip point Pk to further reduce or prevent the lawn removal or the error in the positional information due to the slip.
In this embodiment, the robot lawn mower 2 is configured to decelerate to a speed lower than the slip generation running speed Vλ acquired by the slip generation speed acquisition unit 54A when entering the high slip point Pk.
This can surely make the degree of the slip at a time of passing the high slip point Pk smaller than the first degree to further reduce or prevent the lawn removal or the error in the positional information due to the slip.
In this embodiment, the robot lawn mower 2 is configured to decelerate at least to the slip reduction running speed Vs of the slip rate distribution data 70 stored in the storing unit 58 when entering the high slip point Pk.
This can surely decrease the slip generated when the robot lawn mower 2 passes the high slip point Pk, to the second degree or less, to surely reduce or prevent the lawn removal or the error in the positional information due to the slip.
In this embodiment, the robot lawn mower 2 is configured to autonomously run on the work path D where the turning point Ps deviates from the high slip point Pk, when a turning point Ps included in the defined work path D is a high slip point Pk.
This can reduce the slip at a time of turning, because the robot lawn mower 2 does not turn at the high slip point Pk, to reduce or prevent the lawn removal or the error in the positional information due to the slip at the turning point Ps.
In this embodiment, the robot lawn mower 2 is configured to autonomously run so that the frequency of passing the low slip point Pt is higher than the frequency of passing the high slip point Pk during the lawn mowing work.
This can reduce the frequency of running at the high slip point Pk to reduce the risk of generation of the first-degree slip, further reducing or preventing the lawn removal or the error in the positional information due to the slip.
In this embodiment, the robot lawn mower 2 is configured to change the return path E not to include the high slip point Pk and return, when the high slip point Pk is included in the return path E for returning to the station 8 after finishing the lawn mowing work.
As a result, the robot lawn mower 2 runs to return along the return path E that does not pass the high slip point Pk, and thus this can reduce the generation of slip in the situation where the detection accuracy of positional information is required, such as return running to the station 8, to improve the accuracy of returning to the station 8.
Note that each of the above-described embodiments merely exemplifies one aspect of the present invention, and can be optionally modified and applied without departing from the gist of the present invention.
In the above-described embodiments, cases are exemplified where the work path D is defined based on the running pattern at the time of lawn mowing work and the turning angle at the boundary A, but the way of defining the work path D is not limited to this. For example, data (for example, a set of positional information) that specifies the trajectory of the work path D from the start to the end of the lawn mowing work at one time may be set in advance.
Further, the return path E is set to a path that linearly connects the end point of the lawn mowing work and the station 8, but the return path E is not limited to this and may include a curve or a turning point.
In addition, for example, the robot lawn mower 2 may generate slip rate distribution data 70 while the robot lawn mower 2 is making a test run in the lawn mowing area 4 prior to the lawn mowing work.
Further, for example, the case where the lawn mowing area 4 is demarcated by the area wire 6 has been exemplified, but the way of demarcating the lawn mowing area 4 is not limited to this.
For example, the area detection sensor unit 28A of the robot lawn mower 2 may be configured to acquire positional information of the boundary A (relative positional information with respect to the station 8 or absolute positional information obtained from GPS or the like), and the robot lawn mower 2 may determine whether it is located at the boundary A based on the detection signal of the odometry detection sensor unit 28B. In this case, the area detection sensor unit 28A may acquire the positional information of the boundary A from an external computer, or may acquire it from data stored in advance in the memory device 42 or the storage device 44.
Further, for example, the configuration may be such that markers that can be detected by a camera, a sensor, or the like are provided at appropriate intervals along the boundary A of the lawn mowing area 4 instead of the area wire 6, and the area detection sensor unit 28A of the robot lawn mower 2 detects these markers using a camera or a sensor to detect the boundary A obtained by connecting respective markers.
Further, for example, the robot lawn mower 2 identifies the slip reduction running speed Vs with the running speed V at which the slip rate λ becomes equal to or less than the second predetermined value λth2 when the vehicle passes the high slip point Pk, however, the slip reduction running speed Vs may be identified as follows. That is, the robot lawn mower 2 may identify in advance the relationship (λ-V dependency) between the slip rate λ and the running speed V when passing the high slip point Pk to calculate the slip reduction running speed Vs based on the relationship.
In addition, for example, the robot lawn mower 2 executes control to lower the running speed V below the slip generation running speed Vλ when passing the high slip point Pk during the lawn mowing running. However, the way of preventing slip generation is not limited to this, and the robot lawn mower 2 may avoid the high slip point Pk to autonomously run, in the same way as the return running. The operation during the lawn mowing running is realized, for example, in a way where the frequency of passing the high slip point Pk is set to “zero” in the above-mentioned passing point change control so that the path avoiding (not passing) the high slip point Pk is set for the work path D.
The functional blocks shown in
Furthermore, an external computer (personal computer, smartphone, server computer, or the like) that communicates with the robot lawn mower 2 may include a part of the functional configuration of the control unit 30 shown in
The present invention can be applied not only to the robot lawn mower 2 that performs lawn mowing work while autonomously running, but also to any autonomous running working machine that performs any work while autonomously running.
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/JP2018/013912 | 3/30/2018 | WO | 00 |
