US 6,574,536 B1
`(10) Patent N0.:
`(12) Unlted States Patent
`
`Kawagoe et al.
`(45) Date of Patent:
`Jun. 3, 2003
`
`U5006574536B1
`
`(54) MOVING APPARATUS FOR EFFICIENTLY
`MOVING ON FLOOR WITH OBSTACLE
`
`(75)
`
`.
`.
`Inventors Nopulfazu Kawagoe’ Toyonalfa UP)’
`Yulchl Kawakaml, Itami (JP), Kyoko
`.
`.
`NEIkamura, TOYOPaka (JP), Yasuhlsa
`Klnt0,Amagasak1(JP)
`
`(73) Assignee: Minolta Co., Ltd., Osaka (JP)
`
`( * ) Notice:
`
`Subject to any disclaimer, the term of this
`patent is extended or adjusted under 35
`U50 1540)) by 799 days'
`
`(21) Appl. No.: 08/789,127
`
`(22)
`(30)
`
`Jan. 27, 1997
`F11ed:
`Foreign Application Priority Data
`
`Jan. 29, 1996
`Jan. 29, 1996
`Mar. 29, 1996
`
`(JP)
`(JP)
`(JP)
`
`............................................. 8—013134
`
`............ 8—013225
`............................................. 8—076953
`
`Int. Cl.7 ........................... G01C 22/00; G05D 1/00
`(51)
`(52) us. Cl.
`............................ 701/23, 701/24, 15/533;
`15/98; 15/319, 318/568.1; 318/568.12;
`318/568.13; 901/1; 901/5
`(58) Field of Search .............................. 701/23, 24, 25,
`701/26, 27, 117, 118, 301, 302; 318/587,
`568.12, 580; 15/340.1, 319, 325, 49.1,
`53.3, 98; 901/1, 2, 3, 180/167, 168, 279,
`169
`
`(56)
`
`References Cited
`U.S. PATENT DOCUMENTS
`
`4,473,787 A
`4,700,427 A
`4,780,817 A
`4,802,096 A
`4,920,520 A
`4,962,453 A
`4982329 A
`5,032,775 A
`5,036,935 A
`5,179,329 A
`5,220,263 A
`
`
`
`9/1984 Schick ....................... 318/587
`10/1987 Knepper
`.. 15/319
`10/1988 Lofgren ..............
`.. 701/23
`.
`1/1989 Hainsworth et a1.
`. 364/461
`.........
`4/1990 Gébel et a1.
`367/99
`
`10/1990 Pong et al.
`701/25
`
`1/1991 Tabata et al.
`701/25
`
`..
`7/1991 Mizuno et al.
`318/587
`8/1991 Kohara .................... 180/168
`
`..
`1/1993 Nishikawa et a1.
`318/587
`............... 318/587
`6/1993 Onishi et al.
`
`5,280,431 A
`........ 701/23
`1/1994 Summerville et a1.
`5,283,739 A
`........ 701/23
`2/1994 Summerville et al.
`5,305,217 A
`4/1994 Nakamura et al. ......... 701/25
`5,353,224 A
`10/1994 Lee et a1. .............. 701/25
`
`5,402,051 A
`3/1995 Fujiwara et a1.
`..
`318/587
`
`5 434 490 A
`7/1995 1 h‘d
`,
`,
`s 1 a et al.
`......
`318/587
`
`5,488,277 A
`1/1996 Nishikawa et a1.
`318/587
`5,548,511 A
`8/1996 Bancroft ................... 701/23
`
`5,568,589 A
`10/1996 Hwang ................
`. 706/52
`
`5,613,261 A *
`3/1997 Kawakami et a1.
`15/98
`5,636,402 A *
`...........
`6/1997 Kubo et a1.
`15/98
`
`5,652,489 A *
`318/587
`7/1997 Kawakami ........
`
`5,696,675 A * 12/1997 Nakamura et a1. ......... 701/25
`..
`.. 356/3.12
`5,717,484 A *
`2/1998 Hamaguchi et al.
`
`.. 15/340.1
`5,720,077 A *
`2/1998 Nakamura et al.
`.................... 15/98
`5,735,959 A *
`4/1998 Kubo et al.
`FOREIGN PATENT DOCUMENTS
`
`61—245215
`JP
`62454008
`JP
`2—127378
`JP
`3—184105
`JP
`5—165517
`JP
`5‘257533
`JP
`6—119035
`JP
`7—47045
`JP
`746204
`JP
`* cited by examiner
`
`10/1986
`7/1987
`5/1990
`8/1991
`7/1993
`10/1993
`4/1994
`2/1995
`3/1995
`
`Primary Examiner—Jacques H. Louis-Jacques
`(74) Attorney, Agent, or Firm—McDermott, Will & Emery
`
`(57)
`
`ABSTRACT
`
`A moving robot first moves straight in a first forward path.
`When encountering an obstacle such as shelf,
`the robot
`makes a U-turn to move straight in a backward path located
`with a prescribed distance away from the first forward path.
`When encountering another obstacle, the robot again makes
`a U-turn to move straight in a second forward path extending
`in the same direction as that of the first forward path but
`located with a distance away from the backward path. When
`the robot exceeding the point of the U-turn in the first
`forward path is detected during running in the second
`forward path, presence of a region where the robot has not
`run yet is recognized, and running in that region is carried
`out thereafter.
`
`27 Claims, 22 Drawing Sheets
`
` #101
`
`MEASURE DISTANCE TO
`RIGHT AND LEFT OBSTACLES
`
`
`
` #102 MOVE TOWARD CLOSER
`OBSTACLE (0N WORKING
`STAFIT SIDE) AND FOLLOW IT
`I
`x0=o.yo=0
`x1=Xmax,y1=YI'nax
`
`#—
`4‘ ‘04 CALCULATE THANSVERSE
`MOVEMENT PITCH P0 BASED ON
`DISTANCE T0 FURTHER OBSTACLE
`(ON WORKING COMPLETION SIDE)
`
`#103
`
`#105
`
`#106
`
`
`
`
`
`I
`
`ZIGZAG RUNNING
`
`I
`
`Silver Star Exhibit 1007
`
`Silver Star Exhibit 1007
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 1 0f 22
`
`US 6,574,536 B1
`
`FIG. 1
`
`
`
`Silver Star Exhibit 1007 - 2
`
`Silver Star Exhibit 1007 - 2
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 2 0f 22
`
`US 6,574,536 B1
`
`
`
`Silver Star Exhibit 1007 - 3
`
`Silver Star Exhibit 1007 - 3
`
`

`

`FIG. 4
`
`TEACH D
`
`OPERATE III
`
`
`
`
`
`mama'S'fl
`
`€00Z‘9°unf
`
`ZZJ09193IIS
`
`Ia999‘17Ls‘930
`
`Silver Star Exhibit 1007 - 4
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 4 0f 22
`
`US 6,574,536 B1
`
`FIG. 5
`
`START RUNNING BY SETTING "ZIGZAG"
`
`LONGITUDINAL §_0_Qcm TRANSVEFISE -cm END _L
`
`
`
` DISPLAY
`
`CONTROL
`UNIT
`
`
`
`
`
`
`CONTROLLER
`INF’UT
`EXTERNAL
`CONTROL
`
`
`INTERFACE
`
`
`UNIT
`
`
`
`CONTROL
`
`
`
`
`48 COMMUNI-
`
`COM MUNI-
`CATION
`
`CONTROL
`CATION
`
`UNIT
`UNIT
`
`
`Silver Star Exhibit 1007 - 5
`
`Silver Star Exhibit 1007 - 5
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 5 0f 22
`
`US 6,574,536 B1
`
`FIG. 6
`
`73
`
`LIQUID
`
`DETECTING
`SENSOR
`
`PUMP
`
`ROTOR
`
`22
`
`9
`
`25
`
`CLEANING
`
`
`PORTION
`MOVING
`
`
`ROTOR
`78
`
`GYRO-
`
`SENSOR
`
`6a
`
`7
`
`FORWARD
`OBSTACLE
`ENSOR
`
`LE FT-HAND
`
`
`
`DISTANCE
`MEASURING
`
`
`SENSOR
`3a
`
`LEFT-HAND
`DRIVE
`WHEEL
`
`
`
`DISPLAY
`CONTROL
`k
`
`
`
`
`
`PUMP
`CONTROL
`
`INPUT
`
`
`CONTROL
`WORKING
`PORTION
`‘
`
`MEMORY
`CPU
`
`
`CARD
`READING
`
`
`UNIT
`
`
`
` POWER
`SUPPLY
`
`CIRCUIT
`
`
`ROTOR
`CONTROL
`l
`
`
`
`CLEANING
`PORTION
`DRIVE
`
`
`CONTROL
`
`
`UNIT
`
`
`
`DISPLAY
`UNIT
`
`1"
`
`IIIIDNT
`
`MEMORY
`CARD
`
`13
`
`20
`
`BATTERY
`
`3g
`
`FOLLOWING
`SENSOR
`
`8a-8d
`
`6b
`
`
`
`
`
`
`
`RIGHT-HAND
`DISTANCE
`MEASURING
`
`SENSOR
`
`
`
`-HAND
`LE
`RUNN'NG
`RIGHT-HAND
`
`DRIVE
`PORTION
`DRIVE
`MOTOR
`CPU
`MOTOR
`
`5a
`
` RIGHT-HAND
`
`
`LEFT-HAND
`ROTATION
`ROTATION
`
`
`
`SPEED
`SPEED
`
`
`
`DETECTING
`DETECTING
`
`
`
`ENCODER
`ENCODER
`
`
`
`
`
`
`
`COMM NI-
`
`OPERATION
`PITCH TC.
`CATION
`CONTROL
`STORAGE
`
`
`
`UNIT
`UNIT
`UNIT
`
`
`
`
`
`
`MAIN B 0 DY
`
`ROTATION
`CONTROL UNIT
`
`
`RIGHT-HAND 3b
`DRIVE
`WHEEL
`
`68
`
`MAI BODY
`ROTATION
`MOTOR
`
`Silver Star Exhibit 1007 - 6
`
`Silver Star Exhibit 1007 - 6
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 6 0f 22
`
`US 6,574,536 B1
`
`FIG. 8
`
`#101
`
`MEASURE DISTANCE TO
`
`RIGHT AND LEFT OBSTACLES
`
`
`#102
`MOVE TOWARD CLOSER
`OBSTACLE (ON WORKING
`
`
`
`START SIDE) AND FOLLOW IT
`
`# 103
`
`x0=0,y0=0
`x1=Xmax,y1=Ymax
`
`# 104 CALCULATE TRANSVERSE
`
`MOVEMENT PITCH P0 BASED ON
`
`DISTANCE TO FURTHER OBSTACLE (ON WORKING COMPLETION SIDE)
`
`#105
`
`#106
`
`MF=0
`
`ZIGZAG RUNNING
`
`END
`
`Silver Star Exhibit 1007 - 7
`
`Silver Star Exhibit 1007 - 7
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 7 0f 22
`
`US 6,574,536 B1
`
`FIG. 9
`
`ZIGZAG RUNNING
`
`# 201 START MOVING STRAIGHT
`
`
` ANY OTHER
`CLOSER OBSTACLE FOUND
`ON WORKING COMPLETION
`SIDE?
`
`NO
`
`
`
`
`
`# 204
`
`CALCULATE TRANSVERSE MOVEMENT PITCH P0
`
`
`NO
`# 206
`
`
`
`OBSTACLE
`
`YES
`
`STORE MF ,PO, x1, y0
`IN STACK
`
`RUN REMAINING
`
`WORKING REGION
`
`# 208
`
`
`
`
`
`RESTORE MF, PO,
`x1, yo FROM STACK
`
`#210—
`
`Silver Star Exhibit 1007 - 8
`
`Silver Star Exhibit 1007 - 8
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 8 0f 22
`
`US 6,574,536 B1
`
`FIG. 10
`
`
`
`
`
`PITCH P0 IN WORKING
`COMPLETION DIRECTION
`
`AND MAKE U-TURN
`
` MOVE TRANSVERSELY BY
`
`PITCH PO IN WORKING
`
`
`
`.
`LANE ALONG
`COMPLETION DIRECTION
`
`
`CLOSEST OBSTACLE ON
`
`
`AND MAKE U-TURN
`
`WORKING COMPLETION
`
`SIDE?
`
`
`RETURN
`
`#215
`
`
`
`MOVE STRAIGHT
`
`TO y=y0
`
`
`
`#216 a
`
`#217
`
`NO
`
`YES
`
`RUN LANE ON WORKING
`
`COMPLETION SIDE
`
`
`
`
`
`COMPLETION DIRECTION
`AND MAKE U-TURN
`
`MOVE TRANSVERSELY BY
`PITCH P0 IN WORKING
`
`
`
`
`
`Silver Star Exhibit 1007 - 9
`
`Silver Star Exhibit 1007 - 9
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 9 0f 22
`
`US 6,574,536 B1
`
`FIG. 11
`
`#300
`
`REMAINING WORKING
`REGION RUNNING
`
`
`
`
`
`
`#301 MEASURE DISTANCE D TO
`OBSTACLE ON WORKING START SIDE
`
`# 302
`
`NO
`
`#303
`
`
`NO ®
`
`
`MOVE TRANSVERSELY TOWARD SET NUMBER OF LANES IN REMAINING
`
`OBSTACLE ON WORKING START WORKING REGION TO 3 AND CALCULATE
`SIDE AND FOLLOW OBSTACLE
`TRANSVERSE MOVEMENT PITCH P0
`
`
`MOVE TRANSVERSELY TOWARD
`WORKING COMPLETION SIDE BY
`
`D AND FOLLOW OBSTACLE
`
`# 307 SET NUMBER OF LANES IN
`REMAINING WORKING REGION T01
`
`
`
`
` START MOVING STRAIGHT
`
`# 308
`
`
`YES
`
`#309 w
`
`
`STORE PRESENCE OF
`
`UNWORKED REGION
`
`ANY OTHE '
`BESIDE OBSTACLE
`
`
`CLOSER OBSTACLE FOUND 0
`WORKING COMPLETION
`
`NO
`
`
`
`# 314
`FORWARD
`OBSTACLE?
`
`NO
`
`
`
`#315 a
`
`YES
`
`Silver Star Exhibit 1007 - 10
`
`Silver Star Exhibit 1007 - 10
`
`

`

`
`
`mama'S'fl
`
`LI
`1%
`g
`g
`w
`
`m
`E;
`
`E
`:3
`
`t:
`CI)
`
`9U
`
`]
`\l
`
`6
`
`FIG. 12
`
`#322
`
`
`
`NO
`
`
`#316
`
`NUMBER OF
`
`LANES IN REMAINING
`
`
`WORKING REGION
`
`
`#317
`COMPLETED.
`
`
`MOVE TRANSVERSELY BY
`PITCH Po IN WORKING START
`YES
`DIRECTION AND MAKE u-TURN
`
`y0=y,y1=Ymax
`
`#323
`
`MOVE TO END OF
`ANY
`
`
`UNWORKED REGION ON
`
`WORKING START SIDE
`NWORKED REGION
`
`
`BESIDE OBSTACLE
`
`'RESENT’?
`
`
`
`NO
`
`# 324
`CALCULATE NUMBER OF
`LANES AND TRANSVERSE
`
`MOVEMENT PITCH
`.
`
`
`BASED ON (x1-x)
`ROTATE BY 90 TOWARD
`
`
`WORKING COMPLETION SIDE,
`
`
`MOVE STRAIGHT TO x=x1, AND
`# 325
`
`
`I—I FURTHER ROTATE BY 90°
`
`
`TOWARD OPPOSITE DIRECTION
`
`
`MOVE STRAIGHT TO y=y0
`
`# 318
`
`# 319
`
`MOVE TRANSVERSELV BY
`PITCH PO IN WORKING START
`
`DIRECTION AND MAKE LI-TURN
`
`Silver Star Exhibit 1007 - 11
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 11 0f 22
`
`US 6,574,536 B1
`
`FIG. 13
`
`WORKING COMPLETION
`
`SIDE LANE RUNNING
`
`#401
`
`# 402 CHANGE WORKING START DIRECTION
`WITH WORKING COMPLETION DIRECTION
`
`
`
`
`
`AND REVERSE POSITIVE AND NEGATIVE
`
`
`DIRECTIONS OF x- AND y-AXES
`
`
`# 403
`
`
`x=0, y=0, y0=0
`x1=x, y1=Ymax
`
`
`
`# 404 MEASURE DISTANCE De TO
`
`OBSTACLE ON WORKING
`
`START SIDE
`
`#405
`
`De > Do 2
`
`YES
`
`
`
`NO
`
`CALCULATE NUMBER OF
`
`LANES AND TRANSVERSE
`
` #407
`MOVEMENT PITCH PO
`
`NUMBER OF LANES =1
`BASED ON De
`
`
`
`#408 MOVE TOWARD OBSTACLE ON WORKING
`
`START SIDE AND FOLLOW OBSTACLE
`
`# 409 I ZIGZAG RUNING I
`
`Silver Star Exhibit 1007 - 12
`
`Silver Star Exhibit 1007 - 12
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 12 0f 22
`
`US 6,574,536 B1
`
`FIG. 14
`
`\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\‘J
`
`‘\
`
`\§\\§\x\\\x\xxxxxxx\§§§§
`
`FORWARD
`
`MOVING
`
`DIRECTION
`
`BACKWARD
`
`MOVING
`
`DIRECTION
`
`
`
`.§§\§\§§§/
`
`/
`
`WORKING
`
`
`START
`DIRECTION
`
`WORKING
`
`PROCEEDING
`DIRECTION
`
`
`
`Silver Star Exhibit 1007 - 13
`
`Silver Star Exhibit 1007 - 13
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 13 0f 22
`
`US 6,574,536 B1
`
`FIG. 15
`
`\
`\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
`
`\ W
`
`‘\\\\\\\\\\\\V\\.\\\.\\\\\\\\\.\\\\\\\\\\\\\\\\\\\\\K‘\\\\\\\\\\\\.\\\\\\\\h“\\\‘\\\\\\\V\\\\\\\\‘\5*
`
`E.Ill,\«Infill_rut-II]-%h_Ia-
`
`\\\\\\\\\5‘\\\\\\V\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\‘\\\\
`
`\ \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
`
`Silver Star Exhibit 1007 - 14
`
`Silver Star Exhibit 1007 - 14
`
`
`
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 14 0f 22
`
`US 6,574,536 B1
`
`FIG. 16
`
`\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
`\\\\\\\\
`
`\I.I3\fl\fl-\\%\\\\\\\\\\\\\\\\\\\V
`
`\\\\\\\i\,\\\\\\\\\\\\\\\\VV\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\§
`nni—MW..
`
`II
`
`_.I
`
`lI\w{iwig_I..\\§_«-
`
`,_
` \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
`\“\w
`
`
`
`Silver Star Exhibit 1007 - 15
`
`Silver Star Exhibit 1007 - 15
`
`
`
`
`
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 15 0f 22
`
`US 6,574,536 B1
`
`FORWARD
`MOVING
`
`DIRECTION
`
`BAC KWARD
`
`MOVING
`DIRECTION
`
` ll!
`
`
`
`all
`.\\\_'\\§\‘\\\///
`
`
`
`
`
`WORKING
`
`START
`DIRECTION
`
`———————>
`
`WORKING
`
`PROCEEDING
`DIRECTION
`
`Silver Star Exhibit 1007 - 16
`
`Silver Star Exhibit 1007 - 16
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 16 0f 22
`
`US 6,574,536 B1
`
`FIG. 18
`
`CALCU LATE
`PITCH
`
`310
`
`SET REFERENCE RUNNING WIDTH TO
`
`(RUNNING WIDTH-WORKING WIDTH)
`
`S11
`
`SET MAXIMUM RUNNING PITCH TO (WORING
`
`WIDTH-MINIMUM WORKING MARGIN)
`
`
`
`COMPLETE WORKING
`
`ON THIS SIDE?
`
`
`
`
`
`SET NUMBER OF TIMES
`
`OF RECIPROCATION TO
`
`OF RECIPROCATION TO
`
`
`
`
`SET NUMBER OF TIMES
`
`ODD NUMBER
`EVEN NUMBER
`
`
`
`
`S14
`
`OBTAIN MINIMUM NUMBER OF TIMES
`
`OF RECIPROCATION WITH REFERENCE
`
`MAXIMUM RUNNING PITCH
`
`RUNNING WIDTH BY AT MOST
`
`815
`
`SET PITCH TO REFERENCE RUNNING
`
`
`
`WIDTH/ (NUMBER OF TIMES OF
`RECIPROCATION -1)
`
`COMPLETE PITCH
`
`CALCULATION
`
`Silver Star Exhibit 1007 - 17
`
`Silver Star Exhibit 1007 - 17
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 17 0f 22
`
`US 6,574,536 B1
`
`FIG. 19
`
`
`
`Silver Star Exhibit 1007 - 18
`
`Silver Star Exhibit 1007 - 18
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 18 0f 22
`
`US 6,574,536 B1
`
`FIG. 20A
`
`101
`
`
`
`FIG. ZOB
`
`
`
`Silver Star Exhibit 1007 - 19
`
`Silver Star Exhibit 1007 - 19
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 19 0f 22
`
`US 6,574,536 B1
`
`FIG. 21
`
`
`
`FIG. 22
`
`
`
`100
`
`Silver Star Exhibit 1007 - 20
`
`Silver Star Exhibit 1007 - 20
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 20 0f 22
`
`US 6,574,536 B1
`
`FIG. 23
`
`
`
`FIG. 24
`
`
`
`Sllver Star Exhlblt 1007 - 21
`
`Silver Star Exhibit 1007 - 21
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 21 0f 22
`
`US 6,574,536 B1
`
`FIG. 25
`
`101a
`
`101b
`
`I
`
`101C
`
`100 I.
`
`FIG. 26
`
`RELATED ART
`
`100.;
`
`, .,
`
`Silver Star Exhibit 1007 - 22
`
`Silver Star Exhibit 1007 - 22
`
`

`

`US. Patent
`
`Jun. 3, 2003
`
`Sheet 22 0f 22
`
`US 6,574,536 B1
`
`FIG. 27 RELATED ART
`
`4———————
`
`r—Iy—Ii—I
`
`10‘
`
`+_n L___J.~ 100
`
`FIG. 28 RELATED ART
`
`
`
`
`100b
`
`101D
`
`100a
`
`101a
`
`Silver Star Exhibit 1007 - 23
`
`Silver Star Exhibit 1007 - 23
`
`

`

`US 6,574,536 B1
`
`1
`MOVING APPARATUS FOR EFFICIENTLY
`MOVING ON FLOOR WITH OBSTACLE
`
`BACKGROUND OF THE INVENTION
`
`1. Field of the Invention
`
`invention relates to autonomous moving
`The present
`working vehicles, and more particularly, to an autonomous
`moving working vehicle for running all over the working
`range to carry out working such as cleaning and waxing.
`2. Description of the Related Art
`(1) First Related Art
`As a conventional autonomous moving working vehicle,
`Japanese Patent Publication No. 5-82601 for example dis-
`closes an autonomous moving working vehicle having a
`rotatable ultrasonic distance measuring sensor and a dead
`reckoning function for obtaining position coordinates Xmin,
`Xmax, Ymin, Ymax of obstacles (such as walls) by the
`ultrasonic distance measuring sensor, and while running the
`range surrounded by these four points, correcting these four
`points using the latest data obtained by the ultrasonic
`distance measuring sensor to search for a running range.
`Further, Japanese Patent Laying-Open No. 5-257533 dis-
`closes an autonomous moving working vehicle having a
`dead reckoning function and a non-contact obstacle sensor.
`This autonomous moving working vehicle has prescribed
`information such as a shape of the working region pre-input
`via a keyboard or the like, but does not have information on
`obstacles. Accordingly,
`the vehicle carries out working
`according to a prescribed regular moving pattern in a region
`where obstacles are not detected, while in a region where
`obstacles are detected, it carries out working according to
`the above-mentioned regular moving pattern within a region
`where it can avoid the obstacles. More specifically,
`the
`vehicle recognizes a lane (hereinafter referred to as a first
`through path) in which it has been able to run a prescribed
`distance without detecting obstacles right before an obstacle
`existing region and a lane (hereinafter referred to as a second
`through path) in which it has been able to run a prescribed
`distance without detecting obstacles right behind the
`obstacle existing region, and recognizes the region sur-
`rounded by these two lanes as obstacle existing region.
`Then, it applies working to an unworked region within the
`obstacle existing region according to the above-mentioned
`regular moving pattern from the end point of the lane where
`it has been able to run a prescribed distance without detect-
`ing obstacles right behind the obstacle existing region.
`However, the conventional autonomous moving working
`vehicle disclosed in the above-mentioned Japanese Patent
`Publication No. 5-82601 determines a cleaning region using
`the coordinates Xmin, Xmax, Ymin, Ymax and therefore
`always regards the cleaning region as rectangular region
`regardless of an actual shape thereof, whereby the area
`thereof is larger than the actual area, resulting in the need for
`an additional operation.
`In addition, searching for an
`unworked region requires an operation of subtracting a
`worked region from the above-mentioned rectangular region
`and therefore the vehicle must store the worked region,
`whereby memory capacity and operation time are increased
`with an increased number of obstacles and a complexed
`shape of the working region. In addition, the vehicle carries
`out working by running zigzag and making a U-turn when
`running up against an obstacle, and does not search for an
`unworked region until it cannot run any more being sur-
`rounded by obstacles and thereafter proceeds to the working
`of the unworked region, whereby it might be required for the
`
`10
`
`15
`
`20
`
`25
`
`30
`
`35
`
`40
`
`4s
`
`50
`
`55
`
`60
`
`65
`
`2
`vehicle to move a long distance away to the position where
`it should start the working of the unworked region or to
`again run the worked region. Therefore,
`in the case of
`working such as waxing, and spreading and mopping of
`antiseptic solution, such re-running on the worked region
`undesirably degrades the working quality.
`Further, the above-mentioned conventional autonomous
`moving working vehicle disclosed in Japanese Patent
`Laying-Open No. 5-257533 recognizes an obstacle existing
`region and an obstacle non-existing region by determining
`whether or not it has been able to run a prescribed distance
`without encountering an obstacle, and therefore information
`on a shape of the working region must be set (taught) before
`working. Accordingly, troublesome tasks such as premea-
`surement of the size of the working region must be carried
`out.
`
`Further, an obstacle in fact seldom corresponds to the
`pitch of the running lanes of the autonomous moving
`working vehicle, and therefore a remaining working region
`is produced between the through path and the obstacle.
`Accordingly,
`the vehicle merely carries out the working
`while simply avoiding obstacles after the first through path
`and before the second through path without
`taking the
`working of the remaining working region into account,
`producing a remaining working region around the obstacles,
`in particular, in the Vicinity of the sides of the obstacles.
`As described above, according to the conventional
`autonomous moving working vehicles for carrying out
`working such as floor cleaning while moving on all over the
`floor, working of such a working region as that being
`provided with a plurality of obstacles such as shelves and
`pillars at the wall surface of a room or a hall requires tasks
`such as map input and teaching, and further, even the
`autonomous moving working vehicle for automatically
`determining the size of a room by the distance measuring
`sensor spends much time in searching for the working
`region, requires large storage capacity, or the like.
`(2) Second Related Art
`A cleaning robot for working all over the surface of a
`designated region is known. Zigzag running is generally
`employed to control such a cleaning robot. The zigzag
`running herein means reciprocation in a designated region
`with a prescribed space between backward and forward
`paths. The zigzag running is realized by combination of
`forward moving operation and U-turn operation to the right
`and left on the plane.
`More specifically, the zigzag running includes right zig-
`zag running by which the cleaning robot carries out working
`to the right (in the direction of the arrow 103) from a
`working start position 100 to an end position 101 as shown
`in FIG. 26, and left zigzag running by which it carries out
`working to the left as shown in FIG. 27. The direction shown
`by the arrow 103 is hereinafter referred to as a working
`proceeding direction.
`The following method (1) or (2) is used to realize the two
`kinds of zigzag running.
`(1) Auser gives instructions such as move forward, make
`a U-turn, move forward, make a U-turn to the cleaning robot
`by a remote controller to achieve the zigzag running.
`(2) Auser inputs the longitudinal length and the transverse
`length whereby pitch length (the distance between the
`backward and forward paths in reciprocation) of a U-turn is
`automatically calculated in consideration of the width by
`which the cleaning robot can work while moving straight to
`achieve the zigzag running.
`The above method (1) achieves efficient working with a
`reduced running distance, but a user must input instructions
`
`Silver Star Exhibit 1007 - 24
`
`Silver Star Exhibit 1007 - 24
`
`

`

`US 6,574,536 B1
`
`leading to
`
`3
`such as move forward and make a U-turn,
`complex operation.
`Meanwhile, the above method (2) fixes a working end
`position (the position shown by the reference numeral 101 in
`FIGS. 26 and 27) and therefore cannot efficiently control a
`moving body.
`This gives rise to the problem particularly when such a
`region formed of two successive rectangular working
`regions as shown in FIG. 28 is to be subjected to working.
`More specifically, after carrying out the first zigzag run-
`ning from a working start position 100a to an end position
`101a, the cleaning robot must move to a start position 100b
`of the second zigzag running. Such re-running of the already
`worked region causes a waste of time and battery as well as
`makes that region dirty.
`
`SUMMARY OF THE INVENTION
`
`invention is made to solve the above
`The present
`described problems, and it
`is an object of the present
`invention to provide a moving apparatus capable of auto-
`matically efficiently moving on all over the working region
`including unknown obstacles according to simple process-
`ing without map input, a mass storage memory, and com-
`plicated calculation.
`It is another object of the present invention to provide a
`moving apparatus capable of moving the whole working
`region with uniform working quality.
`It is a further object of the present invention to provide a
`moving apparatus capable of appropriately controlling a
`moving body with a simple operation even if an operator has
`insufficient knowledge.
`In order to achieve such objects as described above, a
`moving apparatus according to one aspect of the present
`invention includes a running control unit for achieving
`zigzag running by repeatedly carrying out control including
`the steps of detecting presence/absence of an obstacle to
`running while running in a Y direction, storing the Y
`coordinate of the detected obstacle, and upon detection of
`the obstacle, stopping running in the Y direction, moving by
`a prescribed pitch in an X direction perpendicular to the Y
`direction and thereafter running in the direction opposite to
`the Y direction; and a recognizing unit for recognizing, upon
`running in the Y direction beyond previously stored Y
`coordinate of the obstacle during zigzag running achieved
`by the running control unit, presence of a remaining running
`region between a current running path and the obstacle.
`A moving apparatus according to another aspect of the
`present invention includes a running control unit for repeat-
`edly carrying out zigzag running of running a lane in a first
`direction, moving by a prescribed pitch in a second direction
`perpendicular to the first direction and thereafter running in
`the next lane in the direction opposite to the first direction;
`a measuring unit for measuring a distance up to an obstacle
`existing in the second direction; and an operation unit for
`performing an operation of the prescribed pitch employed by
`the running control unit according to the distance measured
`by the measuring unit.
`A moving apparatus according to a further aspect of the
`present invention includes a running control unit for repeat-
`edly carrying out zigzag running of running a lane in a first
`direction, moving by a prescribed pitch in a second direction
`perpendicular to the first direction and thereafter running in
`the next lane in the direction opposite to the first direction;
`a setting unit for setting a region where the moving appa-
`ratus moves; an input unit for inputting a position where the
`
`10
`
`15
`
`20
`
`25
`
`30
`
`35
`
`40
`
`4s
`
`50
`
`55
`
`60
`
`65
`
`4
`moving apparatus completes the movement in the set region;
`and an operation unit for performing an operation of the
`prescribed pitch employed by the running control unit based
`on the region set by the setting unit and the position input by
`the input unit.
`Such an invention as described above allows efficient
`
`control of a moving apparatus with simple operation,
`improving operativity as well as achieving appropriate run-
`ning.
`The foregoing and other objects, features, aspects and
`advantages of the present
`invention will become more
`apparent from the following detailed description of the
`present
`invention when taken in conjunction with the
`accompanying drawings,
`
`BRIEF DESCRIPTION OF THE DRAWINGS
`
`FIG. 1 is a perspective view of a cleaning robot and a
`controller according to a first embodiment of the invention.
`FIG. 2 is a schematic diagram showing the structure of the
`cleaning robot shown in FIG. 1.
`FIG. 3 is a diagram for use in illustration of how a side
`following sensor is used.
`FIG. 4 is a plan view of controller 2 shown in FIG. 1.
`FIG. 5 is a diagram showing a zigzag menu displayed on
`a display unit 49 of FIG. 4.
`FIG. 6 is a block diagram showing the structure of
`cleaning robot 1 of FIG. 1.
`FIG. 7 is a block diagram showing the structure of
`controller 2 of FIG. 1.
`FIG. 8 is a flow chart for use in illustration of the
`processing of measuring a distance and calculating a trans-
`verse movement pitch of zigzag running.
`FIGS. 9 and 10 together show a flow chart for use in
`illustration of the processing for zigzag running shown in
`FIG. 8.
`
`FIGS. 11 and 12 together show a flow chart for use in
`illustration of a subroutine for running in a remaining
`working region shown in FIG. 9.
`FIG. 13 is a flow chart for use in illustration of a
`
`subroutine for running in a lane on the working completion
`side shown in FIG. 10.
`
`FIGS. 14 to 17 are diagrams for use in illustration of first
`to fourth operation examples of the cleaning robot shown in
`FIG. 1, respectively.
`FIG. 18 is a flow chart showing the processing of calcu-
`lation of a U-turn pitch in zigzag running according to a
`second embodiment.
`
`FIG. 19 is a diagram for use in illustration of reciprocation
`of the cleaning robot.
`FIGS. 20A and 20B are diagrams for use in illustration of
`zigzag running of a cleaning robot according to the second
`embodiment of the invention.
`
`FIG. 21 is a first diagram showing the state obtained upon
`completion of zigzag running.
`FIG. 22 is a diagram for use in illustration of operation
`carried out by the cleaning robot from the state shown in
`FIG. 21.
`
`FIG. 23 is a second diagram showing the state obtained
`upon completion of zigzag running.
`FIG. 24 is a diagram showing operation carried out by the
`cleaning robot from the state shown in FIG. 23.
`FIG. 25 is a diagram for use in illustration of the effects
`of the invention.
`
`Silver Star Exhibit 1007 - 25
`
`Silver Star Exhibit 1007 - 25
`
`

`

`US 6,574,536 B1
`
`5
`FIG. 26 is a diagram showing zigzag running to the right.
`FIG. 27 is a diagram showing zigzag running to the left.
`FIG. 28 is a diagram for use in illustration of the problems
`of the related art.
`
`DESCRIPTION OF THE PREFERRED
`EMBODIMENTS
`
`[First Embodiment]
`Referring to FIG. 1, a cleaning robot 1 includes a forward
`obstacle sensor 7 for sensing contact with a wall or the like,
`following sensors 8a to 8d for measuring the distance up to
`a wall or the like to achieve running along the wall or the
`like, a cleaning portion 31 for cleaning a floor surface by
`rotating a nonwoven fabric cloth, a display unit 18 for
`displaying a message to a user, and a working start button 90
`for starting working. Further, a memory card 13 is inserted
`into cleaning robot 1, whereby cleaning robot 1 can carry out
`instructions stored therein.
`
`FIG. 2 is a schematic diagram showing the structure of
`cleaning robot 1 of FIG. 1. Referring to FIG. 2, the cleaning
`robot includes a main body 60, a running portion 70, a
`forward obstacle sensor 7, side following sensors 8a to 8d,
`a left-hand drive wheel 3a, a right-hand drive wheel 3b, a
`left-hand drive motor 14a, a right-hand drive motor 14b, a
`front swivel caster wheel 4a, a rear swivel caster wheel 4b,
`a cleaning portion 31, a main body rotating shaft 67, a main
`body rotation drive motor 68, a left-hand distance measuring
`sensor 6a, and a right-hand distance measuring sensor 6b.
`Main body 60 is mounted on running portion 70, and is
`rotatably supported around main body rotating shaft 67
`which is perpendicular to the floor surface. Main body 60 is
`rotatively driven by main body rotation drive motor 68.
`Running portion 70 is a member for moving the main body
`of the cleaning robot.
`Forward obstacle sensor 7 is mounted in front of main
`body 60, and detects the contact with a forward obstacle and
`outputs an obstacle detection signal to a running control unit
`32 (see FIG. 6). Side following sensors 8a to 8d detect the
`distance up to a wall when the robot moves straight along a
`wall located on its side. A potentiometer is attached to the
`right and left sides of main body 60, and a shaft thereof is
`attached to rotate around a perpendicular axis. A rod pro-
`jecting in a transverse direction is attached to the shaft of the
`potentiometer. Thus, the side following sensor is formed. A
`ball is attached to the tip of the rod so as to prevent damage
`to the wall. Side following sensors 8a to 8d structured as
`such are respectively attached to the forward and backward
`positions on the right and left sides of the cleaning robot.
`Left-hand drive wheel 3a and right-hand drive wheel 3b
`are directly connected to the respective driving shafts of
`left-hand drive motor 14a and right-hand drive motor 14b to
`be rotatable independently. Speed of rotation thereof is
`measured by a left-hand rotation speed detecting encoder 5a
`and a right-hand rotation speed detecting encoder 5b (see
`FIG. 6).
`Left-hand drive motor 14a and right-hand drive motor
`14b are fixed at a body base plate of running portion 70, and
`are independently driven by running control unit 32 to turn
`left-hand drive wheel 3a and right-hand drive wheel 3b,
`thereby achieving forward movement, backward movement,
`rotation, or curve running.
`Front swivel caster wheel 4a and rear swivel caster wheel
`
`4d support the body together with left-hand drive wheel 3a
`and right-hand drive wheel 3b, and turns the direction of
`their own wheels according to rotation of left-hand drive
`
`10
`
`15
`
`20
`
`25
`
`30
`
`35
`
`40
`
`4s
`
`50
`
`55
`
`60
`
`65
`
`6
`wheel 3a! and right-hand drive wheel 3b, achieving smooth
`rotation and curve running.
`Cleaning portion 31 is connected to main body 60, and
`cleans the floor surface. Main body 60 rotates around main
`body rotating shaft 67 with respect to running portion 70.
`Main body rotation drive motor 67 is a motor for rotating
`main body 60 with respect to running portion 70.
`The left-hand distance measuring sensor 6a and right-
`hand distance measuring sensor 6b are sensors for measur-
`ing the distance up to obstacles on the left side and on the
`right side thereof, respectively, and an ultrasonic distance
`measuring sensor or an optical distance measuring sensor is
`used as those sensors.
`
`Side following sensors 8a to 8d shown in FIGS. 1 and 2
`will now be described in further detail. FIG. 3 is a diagram
`showing how the side following sensors are used. When the
`robot runs along a wall located on the side, the tip portions
`of side following sensors 8a! to 8d come in contact with the
`wall and rotate around the shaft of the potentiometer accord-
`ing to the distance up to the wall, and rotation angles 61 and
`62 at this time are detected by the potentiometer.
`Running control unit 32 calculates both a parallel degree
`of the wall and the cleaning robot and the distance therebe-
`tween based on the rotation angles 61 and 62 of forward and
`backward side following sensors 8a to 8d, and then main-
`tains a prescribed distance such that
`the lateral side of
`cleaning portion 31 is in contact with the wall, as well as
`controls running such that the cleaning robot runs in parallel
`with the wall.
`
`FIG. 4 is a plan view of a controller 2 shown in FIG. 1.
`Referring to FIG. 4, controller 2 is used to remotely
`control cleaning robot 1 and to teach running and working.
`As an input unit of the controller, an operation shift button
`group 40, a cross-shaped cursor button 35 for designating a
`direction, a mode switching button 36 for switching a mode,
`a start button 37 for indicating start of operation of the
`cleaning robot, a stop button 38 for indicating stop of
`operation, a pause button 39 for making a pause in operation,
`a cancel button 52 for canceling the setting, a set button 53
`for setting input data, and a power supply switch 46 are
`provided. Operation shift button group 40 includes a running
`portion rotation button 41 for turning only the direction of
`running portion 70 to the right and left without changing the
`direction of main body 60, a main body rotation button 42
`for simultaneously rotating main body 60 and running
`portion 70, a cleaning portion slide button 43 for moving
`cleaning portion 31 to the right and left with respect to main