[go: up one dir, main page]

JP2006323618A - Self-propelled robot - Google Patents

Self-propelled robot Download PDF

Info

Publication number
JP2006323618A
JP2006323618A JP2005146130A JP2005146130A JP2006323618A JP 2006323618 A JP2006323618 A JP 2006323618A JP 2005146130 A JP2005146130 A JP 2005146130A JP 2005146130 A JP2005146130 A JP 2005146130A JP 2006323618 A JP2006323618 A JP 2006323618A
Authority
JP
Japan
Prior art keywords
traveling
ultrasonic
self
mode
straight
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP2005146130A
Other languages
Japanese (ja)
Inventor
Akiyoshi Shimizu
章良 清水
Tomoyoshi Tokumaru
智▲祥▼ 徳丸
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sanyo Electric Co Ltd
Original Assignee
Sanyo Electric Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sanyo Electric Co Ltd filed Critical Sanyo Electric Co Ltd
Priority to JP2005146130A priority Critical patent/JP2006323618A/en
Publication of JP2006323618A publication Critical patent/JP2006323618A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
  • Electric Suction Cleaners (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To detect obstacles in a self-propelled robot's surroundings. <P>SOLUTION: For the self-propelled robot, three ultrasonic transmitters and four ultrasonic receivers are disposed alternately and equidistantly in the traveling direction V1 by centering the ultrasonic transmitter s2. Here, the ultrasonic receiver r1, ultrasonic transmitter s1, ultrasonic receiver r2, ultrasonic transmitter s2, ultrasonic receiver r3, ultrasonic transmitter s3 and ultrasonic receiver r4 are disposed one by one from the left side of the traveling direction V1. Along the center line LS in parallel with the traveling direction V1 through the central point O of the body 10, three ultrasonic transmitters and four receivers are disposed at the axisymmetrical positions. <P>COPYRIGHT: (C)2007,JPO&INPIT

Description

本発明は、少なくとも1の車輪の駆動軸を所定の回転速度で回転させる駆動手段と、進行方向を自在に設定する操舵手段とを備え、所定の領域内を走行する自走式ロボットに関するものである。   The present invention relates to a self-propelled robot that includes a drive unit that rotates a drive shaft of at least one wheel at a predetermined rotational speed, and a steering unit that freely sets a traveling direction, and travels within a predetermined region. is there.

近年、室内の床面の掃除を行う掃除ロボット等の所定の領域内を略均一に走行する自走式ロボットが知られている。ここで、所定の領域内において、自走式ロボットを略均一に走行させるためには、自走式ロボットの進行方向にある障害物を正確に検知する必要があり、この障害物を検知する方法について種々の提案がなされている。   In recent years, a self-propelled robot that travels substantially uniformly in a predetermined area, such as a cleaning robot that cleans an indoor floor surface, is known. Here, in order to make the self-propelled robot run substantially uniformly within a predetermined area, it is necessary to accurately detect an obstacle in the traveling direction of the self-propelled robot, and a method for detecting this obstacle Various proposals have been made.

例えば、特許文献1には、4個の送信用超音波センサと5個の受信用超音波センサとを交互に配置し、1つの送信用超音波センサと両隣の2つの受信用超音波センサとの組み合わせで障害物検知を行い、しかもこの組み合わせを一定の時間間隔で順次切り換えて障害物検知を行うことにより、前方、左右の広い範囲にわたって障害物を検知する障害物検知装置が開示されている。
特開2003−35774号公報
For example, in Patent Literature 1, four transmission ultrasonic sensors and five reception ultrasonic sensors are alternately arranged, and one transmission ultrasonic sensor and two adjacent reception ultrasonic sensors are provided. An obstacle detection device is disclosed that detects obstacles over a wide range of front and left and right by performing obstacle detection by sequentially switching the combination at regular time intervals and performing obstacle detection. .
JP 2003-35774 A

しかしながら、特許文献1に開示されている障害物検知装置では、前方正面の障害物の検出が2個の送信用超音波センサ(特許文献1の図5における送信用超音波センサS2、S3)からの超音波を用いて行われるため、前方正面の障害物を2つの受信用超音波センサで略同時に測定することは困難であり、前方正面の障害物の検出精度が充分ではない場合があった。   However, in the obstacle detection device disclosed in Patent Document 1, an obstacle in front of the front is detected from two transmitting ultrasonic sensors (transmitting ultrasonic sensors S2 and S3 in FIG. 5 of Patent Document 1). Therefore, it is difficult to measure obstacles in front of the front with two receiving ultrasonic sensors at the same time, and the detection accuracy of obstacles in front of the front may not be sufficient. .

すなわち、自走式ロボットは、所定の領域内を移動しながら障害物を検知する必要があるが、障害物検知を行うタイミングが異なると、その間に自走式ロボットが移動するため、その移動量に応じた測定誤差が発生するのである。   In other words, the self-propelled robot needs to detect an obstacle while moving within a predetermined area. However, if the timing for detecting the obstacle is different, the self-propelled robot moves during that time. A measurement error corresponding to this occurs.

本発明は上記課題に鑑みてなされたもので、周囲の障害物を正確に検出することの可能な自走式ロボットを提供することを目的としている。   The present invention has been made in view of the above problems, and an object of the present invention is to provide a self-propelled robot capable of accurately detecting surrounding obstacles.

請求項1に記載の自走式ロボットは、少なくとも1の車輪の駆動軸を所定の回転速度で回転させる駆動手段と、進行方向を自在に設定する操舵手段とを備え、所定の領域内を走行する自走式ロボットであって、自走式ロボット本体の中心を通り進行方向に平行な直線である中心線の近傍に配設され、自走式ロボットの進行方向に向けて信号を発信する第1発信手段と、前記第1発信手段によって発信された信号であって、前記所定の領域の外縁において反射した反射信号を受信する第1受信手段と、前記第1発信手段によって発信された信号が前記第1受信手段によって受信されるまでの経過時間を用いて、自走式ロボットと前記所定の領域の外縁との間の距離を求める距離算出手段とを備え、前記第1受信手段が、前記中心線の両側に配設されていることを特徴としている。   The self-propelled robot according to claim 1 includes a driving unit that rotates a driving shaft of at least one wheel at a predetermined rotational speed, and a steering unit that freely sets a traveling direction, and travels within a predetermined region. A self-propelled robot that is arranged in the vicinity of a center line that is a straight line that passes through the center of the self-propelled robot body and is parallel to the traveling direction, and transmits a signal toward the traveling direction of the self-propelled robot. 1 transmitting means, a signal transmitted by the first transmitting means, a first receiving means for receiving a reflected signal reflected at an outer edge of the predetermined area, and a signal transmitted by the first transmitting means Distance calculating means for obtaining a distance between the self-propelled robot and an outer edge of the predetermined area using an elapsed time until it is received by the first receiving means; and Arranged on both sides of the center line It is characterized in that it is.

上記の構成によれば、自走式ロボット本体の中心を通り進行方向に平行な直線である中心線の近傍に配設された第1発信手段によって、自走式ロボットの進行方向に向けて信号が発信され、第1受信手段によって、第1発信手段により発信された信号であって、所定の領域の外縁において反射した反射信号が受信される。そして、距離算出手段によって、第1発信手段により発信された信号が第1受信手段によって受信されるまでの経過時間を用いて、自走式ロボットと所定の領域の外縁との間の距離が求められる。ここで、第1受信手段は、自走式ロボット本体の中心を通り進行方向に平行な直線である中心線の両側に配設されている。   According to the above configuration, the signal is directed toward the traveling direction of the self-propelled robot by the first transmitting means disposed in the vicinity of the center line that is a straight line passing through the center of the self-propelled robot body and parallel to the traveling direction. Is transmitted, and a reflected signal reflected by the outer edge of a predetermined region is received by the first receiving means. Then, the distance calculating means obtains the distance between the self-propelled robot and the outer edge of the predetermined region using the elapsed time until the signal transmitted by the first transmitting means is received by the first receiving means. It is done. Here, the first receiving means is disposed on both sides of a center line that is a straight line passing through the center of the self-propelled robot body and parallel to the traveling direction.

従って、中心線の近傍に配設された第1発信手段によって、自走式ロボットの進行方向に向けて信号が発信され、中心線の両側に配設された第1受信手段によって、第1発信手段により発信された信号であって、所定の領域の外縁において反射した反射信号が受信されるため、1のタイミングで第1発信手段により発信された信号を用いて前方正面の少なくとも2方向について、自走式ロボットと所定の領域の外縁との間の距離が求められ、前方正面の障害物が正確に検出される。   Therefore, a signal is transmitted toward the traveling direction of the self-propelled robot by the first transmission means disposed near the center line, and the first transmission is performed by the first reception means disposed on both sides of the center line. The signal transmitted by the means, and the reflected signal reflected at the outer edge of the predetermined region is received, so that at least two directions of the front front using the signal transmitted by the first transmitting means at one timing, The distance between the self-propelled robot and the outer edge of the predetermined area is obtained, and the obstacle in front of the front is accurately detected.

請求項2に記載の自走式ロボットは、前記第1受信手段が、前記中心線に対して略線対称な位置に配設されていることを特徴としている。   The self-propelled robot according to a second aspect is characterized in that the first receiving means is disposed at a position substantially line symmetrical with respect to the center line.

上記の構成によれば、第1受信手段が、自走式ロボット本体の中心を通り進行方向に平行な直線である中心線に対して略線対称な位置に配設されているため、1のタイミングで第1発信手段により発信された信号を用いて前方正面の少なくとも2方向について、自走式ロボットと所定の領域の外縁との間の距離が求められ、前方正面の障害物が更に正確に検出される。   According to the above configuration, since the first receiving means is disposed at a position substantially symmetrical with respect to the center line that is a straight line that passes through the center of the self-propelled robot body and is parallel to the traveling direction, The distance between the self-propelled robot and the outer edge of the predetermined area is determined in at least two directions in front of the front using the signal transmitted by the first transmission means at the timing, and the obstacle in front of the front is more accurately Detected.

請求項3に記載の自走式ロボットは、前記第1受信手段が、前記中心線の両側にそれぞれ1個だけ配設されていることを特徴としている。   The self-propelled robot according to claim 3 is characterized in that only one first receiving means is provided on each side of the center line.

上記の構成によれば、第1受信手段が、自走式ロボット本体の中心を通り進行方向に平行な直線である中心線の両側にそれぞれ1個だけ配設されているため、簡単な構成で、前方正面の障害物が正確に検出される。   According to the above configuration, only one first receiving means is provided on each side of the center line that is a straight line passing through the center of the self-propelled robot body and parallel to the traveling direction. Obstacles in front of the front are accurately detected.

請求項4に記載の自走式ロボットは、前記中心線に対して略線対称な位置に配設され、前記中心線から離間する方向に信号を発信する第2発信手段と、前記第2発信手段から発信された信号であって、前記所定の領域の外縁において反射した反射信号を受信する第2受信手段とを備え、前記距離算出手段が、前記第2発信手段によって発信された信号が前記第2受信手段によって受信されるまでの経過時間を用いて、自走式ロボットと前記所定の領域の外縁との間の距離を求めることを特徴としている。   5. The self-propelled robot according to claim 4, wherein the second transmission means is disposed at a position substantially line symmetrical with respect to the center line, and transmits a signal in a direction away from the center line, and the second transmission. And a second receiving means for receiving a reflected signal reflected at the outer edge of the predetermined area, and the distance calculating means is configured to receive the signal sent by the second transmitting means. The distance between the self-propelled robot and the outer edge of the predetermined area is obtained using the elapsed time until it is received by the second receiving means.

上記の構成によれば、中心線に対して略線対称な位置に配設された第2発信手段によって、中心線から離間する方向に信号が発信され、第2受信手段によって、第2発信手段により発信された信号であって、所定の領域の外縁において反射した反射信号が受信される。そして、距離算出手段によって、第2発信手段により発信された信号が第2受信手段により受信されるまでの経過時間を用いて、自走式ロボットと所定の領域の外縁との間の距離が求められる。   According to said structure, a signal is transmitted in the direction away from a centerline by the 2nd transmission means arrange | positioned in the substantially line symmetrical position with respect to a centerline, and a 2nd transmission means is transmitted by the 2nd reception means. The reflected signal reflected at the outer edge of the predetermined area is received. Then, the distance calculating means obtains the distance between the self-propelled robot and the outer edge of the predetermined area using the elapsed time until the signal transmitted by the second transmitting means is received by the second receiving means. It is done.

従って、第2発信手段によって中心線から離間する方向に信号が発信され、所定の領域の外縁において反射した反射信号が第2受信手段により受信されるまでの経過時間を用いて、自走式ロボットと所定の領域の外縁との間の距離が求められるため、中心線から離間する方向の自走式ロボットと所定の領域の外縁との間の距離が検出される。すなわち、進行方向に対して、左右方向(左右両側)の、自走式ロボットと所定の領域の外縁との間の距離が検出される。   Therefore, a self-propelled robot is used by using the elapsed time until a signal is transmitted in a direction away from the center line by the second transmitter and the reflected signal reflected at the outer edge of the predetermined area is received by the second receiver. The distance between the self-propelled robot in the direction away from the center line and the outer edge of the predetermined area is detected. That is, the distance between the self-propelled robot and the outer edge of the predetermined region in the left-right direction (both left and right) with respect to the traveling direction is detected.

請求項5に記載の自走式ロボットは、前記第2発信手段が、前記中心線に対して略線対称な位置に、それぞれ1個だけ配設されていることを特徴としている。   The self-propelled robot according to claim 5 is characterized in that only one second transmitting means is disposed at a position substantially line symmetrical with respect to the center line.

上記の構成によれば、第2発信手段が、中心線に対して略線対称な位置にそれぞれ1個だけ配設されているため、簡単な構成で、中心線から離間する方向の自走式ロボットと所定の領域の外縁との間の距離が検出される。   According to said structure, since only one 2nd transmission means is each arrange | positioned in the substantially line symmetrical position with respect to a center line, it is a simple structure and is self-propelled in the direction away from a center line. A distance between the robot and the outer edge of the predetermined area is detected.

請求項6に記載の自走式ロボットは、前記第1発信手段及び第2発信手段が、予め設定された順序で順次発信することを特徴としている。   The self-propelled robot according to claim 6 is characterized in that the first transmission means and the second transmission means sequentially transmit in a preset order.

上記の構成によれば、第1発信手段及び第2発信手段が、予め設定された順序で順次発信されるため、進行方向の前方正面と、進行方向に対して左右方向とに関して、自走式ロボットと所定の領域の外縁との間の距離が順次検出され、適正な検出が行われる。   According to said structure, since a 1st transmission means and a 2nd transmission means are sequentially transmitted in the order set beforehand, it is self-propelled about the front front of the advancing direction, and the left-right direction with respect to the advancing direction. The distance between the robot and the outer edge of the predetermined area is sequentially detected, and proper detection is performed.

請求項7に記載の自走式ロボットは、前記距離算出手段によって求められた1の距離又は複数の距離の最小値を離間距離として検出する検出手段と、前記所定の領域の外縁に沿って走行させる制御モードである第1モードでの走行をさせるべく、前記操舵手段に対して進行方向を指示する第1走行手段と、前記領域内を直進と回転とを繰り返して走行させる制御モードである第2モードでの走行をさせるべく、前記離間距離が予め設定された所定値以下となるまで直進し、前記離間距離が予め設定された所定値以下である場合に直進を停止して前記操舵手段に対して進行方向を所定方向に変更させる第2走行手段と、前記第2モードで走行中の直進走行開始から停止までの時間である直進走行時間を測定する直進時間測定手段と、2以上の所定回数分の直進走行時間を格納する直進時間記憶手段と、前記第1モードと第2モードとを切り換える切換手段とを備え、前記切換手段が、前記所定回数分の直進走行時間が所定の条件を満たす場合に、前記第2モードを前記第1モードへ切り換えることを特徴としている。   8. The self-propelled robot according to claim 7, wherein the self-propelled robot travels along the outer edge of the predetermined area, detecting means for detecting a distance or a minimum value of a plurality of distances obtained by the distance calculating means as a separation distance. A first driving means for instructing the steering means to travel in order to travel in the first mode, which is a control mode, and a control mode in which the vehicle travels repeatedly in a straight line and rotation in the region. In order to travel in the two modes, the vehicle travels straight until the separation distance is equal to or less than a predetermined value set in advance, and when the separation distance is equal to or less than a predetermined value set in advance, A second traveling means for changing the traveling direction to a predetermined direction; a straight traveling time measuring means for measuring a straight traveling time that is a time from the start to the stop of the straight traveling while traveling in the second mode; and two or more places A straight running time storage means for storing the straight running time for the number of times; and a switching means for switching between the first mode and the second mode, wherein the switching means satisfies a predetermined condition for the straight running time for the predetermined number of times. When the condition is satisfied, the second mode is switched to the first mode.

上記の構成によれば、検出手段によって、距離算出手段によって求められた1の距離又は複数の距離の最小値が離間距離として検出される。そして、第1走行手段によって、所定の領域の外縁に沿って走行させる制御モードである第1モードでの走行をさせるべく、操舵手段に対して進行方向が指示され、第2走行手段によって、所定の領域内を直進と回転とを繰り返して走行させる制御モードである第2モードでの走行をさせるべく、離間距離が予め設定された所定値以下となるまで直進し、離間距離が予め設定された所定値以下である場合に直進を停止して操舵手段に対して進行方向が所定方向に変更される。また、直進時間測定手段によって、第2モードで走行中の直進走行開始から停止までの時間である直進走行時間が測定され、直進時間記憶手段に、2以上の所定回数分の直進走行時間が格納される。更に、切換手段によって、所定回数分の直進走行時間が所定の条件を満たす場合に、第2モードが第1モードへ切り換えられる。   According to said structure, the minimum value of 1 distance or several distance calculated | required by the distance calculation means is detected by a detection means as a separation distance. Then, the first traveling means instructs the steering means to travel in the first mode, which is a control mode for traveling along the outer edge of the predetermined region, and the second traveling means performs the predetermined direction. In order to travel in the second mode, which is a control mode in which the vehicle travels in a straight line and rotates repeatedly, the vehicle travels straight until the separation distance is equal to or less than a predetermined value, and the separation distance is preset. When it is equal to or less than the predetermined value, the straight traveling is stopped and the traveling direction is changed to a predetermined direction with respect to the steering means. The straight travel time measuring means measures the straight travel time that is the time from the start of the straight travel during the second mode to the stop, and stores the straight travel time for two or more predetermined times in the straight travel time storage means. Is done. Further, the second mode is switched to the first mode when the straight traveling time for a predetermined number of times satisfies a predetermined condition by the switching means.

従って、所定の領域内を直進と回転とを繰り返して走行させる制御モードである第2モードで走行中の、2以上の所定回数分の直進走行開始から停止までの時間である直進走行時間が所定の条件を満たす場合に、制御モードが第2モードから、所定の領域の外縁に沿って走行させる制御モードである第1モードへ切り換えられるため、所定の領域内の外縁が複雑な形状である場合であっても、適度な頻度で第1モードへ切り換られ、所定の領域内を略均一に走行させることが可能となる。   Accordingly, during traveling in the second mode, which is a control mode in which the vehicle travels repeatedly within a predetermined area, the straight traveling time that is the time from the start of the straight traveling for two or more predetermined times to the stop is predetermined. When the condition is satisfied, the control mode is switched from the second mode to the first mode, which is a control mode for running along the outer edge of the predetermined area, so that the outer edge in the predetermined area has a complicated shape. Even so, the mode is switched to the first mode at an appropriate frequency, and the vehicle can travel substantially uniformly within a predetermined area.

請求項1に記載の発明によれば、中心線の近傍に配設された第1発信手段によって、自走式ロボットの進行方向に向けて信号が発信され、中心線の両側に配設された第1受信手段によって、第1発信手段により発信された信号であって、所定の領域の外縁において反射した反射信号が受信されるため、1のタイミングで第1発信手段により発信された信号を用いて前方正面の少なくとも2方向について、自走式ロボットと所定の領域の外縁との間の距離が求められ、前方正面の障害物を正確に検出できる。   According to the first aspect of the present invention, a signal is transmitted toward the traveling direction of the self-propelled robot by the first transmission means disposed in the vicinity of the center line, and disposed on both sides of the center line. Since the first receiving means receives the signal transmitted from the first transmitting means and reflected at the outer edge of the predetermined area, the signal transmitted from the first transmitting means at one timing is used. Thus, the distance between the self-propelled robot and the outer edge of the predetermined area is determined in at least two directions in front of the front, and an obstacle in front of the front can be accurately detected.

請求項2に記載の発明によれば、第1受信手段が、自走式ロボット本体の中心を通り進行方向に平行な直線である中心線に対して略線対称な位置に配設されているため、1のタイミングで第1発信手段により発信された信号を用いて前方正面の少なくとも2方向について、自走式ロボットと所定の領域の外縁との間の距離が求められ、前方正面の障害物を更に正確に検出できる。   According to the second aspect of the present invention, the first receiving means is disposed at a substantially line-symmetrical position with respect to a center line that is a straight line passing through the center of the self-propelled robot body and parallel to the traveling direction. Therefore, the distance between the self-propelled robot and the outer edge of the predetermined area is obtained in at least two directions in front of the front using the signal transmitted by the first transmission means at one timing, and the obstacle in front of the front Can be detected more accurately.

請求項3に記載の発明によれば、第1受信手段が、自走式ロボット本体の中心を通り進行方向に平行な直線である中心線の両側にそれぞれ1個だけ配設されているため、簡単な構成で、前方正面の障害物を正確に検出できる。   According to the invention described in claim 3, since only one first receiving means is disposed on each side of the center line that is a straight line that passes through the center of the self-propelled robot body and is parallel to the traveling direction, With a simple configuration, obstacles in front of the front can be accurately detected.

請求項4に記載の発明によれば、第2発信手段により中心線から離間する方向に信号が発信され、所定の領域の外縁において反射した反射信号が第2受信手段により受信されるまでの経過時間を用いて、自走式ロボットと所定の領域の外縁との間の距離が求められるため、中心線から離間する方向の自走式ロボットと所定の領域の外縁との間の距離を検出できる。すなわち、進行方向に対して、左右方向(左右両側)の、自走式ロボットと所定の領域の外縁との間の距離を検出できる。   According to the fourth aspect of the present invention, the signal is transmitted in the direction away from the center line by the second transmitting means, and the reflected signal reflected at the outer edge of the predetermined area is received by the second receiving means. Since the distance between the self-propelled robot and the outer edge of the predetermined area is obtained using time, the distance between the self-propelled robot in the direction away from the center line and the outer edge of the predetermined area can be detected. . That is, it is possible to detect the distance between the self-propelled robot and the outer edge of the predetermined region in the left and right direction (both left and right) with respect to the traveling direction.

請求項5に記載の発明によれば、第2発信手段が、中心線に対して略線対称な位置にそれぞれ1個だけ配設されているため、簡単な構成で、中心線から離間する方向の自走式ロボットと所定の領域の外縁との間の距離を検出できる。   According to the fifth aspect of the present invention, since only one second transmitting means is disposed at a substantially line symmetrical position with respect to the center line, the direction away from the center line is simple. The distance between the self-propelled robot and the outer edge of the predetermined area can be detected.

請求項6に記載の発明によれば、第1発信手段及び第2発信手段が、予め設定された順序で順次発信されるため、進行方向の前方正面と、進行方向に対して左右方向とに関して、自走式ロボットと所定の領域の外縁との間の距離が順次検出され、適正に検出を行うことができる。   According to invention of Claim 6, since a 1st transmission means and a 2nd transmission means are sequentially transmitted in the order set beforehand, regarding the front front of the advancing direction, and the left-right direction with respect to the advancing direction The distance between the self-propelled robot and the outer edge of the predetermined area is sequentially detected, and can be detected appropriately.

請求項7に記載の発明によれば、所定の領域内を直進と回転とを繰り返して走行させる制御モードである第2モードで走行中の、2以上の所定回数分の直進走行開始から停止までの時間である直進走行時間が所定の条件を満たす場合に、制御モードが第2モードから、所定の領域の外縁に沿って走行させる制御モードである第1モードへ切り換えられるため、所定の領域内の外縁が複雑な形状である場合であっても、適度な頻度で第1モードへ切り換られ、所定の領域内を略均一に走行させることができる。   According to the seventh aspect of the present invention, the vehicle travels in a second mode, which is a control mode in which the vehicle travels repeatedly in a predetermined region by repeating straight travel and rotation, and from straight travel start to stop for two or more predetermined times. When the straight traveling time that is the time of the vehicle satisfies the predetermined condition, the control mode is switched from the second mode to the first mode that is a control mode for traveling along the outer edge of the predetermined region. Even in the case where the outer edge has a complicated shape, the mode is switched to the first mode at an appropriate frequency, and the vehicle can travel substantially uniformly in a predetermined area.

図1、2は、それぞれ、本発明に係る掃除ロボット(自走式ロボットに相当する)の一例を示す底面図及び斜視図である。ここでは、室内(所定の領域に相当する)の床面上の集塵を行う掃除ロボットについて説明する。掃除ロボット1は、略円筒形に構成された本体部10と、本体部10を床面に対して走行させる駆動部11(駆動手段、操舵手段に相当する)と、壁面(又は、障害物)との距離を測定する距離センサ12(第1発信手段の一部、第2発信手段の一部、第1受信手段の一部及び第2受信手段の一部に相当する)と、壁面(又は、障害物)との接触を検出するバンパ13と、床面を集塵する集塵部14と、本体部10を床面に対して略平行に支持する補助輪15と、壁面(又は、障害物)近傍の塵を本体部10側へ移動させるサイドブラシ16と、掃除ロボット1全体の動作を制御する制御部17(図示省略:図3参照)とを備えている。   1 and 2 are a bottom view and a perspective view, respectively, showing an example of a cleaning robot (corresponding to a self-propelled robot) according to the present invention. Here, a cleaning robot that collects dust on the floor of a room (corresponding to a predetermined area) will be described. The cleaning robot 1 includes a main body 10 configured in a substantially cylindrical shape, a driving unit 11 (corresponding to a driving means and a steering means) that causes the main body 10 to travel with respect to a floor surface, and a wall surface (or an obstacle). A distance sensor 12 (corresponding to a part of the first transmitting means, a part of the second transmitting means, a part of the first receiving means and a part of the second receiving means) and a wall surface (or A bumper 13 that detects contact with an obstacle), a dust collecting part 14 that collects dust on the floor, an auxiliary wheel 15 that supports the main body 10 substantially parallel to the floor, and a wall surface (or an obstacle). 3) A side brush 16 that moves the dust in the vicinity to the main body 10 side and a control unit 17 (not shown: see FIG. 3) that controls the operation of the entire cleaning robot 1 are provided.

駆動部11は、進行方向V1に対して直行する方向の本体部10略両端位置に回転自在に軸支された駆動輪111a、111bと、駆動輪111a、111bをそれぞれ駆動するモータ113a、113bと、モータ113a、113bの回転速度を減速して駆動輪111a、111bにそれぞれ伝達する減速機112a、112bとを備えている。また、モータ113a、113bの適所には、モータ113a、113bの回転速度をそれぞれ検出するエンコーダ115a、115bが配設されている(図示省略)。   The drive unit 11 includes drive wheels 111a and 111b that are rotatably supported at substantially both end positions of the main body 10 in a direction perpendicular to the traveling direction V1, and motors 113a and 113b that respectively drive the drive wheels 111a and 111b. , Reduction gears 112a and 112b that reduce the rotational speed of the motors 113a and 113b and transmit them to the drive wheels 111a and 111b, respectively. In addition, encoders 115a and 115b that detect the rotational speeds of the motors 113a and 113b are disposed at appropriate positions of the motors 113a and 113b (not shown).

距離センサ12は、超音波センサであって、3台の超音波発信器121(第1発信手段の一部及び第2発信手段の一部に相当する)と、4台の超音波受信器122(第1受信手段の一部及び第2受信手段の一部に相当する)とが交互に略等間隔にバンパ13に埋設されて構成されている。3台の超音波発信器121から発信された超音波を隣接する各2台の超音波受信器122で受信して、超音波発信器121による超音波信号の送信開始から超音波受信器122による超音波信号の受信開始までの時間に基づいて、壁面(又は、障害物)との距離を検出するものである。   The distance sensor 12 is an ultrasonic sensor, and includes three ultrasonic transmitters 121 (corresponding to a part of the first transmitting unit and a part of the second transmitting unit) and four ultrasonic receivers 122. (Corresponding to a part of the first receiving means and a part of the second receiving means) are alternately embedded in the bumper 13 at substantially equal intervals. The ultrasonic waves transmitted from the three ultrasonic transmitters 121 are received by the two adjacent ultrasonic receivers 122, and the ultrasonic receiver 122 starts the transmission of the ultrasonic signal by the ultrasonic transmitter 121. The distance from the wall surface (or obstacle) is detected based on the time until reception of the ultrasonic signal starts.

バンパ13は、本体部10の進行方向V1側に沿って半円筒形に形成され、図略のタッチセンサ131によって壁面(又は、障害物)との接触を検出するものである。   The bumper 13 is formed in a semi-cylindrical shape along the traveling direction V1 side of the main body 10, and detects contact with a wall surface (or an obstacle) by a touch sensor 131 (not shown).

集塵部14は、床面に対向して配設され、床面上の塵が吸入される集塵口141と、集塵口141からの塵を収納する集塵ボックス142と、集塵口141から塵を吸入するべく集塵ボックス142を負圧とするファン143とを備えている。   The dust collection unit 14 is disposed to face the floor surface, and is provided with a dust collection port 141 through which dust on the floor surface is sucked, a dust collection box 142 that stores dust from the dust collection port 141, and a dust collection port. In order to suck in dust from 141, a fan 143 that makes the dust collection box 142 a negative pressure is provided.

補助輪15は、本体部10の底面を床面に対して略平行に支持するべく、本体部10の底面に回転自在に軸支され、進行方向V1について前方側と後方側とにそれぞれ1個及び2個だけ配設されている。   The auxiliary wheel 15 is rotatably supported on the bottom surface of the main body 10 so as to support the bottom surface of the main body 10 substantially parallel to the floor surface, and one auxiliary wheel 15 is provided on each of the front side and the rear side in the traveling direction V1. And only two are arranged.

サイドブラシ16は、壁面(又は、障害物)近傍の塵を、集塵口141から吸入可能な位置まで移動させるものである。すなわち、図4(a)にて後述するように、壁沿い走行をする場合には、進行方向V1に対して左側に壁面(又は、障害物)から所定距離(例えば、20mm)で離間して走行されるため、サイドブラシ16によって、壁面(又は、障害物)近傍の塵を、集塵口141から吸入可能な位置まで移動させる必要がある。   The side brush 16 moves the dust near the wall surface (or obstacle) from the dust collection port 141 to a position where it can be sucked. That is, as will be described later with reference to FIG. 4 (a), when traveling along the wall, it is separated from the wall surface (or obstacle) to the left side with respect to the traveling direction V1 by a predetermined distance (for example, 20 mm). In order to run, it is necessary to move the dust near the wall surface (or obstacle) by the side brush 16 from the dust collection port 141 to a position where it can be sucked.

図3は、掃除ロボット1の主要部の一例を示す構成図である。制御部17は、種々の処理を行うCPU(Central Processing Unit)171と、種々のデータを格納するRAM(Random Access Memory)172とを備えている。   FIG. 3 is a configuration diagram illustrating an example of a main part of the cleaning robot 1. The control unit 17 includes a CPU (Central Processing Unit) 171 that performs various processes and a RAM (Random Access Memory) 172 that stores various data.

CPU171は、機能的に、掃除ロボット1の進行方向に向けて信号を発信する第1発信部171a(第1発信手段の一部に相当する)と、進行方向に対して左右方向に信号を発信する第2発信部171b(第2発信手段の一部に相当する)と、第1発信部171aにより発信された信号を受信する第1受信部171c(第1受信手段の一部に相当する)と、第2発信部171bにより発信された信号を受信する第2受信部171d(第2受信手段の一部に相当する)と、発信時刻から受信時刻までの経過時間を用いて壁面(又は、障害物)との距離を求める距離算出部171eと(距離算出手段に相当する)を備えている。   The CPU 171 functionally transmits a signal in the left-right direction with respect to the traveling direction, and a first transmitting unit 171a (corresponding to a part of the first transmitting means) that transmits a signal toward the traveling direction of the cleaning robot 1. A second transmitter 171b (corresponding to a part of the second transmitter) and a first receiver 171c (corresponding to a part of the first receiver) for receiving a signal transmitted by the first transmitter 171a And a second receiving unit 171d (corresponding to a part of the second receiving means) that receives a signal transmitted by the second transmitting unit 171b, and a wall surface (or, using an elapsed time from the transmitting time to the receiving time) A distance calculation unit 171e for obtaining a distance from the obstacle) (corresponding to a distance calculation unit) is provided.

また、CPU171は、機能的に、距離算出部171eによって求められた1の距離又は複数の距離の最小値である離間距離を検出する検出部171f(検出手段に相当する)と、壁面(又は、障害物)に沿って走行させる制御モードである壁沿いモード(第1モードに相当する)での走行をさせるべく、モータ113a、113bに対して進行方向を指示する壁沿い走行部171g(第1走行手段に相当する)と、室内を直進と回転とを繰り返して走行させる制御モードであるランダムモード(第2モードに相当する)での走行をさせるべく、離間距離が予め設定された所定値以下となるまで直進し、離間距離が予め設定された所定値以下である場合に直進を停止してモータ113a、113bに対して進行方向を所定方向に変更させるランダム走行部171h(第2走行手段に相当する)とを備えている。   In addition, the CPU 171 functionally includes a detection unit 171f (corresponding to detection means) that detects a separation distance that is the minimum value of one distance or a plurality of distances obtained by the distance calculation unit 171e, and a wall surface (or In order to travel in the along-wall mode (corresponding to the first mode), which is a control mode for traveling along the obstacles, the along-wall traveling unit 171g (indicating the traveling direction to the motors 113a and 113b) And the separation distance is equal to or less than a predetermined value set in advance so that the vehicle travels in a random mode (corresponding to the second mode), which is a control mode in which the vehicle travels in a straight line and rotates repeatedly. When the separation distance is less than or equal to a predetermined value, the straight travel is stopped and the motors 113a and 113b are caused to change the traveling direction to a predetermined direction. And a dam driving unit 171h (corresponding to the second driving means).

更に、CPU171は、機能的に、ランダムモードで走行中の直進走行開始から停止までの時間である直進走行時間を測定する直進時間測定部171i(直進時間測定手段に相当する)と、壁沿いモードとランダムモードとを切り換える切換部171j(切換手段に相当する)と、ランダムモードでの走行時間が予め設定された所定時間に到達していない場合に、切換部171jの動作を禁止する禁止部171kと、集塵に関する制御を行うクリーナ制御部171mとを備えている。RAM172は、機能的に、2以上の所定回数(ここでは、3回)分の直進走行時間を格納する直進時間記憶部172a(直進時間記憶手段に相当する)を備えている。   Further, the CPU 171 functionally includes a straight traveling time measuring unit 171i (corresponding to a straight traveling time measuring means) that measures a straight traveling time that is a time from the start of straight traveling while stopping in a random mode, and a wall-side mode. A switching unit 171j (corresponding to switching means) for switching between the random mode and the random mode, and a prohibiting unit 171k for prohibiting the operation of the switching unit 171j when the traveling time in the random mode has not reached a predetermined time set in advance. And a cleaner control unit 171m that performs control related to dust collection. The RAM 172 functionally includes a straight traveling time storage unit 172a (corresponding to a straight traveling time storage unit) that stores straight traveling time for two or more predetermined times (here, three times).

第1発信部171aは、検出部171fからの指示に基づき、図4(b)に示す所定の発信時間Ts2だけ、超音波発信器121(図4に示す中心線LS上に配設された超音波発信器s2)を介して、掃除ロボット1の進行方向に向けて所定の拡り角θs(図5参照)の超音波信号を発信するものである。   Based on an instruction from the detection unit 171f, the first transmission unit 171a performs ultrasonic transmission 121 (on the center line LS illustrated in FIG. 4 on the center line LS only for a predetermined transmission time Ts2 illustrated in FIG. 4B). An ultrasonic signal having a predetermined divergence angle θs (see FIG. 5) is transmitted to the traveling direction of the cleaning robot 1 via the sound wave transmitter s2).

第2発信部171bは、検出部171fからの指示に基づき、図4(b)に示す所定の発信時間Ts1だけ、超音波発信器121(図4に示す中心線LSに対して左側に配設された超音波発信器s1)を介して、掃除ロボット1の進行方向に対して左方向に向けて所定の拡り角θs(図5参照)の超音波信号を発信するものである。また、第2発信部171bは、検出部171fからの指示に基づき、図4(b)に示す所定の発信時間Ts3だけ、超音波発信器121(図4に示す中心線LSに対して右側に配設された超音波発信器s3)を介して、掃除ロボット1の進行方向に対して右方向に向けて所定の拡り角θs(図5参照)の超音波信号を発信するものである。   The second transmitter 171b is arranged on the left side with respect to the ultrasonic transmitter 121 (center line LS shown in FIG. 4) for a predetermined transmission time Ts1 shown in FIG. 4B based on an instruction from the detector 171f. The ultrasonic signal having a predetermined divergence angle θs (see FIG. 5) is transmitted to the left with respect to the traveling direction of the cleaning robot 1 via the ultrasonic transmitter s1). Further, the second transmitter 171b is positioned on the right side with respect to the ultrasonic transmitter 121 (center line LS shown in FIG. 4) for a predetermined transmission time Ts3 shown in FIG. 4B based on an instruction from the detector 171f. An ultrasonic signal having a predetermined divergence angle θs (see FIG. 5) is transmitted to the right with respect to the traveling direction of the cleaning robot 1 via the disposed ultrasonic transmitter s3).

第1受信部171cは、第1発信部171aにより超音波発信器s2を介して発信され、壁面(又は、障害物)で反射された反射信号の内、受信可能な角θr(図5参照)内の反射信号を、検出部171fからの指示に基づき、超音波受信器122(図4に示す中心線LSの左右に配設された超音波受信器r2、r3)を介して、図4(b)に示す所定の受信時間Tr2だけ受信するものである。   The first receiving unit 171c is transmitted through the ultrasonic transmitter s2 by the first transmitting unit 171a, and can receive an angle θr (see FIG. 5) among the reflected signals reflected by the wall surface (or obstacle). The reflected signal in the signal is transmitted through the ultrasonic receiver 122 (ultrasonic receivers r2 and r3 disposed on the left and right of the center line LS shown in FIG. 4) based on an instruction from the detection unit 171f in FIG. It is received only for the predetermined reception time Tr2 shown in b).

第2受信部171dは、第2発信部171bにより超音波発信器s1を介して発信され、壁面(又は、障害物)で反射された反射信号の内、受信可能な角θr(図5参照)内の反射信号を、検出部171fからの指示に基づき、超音波受信器122(図4に示す中心線LSの左側に配設された超音波受信器r1、r2)を介して、図4(b)に示す所定の受信時間Tr1だけ受信するものである。また、第2受信部171dは、第2発信部171bにより超音波発信器s3を介して発信され、壁面(又は、障害物)で反射された反射信号の内、受信可能な角θr(図5参照)内の反射信号を、検出部171fからの指示に基づき、超音波受信器122(図4に示す中心線LSの右側に配設された超音波受信器r3、r4)を介して、図4(b)に示す所定の受信時間Tr3だけ受信するものである。   The second receiving unit 171d transmits an angle θr (see FIG. 5) that can be received from the reflected signal that is transmitted from the second transmitting unit 171b via the ultrasonic transmitter s1 and reflected by the wall surface (or obstacle). The reflected signal in the signal is transmitted through the ultrasonic receiver 122 (ultrasonic receivers r1 and r2 disposed on the left side of the center line LS shown in FIG. 4) based on an instruction from the detection unit 171f. It is received only for the predetermined reception time Tr1 shown in b). In addition, the second receiving unit 171d transmits the angle θr (FIG. 5) that can be received among the reflected signals that are transmitted by the second transmitting unit 171b via the ultrasonic transmitter s3 and reflected by the wall surface (or obstacle). The reflected signal in FIG. 4 is transmitted via the ultrasonic receiver 122 (ultrasonic receivers r3 and r4 disposed on the right side of the center line LS shown in FIG. 4) based on an instruction from the detection unit 171f. The signal is received only for a predetermined reception time Tr3 shown in 4 (b).

距離算出部171eは、第1発信部171aによる発信時刻から第1受信部171cによる受信時刻までの経過時間を用いて壁面(又は、障害物)との距離を求めると共に、第2発信部171bによる発信時刻から第2受信部171dによる受信時刻までの経過時間を用いて壁面(又は、障害物)との距離を求めるものである。   The distance calculation unit 171e obtains the distance from the wall surface (or obstacle) using the elapsed time from the transmission time by the first transmission unit 171a to the reception time by the first reception unit 171c, and by the second transmission unit 171b. The distance from the wall surface (or obstacle) is obtained using the elapsed time from the transmission time to the reception time by the second reception unit 171d.

具体的には、距離算出部171eは、第1発信部171aによる超音波発信器s2からの発信時刻から第1受信部171cによる超音波受信器r2、r3での受信時刻までの経過時間を用いて進行方向正面前方の壁面(又は、障害物)との距離を求めるものである。   Specifically, the distance calculation unit 171e uses the elapsed time from the transmission time from the ultrasonic transmitter s2 by the first transmission unit 171a to the reception time at the ultrasonic receivers r2 and r3 by the first reception unit 171c. Thus, the distance to the wall surface (or obstacle) in front of the traveling direction is obtained.

また、距離算出部171eは、第2発信部171bによる超音波発信器s1からの発信時刻から第2受信部171dによる超音波受信器r1、r2での受信時刻までの経過時間を用いて進行方向左側の壁面(又は、障害物)との距離L11、L12(図5参照)を求めると共に、第2発信部171bによる超音波発信器s3からの発信時刻から第2受信部171dによる超音波受信器r3、r4での受信時刻までの経過時間を用いて進行方向右側の壁面(又は、障害物)との距離を求めるものである。   Further, the distance calculation unit 171e uses the elapsed time from the transmission time from the ultrasonic transmitter s1 by the second transmission unit 171b to the reception time at the ultrasonic receivers r1 and r2 by the second reception unit 171d. While obtaining distances L11 and L12 (see FIG. 5) with the left wall surface (or obstacle), the ultrasonic receiver by the second receiver 171d from the transmission time from the ultrasonic transmitter s3 by the second transmitter 171b The distance from the wall surface (or obstacle) on the right side in the traveling direction is obtained using the elapsed time up to the reception time at r3 and r4.

検出部171fは、バンパ13に配設された3台の超音波発信器121と4台の超音波受信器122とを介して第1発信部171a、第2発信部171b、第1受信部171c及び第2受信部171dに対して指示情報を出力して、距離算出部171eによって検出された1の距離又は複数の距離の最小値を離間距離として検出するものである。以下、図4を用いて具体的に説明する。図4は、検出部171fの動作の一例を示す説明図である。   The detection unit 171f includes a first transmission unit 171a, a second transmission unit 171b, and a first reception unit 171c via three ultrasonic transmitters 121 and four ultrasonic receivers 122 disposed in the bumper 13. The instruction information is output to the second receiving unit 171d, and the minimum value of one distance or a plurality of distances detected by the distance calculating unit 171e is detected as the separation distance. Hereinafter, this will be specifically described with reference to FIG. FIG. 4 is an explanatory diagram illustrating an example of the operation of the detection unit 171f.

(a)は、センサの配置と検出される距離との関係を示す平面図であり、(b)は、3台の超音波発信器121と4台の超音波受信器122との動作タイミングを示すタイミングチャートである。(a)に示すように、進行方向V1に対して、超音波発信器s2を中心(進行方向V1の先端位置)として、等間隔に、3台の超音波発信器121と4台の超音波受信器122とが交互に配設されている。ここでは、進行方向V1に向かって左側から、超音波受信器r1、超音波発信器s1、超音波受信器r2、超音波発信器s2、超音波受信器r3、超音波発信器s3、超音波受信器r4の順に配設されているものする。   (A) is a top view which shows the relationship between the arrangement | positioning of a sensor and the distance detected, (b) shows the operation timing of the three ultrasonic transmitters 121 and the four ultrasonic receivers 122. FIG. It is a timing chart which shows. As shown in (a), three ultrasonic transmitters 121 and four ultrasonic waves are equally spaced with respect to the traveling direction V1 with the ultrasonic transmitter s2 as the center (tip position in the traveling direction V1). Receivers 122 are arranged alternately. Here, from the left side in the traveling direction V1, the ultrasonic receiver r1, the ultrasonic transmitter s1, the ultrasonic receiver r2, the ultrasonic transmitter s2, the ultrasonic receiver r3, the ultrasonic transmitter s3, the ultrasonic wave Assume that the receivers r4 are arranged in this order.

また、ここでは、本体部10の中心点Oを通り、進行方向V1に平行な直線である中心線LSについて、3台の超音波発信器121と4台の超音波受信器122とが線対称な位置に配設されている。具体的には、例えば、超音波発信器s1と超音波発信器s3とが中心線LSについて線対称な位置に配設され、また、超音波受信器r1と超音波受信器r4とが中心線LSについて線対称な位置に配設されている。   Here, the three ultrasonic transmitters 121 and the four ultrasonic receivers 122 are line-symmetric with respect to the center line LS that is a straight line that passes through the center point O of the main body 10 and is parallel to the traveling direction V1. Are arranged at various positions. Specifically, for example, the ultrasonic transmitter s1 and the ultrasonic transmitter s3 are arranged at positions symmetrical with respect to the center line LS, and the ultrasonic receiver r1 and the ultrasonic receiver r4 are center lines. It is disposed at a position symmetrical with respect to LS.

ここでは、掃除ロボット1は、進行方向V1の左側に壁面Wが進行方向V1と平行に存在している場合について説明する。超音波発信器s1から発信された超音波が壁面Wで反射して超音波受信器r1及び超音波受信器r2に到達するが、その伝搬距離から、本体部10と壁面Wとの距離L11及びL12がそれぞれ求められる。ここでは、距離L11が距離L12より小さいため、検出部171fによって距離L11が離間距離として検出される。   Here, the cleaning robot 1 demonstrates the case where the wall surface W exists in parallel with the advancing direction V1 on the left side of the advancing direction V1. The ultrasonic wave transmitted from the ultrasonic transmitter s1 is reflected by the wall surface W and reaches the ultrasonic receiver r1 and the ultrasonic receiver r2. From the propagation distance, the distance L11 between the main body 10 and the wall surface W and L12 is obtained respectively. Here, since the distance L11 is smaller than the distance L12, the distance L11 is detected as the separation distance by the detection unit 171f.

また、(b)に示すように、検出部171fから第1発信部171a、第2発信部171b、第1受信部171c及び第2受信部171dに対する指示情報に基づいて以下の動作が実行される。まず、所定の発信時間Ts1(例えば、2msec)だけ超音波発信器s1から超音波が発信され、超音波発信器s1からの超音波の発信が開始されてから所定の受信時間Tr1(例えば、4msec)だけ、超音波受信器r1及び超音波受信器r2で受信される。そして、超音波受信器r1及び超音波受信器r2での受信が停止されてから所定の休止時間(例えば、1msec)後に、所定の発信時間Ts2(例えば、2msec)だけ超音波発信器s2から超音波が発信され、超音波発信器s2からの超音波の発信が開始されてから所定の受信時間Tr2(例えば、4msec)だけ、超音波受信器r2及び超音波受信器r3で受信される。   Further, as shown in (b), the following operation is executed based on instruction information from the detection unit 171f to the first transmission unit 171a, the second transmission unit 171b, the first reception unit 171c, and the second reception unit 171d. . First, an ultrasonic wave is transmitted from the ultrasonic transmitter s1 for a predetermined transmission time Ts1 (for example, 2 msec), and a predetermined reception time Tr1 (for example, 4 msec) after the transmission of the ultrasonic wave from the ultrasonic transmitter s1 is started. ) Only by the ultrasonic receiver r1 and the ultrasonic receiver r2. Then, after the reception by the ultrasonic receiver r1 and the ultrasonic receiver r2 is stopped, after a predetermined pause time (for example, 1 msec), the ultrasonic wave is transmitted from the ultrasonic transmitter s2 for a predetermined transmission time Ts2 (for example, 2 msec). The ultrasonic wave is transmitted, and the ultrasonic wave receiver r2 and the ultrasonic wave receiver r3 receive the ultrasonic wave only for a predetermined reception time Tr2 (for example, 4 msec) after the transmission of the ultrasonic wave from the ultrasonic wave transmitter s2 is started.

次いで、超音波受信器r2及び超音波受信器r3での受信が停止されてから所定の休止時間(例えば、1msec)後に、所定の発信時間Ts3(例えば、2msec)だけ超音波発信器s3から超音波が発信され、超音波発信器s3からの超音波の発信が開始されてから所定の受信時間Tr3(例えば、4msec)だけ、超音波受信器r3及び超音波受信器r4で受信される。そして、超音波受信器r3及び超音波受信器r4での受信が停止されてから所定の休止時間(例えば、1msec)後に、所定の発信時間Ts1(例えば、2msec)だけ超音波発信器s1から超音波が発信され、上記の動作が繰り返し実行される。   Next, after a predetermined pause time (for example, 1 msec) after reception by the ultrasonic receiver r2 and the ultrasonic receiver r3 is stopped, the ultrasonic wave is transmitted from the ultrasonic transmitter s3 for a predetermined transmission time Ts3 (for example, 2 msec). The ultrasonic wave is transmitted and the ultrasonic wave is received by the ultrasonic wave receiver r3 and the ultrasonic wave receiver r4 for a predetermined reception time Tr3 (for example, 4 msec) after the transmission of the ultrasonic wave from the ultrasonic wave transmitter s3 is started. Then, after the reception by the ultrasonic receiver r3 and the ultrasonic receiver r4 is stopped, after a predetermined pause time (for example, 1 msec), the ultrasonic wave is transmitted from the ultrasonic transmitter s1 for a predetermined transmission time Ts1 (for example, 2 msec). A sound wave is transmitted, and the above operation is repeated.

このように、中心線LSの両側に配設された超音波受信器r2及び超音波受信器r3によって、超音波発信器s2から発信された超音波信号であって、壁面Wにおいて反射した反射信号が受信されるため、1のタイミングで超音波発信器s2から発信された超音波信号を用いて前方正面の2方向について、掃除ロボット1と壁面Wとの間の距離が求められ、前方正面の障害物が正確に検出されるのである。   As described above, the ultrasonic signal transmitted from the ultrasonic transmitter s2 by the ultrasonic receiver r2 and the ultrasonic receiver r3 disposed on both sides of the center line LS, and the reflected signal reflected on the wall surface W. Therefore, the distance between the cleaning robot 1 and the wall surface W is obtained in two directions on the front front using the ultrasonic signal transmitted from the ultrasonic transmitter s2 at the timing of 1. Obstacles are accurately detected.

ここで、超音波発信器121から発信される超音波の大気中での伝搬速度を340m/secとすると、受信時間Tr1〜Tr3が4msecである場合には、本体部10からの距離が略680mm以下の範囲に壁面Wが存在すれば、超音波発信器121から発信された超音波が超音波受信器122で受信されるため、本体部10と壁面Wとの距離が原理的には検出され得る。しかし、ここでは、便宜上、距離算出部171eによって算出された本体部10と壁面Wとの距離が200mmを超える場合には、検出可能な壁面Wが存在しないものとしている。   Here, when the propagation speed of the ultrasonic wave transmitted from the ultrasonic transmitter 121 in the atmosphere is 340 m / sec, when the reception times Tr1 to Tr3 are 4 msec, the distance from the main body 10 is approximately 680 mm. If the wall surface W exists in the following range, since the ultrasonic wave transmitted from the ultrasonic transmitter 121 is received by the ultrasonic receiver 122, the distance between the main body 10 and the wall surface W is detected in principle. obtain. However, here, for convenience, it is assumed that there is no detectable wall surface W when the distance between the main body 10 and the wall surface W calculated by the distance calculation unit 171e exceeds 200 mm.

また、ここでは、壁沿い走行を行う場合に、(a)に示すように壁面Wが進行方向V1の左側になるように制御される。更に、壁沿い走行を行う場合に、基準として用いる壁面Wの方向は、離間距離が検出された超音波発信器121と超音波受信器122との組み合わせに応じて予め設定されている。具体的には、(a)に示すように、検出部171fによって距離L11が離間距離として検出される場合には、壁面Wの方向は、距離L11を示す線分と垂直な向き((a)に示す直線LVの向き)であるとして検出される。   Further, here, when traveling along the wall, the wall surface W is controlled so as to be on the left side in the traveling direction V1 as shown in (a). Further, when traveling along the wall, the direction of the wall surface W used as a reference is set in advance according to the combination of the ultrasonic transmitter 121 and the ultrasonic receiver 122 in which the separation distance is detected. Specifically, as shown in (a), when the distance L11 is detected as the separation distance by the detection unit 171f, the direction of the wall surface W is the direction perpendicular to the line segment indicating the distance L11 ((a). The direction of the straight line LV shown in FIG.

なお、以下の説明において、超音波発信器si(i=1〜3)から発信された超音波信号を、超音波受信器rj(j=1〜4)で受信することによって求められる壁面Wと本体部10との距離を距離Lijという。   In addition, in the following description, the wall surface W calculated | required by receiving the ultrasonic signal transmitted from the ultrasonic transmitter si (i = 1-3) with the ultrasonic receiver rj (j = 1-4). A distance from the main body 10 is referred to as a distance Lij.

再び、図3に戻って、掃除ロボット1の主要部の構成について説明する。壁沿い走行部171gは、壁面(又は、障害物)に沿って走行させる制御モードである壁沿いモードでの走行をさせるべく、モータ113a、113bに対して進行方向を指示するものである。具体的には、検出部171fによって離間距離が検出された超音波発信器121と超音波受信器122との組み合わせに応じて予め設定されている方向(例えば、図4(a)に示す直線LVの向き)に沿って走行させるものである。   Returning to FIG. 3 again, the configuration of the main part of the cleaning robot 1 will be described. The along-wall traveling unit 171g instructs the motors 113a and 113b in the traveling direction so as to travel in the along-wall mode, which is a control mode for traveling along the wall surface (or obstacle). Specifically, a direction (for example, a straight line LV shown in FIG. 4A) set in advance according to the combination of the ultrasonic transmitter 121 and the ultrasonic receiver 122 whose separation distance is detected by the detection unit 171f. Direction).

ランダム走行部171hは、室内を直進と回転とを繰り返して走行させる制御モードであるランダムモードでの走行をさせるべく、検出部171fによって検出された離間距離が予め設定された所定値(例えば、20mm)以下となるまで直進し、検出部171fによって検出された離間距離が予め設定された所定値(例えば、20mm)以下である場合に直進を停止して、モータ113a、113bに対して進行方向を所定方向に変更させるものである。具体的には、例えば、離間距離が検出部171fによって検出された方向に対して角度Δθ(=θ0+α)だけ回転させるものである(図7参照)。ただし、角度θ0は、離間距離が検出された超音波発信器121と超音波受信器122との組み合わせに応じて予め設定されている角度である。例えば、超音波発信器s2と超音波受信器r2とによって離間距離が検出された場合には、角度θ0は45度であり、超音波発信器s1と超音波受信器r1とによって離間距離が検出された場合には、角度θ0は22.5度である。また、角度αは、0〜90度の範囲でランダムに設定される(例えば、乱数を発生させて、発生された乱数に基づき設定される)角度である。   The random travel unit 171h is a predetermined value (for example, 20 mm) in which the separation distance detected by the detection unit 171f is set in advance so as to travel in a random mode that is a control mode in which the vehicle travels linearly and rotates repeatedly. ) Go straight until the distance is less than or equal to the following, and when the separation distance detected by the detector 171f is less than or equal to a predetermined value (for example, 20 mm) set in advance, stop straight ahead and change the direction of travel relative to the motors 113a and 113b. It is changed in a predetermined direction. Specifically, for example, the distance is rotated by an angle Δθ (= θ0 + α) with respect to the direction detected by the detection unit 171f (see FIG. 7). However, the angle θ0 is an angle set in advance according to the combination of the ultrasonic transmitter 121 and the ultrasonic receiver 122 in which the separation distance is detected. For example, when the separation distance is detected by the ultrasonic transmitter s2 and the ultrasonic receiver r2, the angle θ0 is 45 degrees, and the separation distance is detected by the ultrasonic transmitter s1 and the ultrasonic receiver r1. In this case, the angle θ0 is 22.5 degrees. In addition, the angle α is an angle that is randomly set in a range of 0 to 90 degrees (for example, a random number is generated and set based on the generated random number).

直進時間測定部171iは、ランダム走行部171hによってランダムモードで走行中において、直進走行開始から停止までの時間である直進走行時間を測定し、測定された直進走行時間を直進時間記憶部172aに格納するものである。すなわち、回転を終了して、直進を開始した時点から、離間距離が予め設定された所定値(ここでは、20mm)以下となって停止される時点までの経過時間である直進走行時間を測定するものである。   The straight travel time measurement unit 171i measures the straight travel time that is the time from the start of straight travel to the stop while traveling in the random mode by the random travel unit 171h, and stores the measured straight travel time in the straight travel time storage unit 172a. To do. That is, the straight traveling time, which is the elapsed time from when the rotation is finished and the straight traveling is started to when the separation distance is equal to or less than a predetermined value (20 mm in this case) is stopped is measured. Is.

切換部171jは、所定回数(ここでは、3回)分の直進走行時間が所定の条件(以下、第1の条件という)を満たす場合に、ランダムモードを壁沿いモードへ切り換えるものである。なお、第1の条件は、ここでは、3回分の直進走行時間の和が予め設定された所定の閾値(例えば、3秒)以下であることとしている。   The switching unit 171j switches the random mode to the along-wall mode when the straight traveling time for a predetermined number of times (here, three times) satisfies a predetermined condition (hereinafter referred to as a first condition). Here, the first condition is that the sum of the three straight traveling times is not more than a predetermined threshold value (for example, 3 seconds) set in advance.

また、切換部171jは、壁沿いモードでの走行時間が予め設定された所定時間(例えば、15秒)に到達した(以下、この条件を第2の条件という)場合に、壁沿いモードをランダムモードへ切り換えるものである。すなわち、切換部171jは、第1の条件を満たす場合に、ランダムモードを壁沿いモードへ切り換え、第2の条件を満たす場合に、壁沿いモードをランダムモードへ切り換えるものである。   Further, the switching unit 171j randomly selects the wall-side mode when the traveling time in the wall-side mode reaches a predetermined time (for example, 15 seconds) (hereinafter, this condition is referred to as a second condition). Switch to mode. That is, the switching unit 171j switches the random mode to the wall-side mode when the first condition is satisfied, and switches the wall-side mode to the random mode when the second condition is satisfied.

禁止部171kは、ランダムモードの走行時間が予め設定された所定時間(例えば、5分)に到達していない場合に、切換部171jの動作を禁止するものである。すなわち、禁止部171kは、ランダムモードでの走行が開始されると少なくとも5分間以上は必ずランダムモードの走行を継続させるものである。   The prohibition unit 171k prohibits the operation of the switching unit 171j when the running time in the random mode has not reached a predetermined time (for example, 5 minutes) set in advance. That is, the prohibition unit 171k always continues running in the random mode for at least 5 minutes or more when the running in the random mode is started.

クリーナ制御部171mは、集塵に関する制御を行うものであって、具体的には、図1、2に示すファン143、サイドブラシ16等の制御を行うものである。   The cleaner control unit 171m performs control related to dust collection, and specifically controls the fan 143, the side brush 16 and the like shown in FIGS.

直進時間記憶部172aは、直進時間測定部171iによって測定された直進走行時間を3回分だけ格納するものである。すなわち、直進時間測定部171iによって、4回目以降の直進走行時間が測定された場合には、直進時間記憶部172aに格納された直進走行時間は、格納された順(=測定された順)に、直進時間測定部171iによって順次上書きされるものである。   The straight running time storage unit 172a stores the straight running time measured by the straight running time measuring unit 171i for three times. In other words, when the straight traveling time after the fourth time is measured by the straight traveling time measuring unit 171i, the straight traveling time stored in the straight traveling time storage unit 172a is stored in the stored order (= measured order). These are sequentially overwritten by the straight time measuring unit 171i.

図5は、超音波受信器122の受信可能な角θrが超音波発信器121の拡り角θsより大きい場合の死角の一例を示す図である。ここでは、受信可能な角θrが150°であり、拡り角θsが120°である場合について示している。(a)は、本願と同様に、中心線LS上に超音波発信器sa(図4の超音波発信器s2に対応する)が配設され、中心線LSについて線対称な位置に超音波受信器ra1、ra2(それぞれ、図4の超音波受信器r2、r3に対応する)が配設されている場合であり、(b)は、中心線LS上に超音波受信器rbが配設され、中心線LSについて線対称な位置に超音波発信器sb1、sb2が配設されている場合である。   FIG. 5 is a diagram illustrating an example of a blind spot when the angle θr that can be received by the ultrasonic receiver 122 is larger than the spread angle θs of the ultrasonic transmitter 121. Here, a case where the receivable angle θr is 150 ° and the spread angle θs is 120 ° is shown. In (a), similarly to the present application, an ultrasonic transmitter sa (corresponding to the ultrasonic transmitter s2 in FIG. 4) is disposed on the center line LS, and ultrasonic waves are received at positions symmetrical with respect to the center line LS. In this case, the devices ra1 and ra2 (corresponding to the ultrasonic receivers r2 and r3 in FIG. 4 respectively) are arranged, and (b) shows that the ultrasonic receiver rb is arranged on the center line LS. This is a case where the ultrasonic transmitters sb1 and sb2 are disposed at positions symmetrical with respect to the center line LS.

図の斜線部が検出可能な範囲であり、横線で示す領域BAA、BABが死角である。領域BABより、領域BAAは狭くなっており、超音波受信器122の受信可能な角θrが超音波発信器121の拡り角θsより大きい場合には、(a)に示す配置のほうが(b)に示す配置より、死角が小さくなることが分かる。すなわち、図4に示す本願のセンサ配置は、超音波受信器122の受信可能な角θrが超音波発信器121の拡り角θsより大きい場合には、死角においても良好な配置であることが分かる。   The shaded area in the figure is a detectable range, and the areas BAA and BAB indicated by horizontal lines are blind spots. When the area BAA is narrower than the area BAB and the angle θr that can be received by the ultrasonic receiver 122 is larger than the spread angle θs of the ultrasonic transmitter 121, the arrangement shown in FIG. It can be seen from the arrangement shown in FIG. That is, the sensor arrangement of the present application shown in FIG. 4 may be a good arrangement even in the blind spot when the receivable angle θr of the ultrasonic receiver 122 is larger than the spread angle θs of the ultrasonic transmitter 121. I understand.

図6は、制御部17の動作の一例を示すフローチャートである。まず、ランダム走行部171hによって、ランダムモードでの走行が行われ、タイマ等によって掃除時間の計時が開始される(ステップS101)。そして、掃除時間として予め設定された時間(例えば、30分)が経過したか否かが判定される(ステップS103)。30分が経過したと判定された場合(ステップS103でYES)には、処理が終了される。30分が経過していないと判定された場合(ステップS103でNO)には、禁止部171kによって、ランダムモードでの走行が開始されてから時間T1(ここでは、5分)以上経過したか否かの判定が行われる(ステップS105)。   FIG. 6 is a flowchart illustrating an example of the operation of the control unit 17. First, the random travel unit 171h travels in the random mode, and the time for cleaning is started by a timer or the like (step S101). Then, it is determined whether a preset time (for example, 30 minutes) has passed as the cleaning time (step S103). If it is determined that 30 minutes have elapsed (YES in step S103), the process ends. If it is determined that 30 minutes have not elapsed (NO in step S103), whether or not time T1 (5 minutes in this case) has elapsed since the prohibition unit 171k started traveling in the random mode. Is determined (step S105).

時間T1以上は経過していない(すなわち、経過時間が5分未満である)と判定された場合(ステップS105でNO)には、禁止部171kによって、処理がステップS101に戻される。時間T1以上経過したと判定された場合(ステップS105でYES)には、ランダムモードでの走行と壁沿いモードでの走行を交互に行うモード(以下、混合モードという)での走行が行われる(ステップS107)。   If it is determined that the time T1 or more has not elapsed (that is, the elapsed time is less than 5 minutes) (NO in step S105), the prohibition unit 171k returns the process to step S101. If it is determined that time T1 or more has elapsed (YES in step S105), traveling in a mode (hereinafter referred to as a mixed mode) in which traveling in the random mode and traveling along the wall mode are performed alternately (hereinafter, referred to as mixed mode) is performed ( Step S107).

そして、掃除時間として予め設定された時間(例えば、30分)が経過したか否かが判定される(ステップS109)。30分が経過したと判定された場合(ステップS109でYES)には、処理が終了される。30分が経過していないと判定された場合(ステップS103でNO)には、禁止部171kによって、混合モードでの走行が開始されてから時間T2(ここでは、5分)以上経過したか否かの判定が行われる(ステップS111)。時間T2以上は経過していない(すなわち、経過時間が5分未満である)と判定された場合(ステップS111でNO)には、禁止部171kによって、処理がステップS107に戻される。時間T2以上経過したと判定された場合(ステップS111でYES)には、処理がステップS101に戻される。   Then, it is determined whether or not a preset time (for example, 30 minutes) has passed as the cleaning time (step S109). If it is determined that 30 minutes have elapsed (YES in step S109), the process ends. If it is determined that 30 minutes have not elapsed (NO in step S103), whether or not time T2 (here, 5 minutes) or more has elapsed since the prohibition unit 171k started traveling in the mixed mode. Is determined (step S111). If it is determined that the time T2 or more has not elapsed (that is, the elapsed time is less than 5 minutes) (NO in step S111), the prohibition unit 171k returns the process to step S107. If it is determined that time T2 or more has elapsed (YES in step S111), the process returns to step S101.

図7は、図6に示すフローチャートのステップS107で行われる混合走行モードでの動作の一例を示す詳細フローチャートである。なお、以下の処理は、特に記載しない限り切換部171jによって行われる。また、ランダムモードを壁沿いモードへ切り換える条件を構成する、3回分の直進走行時間を、ここでは、第1直進走行時間TS1、第2直進走行時間TS2、第3直進走行時間TS3という。   FIG. 7 is a detailed flowchart showing an example of the operation in the mixed travel mode performed in step S107 of the flowchart shown in FIG. The following processing is performed by the switching unit 171j unless otherwise specified. Further, the three straight travel times constituting the condition for switching the random mode to the wall-side mode are referred to as a first straight travel time TS1, a second straight travel time TS2, and a third straight travel time TS3.

まず、直進走行時間の測定回数をカウントする回数カウンタNの値が1に初期化される(ステップS201)。そして、直進走行時間TSが0に初期化されて、直進走行時間TSの計時が開始される(ステップS203)。次いで、ランダム走行部171hによって、ランダムモードでの走行が行われる(ステップS205)。   First, the value of the number counter N that counts the number of measurements of the straight traveling time is initialized to 1 (step S201). Then, the straight traveling time TS is initialized to 0, and the time measurement of the straight traveling time TS is started (step S203). Next, traveling in random mode is performed by the random traveling unit 171h (step S205).

そして、直進時間測定部171iによって、直進走行時間TSが求められる(ステップS207)。次ぎに、直進時間測定部171iによって、第1直進走行時間TS1が第2直進走行時間TS2の値に更新され、第2直進走行時間TS2が第3直進走行時間TS3の値に更新され、第3直進走行時間TS3が直進走行時間TSの値に更新される(ステップS209)。   Then, the straight traveling time TS is obtained by the straight traveling time measuring unit 171i (step S207). Next, the first straight travel time TS1 is updated to the value of the second straight travel time TS2, the second straight travel time TS2 is updated to the value of the third straight travel time TS3 by the straight travel time measurement unit 171i, and the third The straight traveling time TS3 is updated to the value of the straight traveling time TS (step S209).

そして、回数カウンタNの値が3以上であるか否かの判定が行われる(ステップS211)。回数カウンタNの値が3以上ではないと判定された場合(ステップS211でNO)には、回数カウンタNが1だけインクリメントされ(ステップS213)、処理がステップS203に戻される。回数カウンタNの値が3以上であると判定された場合(ステップS211でYES)には、3回分の直進走行時間の和(=TS1+TS2+TS3)である合計時間TTが求められ(ステップS215)、合計時間TTが閾値T0(ここでは、3秒)以上であるか否かの判定が行われる(ステップS217)。   Then, it is determined whether or not the value of the number counter N is 3 or more (step S211). If it is determined that the value of the number counter N is not 3 or more (NO in step S211), the number counter N is incremented by 1 (step S213), and the process returns to step S203. When it is determined that the value of the number counter N is 3 or more (YES in step S211), a total time TT that is the sum of three straight traveling times (= TS1 + TS2 + TS3) is obtained (step S215), and the total It is determined whether or not the time TT is equal to or greater than a threshold value T0 (here, 3 seconds) (step S217).

合計時間TTが閾値T0以下ではない(閾値T0より大きい)と判定された場合(ステップS217でNO)には、処理がステップS201に戻される。合計時間TTが閾値T0以下であると判定された場合(ステップS217でYES)には、壁沿い走行部171gによって、壁沿い走行が行われる(ステップS219)。そして、壁沿い走行を開始してからの経過時間が、予め設定された時間T3(ここでは、15秒)以上であるか否かの判定が行われる(ステップS221)。時間T3以上ではないと判定された場合(ステップS221でNO)には、処理がステップS219に戻される。時間T3以上であると判定された場合(ステップS221でYES)には、処理がリターンされる(=図6に示すフローチャートのステップS109が開始される)。   If it is determined that the total time TT is not less than or equal to the threshold value T0 (greater than the threshold value T0) (NO in step S217), the process returns to step S201. When it is determined that the total time TT is equal to or less than the threshold value T0 (YES in step S217), traveling along the wall is performed by the wall traveling section 171g (step S219). Then, it is determined whether or not the elapsed time since the start of traveling along the wall is equal to or longer than a preset time T3 (here, 15 seconds) (step S221). If it is determined that the time is not equal to or greater than time T3 (NO in step S221), the process returns to step S219. If it is determined that the time is equal to or greater than time T3 (YES in step S221), the process is returned (= step S109 in the flowchart shown in FIG. 6 is started).

図8は、図6に示すフローチャートのステップS101及び図7に示すフローチャートのステップS205で行われるランダム走行モードでの動作の一例を示す詳細フローチャートである。なお、以下の処理は、特に記載しない限りランダム走行部171hによって行われる。まず、直進が開始される(ステップS301)。そして、検出部171fによって、図4に示す距離L11〜L34が測定される(ステップS303)。次いで、検出部171fによって、距離L11〜L34の内最小値である離間距離LMが閾値LSH(ここでは、20mm)以下であるか否かの判定が行われる(ステップS305)。   FIG. 8 is a detailed flowchart showing an example of the operation in the random travel mode performed in step S101 of the flowchart shown in FIG. 6 and step S205 of the flowchart shown in FIG. The following processing is performed by the random travel unit 171h unless otherwise specified. First, straight travel is started (step S301). Then, the distances L11 to L34 shown in FIG. 4 are measured by the detection unit 171f (step S303). Next, the detection unit 171f determines whether or not the separation distance LM, which is the minimum value among the distances L11 to L34, is equal to or less than a threshold value LSH (here, 20 mm) (step S305).

閾値LSH以下ではない(閾値LSHより大きい)と判定された場合(ステップS305でNO)には、処理がステップS301に戻され、直進が継続される。閾値LSH以下であると判定された場合(ステップS305でYES)には、走行が停止される(ステップS307)。そして、超音波発信器121と超音波受信器122との組み合わせに応じて予め設定されている角度θ0と0〜90度の範囲でランダムに設定される角度αとの和として回転角Δθが求められる(ステップS309)。次ぎに、回転角Δθだけ回転され(=進行方向が変更され)(ステップS311)、処理がリターンされる。   If it is determined that it is not less than or equal to threshold value LSH (greater than threshold value LSH) (NO in step S305), the process returns to step S301 and continues straight. If it is determined that it is equal to or less than the threshold value LSH (YES in step S305), the traveling is stopped (step S307). Then, the rotation angle Δθ is obtained as the sum of the angle θ0 set in advance according to the combination of the ultrasonic transmitter 121 and the ultrasonic receiver 122 and the angle α set at random in the range of 0 to 90 degrees. (Step S309). Next, it is rotated by the rotation angle Δθ (= the traveling direction is changed) (step S311), and the process is returned.

図9は、図7に示すフローチャートのステップS219で行われる壁沿い走行モードでの動作の一例を示す詳細フローチャートである。なお、以下の処理は、特に記載しない限り壁沿い走行部171gによって行われる。まず、検出部171fによって、図4に示す距離L11〜L34が測定される(ステップS401)。次いで、最も近い壁面(又は、障害物)と平行な方向に回転される(ステップS403)。そして、直進が開始される(ステップS405)。   FIG. 9 is a detailed flowchart showing an example of the operation in the wall running mode performed in step S219 of the flowchart shown in FIG. The following processing is performed by the along-wall traveling unit 171g unless otherwise specified. First, the distances L11 to L34 shown in FIG. 4 are measured by the detection unit 171f (step S401). Next, it is rotated in a direction parallel to the nearest wall surface (or obstacle) (step S403). Then, straight travel is started (step S405).

次いで、検出部171fによって、距離L11〜L34が測定される(ステップS407)。そして、距離L22、L23、L33、L34の内、最小の距離が閾値LM(ここでは、20mm)以下であるか否かの判定が行われる(ステップS409)。閾値LM以下であると判定された場合(ステップS409でYES)には、処理がリターンされる(図7に示すフローチャートのステップS221の処理が開始される)。   Next, the distances L11 to L34 are measured by the detection unit 171f (step S407). Then, it is determined whether or not the minimum distance among the distances L22, L23, L33, and L34 is equal to or less than a threshold value LM (here, 20 mm) (step S409). If it is determined that the value is equal to or less than the threshold LM (YES in step S409), the process is returned (the process in step S221 in the flowchart shown in FIG. 7 is started).

閾値LM以下ではない(閾値LMより大きい)と判定された場合(ステップS409でNO)には、進行方向を修正するパラメータα1〜α3が次の(1)〜(3)式により求められる(ステップS411、413、415)。
α1←(L01−L11)×A11 (1)
α2←(L02−L12)×A12 (2)
α3←(α1+α2)/2 (3)
ここで、距離L01、L02は、それぞれ、壁沿い走行モードでの距離L11、L12の基準距離である。例えば、距離L01、L02は、図4において、進行方向V1が壁面Wと平行であり、且つ、本体部10と壁面Wとの距離が閾値LMである場合の距離L11、L12の値である。また、定数A11、A12は、予め設定された比例定数である。
If it is determined that it is not less than or equal to the threshold value LM (greater than the threshold value LM) (NO in step S409), parameters α1 to α3 for correcting the traveling direction are obtained by the following equations (1) to (3) (step) S411, 413, 415).
α1 ← (L01−L11) × A11 (1)
α2 ← (L02−L12) × A12 (2)
α3 ← (α1 + α2) / 2 (3)
Here, the distances L01 and L02 are reference distances of the distances L11 and L12 in the travel mode along the wall, respectively. For example, the distances L01 and L02 are values of the distances L11 and L12 in the case where the traveling direction V1 is parallel to the wall surface W and the distance between the main body 10 and the wall surface W is the threshold LM in FIG. Constants A11 and A12 are preset proportionality constants.

そして、左右の車輪の周速VR、VLが、現在の周速Vを用いて、それぞれ次の(4)、(5)式で求められ、モータ113a、113bに対して指示され(ステップS417)、処理がステップS407に戻される。
VR←V−α3 (4)
VL←V+α3 (5)
Then, the peripheral speeds VR and VL of the left and right wheels are obtained by the following equations (4) and (5) using the current peripheral speed V, respectively, and are instructed to the motors 113a and 113b (step S417). The processing is returned to step S407.
VR ← V−α3 (4)
VL ← V + α3 (5)

図10は、上述の混合走行モードと従来の走行制御(上述の特許文献1:特開2002−136454号公報参照)とを比較した制御結果の一例を示す図である。図は、掃除ロボット1を走行させる室内の平面図であり、(a)は従来の走行制御での走行結果、(b)は上述の混合走行モードでの走行結果を表している。室内ARには、左上側に、2箇所の障害物W1、W2が隣接して配置され、右下側に、障害物W3が配置されている。   FIG. 10 is a diagram illustrating an example of a control result comparing the above-described mixed traveling mode and conventional traveling control (see Patent Document 1: Japanese Patent Laid-Open No. 2002-136454). FIG. 4 is a plan view of the room in which the cleaning robot 1 is driven, in which (a) shows a running result in conventional running control, and (b) shows a running result in the above-described mixed running mode. In the room AR, two obstacles W1 and W2 are arranged adjacent to each other on the upper left side, and an obstacle W3 is arranged on the lower right side.

(a)に示すように、従来の走行制御では、障害物W1、W2、W3の近傍に、壁沿いモードでの走行範囲MCP1が7箇所発生している。これに対して、(b)に示すように、上述の混合走行モードでは、壁沿いモードでの走行範囲MCP2は、わずかに3箇所となっている。つまり、従来の走行制御では、壁沿いモードでの走行範囲となる領域の内、過半数の領域において、上述の混合走行モードでは、ランダムモードでの走行が行われることとなり、室内ARをより均一に走行させることが可能となるのである。   As shown in (a), in the conventional traveling control, seven traveling ranges MCP1 in the wall-side mode are generated in the vicinity of the obstacles W1, W2, and W3. On the other hand, as shown in (b), in the above-described mixed traveling mode, the traveling range MCP2 in the along-wall mode is only three places. In other words, in the conventional traveling control, in the above-described mixed traveling mode, the traveling in the random mode is performed in the majority of the region that is the traveling range in the wall-side mode, and the indoor AR is made more uniform. It is possible to run.

上述のようにして、中心線LSの両側に配設された超音波受信器r2及び超音波受信器r3によって、超音波発信器s2から発信された超音波信号であって、壁面(又は、障害物)において反射した反射信号が受信されるため、1のタイミングで超音波発信器s2から発信された超音波信号を用いて前方正面の2方向について、掃除ロボット1と壁面(又は、障害物)Wとの間の距離が求められ、前方正面の障害物が正確に検出される。   As described above, an ultrasonic signal transmitted from the ultrasonic transmitter s2 by the ultrasonic receiver r2 and the ultrasonic receiver r3 disposed on both sides of the center line LS, Since the reflected signal reflected at the object) is received, the cleaning robot 1 and the wall surface (or obstacle) in two directions in front of the front using the ultrasonic signal transmitted from the ultrasonic transmitter s2 at one timing. The distance to W is obtained, and the obstacle in front of the front is accurately detected.

また、超音波受信器r2、r3が、掃除ロボット1の本体部10の中心Oを通り進行方向V1に平行な直線である中心線LSに対して線対称な位置に配設されているため、1のタイミングで超音波発信器s2から発信された超音波信号を用いて前方正面の2方向について、掃除ロボット1と壁面(又は、障害物)Wとの間の距離が求められ、前方正面の障害物が更に正確に検出される。   Further, since the ultrasonic receivers r2 and r3 are arranged at positions symmetrical with respect to the center line LS that is a straight line passing through the center O of the main body 10 of the cleaning robot 1 and parallel to the traveling direction V1, The distance between the cleaning robot 1 and the wall surface (or obstacle) W is obtained in two directions on the front front using the ultrasonic signal transmitted from the ultrasonic transmitter s2 at the timing of 1. Obstacles are detected more accurately.

更に、超音波受信器r2、r3が、掃除ロボット1の本体部10の中心Oを通り進行方向V1に平行な直線である中心線LSの両側にそれぞれ1個だけ配設されているため、簡単な構成で、前方正面の障害物が正確に検出される。   Furthermore, since only one ultrasonic receiver r2, r3 is disposed on each side of the center line LS, which is a straight line that passes through the center O of the main body 10 of the cleaning robot 1 and is parallel to the traveling direction V1, it is simple. With this configuration, an obstacle in front of the front can be accurately detected.

加えて、超音波発信器s1によって中心線LSから離間する方向(=進行方向V1に対して左方向)に超音波信号が発信され、壁面(又は、障害物)Wにおいて反射した反射信号が超音波受信器r1、r2により受信されるまでの経過時間を用いて、掃除ロボット1と壁面(又は、障害物)Wとの間の距離が求められると共に、超音波発信器s3によって中心線LSから離間する方向(=進行方向V1に対して右方向)に超音波信号が発信され、壁面(又は、障害物)Wにおいて反射した反射信号が超音波受信器r3、r4により受信されるまでの経過時間を用いて、掃除ロボット1と壁面(又は、障害物)Wとの間の距離が求められるため、中心線LSから離間する方向の掃除ロボット1と壁面(又は、障害物)Wとの間の距離が検出される。   In addition, an ultrasonic signal is transmitted in a direction away from the center line LS (= leftward with respect to the traveling direction V1) by the ultrasonic transmitter s1, and the reflected signal reflected on the wall surface (or obstacle) W is super The distance between the cleaning robot 1 and the wall surface (or obstacle) W is obtained using the elapsed time until it is received by the sound wave receivers r1 and r2, and the distance from the center line LS by the ultrasonic transmitter s3. Elapsed time until the ultrasonic signal is transmitted in the direction of separation (= rightward with respect to the traveling direction V1) and the reflected signal reflected by the wall surface (or obstacle) W is received by the ultrasonic receivers r3 and r4. Since the distance between the cleaning robot 1 and the wall surface (or obstacle) W is obtained using time, the distance between the cleaning robot 1 and the wall surface (or obstacle) W in a direction away from the center line LS is obtained. The distance is detected .

また、超音波発信器s1、s3が、中心線LSに対して線対称な位置にそれぞれ1個だけ配設されているため、簡単な構成で、中心線LSから離間する方向の掃除ロボット1と壁面(又は、障害物)Wとの間の距離が検出される。   Further, since only one ultrasonic transmitter s1, s3 is disposed at a position symmetrical with respect to the center line LS, the cleaning robot 1 in a direction away from the center line LS can be configured with a simple configuration. A distance from the wall surface (or obstacle) W is detected.

更に、超音波発信器s1、s2、s3が、予め設定された順序(ここでは、超音波発信器s1、s2、s3の順)で順次発信されるため、進行方向の前方正面と、進行方向に対して左右方向とに関して、掃除ロボット1と壁面(又は、障害物)Wとの間の距離が順次検出され、適正な検出が行われる。   Furthermore, since the ultrasonic transmitters s1, s2, and s3 are sequentially transmitted in a preset order (in this case, the ultrasonic transmitters s1, s2, and s3), the front in the traveling direction and the traveling direction With respect to the horizontal direction, the distance between the cleaning robot 1 and the wall surface (or obstacle) W is sequentially detected, and appropriate detection is performed.

加えて、室内を直進と回転とを繰り返して走行させる制御モードであるランダムモードで走行中の、所定回数(ここでは、3回)分の直進走行時間TS1〜TS3が所定の条件を満たす場合に、ランダムモードが、室内の外縁に沿って走行させる制御モードである壁沿いモードへ切り換えられるため、室内の外縁が複雑な形状である場合であっても、適度な頻度で壁沿いモードへ切り換られ、室内を略均一に走行させることが可能となる。   In addition, when traveling in the random mode, which is a control mode in which the vehicle travels straight ahead and rotates repeatedly, the straight traveling times TS1 to TS3 for a predetermined number of times (here, three times) satisfy a predetermined condition. Because the random mode is switched to the along-wall mode, which is a control mode that runs along the outer edge of the room, even if the outer edge of the room is a complicated shape, the mode is switched to the along-wall mode at an appropriate frequency. Therefore, it is possible to run the room substantially uniformly.

なお、本発明は以下の形態をとることができる。   In addition, this invention can take the following forms.

(A)本実施形態においては、自走式ロボットが掃除ロボット1である場合について説明したが、その他の所定の領域内を略均一に走行させる自走式ロボットでもよい。例えば、庭等の芝生上を走行する芝刈り機を備えた芝刈りロボットである形態でもよい。   (A) In the present embodiment, the case where the self-propelled robot is the cleaning robot 1 has been described. However, a self-propelled robot that travels substantially uniformly in another predetermined area may be used. For example, a form of a lawn mowing robot including a lawn mower that travels on a lawn such as a garden may be employed.

(B)本実施形態においては、距離センサ12が超音波センサを備える場合について説明したが、その他の種類の距離センサ(例えば、電磁波センサ等)である形態でもよい。   (B) Although the case where the distance sensor 12 includes an ultrasonic sensor has been described in the present embodiment, other types of distance sensors (for example, an electromagnetic wave sensor or the like) may be used.

(C)本実施形態においては、第1受信部171cが、2個の超音波受信器122(図4に示す中心線LSの左右に配設された超音波受信器r2、r3)を介して反射信号を受信する場合について説明したが、3個以上(例えば、4個)の超音波受信器122を介して反射信号を受信する形態でもよい。この場合には、掃除ロボット1と壁面(又は、障害物)Wとの間の距離を更に正確に測定することが可能となる。   (C) In the present embodiment, the first receiving unit 171c is connected via two ultrasonic receivers 122 (ultrasonic receivers r2 and r3 disposed on the left and right of the center line LS shown in FIG. 4). Although the case where the reflected signal is received has been described, the reflected signal may be received via three or more (for example, four) ultrasonic receivers 122. In this case, the distance between the cleaning robot 1 and the wall surface (or obstacle) W can be measured more accurately.

(D)本実施形態においては、第2発信部171bが、2個の超音波発信器121(図4に示す中心線LSに対して左右両側に配設された超音波発信器s1、s3)を介して、超音波信号を発信する場合について説明したが、3個以上(例えば、4個)の超音波発信器121を介して超音波信号を発信する形態でもよい。この場合には、掃除ロボット1と壁面(又は、障害物)Wとの間の距離を更に正確に測定することが可能となる。   (D) In the present embodiment, the second transmitter 171b includes two ultrasonic transmitters 121 (the ultrasonic transmitters s1 and s3 disposed on the left and right sides with respect to the center line LS shown in FIG. 4). Although the case where the ultrasonic signal is transmitted via the ultrasonic wave transmitter has been described, the ultrasonic signal may be transmitted via three or more (for example, four) ultrasonic transmitters 121. In this case, the distance between the cleaning robot 1 and the wall surface (or obstacle) W can be measured more accurately.

(E)本実施形態においては、超音波発信器121と超音波受信器122とが交互の配設されている場合(すなわち、2つの超音波発信器121の間に配設された超音波受信器122が、その2つの超音波発信器121から発信される超音波信号を時分割的に受信する)について説明したが、1の超音波受信器122が1の超音波発信器121から発信される超音波信号のみを受信する形態でもよい。この場合には、超音波発信器121の特性(例えば、超音波の周波数)に応じて超音波受信器122の特性(例えば、周波数特性)を微調整することが可能となり、掃除ロボット1と壁面(又は、障害物)Wとの間の距離を更に正確に測定することが可能となる。   (E) In the present embodiment, when the ultrasonic transmitters 121 and the ultrasonic receivers 122 are alternately arranged (that is, the ultrasonic reception provided between the two ultrasonic transmitters 121). In the above description, the transmitter 122 receives the ultrasonic signals transmitted from the two ultrasonic transmitters 121 in a time-sharing manner. However, one ultrasonic receiver 122 is transmitted from the single ultrasonic transmitter 121. It is also possible to receive only ultrasonic signals. In this case, it becomes possible to finely adjust the characteristics (for example, frequency characteristics) of the ultrasonic receiver 122 according to the characteristics (for example, the frequency of the ultrasonic waves) of the ultrasonic transmitter 121. It becomes possible to measure the distance to the (or obstacle) W more accurately.

(F)本実施形態においては、ランダムモードが壁沿いモードへ切り換えられる条件(第1の条件)が3回分の直進走行時間TS1〜TS3の和が閾値T0未満であることである場合について説明したが、直進走行時間TS1〜TS3に関するその他の条件である形態でもよい。例えば、第1の条件が、「直進走行時間TS1〜TS3の加重和(例えば、0.5×TS1+TS2+1.5×TS3)が所定の閾値未満であること」である形態でもよい。この場合には、加重を適正に設定することにより、更に適正な走行制御を行わせることができる。   (F) In the present embodiment, the case where the condition (first condition) for switching the random mode to the along-wall mode is that the sum of the three straight traveling times TS1 to TS3 is less than the threshold value T0 has been described. However, the form which is the other conditions regarding straight traveling time TS1-TS3 may be sufficient. For example, the first condition may be that “the weighted sum of the straight traveling times TS1 to TS3 (for example, 0.5 × TS1 + TS2 + 1.5 × TS3) is less than a predetermined threshold”. In this case, more appropriate travel control can be performed by setting the weight appropriately.

本発明に係る掃除ロボットの一例を示す底面図である。It is a bottom view which shows an example of the cleaning robot which concerns on this invention. 本発明に係る掃除ロボットの一例を示す斜視図である。It is a perspective view which shows an example of the cleaning robot which concerns on this invention. 掃除ロボットの主要部の一例を示す構成図である。It is a block diagram which shows an example of the principal part of a cleaning robot. 検出部の動作の一例を示す説明図である。It is explanatory drawing which shows an example of operation | movement of a detection part. 超音波受信器の受信可能な角θrが超音波発信器の拡り角θsより大きい場合の死角の一例を示す図である。It is a figure which shows an example of a blind spot in case the angle (theta) r which can be received of an ultrasonic receiver is larger than the expansion angle (theta) s of an ultrasonic transmitter. 制御部の動作の一例を示すフローチャートである。It is a flowchart which shows an example of operation | movement of a control part. 図6に示すフローチャートのステップS107で行われる混合走行モードでの動作の一例を示す詳細フローチャートである。It is a detailed flowchart which shows an example of the operation | movement in mixed running mode performed by step S107 of the flowchart shown in FIG. 図6に示すフローチャートのステップS101及び図7に示すフローチャートのステップS205で行われるランダム走行モードでの動作の一例を示す詳細フローチャートである。FIG. 8 is a detailed flowchart showing an example of an operation in a random travel mode performed in step S101 of the flowchart shown in FIG. 6 and step S205 of the flowchart shown in FIG. 図7に示すフローチャートのステップS219で行われる壁沿い走行モードでの動作の一例を示す詳細フローチャートである。It is a detailed flowchart which shows an example of the operation | movement in wall running mode performed by step S219 of the flowchart shown in FIG. 上述の混合走行モードと従来の走行制御とを比較した制御結果の一例を示す図である。It is a figure which shows an example of the control result which compared the above-mentioned mixed driving mode and the conventional driving control.

符号の説明Explanation of symbols

1 掃除ロボット
10 本体部
11 駆動部
12 距離センサ
121 超音波発信器(第1発信手段の一部、第2発信手段の一部)
122 超音波受信器(第1受信手段の一部、第2受信手段の一部)
17 制御部
171 CPU
171a 第1発信部(第1発信手段の一部)
171b 第2発信部(第2発信手段の一部)
171c 第1受信部(第1受信手段の一部)
171d 第2受信部(第2受信手段の一部)
171e 距離算出部(距離算出手段)
171f 検出部(検出手段の一部)
171g 壁沿い走行部(第1走行手段)
171h ランダム走行部(第2走行手段)
171i 直進時間測定部(直進時間測定手段)
171j 切換部(切換手段)
171k 禁止部(禁止手段)
171m クリーナ制御部
172 RAM
172a 直進時間記憶部
DESCRIPTION OF SYMBOLS 1 Cleaning robot 10 Main-body part 11 Drive part 12 Distance sensor 121 Ultrasonic transmitter (a part of 1st transmission means, a part of 2nd transmission means)
122 Ultrasonic receiver (part of first receiving means, part of second receiving means)
17 control unit 171 CPU
171a 1st transmission part (a part of 1st transmission means)
171b Second transmitter (part of second transmitter)
171c 1st receiving part (a part of 1st receiving means)
171d Second receiver (part of second receiver)
171e Distance calculation unit (distance calculation means)
171f detection part (part of detection means)
171g Traveling along the wall (first traveling means)
171h Random traveling part (second traveling means)
171i Straight running time measuring unit (straight running time measuring means)
171j Switching unit (switching means)
171k Prohibited part (prohibited means)
171m Cleaner control unit 172 RAM
172a Straight running time storage

Claims (7)

少なくとも1の車輪の駆動軸を所定の回転速度で回転させる駆動手段と、進行方向を自在に設定する操舵手段とを備え、所定の領域内を走行する自走式ロボットであって、
自走式ロボット本体の中心を通り進行方向に平行な直線である中心線の近傍に配設され、自走式ロボットの進行方向に向けて信号を発信する第1発信手段と、
前記第1発信手段によって発信された信号であって、前記所定の領域の外縁において反射した反射信号を受信する第1受信手段と、
前記第1発信手段によって発信された信号が前記第1受信手段によって受信されるまでの経過時間を用いて、自走式ロボットと前記所定の領域の外縁との間の距離を求める距離算出手段とを備え、
前記第1受信手段は、前記中心線の両側に配設されていることを特徴とする自走式ロボット。
A self-propelled robot that travels in a predetermined area, comprising: a drive unit that rotates a drive shaft of at least one wheel at a predetermined rotation speed; and a steering unit that freely sets a traveling direction.
A first transmission means disposed in the vicinity of a center line that is a straight line passing through the center of the self-propelled robot body and parallel to the traveling direction; and transmitting a signal toward the traveling direction of the self-propelled robot;
First receiving means for receiving a signal transmitted by the first transmitting means and reflected at an outer edge of the predetermined area;
Distance calculating means for obtaining a distance between the self-propelled robot and the outer edge of the predetermined area using an elapsed time until the signal transmitted by the first transmitting means is received by the first receiving means; With
The self-propelled robot, wherein the first receiving means is disposed on both sides of the center line.
前記第1受信手段は、前記中心線に対して略線対称な位置に配設されていることを特徴とする請求項1に記載の自走式ロボット。   2. The self-propelled robot according to claim 1, wherein the first receiving unit is disposed at a substantially line-symmetrical position with respect to the center line. 前記第1受信手段は、前記中心線の両側にそれぞれ1個だけ配設されていることを特徴とする請求項1又は2に記載の自走式ロボット。   3. The self-propelled robot according to claim 1, wherein only one first receiving unit is provided on each side of the center line. 4. 前記中心線に対して略線対称な位置に配設され、前記中心線から離間する方向に信号を発信する第2発信手段と、
前記第2発信手段によって発信された信号であって、前記所定の領域の外縁において反射した反射信号を受信する第2受信手段とを備え、
前記距離算出手段は、前記第2発信手段によって発信された信号が前記第2受信手段によって受信されるまでの経過時間を用いて、自走式ロボットと前記所定の領域の外縁との間の距離を求めることを特徴とする請求項1〜3のいずれかに記載の自走式ロボット。
Second transmitting means disposed at a position substantially symmetrical with respect to the center line and transmitting a signal in a direction away from the center line;
A second receiving means for receiving a signal transmitted by the second transmitting means and reflected by an outer edge of the predetermined area;
The distance calculating means uses the elapsed time until the signal transmitted by the second transmitting means is received by the second receiving means, and the distance between the self-propelled robot and the outer edge of the predetermined area. The self-propelled robot according to any one of claims 1 to 3, wherein:
前記第2発信手段は、前記中心線に対して略線対称な位置に、それぞれ1個だけ配設されていることを特徴とする請求項4に記載の自走式ロボット。   5. The self-propelled robot according to claim 4, wherein each of the second transmitting means is disposed at a position substantially symmetrical with respect to the center line. 前記第1発信手段及び第2発信手段は、予め設定された順序で順次発信することを特徴とする請求項4又は5に記載の自走式ロボット。   The self-propelled robot according to claim 4 or 5, wherein the first transmission unit and the second transmission unit sequentially transmit in a preset order. 前記距離算出手段によって求められた1の距離又は複数の距離の最小値を離間距離として検出する検出手段と、
前記所定の領域の外縁に沿って走行させる制御モードである第1モードでの走行をさせるべく、前記操舵手段に対して進行方向を指示する第1走行手段と、
前記領域内を直進と回転とを繰り返して走行させる制御モードである第2モードでの走行をさせるべく、前記離間距離が予め設定された所定値以下となるまで直進し、前記離間距離が予め設定された所定値以下である場合に直進を停止して前記操舵手段に対して進行方向を所定方向に変更させる第2走行手段と、
前記第2モードで走行中の直進走行開始から停止までの時間である直進走行時間を測定する直進時間測定手段と、
2以上の所定回数分の直進走行時間を格納する直進時間記憶手段と、
前記第1モードと第2モードとを切り換える切換手段とを備え、
前記切換手段は、前記所定回数分の直進走行時間が所定の条件を満たす場合に、前記第2モードを前記第1モードへ切り換えることを特徴とする請求項1〜6のいずれかに記載の自走式ロボット。
Detecting means for detecting a distance or a minimum value of a plurality of distances obtained by the distance calculating means as a separation distance;
First traveling means for instructing the steering means in the traveling direction to travel in the first mode, which is a control mode for traveling along the outer edge of the predetermined region;
In order to travel in the second mode, which is a control mode in which the vehicle travels in a straight line and rotates repeatedly, the vehicle travels straight until the separation distance is equal to or less than a predetermined value, and the separation distance is set in advance. Second traveling means for stopping straight traveling and changing the traveling direction to a predetermined direction with respect to the steering means when the value is equal to or less than the predetermined value;
A straight traveling time measuring means for measuring a straight traveling time which is a time from the start of the straight traveling to the stop while traveling in the second mode;
Straight running time storage means for storing straight running time for a predetermined number of times of 2 or more;
Switching means for switching between the first mode and the second mode,
The switching means switches the second mode to the first mode when the straight traveling time for the predetermined number of times satisfies a predetermined condition. A traveling robot.
JP2005146130A 2005-05-19 2005-05-19 Self-propelled robot Pending JP2006323618A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005146130A JP2006323618A (en) 2005-05-19 2005-05-19 Self-propelled robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005146130A JP2006323618A (en) 2005-05-19 2005-05-19 Self-propelled robot

Publications (1)

Publication Number Publication Date
JP2006323618A true JP2006323618A (en) 2006-11-30

Family

ID=37543251

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005146130A Pending JP2006323618A (en) 2005-05-19 2005-05-19 Self-propelled robot

Country Status (1)

Country Link
JP (1) JP2006323618A (en)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100845528B1 (en) * 2007-06-29 2008-07-10 (주)하기소닉 Connection device and method for obstacle avoidance and automatic charging of mobile robot using anisotropic ultrasonic sensor
KR100845531B1 (en) 2007-06-29 2008-07-10 (주)하기소닉 Connection method for automatic charging of mobile robot using anisotropic ultrasonic sensor
KR101080366B1 (en) 2009-01-30 2011-11-04 (주)하기소닉 Localization Method of Mobile Robots using Ultrasonic Sensors and Device Thereby
US9037294B2 (en) 2009-06-12 2015-05-19 Samsung Electronics Co., Ltd. Robot cleaner and control method thereof
WO2016009585A1 (en) * 2014-07-18 2016-01-21 パナソニックIpマネジメント株式会社 Autonomous mobile object and method of controlling same
JP2016514583A (en) * 2013-04-15 2016-05-23 アクティエボラゲット エレクトロラックス Robot vacuum cleaner with protruding side brush
CN106393140A (en) * 2015-07-30 2017-02-15 燕成祥 Robot capable of automatically adjusting action path and method thereof
WO2018142483A1 (en) * 2017-01-31 2018-08-09 本田技研工業株式会社 Unmanned working system, management server, and unmanned working machine
WO2024085544A1 (en) * 2022-10-20 2024-04-25 삼성전자주식회사 Robot and control method thereof
WO2024101319A1 (en) * 2022-11-11 2024-05-16 ローム株式会社 Autonomous moving device and speaker/microphone combined unit for autonomous moving device
EP4440799A4 (en) * 2022-04-14 2025-04-09 Samsung Electronics Co., Ltd. METHOD AND APPARATUS FOR PROXIMITY DETECTION AND PROXIMITY DIRECTION ESTIMATION

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100845531B1 (en) 2007-06-29 2008-07-10 (주)하기소닉 Connection method for automatic charging of mobile robot using anisotropic ultrasonic sensor
KR100845528B1 (en) * 2007-06-29 2008-07-10 (주)하기소닉 Connection device and method for obstacle avoidance and automatic charging of mobile robot using anisotropic ultrasonic sensor
KR101080366B1 (en) 2009-01-30 2011-11-04 (주)하기소닉 Localization Method of Mobile Robots using Ultrasonic Sensors and Device Thereby
US9844876B2 (en) 2009-06-12 2017-12-19 Samsung Electronics Co., Ltd. Robot cleaner and control method thereof
US9037294B2 (en) 2009-06-12 2015-05-19 Samsung Electronics Co., Ltd. Robot cleaner and control method thereof
JP2016514583A (en) * 2013-04-15 2016-05-23 アクティエボラゲット エレクトロラックス Robot vacuum cleaner with protruding side brush
WO2016009585A1 (en) * 2014-07-18 2016-01-21 パナソニックIpマネジメント株式会社 Autonomous mobile object and method of controlling same
JPWO2016009585A1 (en) * 2014-07-18 2017-04-27 パナソニックIpマネジメント株式会社 Autonomous mobile object and its control method
CN106393140A (en) * 2015-07-30 2017-02-15 燕成祥 Robot capable of automatically adjusting action path and method thereof
WO2018142483A1 (en) * 2017-01-31 2018-08-09 本田技研工業株式会社 Unmanned working system, management server, and unmanned working machine
EP4440799A4 (en) * 2022-04-14 2025-04-09 Samsung Electronics Co., Ltd. METHOD AND APPARATUS FOR PROXIMITY DETECTION AND PROXIMITY DIRECTION ESTIMATION
WO2024085544A1 (en) * 2022-10-20 2024-04-25 삼성전자주식회사 Robot and control method thereof
WO2024101319A1 (en) * 2022-11-11 2024-05-16 ローム株式会社 Autonomous moving device and speaker/microphone combined unit for autonomous moving device

Similar Documents

Publication Publication Date Title
US20210321854A1 (en) Mobile robot
US7660650B2 (en) Self-propelled working robot having horizontally movable work assembly retracting in different speed based on contact sensor input on the assembly
US6124694A (en) Wide area navigation for a robot scrubber
JP2006323618A (en) Self-propelled robot
US20030102014A1 (en) Self-running cleaning apparatus and self-running cleaning method
JP2006113952A (en) Charging type travel system
US20080004751A1 (en) Robot cleaner system and method of controlling the same
JP2002355204A (en) Self-propelled vacuum cleaner
JP2009037378A (en) Autonomous traveling device and program
JPH11174145A (en) Ultrasonic range finding sensor and autonomous driving vehicle
KR20160097051A (en) Apparatus for returning of robot and returning method thereof
US20190008347A1 (en) Self-propelled electronic device and travel method for self-propelled electronic device
JPH1055215A (en) Moving travel vehicle
US7546179B2 (en) Method and apparatus for allowing mobile robot to return to docking station
JPH0582603B2 (en)
JP2005309700A (en) Self-traveling object, traveling object control method and computer program
JP3301089B2 (en) Mobile work robot
JP4962255B2 (en) Self-propelled device
JPH09265319A (en) Autonomously traveling vehicle
JP2006268499A (en) Running device and self-propelled vacuum cleaner
JP4910972B2 (en) Self-propelled device and program
JP4278634B2 (en) Self-propelled robot
JP2007286730A (en) Self-propelled type cleaner
JP2008090380A (en) Autonomous traveling device and program
JP2004318721A (en) Autonomous vehicles

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20070918

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20081008

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20081021

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20081210

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20090324