Work Path Determination Device

By dividing the work area into regions along obstacle boundaries and optimizing the selection of adjacent regions, the work route determination process is streamlined, reducing processing load and U-turns, ensuring comprehensive coverage.

JP7577518B2Active Publication Date: 2024-11-05NIPPON SIGNAL CO LTD
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
JP2020195484
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2020-11-25
Publication Date
2024-11-05
Estimated Expiration
2040-11-25

AI Technical Summary

Technical Problem

The processing load for determining a work route is high when obstacles are present in the work area due to varying positions, shapes, and sizes, especially without any reference, leading to increased complexity and computational burden.

Method used

The work area is divided into multiple regions along straight lines touching obstacles, and a work route is determined by sequentially selecting adjacent regions, prioritizing those with the longest continuous lengths or largest areas, reducing the number of U-turns and optimizing the route to cover the entire area efficiently.

Benefits of technology

This approach reduces processing load and minimizes the number of U-turns, ensuring complete coverage of the work area while maintaining an efficient work route that avoids obstacles effectively.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007577518000001
    Figure 0007577518000001
  • Figure 0007577518000002
    Figure 0007577518000002
  • Figure 0007577518000003
    Figure 0007577518000003
Patent Text Reader

Abstract

To reduce a load of processing for determining a working path in the case where there is an obstacle in a work object area.SOLUTION: An information acquisition unit 11 acquires area information and obstacle information. A working path determination unit 12 divides a work object area shown by the acquired area information into a plurality of division areas by a straight line coming into contact with an obstacle shown by the acquired obstacle information. The working path determination unit 12 sequentially selects an adjacent division area from a work start area or an origin area, and selects a division area group on the working path. The working path determination unit 12 redetermines a working path in the case where there is an unselected division area in the work object area even though there is no unselected division area adjacent to the last selected division area group. The working path determination unit 12 determines a movement path of a cleaning robot 20 on the basis of working paths selected so far in the case of determining that there is no unselected division area in the work object area.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a technique for determining a work path. [Background technology]

[0002] Patent Document 1 discloses a technology for determining a work route in which, each time an obstacle is detected ahead in the direction of travel, new latest driving route information is generated that enables the entire uncleaned area excluding the location of the obstacle to be cleaned in the shortest driving distance, the robot drives based on the latest driving route information and driving position information, and, upon completion of the drive, final driving route information is generated that enables the location of the obstacle to be cleaned in the shortest driving distance. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2010-17428 A Summary of the Invention [Problem to be solved by the invention]

[0004] It is desirable to have a small processing load when performing processing to determine a work path as in Patent Document 1. If there is an obstacle in the work area, it is necessary to determine a work path that avoids the obstacle, but since the positions, shapes, and sizes of obstacles vary, the processing load for determining the work path is likely to be large. In view of the above background, an object of the present invention is to reduce the processing load for determining a work path when an obstacle is present in a work area. [Means for solving the problem]

[0005] In order to solve the above-mentioned problems, the present invention provides, in a first aspect, a work path determination device that divides a work area, including an obstacle, into a number of divided areas by straight lines tangent to the obstacles, and determines a work path by sequentially selecting adjacent divided areas from the divided area where work is to be started.

[0006] According to the work path determination device of the first aspect, it is possible to reduce the processing load for determining a work path when there is an obstacle in the work target area, compared to when divided areas are not used.

[0007] In the work path determination device of the first aspect described above, a configuration may be adopted as a second aspect in which a plurality of divided areas in a direction in which the length of the unselected divided areas continuing from the divided area where the work is to be started is the longest are selected as the first group of divided areas on the work path.

[0008] According to the work route determination device of the second aspect, it is possible to make it easier for the number of U-turns included in the work route to be reduced.

[0009] In the work path determination device of the second aspect described above, a third aspect may be adopted in which one or more unselected divided areas adjacent to the last selected group of divided areas in the direction in which the length of the continuous unselected divided areas is longest are selected as a new group of divided areas on the work path.

[0010] According to the work route determination device of the third aspect, it is possible to make it easier for the number of U-turns included in the work route to be reduced.

[0011] In the work path determination device of the first aspect described above, a configuration may be adopted as a fourth aspect in which a plurality of divided areas in a direction in which the area of ​​the unselected divided areas continuing from the divided area where work is to be started is the largest are selected as the first group of divided areas on the work path.

[0012] According to the work path determination device of the fourth aspect, it is possible to make it easier for work to be carried out in larger areas of the work target area first.

[0013] In the work path determination device of the fourth aspect described above, a configuration may be adopted as a fifth aspect in which one or more unselected divided areas adjacent to the last selected group of divided areas in a direction in which the area of ​​the continuous unselected divided areas is the largest are selected as a new group of divided areas on the work path.

[0014] According to the work path determination device of the fifth aspect, it is possible to make it easier for work to be carried out first in larger areas of the work target area.

[0015] In the work path determination device of the third or fifth aspect described above, a configuration may be adopted as a sixth aspect in which, if any unselected divided area is not adjacent to the last selected group of divided areas, the unselected divided area is selected as the next divided area on the work path after the selected divided area adjacent to the unselected divided area.

[0016] According to the operation path determination device of the sixth aspect, it is possible to eliminate unselected divided areas.

[0017] In the work path determination device of any one of the first to sixth aspects above, a configuration may be adopted as a seventh aspect in which a movement path within one or more divided areas that are continuous in one direction on the work path is determined, the movement path within the divided area being scanned throughout the entire area of ​​the one or more divided areas by moving in the direction in which the length of the one or more divided areas is longer and making a U-turn.

[0018] According to the work route determination device of the seventh aspect, it is possible to make it easier for the number of U-turns included in the work route to be reduced.

[0019] In the work path determination device of the seventh aspect described above, a configuration may be adopted as an eighth aspect in which the distance between adjacent straight portions of the movement path is set to be less than the width of the working range of a mobile device that moves while performing work along the movement path.

[0020] According to the work path determination device of the eighth aspect, it is possible to prevent any unworked area from remaining between adjacent straight line portions of the movement path.

[0021] In the work path determination device of the eighth aspect above, a configuration may be adopted as a ninth aspect in which a movement path is determined such that an unworked area is always included in the work range.

[0022] According to the work path determination device of the ninth aspect, it is possible to eliminate travel paths that do not involve any work in unworked areas. [Brief description of the drawings]

[0023] [Figure 1] FIG. 1 is a diagram illustrating a configuration of an automatic cleaning system according to an embodiment. [Diagram 2] A diagram showing an example of a work area [Diagram 3] FIG. 1 is a diagram for explaining a method for selecting a group of divided regions; [Figure 4] FIG. 1 is a diagram for explaining a method for reviewing the selection of a group of divided regions; [Diagram 5] A diagram for explaining how to determine a detailed work route [Figure 6] FIG. 1 is a diagram illustrating an example of an operation procedure in a route determination process. [Figure 7] FIG. 13 is a diagram for explaining a method for selecting a group of divided regions according to a modified example; DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0024] [1] Example 1 shows the configuration of an automatic cleaning system 1 according to an embodiment. The automatic cleaning system 1 includes a work path determination device 10 that determines a work path for cleaning a floor, and a cleaning robot 20 that automatically cleans floors while traveling autonomously. The cleaning robot 20 includes a traveling unit 21, a working unit 22, an operation control unit 23, and a work path storage unit 24.

[0025] The traveling unit 21 has a motor, gears, tires, etc., and drives the cleaning robot 20. The working unit 22 has a motor, gears, a rotating brush, a cleaning water launching mechanism, a squeegee, a storage unit for dirty water, etc., and rotates the brush to clean the floor surface with cleaning water, and then scoops up the dirty water that has become dirty from the cleaning water and takes it into the storage unit. The operation control unit 23 controls the operations of the traveling unit 21 and the working unit 22. The operation control unit 23 includes a processor, memory, and storage. The processor has, for example, an arithmetic device such as a CPU (Central Processing Unit), a register, peripheral circuits, etc.

[0026] The memory is a recording medium readable by the processor, and includes a RAM (Random Access Memory) and a ROM (Read Only Memory), etc. The storage is a recording medium readable by the processor, and includes, for example, a hard disk drive or a flash memory, etc. The processor controls the operation of the traveling unit 21 and the working unit 22 by executing programs stored in the ROM or the storage, using the RAM as a work area.

[0027] The work path memory unit 24 stores a work path represented by a movement path traveled by the device itself when cleaning a room. The operation control unit 23 refers to the work path memory unit 24 and controls the operation of the travel unit 21 so as to cause the device itself to travel along the stored work path (movement path). The operation control unit 23 also controls the operation of the work unit 22 so as to perform cleaning work while traveling along the work path. The work path memory unit 24 stores the work path transmitted from the work path determination device 10.

[0028] The work path determination device 10 is a device that determines a work path for the cleaning robot 20. The work path determination device 10 includes an information acquisition unit 11 and a work path determination unit 12. The information acquisition unit 11 acquires information necessary to determine a work path. The information acquisition unit 11 acquires, for example, area information indicating an area to be cleaned (hereinafter referred to as a "work area"), and obstacle information indicating the position, shape, and size of obstacles present in the work area.

[0029] The target work area is usually an area where the floor of a room is exposed, and the obstacles are, for example, pillars, protruding parts of walls, furniture, and the like that are arranged in the target work area. Fig. 2 shows an example of a work target area. In Fig. 2, a rectangular room viewed vertically from above is shown as work target area A1. Information acquisition unit 11 acquires, for example, the coordinates of the four corners of a two-dimensional coordinate system with the upper left corner of work target area A1 as the origin, as area information.

[0030] As shown in FIG. 2(a), obstacles B1 and B2 exist in the work target area A1. Both obstacles B1 and B2 have a rectangular shape when viewed vertically from above. The information acquisition unit 11 acquires, for example, the coordinates of the four corners of each of obstacles B1 and B2 in the above-mentioned two-dimensional coordinate system as obstacle information. The information acquisition unit 11 acquires data transmitted from an external device or data input to its own device as area information and obstacle information, and supplies the acquired information to the work path determination unit 12.

[0031] The work path determination unit 12 determines a work path for the cleaning robot 20 based on the supplied area information and obstacle information. Specifically, the work path determination unit 12 determines a work path as follows. First, the work path determination unit 12 divides a work target area that includes obstacles (B1 and B2 in the case of the work target area A1) such as the work target area A1 into multiple divided areas by straight lines tangent to the obstacles. In the example of FIG. 2, the work path determination unit 12 divides the work target area into 13 divided areas as shown in FIG. 2(b).

[0032] In the example of Fig. 2, the work path determination unit 12 divides the work target area A1 into divided areas D1-D13 by tangent lines C1, C2, C3, and C4 that are tangent to the upper, lower, left, and right sides of obstacle B1, respectively, and tangent lines C5 and C6 that are tangent to the left and right sides of obstacle B2, respectively. Note that in the example of Fig. 2, tangent lines C1 and C2 are tangent to the upper and lower sides of obstacle B2, respectively. The divided areas D1-D5 are areas obtained by dividing the area of ​​the work target area A1 above tangent line C1 by the four tangent lines C3-C6.

[0033] Of the work target area A1, divided area D6 is an area surrounded by tangent lines C1, C2, and C3, and divided area D7 is an area surrounded by tangent lines C1, C2, C4, and C5. Divided area D8 is an area surrounded by tangent lines C1, C2, and C6. Also, of the work target area A1, divided areas D9 to D13 are areas obtained by dividing the area below tangent line C2 by the four tangent lines C3 to C6.

[0034] Next, the work path determination unit 12 sequentially selects adjacent divided areas from the divided area where work starts (hereinafter referred to as the "work start area") to determine the work path. For example, the work path determination unit 12 determines the divided area D1 with the smallest code value as the work start area. The work path determination unit 12 selects multiple divided areas in the direction in which the length of the unselected divided areas continuing from the work start area (hereinafter referred to as the "unselected continuous areas") is the longest as the first group of divided areas on the work path.

[0035] Fig. 3 is a diagram for explaining a method for selecting a group of divided areas. Fig. 3 shows the work target area A1 and divided areas D1 to D13 shown in Fig. 2. The work path determination unit 12 calculates the length of an unselected continuous area in a direction (rightward) toward divided area D2 adjacent to divided area D1, which is the work start area, and in a direction (downward) toward divided area D6 adjacent to divided area D1, which is also the work start area. In the example of Fig. 3, divided areas D2 to D5 exist as unselected continuous areas to the right, and divided areas D6 and D9 exist as unselected continuous areas to the downward.

[0036] The length along the right direction of the divided regions D1 to D5, which are unselected continuous regions, is longer than the length along the downward direction of the divided regions D1, D6, and D9, which are also unselected continuous regions. Therefore, the work path determination unit 12 selects the divided regions D1 to D5 as the first group of divided regions on the work path, as shown in Figure 3(a). Note that the unselected continuous region does not necessarily have to be multiple divided regions, and may be a single divided region.

[0037] The work path determination unit 12 selects one of the first group of divided areas that is adjacent to an unselected divided area (hereinafter referred to as the "starting area") to serve as the starting point of the next group of divided areas. When there are multiple divided areas that are adjacent to unselected divided areas, the work path determination unit 12 selects the starting area according to the following priority order: First, the work path determination unit 12 assigns a numerical value included in the code to each divided area (for example, assigning "2" to divided area D2).

[0038] The work path determination unit 12 selects, as the starting area, the divided area at both ends of the divided area group (divided areas D1 and D5 in the example of FIG. 3) that has the smaller assigned numerical value (divided area D1 in the example of FIG. 3). If there is no unselected divided area adjacent to the divided area at both ends with the smaller numerical value, the work path determination unit 12 selects the divided area at both ends with the larger numerical value as the starting area.

[0039] When neither of the divided areas at both ends has an unselected divided area adjacent thereto, the work path determination unit 12 selects, as the starting area, one of the divided areas other than the two ends that has an unselected divided area adjacent thereto and has the smallest numerical value. In the example of Fig. 3, the work path determination unit 12 selects the divided area D1 as the next starting area, as described above. The work path determination unit 12 determines, as the work path, a path that passes through the selected divided areas in sequence and a path to the divided area that will be the next starting area.

[0040] In the example of Fig. 3, the work path determination unit 12 determines, as the work path, a path that goes from divided area D1 to D5, turns back from there, and goes to divided area D1, which is the next starting area, as shown in Fig. 3(a). After selecting a group of divided areas on the initial work path in this way, the work path determination unit 12 then selects, as a new group of divided areas on the work path, one or more divided areas in the direction in which the length of the unselected continuous area (continuous unselected divided areas) is the longest, from among the unselected divided areas adjacent to the last selected group of divided areas.

[0041] In the example of Fig. 3, the divided area D1, which is the starting area, is adjacent to unselected divided areas only in the downward direction, so the length of the continuous unselected divided areas is the longest in the downward direction. Therefore, the work path determination unit 12 selects the divided area D1, which is the starting area, and the unselected divided areas D6 and D9, which are continuous in the downward direction, as the next group of divided areas on the work path, as shown in Fig. 3(b).

[0042] The work path determination unit 12 selects divided area D9 as the next starting area because divided area D9 is the only unselected divided area adjacent to it among the selected group of divided areas. Since unselected divided areas are adjacent to divided area D9 only to the right, the work path determination unit 12 selects unselected divided areas D9-D13, which are continuous to the right, as the next group of divided areas on the work path, as shown in FIG.

[0043] Since there are two unselected divided areas adjacent to the selected divided area group, D11 and D13, the work path determination unit 12 selects the divided area D13, which has the larger assigned numerical value among both ends of the divided area group, as the next starting area according to the above-mentioned priority order. Since the unselected divided area D13 is adjacent only to the upper direction, the work path determination unit 12 selects the unselected divided areas D13 and D8, which are continuous upward, as the next divided area group on the work path, as shown in FIG. 3(c).

[0044] If none of the unselected divided areas are adjacent to the group of divided areas last selected, the work path determination unit 12 temporarily confirms the work path E1 connecting the groups of divided areas selected up to that point. When the work path determination unit 12 adopts the confirmed work path E1, it judges whether or not there are any unselected divided areas remaining in the work target area A1. If there are any unselected divided areas remaining, the work path determination unit 12 re-determines the work path so as to include the unselected divided areas.

[0045] Fig. 4 is a diagram for explaining a method of reviewing the selection of a group of divided areas. Fig. 4 shows the work target area A1 and divided areas D1-D13 shown in Fig. 3, and Fig. 4(a) shows the work path E1 determined in Fig. 3. As shown in Fig. 4(a), when the work path E1 shown in Fig. 3 is determined, the divided area D7 remains as an unselected divided area. In this case, the work path determination unit 12 re-determines the work path in the following procedure.

[0046] The work path determination unit 12 first identifies the divided area adjacent to the divided area D7 (divided areas D3 and D11 in the example of FIG. 4) that has the smallest assigned numerical value (divided area D3 in the example of FIG. 4). Even if there are multiple unselected divided areas, the work path determination unit 12 similarly identifies the divided area adjacent to those divided areas that has the smallest assigned numerical value as the interruption area.

[0047] Next, the work path determination unit 12 temporarily deletes from the work path those divided areas that continue after the identified interruption area among the divided areas included in the work path determined in the explanation of Fig. 3. As a result, the previously determined work path is interrupted up to the interruption area. Next, the work path determination unit 12 selects the identified interruption area and an unselected divided area adjacent to the interruption area (divided area D3, which is the interruption area, and unselected divided area D7 in the example of Fig. 4) as a group of divided areas on the next work path.

[0048] If there are multiple unselected divided areas adjacent to the identified interruption area at distant locations, the work path determination unit 12 selects the one with the smallest assigned numerical value as the group of divided areas on the next work path. Also, if there are further unselected divided areas continuously beyond the unselected divided area adjacent to the identified interruption area, the work path determination unit 12 selects the interruption area and the multiple unselected divided areas (unselected continuous areas) as the group of divided areas on the next work path.

[0049] In this way, when none of the unselected divided areas are adjacent to the group of divided areas selected last, the work path determination unit 12 selects the unselected divided area (divided area D7 in the example of FIG. 4) and the selected divided area (divided area D3 in the example of FIG. 4) adjacent to the unselected divided area on the work path as the next divided areas. After this, the work path determination unit 12 determines the work path by the method described in FIG. 3.

[0050] In the example of Fig. 4, since an unselected divided area is adjacent to the divided area D3, which is the divided area D3 with the smallest assigned numerical value, among the divided areas D3 and D7 at both ends of the selected divided area group, as shown in Fig. 4(b), the work path determination unit 12 determines the divided area D3 as the next starting area, as shown in Fig. 4(c). After that, the work path determination unit 12 selects the divided areas D3 to D5 as the next divided area group, as shown in Fig. 4(c).

[0051] Next, as shown in Fig. 4(c), the work path determination unit 12 selects divided areas D5, D8, and D13 as the next group of divided areas, selects divided areas D13, D12, D11, D10, and D9 as the next group of divided areas, and selects divided areas D9 and D6 as the next group of divided areas. The work path determination unit 12 temporarily confirms the work path E2 shown in Fig. 4(c). If the work path E2 is adopted, no unselected divided areas will remain in the work target area A1.

[0052] In this case, the work path determination unit 12 determines the work path E2 as the work path in the work target area A1, and determines a movement path for the cleaning robot 20 that scans the entire group of divided areas included in the work path E2. 5 is a diagram for explaining a detailed method for determining a work path. More specifically, the work path determination unit 12 determines a movement path by moving in the direction in which the length of one or more divided areas is longer and making a U-turn within one or more divided areas that are continuous in one direction on the work path.

[0053] For example, within divided regions D1 to D3 that are continuous in the right direction, the work path determination unit 12 determines a movement path by a movement to the right that is longer and a U-turn. In the example of Fig. 5, the work path determination unit 12 determines a path F1 for moving to the right, a path F2 for making a U-turn, a path F3 for moving to the left, a path F4 for making another U-turn, and a path F5 for moving to the right again, as shown in Fig. 5(a).

[0054] The work path determination unit 12 also determines a path F6 for making another U-turn after the path F5, a path F7 for moving left, a path F8 for making another U-turn, and a path F9 for moving right. In this way, the entire divided area group is included in the work range by the round-trip paths going back and forth within the divided area group. The work path determination unit 12 sets the interval between adjacent straight line portions (e.g., paths F1 and F3) in the round-trip paths to be equal to or less than the width of the work range of a moving device (in this embodiment, the cleaning robot 20) that moves while working along those movement paths.

[0055] If the interval between the straight line portions in the reciprocating path is made larger than the width of the working range, an unworked area will remain between the straight line portions when the cleaning robot 20 moves along the moving path. In this embodiment, by making the interval between the straight line portions equal to or smaller than the width of the working range, it is possible to prevent an unworked area from remaining between adjacent straight line portions of the moving path. In addition, the working path determination unit 12 determines the moving path so that an unworked area is always included in the working range.

[0056] Therefore, for example, in divided area D3, which is the starting area of ​​divided areas D3-D5, which is a group of divided areas, the work path determination unit 12 secures a margin G1 so that an unworked area remains up to the start position of the next work path, and determines paths F1-F9 so as not to overlap the margin G1. Furthermore, the work path determination unit 12 determines path F9 as the length to the start position H1 of the round-trip path in divided areas D3 and D7, which are the next group of divided areas.

[0057] The work path determination unit 12 determines a round trip path in the divided areas D3 and D7 following the path F9. The work path determination unit 12 determines this round trip path so as not to intersect with the round trip paths in the divided areas D1 to D3, which are the previous group of divided areas, as shown in Fig. 5(b). Then, the work path determination unit 12 determines the final path F11 of the round trip paths in the divided areas D3 and D7 as a length that passes through the margin G1 to the start position H2 of the round trip paths in the divided areas D3 to D5, which are the next group of divided areas.

[0058] Thereafter, the work path determination unit 12 determines the round trip path in the next divided area group as the path to the start position of the round trip path in the next divided area group, as shown in Fig. 5(b). As described above, the movement path is determined so that the unworked area is always included in the work range, thereby eliminating unnecessary movement paths where no work is performed in the unworked area. As a result, it is possible to make the movement path shorter compared to the case where an unnecessary movement path occurs.

[0059] After determining all the movement routes as described above, the work path determination unit 12 transmits the work path represented by the determined movement routes to the cleaning robot 20. The work path memory unit 24 of the cleaning robot 20 stores the transmitted work path, so that the cleaning robot 20 can move and work along the stored work path (movement route).

[0060] The work route determination device 10, with the above-described configuration, performs a route determination process for determining a work route. 6 shows an example of the operation procedure in the route determination process. First, the work route determination device 10 (information acquisition unit 11) acquires area information and obstacle information (step S11). Next, the work route determination device 10 (work route determination unit 12) divides the work target area indicated by the acquired area information into multiple divided areas by straight lines tangent to obstacles indicated by the acquired obstacle information (step S12).

[0061] Next, the work path determination device 10 (work path determination unit 12) sequentially selects adjacent divided areas from the work start area or origin area to select a group of divided areas on the work path (step S13). Next, the work path determination device 10 (work path determination unit 12) determines whether there is an unselected divided area adjacent to the last selected group of divided areas (step S14). If the work path determination device 10 (work path determination unit 12) determines that there is an adjacent unselected divided area (YES), it selects a starting area from the divided areas adjacent to the unselected divided areas (step S15) and returns to step S13 to select the next group of divided areas.

[0062] If the work route determination device 10 (work route determination unit 12) determines that there is no adjacent unselected divided area (NO), it determines whether or not there is an unselected divided area in the work target area (step S16). If the work route determination device 10 (work route determination unit 12) determines that there is an unselected divided area in the work target area (YES), it identifies an interruption area from the divided areas included in the group of divided areas selected so far (step S17).

[0063] Next, the work path determination device 10 (work path determination unit 12) deletes the divided areas following the identified interruption area (step S18), and returns to step S13 to select the next group of divided areas. If the work path determination device 10 (work path determination unit 12) determines that there are no unselected divided areas in the work target area (NO), it determines a movement path for the cleaning robot 20 based on the work paths selected so far (step S19). Then, the work path determination device 10 (work path determination unit 12) transmits the work path represented by the determined movement path to the cleaning robot 20 (step S20), and ends this operation procedure.

[0064] When there is an obstacle in the work area, the work path must be determined so as to avoid the obstacle, but the position, shape, and size of the obstacle vary, so the processing load for determining the work path is likely to be large. In particular, when determining a work path without any criteria in the work area, the degree of freedom is too high and the processing load is likely to be large. In this embodiment, by using the divided area, the number of patterns of the work path that can be determined is reduced compared to when the divided area is not used, and the processing load for determining the work path when an obstacle is present in the work area can be reduced.

[0065] For areas of the same area, the longer the straight line portion in the round trip route, the fewer the number of U-turns. In this embodiment, by selecting a group of divided areas in the direction in which the length of the unselected divided areas continuing from the work start area or origin area is the longest, it is possible to reduce the number of U-turns included in the work route in the entire work target area compared to when selecting a group of divided areas in the direction in which this length is the shortest. In addition, in this embodiment, the work route is re-determined when there is an unselected divided area, so that the unselected divided area can be eliminated.

[0066] The above-described embodiment is merely one example of the implementation of the present invention, and may be modified as follows. Furthermore, the embodiment and each modification may be combined as necessary.

[0067] [2-1] Obstacles In the embodiment, a rectangular obstacle whose sides are parallel to the rectangular work area is present, but this is not limited to this. For example, an obstacle may be rectangular whose sides are not parallel to the sides of the work area, or an obstacle may be a polygon other than a circle, ellipse, or square, or an irregular shape.

[0068] In such cases, the work path determination unit 12 may divide the rectangular work area into divided areas with the tangents to the obstacle being parallel to each side of the area. In this case, an area that is not included in any of the divided areas (hereinafter referred to as a "gap area") will be generated in the gap between the obstacle and the divided area, but if this area is small enough, it will not have a significant effect on the work and so it is not a problem if it is not included in the work range.

[0069] However, if this area is large, or if it is small but needs to be included in the work range, the work path determination unit 12 may determine the divided areas, for example, as follows: For example, the work path determination unit 12 may combine the gap area with a divided area adjacent to the gap area to determine a new divided area. If there are multiple divided areas adjacent to the gap area, the work path determination unit 12 may determine the divided areas to be combined according to a set priority order (for example, priority is given to the area with the smaller assigned number).

[0070] Moreover, the work path determination unit 12 may simply perform division by treating the gap area as it is as a divided area. According to this modification, regardless of the shape, orientation, and size of an obstacle present in the work area, the work area is divided into a plurality of divided areas based on the obstacle, so that, as in the embodiment, the processing load for determining a work path when an obstacle is present in the work area can be reduced.

[0071] [2-2] How to allocate to divided areas In the embodiment, the work path determination unit 12 assigns a numerical value to each divided area, but the method of assignment may be different from that in the embodiment. In the embodiment, the work path determination unit 12 assigns numerical values ​​in ascending order from the divided area in the upper left corner of the work target area to the divided areas arranged to the right.

[0072] Then, when the work path determination unit 12 reaches the rightmost divided area, it returns to the left end and repeats the allocation to the divided areas arranged to the right, starting from the divided area one below the already allocated divided area. In this modified example, the work path determination unit 12 may allocate in order from the largest numerical value, or may allocate in order from the divided areas at the upper right corner, lower left corner, and lower right corner of the work target area, instead of the upper left corner.

[0073] The work path determination unit 12 may also assign numbers in order to divided areas that are lined up to the left, top, or bottom instead of to the right. The work path determination unit 12 may also assign symbols with a fixed order, such as the alphabet or the Japanese syllabary, instead of assigning numbers. In short, it is sufficient that information is assigned that allows for formulating rules for determining the priority order of each divided area when one must be selected from two or more divided areas.

[0074] [2-3] How to select the starting area The work path determination unit 12 may select a starting point area in a method different from that of the embodiment. In the embodiment, the work path determination unit 12 selects a starting point area in the order of priority A>B>C (A is the highest priority, B if A is not available, and C if B is not available), where A is the divided area with the smallest numerical value among the divided areas at both ends, B is the divided area with the largest numerical value among the divided areas at both ends, and C is the divided area other than the divided areas at both ends that is adjacent to an unselected divided area and has the smallest numerical value.

[0075] In this modified example, the work path determination unit 12 may prioritize the divided areas as C>B>A, or as B>A>C. The work path determination unit 12 may also select the starting area by comparing unselected continuous areas in a direction in which the unselected divided area is adjacent among the divided areas included in the selected group of divided areas. Specifically, the work path determination unit 12 may select the divided area having the longest length of adjacent unselected continuous areas as the starting area.

[0076] The work path determination unit 12 may compare the length of the divided areas included in the selected group of divided areas, including the divided areas adjacent to the unselected continuous area. In this case, in the example of Fig. 3(a), the length of the divided areas D1 to D5 is compared with the length of the divided areas D1, D6, and D9. The work path determination unit 12 may select the unselected continuous area (or the area including the divided areas adjacent to it) with the largest area as the starting area.

[0077] [2-4] How to select the divided regions The work path determination unit 12 may select a group of divided areas by a method different from that of the embodiment. For example, the work path determination unit 12 selects a plurality of divided areas in a direction in which the area of ​​the unselected divided areas continuing from the work start area is the largest as the first group of divided areas on the work path. Fig. 7 is a diagram for explaining a method for selecting a group of divided areas in this modified example, in which a work area A11 in which only an obstacle B11 exists is shown.

[0078] The work path determination unit 12 divides the work target area A11 into divided areas D21 to D29. The work path determination unit 12 calculates the size of the continuous unselected divided areas in the direction toward divided area D22 adjacent to divided area D21, which is the work start area (rightward), and in the direction toward divided area D24 adjacent to divided area D21, which is also the work start area (downward).

[0079] The work path determination unit 12 selects divided areas D24 and D26 in the direction in which the calculated area increases (downward in the example of FIG. 7) and divided area D21, which is the work start area, as the first group of divided areas on the work path. After that, the work path determination unit 12 selects, as new groups of divided areas on the work path, one or more divided areas in the direction in which the area of ​​the continuous unselected divided areas is the largest, among the unselected divided areas adjacent to the last selected group of divided areas.

[0080] Fig. 7 is a diagram for explaining a method for selecting a divided area group in this modified example. Fig. 7(a) shows a work target area A11 that has an L-shape with a rectangular area connected to a part of another rectangular area and has an obstacle B11. In this case, the work path determination unit 12 divides the work target area A11 by determining a rectangular area A12 circumscribing the work target area A11 as the work target area and the area that is the difference from the work target area A11 as an obstacle B12, as shown in Fig. 7(b).

[0081] In the example of Fig. 7, the work path determination unit 12 divides the area into divided areas D21 to D29 by tangent lines C11, C12, C13, and C14 to obstacle B11, as well as tangent line C15 to obstacle B12, as shown in Fig. 7(b). When divided area D21 is set as the work start area, the work path determination unit 12 first compares the size of a group of divided areas including unselected divided areas D22 and D23 that are successive to the right, with the size of a group of divided areas including unselected divided areas D24 and D26 that are successive to the bottom.

[0082] In this case, since the former is larger, the work path determination unit 12 selects divided areas D21, D22, and D23 as the first group of divided areas, as shown in Fig. 7(c). For ease of explanation, it is assumed here that the work path determination unit 12 selects the starting area in the above-mentioned order of priority B>A>C (in this case, the divided area D23 is selected). Next, since the unselected divided areas are adjacent only downward, the work path determination unit 12 selects the downward divided areas D23, D25, and D28 as the next group of divided areas, as shown in Fig. 7(c).

[0083] Because the divided area D28 is the only adjacent unselected divided area, the work path determination unit 12 selects the divided area D28 as the starting area. The work path determination unit 12 compares the size of the unselected continuous area to the right of the divided area D28 with the size of the unselected continuous area to the left of the divided area D28, and selects the larger unselected continuous area to the right (divided area D29) and the starting area (divided area D28) as the next group of divided areas, as shown in FIG. 7(c).

[0084] In the example of Fig. 7, since an unselected divided area remains, the work path determination unit 12 identifies the interruption area and re-determines the work path. In this modification, for example, when selecting a group of divided areas from the divided area D21, the divided area on the right side, which is longer downward than on the right side but has a larger area, is selected. Also, when selecting a group of divided areas from the divided area D28, one unselected continuous area on the right side is selected instead of two unselected continuous areas on the left side.

[0085] In this modified example, as described above, by selecting a group of divided areas in the direction in which the unselected divided areas continuing from the work start area or starting point area are widest, it is possible to make it easier for work to be carried out in larger areas of the work area first, compared to when a group of divided areas is selected in the direction in which these areas are narrowest.

[0086] [2-5] Work In the embodiment, cleaning work was performed in the work area, but the work performed in the work area is not limited to this. For example, if the work area is a field, a drone may be used to spray pesticides. Also, if the work area is a paddy field, an autonomous rice planting machine may be used to plant rice.

[0087] Even if there is nothing in the paddy field or field that obstructs the movement of the rice planter or drone, if the work area is not rectangular, the difference between the rectangle circumscribing the work area can be regarded as an obstacle, as described in the explanation of Figure 7(b). In short, any work can be performed as long as it is performed in an area where an obstacle may exist.

[0088] [2-6] Invention Categories The present invention can be understood as an information processing method for realizing the processes performed by the automatic cleaning system 1, the work path determination device 10 and the cleaning robot 20, and as a program for causing a computer that controls the automatic cleaning system 1 to function. This program may be provided in the form of a recording medium such as an optical disk on which it is stored, or may be provided in the form of a program that is downloaded to a computer via a network such as the Internet and installed to make it available. [Explanation of symbols]

[0089] 1...automatic cleaning system, 10...work path determination device, 11...information acquisition unit, 12...work path determination unit, 20...cleaning robot, 21...traveling unit, 22...working unit, 23...motion control unit, 24...work path memory unit.

Claims

1. Dividing a work area including an obstacle into a plurality of divided areas by a straight line tangent to the obstacle, and determining a work path by sequentially selecting adjacent divided areas from the divided area in which work is to be started until there are no adjacent unselected divided areas; If an unselected divided area exists when the work path is determined, one of the divided areas adjacent to the unselected divided area is selected, and the unselected divided area is inserted in the order following the selected divided area, and a new work path returning to the selected divided area is determined. Work path determination device.

2. A plurality of divided areas in a direction in which the length of the continuous unselected divided areas from the divided area from which the work is started is the longest are selected as an initial group of divided areas on the work path. The work route determination device according to claim 1 .

3. Among the unselected divided areas adjacent to the last selected group of divided areas, one or more divided areas in a direction in which the length of the continuous unselected divided areas is the longest are selected as a new group of divided areas on the work path. The work route determination device according to claim 2.

4. A plurality of divided areas in a direction in which the area of ​​the continuous unselected divided areas from the divided area from which the work is started is the largest are selected as an initial group of divided areas on the work path. The work route determination device according to claim 1 .

5. Among the unselected divided areas adjacent to the last selected group of divided areas, one or more divided areas in a direction in which the area of ​​the continuous unselected divided areas is the largest are selected as a new group of divided areas on the work path.

5. The work route determination device according to claim 4.

6. If none of the unselected divided areas is adjacent to the group of divided areas last selected, the unselected divided area and a selected divided area adjacent to the unselected divided area on the work path are selected as the next divided areas.

6. The work route determination device according to claim 3 or 5.

7. A movement path within one or more divided regions that are continuous in one direction on the working path is determined, the movement path within the divided regions being scanned in the entire area of ​​the one or more divided regions by moving in the direction in which the length of the one or more divided regions is longer and making a U-turn. The operation route determination device according to any one of claims 1 to 6.

8. The distance between adjacent straight line portions of the moving path is set to be equal to or less than the width of the working range of a moving device that moves while working along the moving path. The operation route determination device according to claim 7.

9. Determine the movement route so that the unworked area is always included in the work range. The work route determination device according to claim 8.

Citation Information

Patent Citations

  • Working route determining device for working vehicle

    JP1988286910A

  • Mobile robot

    JP1991292513A

  • Map storing method and route preparing method using map

    JP1996016241A

  • Robot vacuum cleaner and robot vacuum cleaner control program

    JP2004033340A

  • Floor cleaning robot

    JP2010017428A