TWI794700B - 移動式機器人 - Google Patents
移動式機器人 Download PDFInfo
- Publication number
- TWI794700B TWI794700B TW109144326A TW109144326A TWI794700B TW I794700 B TWI794700 B TW I794700B TW 109144326 A TW109144326 A TW 109144326A TW 109144326 A TW109144326 A TW 109144326A TW I794700 B TWI794700 B TW I794700B
- Authority
- TW
- Taiwan
- Prior art keywords
- mop
- floor
- view image
- mobile robot
- sensor
- Prior art date
Links
- 239000000463 material Substances 0.000 claims abstract description 213
- 230000003287 optical effect Effects 0.000 claims abstract description 74
- 230000001133 acceleration Effects 0.000 claims description 70
- 238000000034 method Methods 0.000 description 40
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 34
- 230000005484 gravity Effects 0.000 description 26
- 238000004140 cleaning Methods 0.000 description 20
- 230000008569 process Effects 0.000 description 15
- 241001417527 Pempheridae Species 0.000 description 9
- 238000004891 communication Methods 0.000 description 8
- 238000009499 grossing Methods 0.000 description 8
- 238000002310 reflectometry Methods 0.000 description 7
- 238000012545 processing Methods 0.000 description 6
- 230000004044 response Effects 0.000 description 5
- 238000003860 storage Methods 0.000 description 5
- 238000009826 distribution Methods 0.000 description 4
- 230000001154 acute effect Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000003780 insertion Methods 0.000 description 3
- 230000037431 insertion Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000004590 computer program Methods 0.000 description 2
- 230000014509 gene expression Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 241000238631 Hexapoda Species 0.000 description 1
- 208000034530 PLAA-associated neurodevelopmental disease Diseases 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000002790 cross-validation Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000004579 marble Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001846 repelling effect Effects 0.000 description 1
- 239000008400 supply water Substances 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 238000009827 uniform distribution Methods 0.000 description 1
- 238000010200 validation analysis Methods 0.000 description 1
- 239000002023 wood Substances 0.000 description 1
- 239000002759 woven fabric Substances 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4036—Parts or details of the surface treating tools
- A47L11/4038—Disk shaped surface treating tools
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4063—Driving means; Transmission means therefor
- A47L11/4066—Propulsion of the whole machine
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4063—Driving means; Transmission means therefor
- A47L11/4069—Driving or transmission means for the cleaning tools
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/008—Manipulators for service tasks
- B25J11/0085—Cleaning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
- B25J13/089—Determining the position of the robot with reference to its environment
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0055—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements
- G05D1/0066—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements for limitation of acceleration or stress
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0253—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
- A47L2201/04—Automatic control of the travelling movement; Automatic obstacle detection
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
- A47L2201/06—Control of the cleaning action for autonomous devices; Automatic detection of the surface condition before, during or after cleaning
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B15/00—Systems controlled by a computer
- G05B15/02—Systems controlled by a computer electric
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45098—Vacuum cleaning robot
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Human Computer Interaction (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Reciprocating, Oscillating Or Vibrating Motors (AREA)
Abstract
本發明提供一種移動式機器人。該移動式機器人包括:一本體;一對旋轉拖把,可旋轉地安裝在該本體上;一拖把馬達,配置以向該對旋轉拖把提供驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得底視影像訊息;以及一控制器,配置以基於該光學流量感測器感測的該底視影像訊息,判定地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作。
Description
本發明係關於一種能夠執行拖把操作的移動式機器人。
清掃機器人是一種藉由吸取地板上諸如灰塵的異物或掃除地板上的異物來清掃地板的裝置。近年來,已經開發出能夠執行拖把操作的清掃機。此外,清掃機器人是一種自主行進的同時執行清掃的裝置。
根據習知技術(韓國專利註冊第10-1654014號),已知一種能夠使用拖把表面來移動的清掃機器人。在該習知技術中,清掃機器人包括第一旋轉構件和第二旋轉構件,用以固定在左右方向上佈置的一對拖把表面。根據該習知技術的清掃機器人,第一旋轉構件和第二旋轉構件可拆卸地耦接至機器人的本體。
然而,習知技術的清掃機器人並不具有偵測地板材質的功能,因此無法根據地板材質控制其行進。舉例來說,當執行拖把操作的清掃機在地毯或其類似物上行進時,清掃機會出現無法離開地毯的問題。
此外,由於習知技術的清掃機器人不能夠偵測地毯或其類似物,因此可能不符期待地移動至地毯上。此時,清掃機器人的拖把可能會碰到地毯,導致拖把的機構出現問題。此外,習知技術的清掃機器人可能無法適當地在地毯上行進,導致清掃的時間增加。
還有另一種習知的移動式機器人,其配置有懸崖感測器,用於偵測地板的台階部分並基於該偵測結果控制行進。然而,此習知的移動式機器人也無法偵測地板材質,而因此具有上述的問題。
[相關技術文件]
[專利文件]
韓國專利註冊第10-1654014號(2016年8月30日註冊)。
本發明之一目的係提供一種移動式機器人,能夠準確地偵測地板材質,從而避免進入無法進行濕拖的區域、或者避免進入由於其材質而使利用拖把旋轉力行進的清掃機難以離開的區域。
本發明之另一目的係從底視影像訊息中提取影像品質值、地板的反射率、以及影格率,並且基於此判定地板材質,從而能夠避免移動式機器人移動至問題區域,其中該底視影像訊息由用於偵測移動式機器人之移動的光學流量感測器來取得。
本發明之又一目的係當無法基於地板的影像訊息而完整地判定地板材質時,基於旋轉拖把的負載訊息、加速度訊息、以及自懸崖感測器獲得的訊息來判定地板材質,從而避免移動式機器人移動至問題區域。
本發明之再一目的係基於地板的影像訊息、旋轉拖把的負載訊息、加速度訊息、以及自懸崖感測器獲得的訊息判定地板材質,從而避免移動式機器人移動至問題區域。
本發明之又一目的係藉由將懸崖感測器和光學流量感測器設置在相較於旋轉拖把更靠前方的位置,以使在旋轉拖把移動至問題區域之前,主動地判定例如地毯的問題區域,以防止移動式機器人行進在問題區域中。
為了實現以上所述與其他目的,根據本發明的移動式機器人基於地板的影像偵測地板材質,並基於偵測的地板材質來行進。
另外,根據本發明的移動式機器人從地板影像提取的影像品質值、影格率、或地板的反射率中的至少一個來偵測地板材質,並且根據偵測到的地板材質來行進。
另外,根據本發明的移動式機器人藉由綜合判定地板的影像、加速度、拖把負載、以及從懸崖感測器輸出的訊息來偵測地板材質,並基於偵測的地板材質來行進。
具體而言,根據本發明的移動式機器人包括:一本體;一對旋轉拖把,可旋轉地安裝在該本體上;一拖把馬達,配置以向該對旋轉拖把提供驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得底視影像訊
息;以及一控制器,配置以基於該光學流量感測器感測的底視影像訊息,判定地板材質是否為問題材質,並配置以當判定地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作。
該光學流量感測器可以設置在相較於該對旋轉拖把更靠前方。
該光學流量感測器可以包含:一影像感測器,配置以擷取一底視影像以獲得該底視影像訊息;以及至少一個光源,配置以調整一光量。
該控制器可以基於該底視影像訊息計算底視影像的影像品質值,並且當該影像品質值小於一預設參考影像品質值時,可以判定地板材質為問題材質。
該影像品質值可以基於由光源所發出的光形成在該地板上的一影像形狀來判定。
該控制器可以基於該底視影像訊息計算底視影像的影格率,並且當該影格率低於一預設參考影格率時,可以判定地板材質為問題材質。
該控制器可以基於該底視影像訊息計算地板的一反射值,並且當地板的反射值小於一預設參考反射值時,可以判定地板材質為問題材質。
該控制器可以基於該底視影像訊息計算地板的反射值、底視影像的影像品質值、以及底視影像的影格率,並且當滿足以下條件1到3中的至少一個時,可以判定地板材質為問題材質。
<條件1>
影像品質值小於預設參考影像品質值
<條件2>
影格率低於預設參考影像影格率
<條件3>
地板的反射值小於預設參考反射值
另外,根據本發明的移動式機器人可以進一步包括一照相機,配置以在一固定時間間隔獲得頂視影像訊息,並且該控制器可以基於該頂視影像訊息偵測目前當前位置。
在判定地板材質是問題材質時,該控制器可以將該目前位置設置為問題區域。
另外,根據本發明的移動式機器人可以進一步包括一拖把負載訊息感測器,配置以感測該拖把馬達的一負載值。當該拖把馬達的該負載值大於一預設參考負載值時,該控制器可以控制該拖把馬達以執行該進入限制操作。
另外,根據本發明的移動式機器人可以進一步包括一懸崖感測器,配置以感測至該地板的距離。當至該地板的距離小於一參考距離時,該控制器可以控制該拖把馬達以執行該進入限制操作。
該懸崖感測器可以設置在相較於該對旋轉拖把更靠前方。
該懸崖感測器可以設置使得其至少一部分在一垂直方向上與一假想中心垂直平面重疊。
另外,根據本發明的移動式機器人可以進一步包括一加速度感測器,安裝在該本體上,以感測加速度值。該控制器可以基於該些加速度值計算一平均加速度值,並且在判定該平均加速度值大於一參考平均加速度值時,該控制器可以控制該拖把馬達以執行該進入限制操作。
另外,根據本發明的移動式機器人可以進一步包括一加速度感測器,安裝在該本體上,以感測加速度值。該控制器可以計算該些加速度值的偏差,並且在判定該偏差大於一參考偏差時,該控制器可以控制該拖把馬達以執行該進入限制操作。
另外,根據本發明的移動式機器人可以進一步包括:一拖把負載訊息感測器,配置以感測該拖把馬達的一負載值;一懸崖感測器,配置以感測至該地板的距離;以及一加速度感測器,安裝在該本體上,以感測加速度值。當滿足以下條件4至7中的至少一個時,該控制器可以控制該拖把馬達以執行該進入限制操作。
<條件4>
拖把馬達的負載值大於預定參考負載值
<條件5>
至地板的距離小於預定參考距離值
<條件6>
平均加速度值大於預定參考平均加速度值
<條件7>
加速度的偏差大於參考偏差
另外,根據本發明的移動式機器人包括:一本體;一對旋轉拖把,可旋轉地安裝在該本體上;一拖把馬達,配置以向該對旋轉拖把提供驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得底視影像訊息;一加速度感測器,安裝在該本體上,以感測加速度值;一懸崖感測器,配置以感測至該地板的距離,一拖把負載訊息感測器,配置以感測該拖把馬達的一負載值;以及一控制器,配置以基於該光學流量感測器、該加速度感測器、該懸崖感測器、或該拖把負載訊息感測器中的至少一個所接收到的訊息,判定地板材質是否為問題材質,並配置以當判定地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作。
該光學流量感測器可以配置在相較於連接該對旋轉拖把的旋轉軸的一線更靠前方的位置,以使該光學流量感測器不與該對旋轉拖把垂直地重疊,並且該懸崖感測器可以相較於該對旋轉拖把和該光學流量感測器的前端設置更靠前方。
該對旋轉拖把可以設置為相對於假想的中心垂直平面而彼此左右對稱,並且該光學流量感測器和該懸崖感測器可以設置為與該假想的中心垂直平面垂直地重疊。
1:清掃機、移動式機器人
10:控制器
11:拖把馬達控制器
11a:第一拖把馬達控制器
11b:第二拖把馬達控制器
12:地板材質判定單元
16:輸入單元
17:輸出單元
18:儲存單元
19:通訊單元
20:感測單元
21:障礙物感測器
22:位置訊號感測器
23a:懸崖感測器
23b:光學流量感測器
24:照相機
25:三維感測器(3D感測器)
26:陀螺儀感測器
27:磁場感測器
28:加速度感測器
29:拖把負載訊息感測器
30:本體
31:殼體
311:上壁
312:側壁
313:水箱插入開口
32:基座
40:拖把模組
41:旋轉拖把
41a:左旋轉拖把
41b:右旋轉拖把
58:輔助輪
61:拖把馬達
61a:第一拖把馬達
61b:第二拖把馬達
81:水箱
Po:中心垂直線、中央垂直平面
Tc:幾何中心
osa,osb:旋轉軸
w1f:第一正向方向
w1r:第一反向方向
w2f:第二正方向
w2r:第二反方向
Wc:移動式機器人的重心
BC:電池的重心
PC:水箱的重心
Ag1a,Ag1b:傾斜方向角
H:假想水平面
Pla,Plb:最低點
Pha,phb:最高點
mca:第一拖把馬達的重心
mcb:第二拖把馬達的重心
M:地毯
CHL:中心水平線
Q:其餘部分
U:向上
Le:向左
R:向後
D:向下
Ri:向右
F:向前
S100~S300:步驟
S110,S112,S113:步驟
S116,S117:步驟
S210,S220:步驟
S221~S225:步驟
S310,S312,S320:步驟
將透過結合以下圖式的詳細描述,更清楚地理解上述以及其他本發明之目的、特徵、以及其他優點,其中:
圖1是本發明第一實施例之移動式機器人的立體圖;
圖2是圖1的左側視圖;
圖3是圖1的底視圖;
圖4是本發明一實施例之移動式機器人的控制方塊圖;
圖5是顯示本發明之移動式機器人的一部分移動至地毯上的狀態;
圖6是顯示本發明第一實施例之移動式機器人的控制方法的流程圖;
圖7是顯示本發明第二實施例之移動式機器人的控制方法的流程圖;
圖8是顯示本發明第三實施例之移動式機器人的控制方法的流程圖;以及
圖9是顯示本發明第四實施例之移動式機器人的控制方法的流程圖。
在以下的描述中,基於圖式中的說明定義出表示方向的用語“向前(F)”、“向後(R)”、“向左(Le)”、“向右(Ri)”、“向上(U)”、以及“向下(D)”。然而,所給出此些定義僅是為了清楚地理解本發明,並可以根據情況的不同而定義該些方向。
舉例來說,將平行於連接左旋轉拖把的中心軸以及右旋轉拖把的中心軸之假想線的方向定義為左右方向;在上下5度或小於5度的角度範圍內,將垂直於左右方向且平行於該些旋轉拖把的中心軸的方向定義為上下方向;並且,將同時垂直於左右方向以及上下方向的方向定義為前後方向。
在以下的描述中,用語“第一”、“第二”、以及“第三”僅係用於避免混淆所指定的部件,並不表示該些部件的順序或重要性或是該些部件之間的關係;例如,僅包含第二部件但缺少第一部件的實施例也是可行的。
在本說明書中,除非單數表達在上下文中明顯地不同,否則單數表達包含複數含義。
以下將要描述地“拖把”可以由各種材質製成,例如編織物或紙材。另外,拖把可以被清洗以重複使用或可拋棄式地使用。
在下文中,將參見圖1至圖3大致地描述根據本發明實施例的清掃機1。
根據本發明實施例的清掃機1執行拖地。清掃機1可以配置以自主行進。根據本發明一實施例的清掃機1包括本體30,其設置有控制器。
本體30包括:殼體31,其界定本體30的外觀,包含上壁311及其上設有供水箱81裝入的水箱插入開口313的側壁312;以及基座32,設置在殼體31的下方。本體30的外表面至少一部分形成一圓,而該圓具有半徑,其在參考半徑的預定誤差範圍內。此處,半徑在參考半徑的預定誤差範圍內的圓並不是正圓,而是半徑可以在每個中心角或每個截面的誤差範圍內變化的一圓。
更具體地,當在垂直方向觀察時,考慮到與其他部件的接合,本體30面積的50%或更多可以形成圓形,並且其剩餘區域可以形成接近圓形的形狀。當然,本文中提到的圓是在工程意義上具有容許偏差的圓,而不是數學上理想的圓。
移動式機器人1包括拖把模組40,其配置以經由與地板(待清掃的表面)接觸來執行拖地。
拖把模組40可以設置在本體30的下方,並可以支撐本體30。在本實施例中,本體30由拖把模組40支撐。本體30界定移動式機器人1的外觀。
拖把模組40設置在主體30的下方。拖把模組40為移動式機器人1的移動提供驅動力。為了移動移動式機器人1,拖把模組40較佳設置在移動式機器人1的後側。
拖把模組40包含至少一個拖把單元(圖未示出),其配置以在旋轉的同時執行拖地。拖把模組40包含至少一個旋轉拖把41。當從上側觀察時,旋轉拖把41沿著順時針方向或逆時針方向旋轉。旋轉拖把41會與地板接觸。
在本實施例中,拖把模組40可以包含一對旋轉拖把41a和41b。當從上側觀察時,旋轉拖把41a和41b在沿著順時針方向或逆時針方向旋轉的同時在地板上執行拖地。當從清掃機1的行進方向的前側觀察時,將旋轉拖把41a和41b之中設置在左側的旋轉拖把41界定為左旋轉拖把41a,而將旋轉拖把41a和41b之中設置在右側的旋轉拖把41界定為右旋轉拖把41b。
左旋轉拖把41a和右旋轉拖把41b各自皆繞著其旋轉軸旋轉。該旋轉軸沿著上下方向設置。左旋轉拖把41a和右旋轉拖把41b可以彼此獨立地旋轉。該對旋轉拖把41可以設置成相對於假想的中心垂直平面Po而彼此左右地對稱。
本發明包括拖把馬達61,其向左旋轉拖把41a和右旋轉拖把41b提供驅動力,並且安裝至本體30上。拖把馬達61包含第一拖把馬達61a以及第二拖把馬達61b。拖把馬達61的旋轉軸可以垂直地延伸。第一拖把馬達61a和第二拖把馬達61b設置成相對於中心垂直線Po而彼此左右地對稱。
中心垂直線Po是平行於前後方向並且穿過本體30的幾何中心Tc的線。當然,中心垂直線Po可以界定為在與連接左旋轉拖把41a的中心軸和右旋轉拖把41b的中心軸的假想線垂直相交的同時,穿過本體30的幾何中心Tc的線。
如果將旋轉拖把41a和41b的底部平行於水平面放置,且旋轉拖把41a和41b設置成相對於中心垂直線Po彼此左右地對稱,則清掃機器人就無法穩定地行進,且行進控制會變得困難。因此,在本發明中,每個旋轉拖把41安裝成往前向下傾斜。在下文中,將描述旋轉拖把41的傾斜度及移動。
再次參見圖3,顯示左旋轉拖把41a的自旋旋轉軸osa與左旋轉拖把41a的底部表面相交的點,並且圖中亦顯示右旋轉拖把41b的自旋旋轉軸osb與
右旋轉拖把41b的底部表面相交的點。當從下側觀察時,左旋轉拖把41a的順時針旋轉方向界定為第一正向方向w1f,而左旋轉拖把41a的逆時針旋轉方向界定為第一反向方向w1r。當從下側觀察時,右旋轉拖把41b的逆時針旋轉方向界定為第二正方向w2f,而右旋轉拖把41b的順時針旋轉方向界定為第二反方向w2r。另外,當從下側觀察時,“左旋轉拖把41a的底部表面的傾斜方向與橫軸所產生的銳角”以及“右旋轉拖把41b的底部表面的傾斜方向與橫軸所產生的銳角”界定為傾斜方向角Ag1a和Ag1b。左旋轉拖把41a的傾斜方向角Ag1a和右旋轉拖把41b的傾斜方向角Ag1b可以彼此相同。另外,參見圖3,“左旋轉拖把41a的底部表面I與假想水平面H所產生的角度”以及“右旋轉拖把41b的底部表面I與假想水平面H所產生的角度”界定為傾斜角Ag2a和Ag2b。
當然,左旋轉拖把41a的右端和右旋轉拖把41b的左端可以彼此接觸或者可以彼此相鄰。因此,可以減小左旋轉拖把41a與右旋轉拖把41b之間未被拖地的區域。
當左旋轉拖把41a旋轉時,在左旋轉拖把41a的底部表面上接收來自地板之最大摩擦力的點Pla位於左旋轉拖把41a的旋轉中心osa的左側。藉由從點Pla向地板傳遞相較於左旋轉拖把41a的底部表面上的任何其他點更大的負載,可以在點Pla處產生最大的摩擦力。在本實施例中,點Pla位於旋轉中心osa的左前側。然而,在另一實施例中,點Pla可以精準地位於旋轉中心osa的左側,或者可以位於旋轉中心osa的左後側。
當右旋轉拖把41b旋轉時,在右旋轉拖把41b的底部表面上接收來自地板之最大摩擦力的點Plb位於右旋轉拖把41b的旋轉中心osb的右側。藉由從點Plb向地板傳遞相較於右旋轉拖把41b的底部表面上的任何其他點更大的負載,可以在點Plb產生最大地摩擦力。在本實施例中,點Plb位於旋轉中心osb的右前側。然而,在另一實施例中,點Plb可以精準地位於旋轉中心osb的右側,或者可以位於旋轉中心osb的右後側。
左旋轉拖把41a的底部表面和右旋轉拖把41b的底部表面可以分別地傾斜佈置。左旋轉拖把41a的傾斜角Ag2a和右旋轉拖把41b的傾斜角Ag2b可以是銳角。可以將傾斜角Ag2a和Ag2b設置成較小,如此使得點Pla和Plb能接收到最大的摩擦力,並且使得拖把單元的整個底部區域能經由左旋轉拖把41a和右旋轉拖把41b的旋轉而與地板接觸。
左旋轉拖把41a的底部表面具有整體在向左方向上形成向下傾斜。右旋轉拖把41b的底部表面具有整體在向右方向上形成向下傾斜。參見圖3,左旋轉拖把41a的底部表面具有位於其左側部分的最低點Pla。左旋轉拖把41a的底部表面具有位在其右側部分的最高點pha。右旋轉拖把41b的底部表面具有位在其右側部分的最低點Plb。右旋轉拖把41b的底部表面具有位於其左側部分的最高點phb。
在一些實施例中,傾斜方向角Ag1a和Ag1b可以設定成0度。另外,在一些實施例中,當從下側觀察時,左旋轉拖把41a的底部表面的傾斜方向可以相對於橫軸在順時針方向中形成傾斜方向角Ag1a,而右旋轉拖把41b的底部表面的傾斜方向可以相對於橫軸在逆時針方向中形成傾斜方向角Ag1b。在該實施例中,當從下側觀察時,左旋轉拖把41a的底部表面的傾斜方向相對於橫軸在逆時針方向中形成傾斜方向角Ag1a,而右旋轉拖把41b的底部表面的傾斜方向相對於橫軸在順時針方向中形成傾斜方向角Ag1b。
移動式機器人1可以透過由拖把模組40產生之與地板間的摩擦力來移動。
拖把模組40可以產生使本體30前移的向前移動摩擦力、或者使本體30後移的向後移動摩擦力。拖把模組40可以產生使本體30左旋的向左移動摩擦力、或者使本體30右旋的向右移動摩擦力。拖把模組40可以透過結合向前移動摩擦力和向後移動摩擦力中的任一個、以及向左移動摩擦力和向右移動摩擦力中的任一個來產生摩擦力。
為了產生向前移動的摩擦力,拖把模組40可以使左旋轉拖把41a沿著第一正向方向w1f以預定的每分鐘轉數(rpm)R1進行旋轉,並可以使右旋轉拖把41b沿著第二正向方向w2f以預定轉數R1進行旋轉。
為了產生向後移動的摩擦力,拖把模組40可以使左旋轉拖把41a沿著第一反向方向w1r以預定的每分鐘轉數R2進行旋轉,並可以使右旋轉拖把41b沿著第二反向方向w2r以預定的轉數R2進行旋轉。
為了產生向右移動的摩擦力,拖把模組40可以使左旋轉拖把41a沿著第一正向方向w1f以預定的每分鐘轉數R3進行旋轉,並且(i)可以使右旋轉拖把41b沿著第二反向w2r進行旋轉、(ii)可以使右旋轉拖把41b停止而不旋
轉、或者(iii)可以使右旋轉拖把41b沿著第二正向方向w2f以低於每分鐘轉數R3的每分鐘轉數R4進行旋轉。
為了產生向左移動的摩擦力,拖把模組40可以使右旋轉拖把41b沿著第二正向方向w2f以預定的每分鐘轉數R5進行旋轉,並且(i)可以使左旋轉拖把41a沿著第一反方向w1r進行旋轉、(ii)可以使左旋轉拖把41a停止而不旋轉、或者(iii)可以使左旋轉拖把41a沿著第一正向方向w1f以低於每分鐘轉數R5的每分鐘轉數R6進行旋轉。
用於增加設置在左右的旋轉拖把41的摩擦力、改進左右方向和前後方向的穩定性、以及穩定行進而與水箱81中的水位無關之各個部件的佈置將在下文中進行描述。
參見圖4,為了增加旋轉拖把41的摩擦力並防止在移動式機器人1旋轉期間的一個方向上出現離心,可以將相對較重的拖把馬達61和電池設置在旋轉拖把41上。
更具體地,第一拖把馬達61a可以設置在左旋轉拖把41a上,而第二拖把馬達61b可以設置在右旋轉拖把41b上。亦即,第一拖把馬達61a的至少一部分可以與左旋轉拖把41a垂直地重疊。較佳地,第一拖把馬達61a的整體可以與左旋轉拖把41a垂直地重疊。第二拖把馬達61b的至少一部分可以與右旋轉拖把41b垂直地重疊。較佳地,第二拖把馬達61b的整體可以與右旋轉拖把41b垂直地重疊。
更具體地,第一拖把馬達61a和第二拖把馬達61b可以設置成與假想的中心水平線CHL垂直地重疊,該假想的中心水平線CHL連接左旋轉拖把41a的自旋旋轉軸osa和右旋轉拖把41b的自旋旋轉軸osb。較佳地,第一拖把馬達61a的重心mca和第二拖把馬達61b的重心mcb可以設置成與假想的中心水平線CHL垂直地重疊,該假想的中心水平線CHL連接左旋轉拖把41a的自旋旋轉軸osa和右旋轉拖把41b的自旋旋轉軸osb。可替代地,第一拖把馬達61a的幾何中心和第二拖把馬達61b的幾何中心可以設置成與假想的中心水平線CHL垂直地重疊,該假想的中心水平線CHL連接左旋轉拖把41a的自旋旋轉軸osa和右旋轉拖把41b的自旋旋轉軸osb。當然,第一拖把馬達61a和第二拖把馬達61b相對於中心垂直線Po而彼此對稱地設置。
由於第一拖把馬達61a的重心mca和第二拖把馬達61b的重心mcb設置成彼此左右地對稱,而不偏離各個旋轉拖把41上方的位置,因此可以增加旋轉拖把41的摩擦力並維持行進的性能和左右平衡。
下文,將左旋轉拖把41a的自旋旋轉軸osa稱為左旋轉軸osa,而將右旋轉拖把41b的自旋旋轉軸osb稱為右旋轉軸osb。
由於水箱81設置成相較於中心水平線CHL更靠後,並且水箱81中的水量是可變化的,因此,不論水箱81中的水位為何,為了維持穩定的前後平衡,第一拖把馬達61a可以設置成自左自旋旋轉軸osa偏向左側。第一拖把馬達61a可以設置成自左自旋旋轉軸osa偏向左前側。較佳地,第一拖把馬達61a的幾何中心或第一拖把馬達61a的重心mca可以設置成自左自旋旋轉軸osa偏向左側。可替代地,第一拖把馬達61a的幾何中心或第一拖把馬達61a的重心mca可以設置成自左自旋旋轉軸osa偏向左前側。
第二拖把馬達61b可以設置成自右自旋旋轉軸osb偏向右側。第二拖把馬達61b可以設置成自右自旋旋轉軸osa偏向右前側。較佳地,第二拖把馬達61b的幾何中心或第二拖把馬達61b的重心mcb可以設置成自右自旋旋轉軸osb偏向右側。可替代地,第二拖把馬達61b的幾何中心或第二拖把馬達61b的重心mcb可以設置成自右自旋旋轉軸osb偏向右前側。
由於第一拖把馬達61a和第二拖把馬達61b在從各個旋轉拖把41的中心偏向前外側的位置施加壓力,因此壓力集中在各個旋轉拖把41的前外部部分,因此旋轉拖把41的旋轉力提高了行進的性能。
左自旋旋轉軸osa和右自旋旋轉軸osb設置成相較於本體30的中心更靠後。中心水平線CHL設置在相較於本體30的幾何中心Tc和移動式機器人1的重心Wc更靠後。左自旋旋轉軸osa和右自旋旋轉軸osb以相同的距離自中心垂直線Po間隔開來。
在本實施例中,設置了單一電池。該電池的至少一部分設置在左旋轉拖把41a和右旋轉拖把41b上。由於相對較重的電池設置在旋轉拖把41上,因此可以增加旋轉拖把41的摩擦力並減少移動式機器人1在旋轉的期間發生離心。
更具體地,可以將電池的左部分設置成與左旋轉拖把41a垂直地重疊,並可以將電池的右部分設置成與右旋轉拖把41b垂直地重疊。電池可以設置成與中心水平線CHL垂直地重疊並與中心垂直線Po垂直地重疊。
更具體地,電池的重心BC或電池的幾何中心可以設置在中心垂直線Po上,並可以設置在中心水平線CHL上。當然,電池的重心BC或電池的幾何中心可以設置在中心垂直線Po上、可以設置在相較於中心水平線CHL更靠前、並也可以設置在相較於本體30的幾何中心Tc更靠後。
電池的重心BC或電池的幾何中心可以設置在相較於水箱81或水箱81的重心PC更靠前。
由於一個電池設置在左旋轉拖把41a與右旋轉拖把41b之間的中間,並設置在中心水平線CHL和中心垂直線Po上,因此較重的電池在旋轉拖把41旋轉期間,用於維持旋轉拖把41的平衡,並向旋轉拖把41施加重量,進而增加旋轉拖把41的摩擦力。
該電池可以設置在與第一拖把馬達61a和第二拖把馬達61b相同的高度(其下端的高度)或相同的平面中。該電池可以設置在第一拖把馬達61a與第二拖把馬達61b之間。該電池設置在第一拖把馬達61a與第二拖把馬達61b之間的空間中。
水箱81的至少一部分設置在左旋轉拖把41a和右旋轉拖把41b上。水箱81可以設置成相較於中心水平線CHL更靠後,並可以設置成與中心垂直線Po垂直地重疊。
更具體地,水箱81的重心PC或水箱81的幾何中心可以設置在中心垂直線Po上,並可以位在相較於中心水平線CHL更靠前。當然,水箱81的重心PC或水箱81的幾何中心可以設置在中心垂直線Po上,並可以設置在相較於中心水平線CHL更靠後。在此,水箱81的重心PC或水箱81的幾何中心設置在相較於中心水平線CHL更靠後,意味著水箱81的重心PC或幾何中心設置成與位在相較於中心水平線CHL更靠後的區域垂直地重疊。當然,在不偏離本體30的情況下,水箱81的重心PC或水箱81的幾何中心位於與本體30垂直地重疊的位置。
水箱81的重心PC或水箱81的幾何中心可以設置在相較於電池的重心BC更靠後。
水箱81可以設置在與第一拖把馬達61a和第二拖把馬達61b相同的高度(其下端的高度)或相同的平面中。水箱81可以設置在第一拖把馬達61a與第二拖把馬達61b之間的空間的後側。
每個旋轉拖把41的一部分與本體30垂直地重疊,並且每個旋轉拖把41的另一部分則暴露於本體30的外側。每個旋轉拖把41與本體30垂直地重疊之面積的比例較佳為每個旋轉拖把41的整個面積的85%至95%。
更具體地,連接本體30的右端和右旋轉拖把41b的右端的一線與自本體30的右端延伸而平行於中心垂直線Po的垂直線之間的角度可為0度到5度。
每個旋轉拖把41暴露於本體30外側的區域長度較佳為每個旋轉拖把41半徑的1/2至1/7。每個旋轉拖把41暴露於本體30外側的區域長度可以是從每個旋轉拖把41暴露於本體30外側的一端至每個旋轉拖把41的旋轉軸的距離。
每個旋轉拖把41暴露於本體30外側的區域末端與本體30的幾何中心Tc之間的距離可以大於本體30的平均半徑。
每個旋轉拖把41所暴露的位置位於本體30的側部分與本體30的後部分之間。亦即,假設當從下側觀察而本體30被劃分成沿著順時針方向依序佈置的四個象限時,每個旋轉拖把41暴露的位置可以位於本體30的第二象限或第三象限中。
參見圖4,移動式機器人1包括感測單元20,用於感測與移動式機器人1的操作或狀態或者與外部狀況有關的各種訊息。
感測單元20可以包含障礙物感測器21,用於感測除了移動式機器人1之外存在的外部障礙物。可以設置複數個障礙物感測器。障礙物感測器21包含用於感測於前方區域存在障礙的障礙物感測器。障礙物感測器21包含用於感測於左右區域存在障礙的障礙物感測器。障礙物感測器21可以設置在本體30。障礙物感測器21可以包含紅外線感測器、超音波感測器、RF感測器、地磁感測器、以及位置靈敏裝置(PSD)感測器。
感測單元20可以包含位置訊號感測器22,用於接收外部識別訊號以判定移動式機器人1的位置。例如,位置訊號感測器22可以是使用UWB訊號的超寬頻(UWB)感測器。控制器10可以基於從位置訊號感測器22接收的訊號來判定移動式機器人1的位置。
該外部識別訊號係由諸如微定位裝置類的外部訊號產生器所發送的訊號。可以設置彼此位置分開的複數個訊號產生器。位置訊號感測器22可以從設置在不同位置的訊號產生器接收識別訊號。
感測單元20可以包含懸崖感測器23a,用於偵測地板上是否存在懸崖或者用於偵測至地板的距離。懸崖感測器23a可以偵測在移動式機器人1的前面及/或後面是否存在有懸崖。懸崖感測器23a可以偵測至地板的距離。當至地板的距離大於預定距離時,控制器10可以判定存在有懸崖,可以執行控制與其對應的操作。
舉例來說,懸崖感測器23a可以包含光學感測器,並且該光學感測器可以包含雷射感測器或紅外線感測器。懸崖感測器23a可以包含向地板發射光的光發射單元(圖未示出)以及接收從地板反射光的光接收單元(圖未示出)。懸崖感測器23a可以使用光返回至光接收單元所花費的時間來測量距離。
另外,懸崖感測器23a可以偵測反射自地板的光量。更具體地,光接收單元可以藉由測量照明度以及返回至光接收單元的光量,來計算光發射單元發射出之光的反射率。懸崖感測器23a偵測反射自地板的光量,並且提供用於偵測地板材質的裝置給控制器10。
懸崖感測器23a可以設置在相較於該對旋轉拖把41更靠前。當將懸崖感測器23a設置成相較於該對旋轉拖把41更靠前時,具備的優點是在地毯向該對旋轉拖把41施加更大的負載之前,就能夠主動地避開地毯。另外,懸崖感測器23a可以設置在相較於該對旋轉拖把41及/或光學流量感測器23b的前端更靠前。
感測單元20可以包含光學流量感測器23b,用於基於地板的影像偵測移動式機器人1的移動量。光學流量感測器23b可以偵測反射自地板的光量。可替代地,光學流量感測器23b能夠以定期使用光來取得底視影像訊息,並且可以將底視影像訊息提供給地板材質判定單元12或控制器10。
光學流量感測器23b將設置在感測器中的影像感測器所接收到的底視圖影像,進行轉換以產生預定格式的影像資料。所產生的影像資料可以被發送至控制器10中。
另外,光學流量感測器(OFS)23b包含:影像感測器(圖未示出),用於擷取底視影像以取得底視影像訊息;以及一個或複數個光源(圖未示出),用於向地板發射平面光。
一個或複數個光源將光線輻射至地板上由影像感測器所拍攝的預定區域。亦即,當移動式機器人1沿著地板移動至該特定區域時,如果地板是平坦的,則影像感測器與地板之間的距離會保持固定。
另一方面,當移動式機器人1移動至地板中不平坦的表面時,由於地板的不平整或是障礙物,至地板的距離會增加到預定距離以上。此時,控制器10可以控制一個或複數個光源,以調節從其發射出的光量。該光源可以是能夠調節光量的光發射裝置,例如發光二極體(LED)。
使用光學流量感測器23b,控制器10可以偵測移動式機器人1的位置,而無關於移動式機器人1的滑動。控制器10可以比較及分析由光學流量感測器23b隨時間推移所取得的影像資料,以計算移動式機器人1的移動距離和移動方向,並可以基於此計算移動式機器人1的位置。基於使用光學流量感測器23b的移動式機器人1的底部視的影像訊息,控制器10可以相對於藉由其他方式計算之移動式機器人1的位置來執行補償以防止滑動。
光學流量感測器23b偵測反射自地板的光量或分析地板的影像,並提供用於偵測地板材質的裝置給控制器10。
可以將光學流量感測器23b設置成在垂直方向至少部分地與中心垂直平面重疊。更具體地,光學流量感測器23b於中心垂直平面上位於相較於連接該對旋轉拖把41之中心軸的一線更靠前。作為另一示例,光學流量感測器23b可以位在相較於該對旋轉拖把41更靠前。
當光學流量感測器23b設置為相較於拖把模組40更靠前時,具有的優點是在地毯向拖把模組40施加更大的負載之前,就能夠主動地避開地毯。
因此,儘管光學流量感測器23b的數量為單個而不是複數個,由於其位在相較於本體30的中心更靠前,因此可以偵測該對旋轉拖把前方的地板材質。
另外,懸崖感測器23a和光學流量感測器23b不僅能夠偵測懸崖和移動式機器人1的移動量,還能夠同時判定地板材質。
感測單元20可以包含照相機24,用於感測外部的影像。照相機24可以設置在本體30。照相機24可以在固定時間間隔取得頂視影像訊息。
感測單元20可以包含三維(3D)感測器25,用於感測外部環境的3D位置訊息。3D感測器25在固定時間間隔取得頂視影像訊息。
作為一個示例,3D感測器25可以包含:光發射單元(圖未示出),用於發射紅外線;以及3D深度照相機(圖未示出),用於感測反射自外部物體的紅外線。該光發射單元可以發射具有預定圖案的紅外線。3D照相機25可以是IR照相機、RGB深度照相機、或其類似者。3D感測器25可以以時差測距(TOF)方法來實行。
作為另一示例,3D感測器25可以包含兩個或更多個照相機,並可以實施在立體視覺方案中,其中藉由組合由兩個或更多個照相機所取得的兩個或更多個影像來產生3D座標訊息。
感測單元20可以包含傾斜訊息取得單元(圖未示出),用於取得關於本體30相對於地板H傾斜的訊息。舉例來說,該傾斜訊息取得單元可以包含陀螺儀感測器26。該傾斜訊息取得單元可以包含處理模組(圖未示出),其將陀螺儀感測器26的感測訊號轉換為傾斜訊息。該處理模組能夠以演算法或程式來實現以作為控制器10的一部分。作為另一個實施例,該傾斜訊息取得單元可以包含磁場感測器27,以基於關於地球磁場的感測訊息取得該傾斜訊息。
此處,地板H是水平面,即為垂直於重力方向的平面。陀螺儀感測器26可以取得關於本體30相對於水平面之旋轉角速度的訊息。更具體地,陀螺儀感測器26可以感測關於X軸和Y軸的旋轉角速度,該X軸和該Y軸平行於水平面且彼此垂直。可以藉由使用處理模組將關於X軸的旋轉角速度(翻滾)和Y軸的旋轉角速度(顛簸)相結合,來計算相對於水平面的旋轉角速度。可以藉由使用處理模組將該些旋轉角速度進行整合來計算傾斜值。
陀螺儀感測器26可以感測預設參考方向。該傾斜訊息取得單元可以基於該參考方向取得傾斜訊息。
陀螺儀感測器26在空間座標系統中,可以相對於彼此垂直的三個軸具有陀螺儀感測功能。陀螺儀感測器26所收集的訊息可以是翻滾、顛簸、以及偏航的訊息。該處理模組可以藉由整合翻滾、顛簸、以及偏航的角速度來計算移動式機器人1的航向角。
陀螺儀感測器26較佳設置在本體30。因此,陀螺儀感測器26設置在本體30的其餘部分Q處,此將在後面進行描述。另外,該傾斜訊息取得單元設置在該其餘部分Q處。
陀螺儀感測器26可以實施為單獨的感測器,或者可以實施為IMU感測器的一些功能,將於後面進行描述。
感測單元20可以包含感測磁場的磁場感測器27。磁場感測器27在空間座標系統中,可以具有感測相對於彼此垂直的三個軸的磁場的功能。磁場感測器27可以測量航向角(方位角)。磁場感測器27可以實施為單獨的感測器,或者可以實施為IMU感測器的某些功能,此將於後面進行描述。
感測單元20可以包含加速度感測器28,其安裝至本體30以感測移動式機器人1的加速度。加速度感測器28在空間座標系統中,可以具有感測相對於彼此垂直三個軸的加速度的功能。加速度感測器27可以實施為單獨的感測器,或者可以實施為IMU感測器的某些功能,此將於後面進行描述。
移動式機器人1可以包含慣性感測器單元(IMU)(圖未示出)。基於IMU的訊息,移動式機器人1可以穩定行進動作。該IMU可以具有陀螺儀感測器26的功能、磁場感測器27的功能、以及加速度感測器28的功能。
感測單元20可以包含拖把負載訊息感測器29,其取得拖把馬達61的負載訊息。
作為一個實施例,拖把負載訊息感測器29可以藉由感測拖把馬達61的馬達負載電流值或馬達負載電壓值,來感測拖把馬達61的負載。更具體地,拖把負載訊息感測器29可以由設置在拖把馬達控制器11中的電流偵測單元來實現。
作為另一實施例,拖把負載訊息感測器29可以使用感測旋轉拖把的轉速或轉數的編碼器來設置。更具體地,隨著施加至旋轉拖把的負載增加,相較於施加至拖把馬達61的旋轉訊號(電流值、電壓值、或其類似者),轉速可能會降低。可以透過編碼器來感測關於轉速的訊息,以獲得負載訊息。
感測單元20可以包含碰撞感測器(圖未示出),其感測與外部障礙物的接觸。該碰撞感測器可以實施為被外部物體按壓的保險桿(圖未示出)。
感測單元20可以包含編碼器(圖未示出),其判別移動式機器人1實際移動的路徑。該編碼器的功能可以由輔助輪58執行。
移動式機器人1包括輸入單元16,可以透過輸入單元16輸入來自使用者的各種指令。輸入單元16可以包含按鈕、撥盤、觸控型顯示器等。輸入單元16可以包含麥克風(圖未示出),用於語音識別。輸入單元16可以包含電源開關,用於輸入電源的開啟/關閉。
移動式機器人1包括輸出單元17,其將各種訊息輸出給使用者。輸出單元17可以包含顯示器(圖未示出),其輸出視覺訊息。輸出單元17可以包含揚聲器(圖未示出),其輸出聽覺訊息。
移動式機器人1包含儲存單元18,其儲存各種訊息。儲存單元18可以包含非永久性或長久性的記錄介質。儲存單元18可以儲存用於控制操作的演算法,以回應移動式機器人1的各種錯誤。
關於行進區域的地圖可以儲存在儲存單元18中。可以由能夠透過通訊單元19交換訊息的外部終端來輸入地圖,或者可以在移動式機器人1自行學習地圖時形成該地圖。在前述的情況下,該外部終端可以是諸如遙控器、PDA、筆記型電腦、智慧型手機、以及平板電腦,其中安裝有用於設定地圖的應用程式。
移動式機器人1可以包括通訊單元19,能夠存取特定的網路。根據通訊標準,可以使用無線通訊技術來實現通訊單元19,諸如IEEE 802.11 WLAN、IEEE 802.15 WPAN、超寬頻(UWB)、Wi-Fi、ZigBee、Z-wave、藍牙等。
移動式機器人1包括控制器10,其控制自主地行進。控制器10可以由設置在本體30內部的PCB Co實施。
控制器10可以處理來自輸入單元16的訊號、或者透過通訊單元19輸入的訊號。
控制器10可以藉由接收感測單元20的感測訊號來控制清掃機的行進。控制器10可以藉由接收感測單元20的感測訊號來控制拖把馬達61。
控制器10可以控制供水模組(圖未示出)。控制器10可以控制幫浦(圖未示出),以調節供應的水量。每小時向拖把模組40供應的水量可以由該幫浦(圖未示出)的控制而改變。作為另一實施例,控制器10可以控制一個用以改變是否要供水的值,其將於後續描述。
控制器10可以透過由照相機24或3D感測器25獲得的影像(頂視影像訊息)來學習行進區域,並可以將目前位置控制為可識別(可偵測)的。控制器10可以設置以透過該影像建構行進區域的地圖。控制器10可以設置以允許透過該影像在建構的地圖上識別出目前位置。由照相機24擷取的影像可以用於產生行進區域的地圖,並用於偵測行進區域內的目前位置。
舉例來說,控制器10可以使用在由照相機24擷取的頂視影像中天花板與邊牆之間的邊界來產生行進區域的地圖。另外,控制器10可以基於影像中的特徵偵測行進區域內的目前位置。
在完成行進之後,控制器10可以控制移動式機器人1返回至充電站。作為一個實施例,移動式機器人1可以設置以藉由感測從充電站發送的紅外線(IR)訊號,返回至充電站。控制器10可以基於從充電站發送的感測訊號,控制移動式機器人1返回至充電站。該充電站可以包含訊號發送器(圖未示出),其發送預定返回訊號。
作為另一實施例,控制器10可以藉由識別地圖上的目前位置,來控制移動式機器人1返回至充電站。藉由識別與充電站相對應的位置和地圖上的目前位置,移動式機器人1能夠返回至充電站。
控制器10可以基於透過使用者終端(例如,智慧型手機、電腦等)輸入的訊息控制移動式機器人1。移動式機器人1可以透過通訊單元19接收該輸入訊息。基於該輸入訊息,控制器10可以控制移動式機器人1的行進模式(例如,以之字形行進、或者在特定區域行進以對該特定區域進行集中清掃)。基於該輸入訊息,控制器10可以控制是否要啟動移動式機器人1的特定功能(例如,搜尋遺失物品的功能或驅除昆蟲的功能)。基於該輸入訊息,控制器10可以將移動式機器人1的清掃行進開始時間設定成特定的時間(清掃預約功能)。
控制器10包含拖把馬達控制器11,其控制拖把馬達61的驅動。拖把馬達控制器11可以包含第一拖把馬達控制器11a,其控制第一拖把馬達61a的驅動。拖把馬達控制器11可以包含第二拖把馬達控制器11b,其控制第二拖把馬達61b的驅動。
在移動式機器人1使用旋轉拖把與地板之間的摩擦力來行進的情況下,如果移動式機器人1移動至地毯上,則旋轉拖把會卡在地毯上。為了解決此問題,本發明使用各種感測器來主動地判定地板材質是否是問題材質。
控制器10可以從光學流量感測器23b、加速度感測器28、懸崖感測器23a、或拖把負載訊息感測器29中的至少一個所接收到的訊息,來判定地板材質是否為問題材質,並在判定地板材質為問題材質時,可以控制拖把馬達以執行進入限制操作。
控制器10可以獨立地或全面地考量從光學流量感測器23b、加速度感測器28、懸崖感測器23a、以及拖把負載訊息感測器29所接收到的訊息,來判定地板材質是否為問題材質。
控制器10可以進一步包含地板材質判定單元12,其判定地板地材質。
控制器10可以基於由光學流量感測器23b獲取的底視影像訊息判定地板材質,並在判定地板材質是問題材質時,控制器10可以控制拖把馬達61以使移動式機器人1執行進入限制操作。另外,在判定地板材質是問題材質時,控制器10可以將目前位置(或目前位置與周圍區域)設置為問題區域。
在下文中,可以將地板材質為問題材質的情況界定為滿足進入限制條件的情況。
舉例來說,進入限制操作可以是控制拖把馬達61使得移動式機器人1在行進時避開滿足進入限制條件的區域的操作。在此,避開滿足進入限制條件的區域是指控制器10控制拖把馬達61使得移動式機器人1在待清掃的區域中,除了滿足進入限制條件的區域(與由照相機所偵測的目前位置距預定半徑以內的區域)以外的地方行進或清掃。
在另一實施例,進入限制操作可以包含:迴避行進操作,用於避開滿足進入限制條件的區域;以及迴避錯誤回應操作,其在未正確執行該迴避行進操作時被執行。迴避錯誤回應操作可以包含輸出諸如訊息、圖像、或符號的視覺訊息的操作。迴避錯誤回應操作可以包含輸出預定聲音的操作。迴避錯誤回應操作可以包含停止行進直到該錯誤被解決的操作。可以藉由組合上述一個或複數個操作來構成一種迴避錯誤回應操作。
在又一實施例,當滿足進入限制條件時,就可以執行進入限制操作,以較佳地降低移動式機器人1的行進速度來實現迴避行進。
當未滿足進入限制條件時(當地板材質不是問題材質時),控制器10可以啟動正常的行進模式。該正常的行進模式是移動式機器人1執行預定正常操作,而非為進入限制操作的模式。
更具體地,地板材質判定單元12可以基於底視影像訊息計算地板的反射值、底視影像的影像品質值、以及底視影像的影格率,並且當滿足以下條件1到3中的至少一個時,則可以判定地板材質為問題材質。
<條件1>
影像品質值小於預設參考影像品質值
<條件2>
影格率低於預設參考影像影格率
<條件3>
地板的反射值小於預設參考反射值
在另一實施例,地板材質判定單元12可以基於底視影像訊息計算底視影像品質值,並且當影像品質值小於預設參考影像品質值時,可以判定地板材質為問題材質。
在又另一實施例,地板材質判定單元12可以基於底視影像訊息計算底視影像的影格率,並且當影格率低於預設參考影格率時,可以判定地板材質為問題材質。
在又另一實施例,地板材質判定單元12可以基於底視影像訊息計算地板的反射值,並且當地板的反射值小於預設參考反射值時,可以判定地板材質為問題材質。
在此,影像品質值界定為藉由將由光學流量感測器23b擷取的底部視影像的狀態進行數位化而獲得的值。
影像品質值可以基於由光源發出的光形成在地板上的影像形狀來進行判定。亦即,當具有預定形狀的平面光從光源發射至地板上並藉由擷取該光來獲得底視影像時,從光源發射出的平面光的形狀與底視影像之間的相似度即可以界定為影像品質值。
在另一實施例,影像質量的測量流程可以是使用柱狀圖平滑化處理後測量對比度是否合適的流程。影像質量的測量流程可以包含二元化處理、以及判定對比度的適合性處裡。
該平滑化處理可以是一種用於使用柱狀圖分析來提高底視影像識別率的流程。所獲得的底視影像可以由複數個像素組成。該柱狀圖顯示了包含在底視影像中複數個像素的強度值分佈。亦即,該柱狀圖顯示了底視影像中明亮區域和昏暗區域的分佈。更具體地,在256灰階影像中強度值的範圍是0至255。該柱狀圖是一長條圖,顯示了各個像素的強度值的頻率。該平滑化處理是指當柱狀圖中強度值的分佈呈現傾斜狀或不均勻時,對該強度值的分佈進行平滑化的處理。換句話說,該平滑化處理是分散偏斜至一側的強度值以獲得均勻分佈的流程。由於該平滑化處理,底視影像的昏暗區域能變亮,而其明亮區域能變暗,因此每個像素可以具有適當的強度值。
該二元化處理可以是在平滑化處理之後,將構成底視影像的像素分類為黑色像素和白色像素的流程。由於在平滑化處理之後,底視影像可能具有複雜的陰影,因此可以透過二元化處理將像素二元化為黑色和白色的像素。該二元化處理需要基於將像素分類為黑色或白色像素的一閾值。該閾值可以是設定以將像素分類為黑色與白色像素的值。當像素的強度值大於該閾值時,可以將其分類為0(黑色),並且當像素的強度值小於該閾值時,可以將其分類為1(白色)。
判定對比度的適合性處理的流程可以是判定該二元化像素的對比度是否滿足預定水平的流程。
當灰暗度在對比度中的比例較高時,影像的質量值較小。當影像的質量值小時,可以判定地板具有高的粗糙度或者地板是地毯。因此,在本發明中,當影像的質量值小於參考影像品質值時,判定地板材質為問題材質。
另外,地板的反射率可以是藉由將白色像素的數量除以黑色像素的數量所得到的值。作為另一實施例,地板的反射率可以界定為在從光源發射出的光之中由地板反射之後,入射至光接收單元(圖未示出)中的光量。
在地板由具有高反射率的材質所製成並為平坦的情況下,例如,當地板由木材、大理石、或油氈製成時,底視影像品質值、地板的反射率、以及影格率為高。然而,在地板由具有低反射率的材質所製成且為粗糙的情況下,底視影像品質值、地板的反射率、以及影格率為低。
因此,在本發明中,基於在由光學流量感測器23b根據地板材質獲得之底視影像的多個參數之間的差異,來判定地板材質,因此移動式機器人1
能夠避開問題區域而不進入該區域。特別地,可以使用單一感測器對多個參數執行交叉驗證及獨立驗證,從而能夠使地板材質得到精準的判定。
因此,移動式機器人1可以將具有低反射率的地板區域判定為地毯區域,並可以在避開該區域時行進。結果,可以解決利用拖把旋轉力行進的移動式機器人1移動至地毯而被其限制住的問題。
作為另一實施例,控制器10可以基於由懸崖感測器23a獲得至地板的距離、以及由光學流量感測器23b獲得之底視影像訊息來判定地板材質。
更具體地,當由懸崖感測器23a獲得至地板的距離小於參考距離時,控制器10可以控制拖把馬達61以執行進入限制操作。在此種情況下,控制器10可以基於由光學流量感測器23b獲得的底視影像訊息來判定地板材質。
當由懸崖感測器23a獲得至地板的距離大於參考距離值且小於最大值時,控制器10可以控制拖把馬達61,使得移動式機器人1正常行進。
懸崖感測器23a設置在本體30前端,並偵測與旋轉拖把接觸的地板(參考地板)與本體30前端下方的地板兩者之間的高度差。使用由懸崖感測器23a偵測的值,可以感測懸崖並偵測相較於參考地板為高的地板。當偵測出高於參考地板的地板時,移動式機器人1判定地板上有地毯或其類似者,並且會避開它們。
透過使用諸如懸崖感測器23a和光學流量感測器23b的多個測量裝置,可以減少判定地板材質時的誤差。
作為又另一實施例,移動式機器人1可以在旋轉拖把的一部分已進入問題區域的狀態下,判定目前位置在問題區域內。
控制器10可以基於由拖把負載訊息感測器29偵測的拖把負載值控制移動式機器人1。更具體地,當由拖把負載訊息感測器29偵測的拖把負載值大於預設參考負載值時,控制器10可以控制拖把馬達61以執行進入限制操作。
另外,當由拖把負載訊息感測器29偵測的拖把負載值小於預設參考負載值時,控制器10可以控制拖把馬達61以執行正常的行進操作。
作為再另一實施例,控制器10可以基於加速度值計算平均加速度值,並且在判定平均加速度值大於預設參考平均加速度值時,控制器10可以控制拖把馬達61以執行進入限制操作。另外,控制器10可以計算加速度值的偏差,並在判定偏差大於預設參考偏差時,可以控制拖把馬達61以執行進入限制操作。
當然,當平均加速度值小於參考平均加速度值時,控制器10可以控制拖把馬達61以執行正常的行進操作。另外,當偏差小於參考偏差時,控制器10可以控制拖把馬達61以執行正常的行進操作。
因此,在本發明中,即使透過懸崖感測器23a或光學流量感測器23b未主動地判定出問題區域,也可以基於諸如旋轉拖把的負載和由加速度感測器28獲得的訊息的一個或複數個因素,在進入有問題區域的初期時,判定目前位置是否在問題區域內。
另外,在移動式機器人1移動的期間,例如旋轉移動或向前移動的期間,可以快速地判定移動式機器人1的一部分被限制在地毯上的風險,並使移動式機器人1能夠快速地避開此種情況。
作為又另一實施例,當滿足以下條件4至7中的至少一個時,控制器10可以控制拖把馬達61以執行進入限制操作。
<條件4>
拖把馬達的負載值大於預定參考負載值
<條件5>
至地板的距離小於預定參考距離值
<條件6>
平均加速度值大於預定參考平均加速度值
<條件7>
加速度的偏差大於參考偏差
作為再另一實施例,當滿足上述條件1至7中的至少一個時,控制器10可以控制拖把馬達61以執行進入限制操作。因此,本發明能夠基於各種因素而全面且精確地判定出地板材質是否為問題材質。
圖5顯示移動式機器人(懸崖感測器23a及/或光學流量感測器23b)途中移動至地毯M上的情況。在本發明中,在移動式機器人途中移動至地毯上或非常接近地毯的情況下,移動式機器人可以避開地毯。此時,由於旋轉拖把仍與地板H接觸,因此移動式機器人可以避開地毯。
在下文中,將描述根據第一至第四實施例控制移動式機器人1的方法。在該些流程圖中,相同的內容將由相同的參考標記來表示,並且將省略掉其中重複的描述。
該控制方法可以由控制器10執行。本發明可以是移動式機器人1的控制方法,或者可以是包含實現該控制方法之控制器10的移動式機器人1。本發明可以是包含該控制方法每個流程的電腦程式,或者可以是使用電腦儲存實現該控制方法的程序的記錄介質。該“記錄介質”是一電腦可讀取的記錄介質。本發明可以是包含硬體以及軟體的清掃機控制系統。
可以透過來自電腦程式的指令,實現該控制方法之流程圖的每個流程以及該控制方法之流程圖的組合。該些指令可以安裝在一般用途的電腦或特殊用途的電腦中。該些指令會產生執行流程圖中的該(些)流程所描述的功能手段。
另外,在一些實施例中,該些流程中所提及的功能可以與本文提及之不同順序來實現。舉例來說,取決於相對應的功能,基本上可以同時地執行二個連續的流程,或者可以用相反的順序執行二個連續的流程。
參見圖6,根據第一實施例的控制方法是移動式機器人的宏觀控制方法。本發明的控制方法可以包括以下步驟:透過移動式機器人1使用各種裝置獲得關於地板的訊息的步驟(S100);基於使用各種裝置所收集之關於地板的訊息判定地板材質的步驟(S200);以及基於地板材質控制移動式機器人移動的步驟(S300)。
在下文中,將參見圖7至圖9詳細描述根據第二至第四實施例的控制方法。
參見圖7,根據第二實施例的控制方法可以包括以下步驟:透過移動式機器人1使用各種裝置獲得關於地板的訊息的步驟(S100);基於使用各種裝置所收集之關於地板的訊息判定地板材質的步驟(S200);以及基於地板材質控制移動式機器人移動的步驟(S300)。
在此,獲得關於地板的訊息的步驟(S100)可以包含:透過移動式機器人擷取底視影像的步驟(S110);以及透過移動式機器人從底視影像獲得底視影像訊息的步驟(S112)。更具體地,由光學流量感測器23b執行獲得關於地板的訊息的步驟(S100)。
基於關於地板的訊息判定地板材質的步驟(S200)包含基於底視影像訊息判定地板材質是問題材質的步驟(S210)。在步驟S210中,移動式機器人及/或控制器10基於透過光學流量感測器23b獲得之底視影像訊息判定地板
材質。更具體地,控制器10可以基於底視影像訊息計算地板的反射值、底視影像的影像品質值、或者底視影像的影格率中的至少一個,並且當滿足上述條件1到3中的至少一個時,可以判定地板材質為問題材質。具體的判定方法則與上述的相同。
控制移動式機器人移動的步驟(S300)包含當地板材質是問題材質時,控制移動式機器人以執行進入限制操作的步驟(S310)。在步驟S310中,控制器10可以將移動式機器人的行進方向改變成向左或向右,或者可以將移動式機器人向後移動,接著改變其行進方向,並可以再次執行步驟S100。
另外,控制移動式機器人移動的步驟(S300)可以包含當地板材質非為問題材質時,控制移動式機器人正常行進的步驟(S312)。更具體地,控制器10可以判定地板材質是否為問題材質,並且在判定地板材質是問題材質時,可以控制拖把馬達以執行進入限制操作。
參見圖8,根據第三實施例的控制方法可以包括以下步驟:透過移動式機器人1使用各種裝置獲得關於地板訊息的步驟(S100);基於使用各種裝置所收集之關於地板的訊息判定地板材質的步驟(S200);以及基於地板材質控制移動式機器人移動的步驟(S300)。
在此,獲得關於地板的訊息的步驟(S100)可以包含以下步驟:透過光學流量感測器23b從底視影像獲得底視影像訊息的步驟(S112);透過加速度感測器28獲得移動式機器人的加速度值的步驟(S113);透過拖把負載訊息感測器29獲得拖把馬達負載值的步驟(S116);以及透過懸崖感測器23a獲得地板與移動式機器人之間的距離值的步驟(S117)。
判定地板材質的步驟(S200)包含:當滿足上述條件1至7中的至少一個時,由控制器10判定地板材質是問題材質的步驟(S220)。當然,在判定地板材質之前,控制器10可以基於加速度值計算平均加速度值,並可以計算加速度值的偏差。具體的判定方法則與上述的相同。
控制移動式機器人移動的步驟(S300)包含:當地板材質是問題材質時,控制移動式機器人以執行進入限制操作的步驟(S310)。另外,控制移動式機器人移動的步驟(S300)可以包含:當地板材質不是問題材質時,控制移動式機器人正常行進的步驟(S312)。更具體地,控制器10可以判定地板
材質是否為問題材質,並且在判定地板材質是問題材質時,可以控制拖把馬達以執行進入限制操作。
另外,控制移動式機器人移動的步驟(S300)可以包含以下步驟:當判定地板材質是問題材質時,由移動式機器人在地圖上將目前位置及/或周圍區域記錄為問題區域的步驟(S320)。
參見圖9,根據第四實施例的控制方法可以包括以下步驟:透過移動式機器人1使用各種裝置獲得關於地板的訊息的步驟(S100);基於使用各種裝置所收集之關於地板的訊息判定地板材質的步驟(S200);以及基於地板材質控制移動式機器人移動的步驟(S300)。
在此,獲得關於地板的訊息的步驟(S100)可以包含以下步驟:透過光學流量感測器23b從底視影像獲得底視影像訊息的步驟(S112);透過加速度感測器28獲得移動式機器人的加速度值的步驟(S113);透過拖把負載訊息感測器29獲得拖把馬達負載值的步驟(S116);以及透過懸崖感測器23a獲得地板與移動式機器人之間的距離值的步驟(S117)。獲得底視影像訊息的步驟(S112)、獲得加速度值的步驟(S113)、獲得拖把馬達負載值的步驟(S116)、以及獲得地板與移動式機器人之間的距離值的步驟(S117)可以單獨地、獨立地、同時地、不同時地、並聯地、或串聯地執行。
判定地板材質的步驟(S200)包含:當滿足上述條件1至3中的至少一個時,由控制器10判定地板材質是問題材質的步驟(S221)。當然,在判定地板材質之前,控制器10可以基於加速度值計算平均加速度值,並可以計算加速度值的偏差。具體的判定方法則與上述的相同。在判定地板材質是問題材質的步驟中(S221),當判定地板材質是問題材質時,控制器10控制拖把馬達以執行進入限制操作(S310),而當判定地板材質不是問題材質時,控制器10基於與地板的距離判定地板材質是否為有問題材質(S222)。
在步驟S222中,當由懸崖感測器23a獲得之與地板的距離小於參考距離值時,控制器10判定地板材質是問題材質。在判定地板材質是問題材質時,控制器10可以控制拖把馬達以執行進入限制操作(S310)。在步驟S222中,在判定地板材質不是問題材料時,控制器10基於拖把馬達負載值,判定地板材質是否是問題材質(S223)。
在步驟S223中,當由拖把負載訊息感測器29偵測的拖把負載值大於預設參考負載值時,控制器10判定地板材質是問題材質。在判定地板材質是問題材質時,控制器10可以控制拖把馬達以執行該進入限制操作(S310)。在步驟S223中,在判定地板材質不是問題材料時,控制器10基於加速度值的偏差,判定地板材質是否是問題材質(S224)。
在步驟S225中,當平均加速度值大於參考平均加速度值時,控制器10判定地板材質是問題材質。在判定地板材質是問題材質時,控制器10可以控制拖把馬達以執行進入限制操作(S310)。在步驟S225中,一旦判定地板材質不是問題材質,則控制器10控制移動式機器人正常行進(S312)。
另外,控制移動式機器人移動的步驟(S300)可以包含以下步驟:當判定地板材質是問題材質時,由移動式機器人在地圖上將目前位置及/或周圍區域記錄為問題區域的步驟(S320)。
從以上的描述顯而易見的是,根據本發明,移動式機器人基於地板的影像判定問題區域,並且在避開該問題區域的同時行進。因此,可以解決利用拖把旋轉力行進的移動式機器人移動至地毯而被其限制住的問題。
另外,使用由多個感測器獲得之地板的反射率、地板的影像質量、旋轉拖把的負載、或加速度中的至少一個,或者使用該些因素的組合來估算地板材質。因此,可以精準地判定地板材質,並可以使移動式機器人避免進入問題區域,或者在進入的初期就離開問題區域。
另外,懸崖感測器23a和光學流量感測器23b不僅能夠偵測懸崖和移動式機器人1的移動量,還能夠同時判定地板材質。因此,不需要安裝單獨的感測器,並可以降低製造成本並容易地形成控制的結構。
另外,由於懸崖感測器23a和光學流量感測器23b相較於拖把模組40更靠前,因此在地毯向拖把模組40施加較大的負載之前,就可以主動地避開地毯。
另外,由於在本體30左右方向上的中央設置有用於判定地板材質的感測器,因此能夠以最少的感測器數量而最大程度地擴大偵測範圍。
儘管已經參考圖式中所顯示的特定實施例來描述本發明,然而對於本發明所屬技術領域中具通常知識者而言,顯而易見的是,本描述並不限定於該些示例性的實施例,並且在不脫離所附申請專利範圍中描述之本發明範圍
的情況下,能夠以多種形式實現本發明。此些修改不應從本發明的技術精神或範圍中被單獨地理解。
本申請主張於2019年12月20日在韓國知識產權局提交之PCT申請PCT/KR2019/018254的優先權,其揭露內容透過引用合併於此。
1:清掃機、移動式機器人
30:本體
32:基座
40:拖把模組
81:水箱
311:上壁
312:側壁
313:水箱插入開口
U:向上
Le:向左
R:向後
D:向下
Ri:向右
F:向前
Claims (19)
- 一種移動式機器人,包括:一本體;一對旋轉拖把,可旋轉地安裝至該本體;一拖把馬達,配置以向該對旋轉拖把提供一驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;以及一控制器,配置以基於由該光學流量感測器感測的該底視影像訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作,其中該光學流量感測器設置在相較於該對旋轉拖把更靠前方。
- 如請求項1所述的移動式機器人,其中該光學流量感測器包含:一影像感測器,配置以擷取一底視影像以獲得該底視影像訊息;以及至少一個光源,配置以調節一光量。
- 如請求項1所述的移動式機器人,其中該控制器基於該底視影像訊息計算該地板的一反射值、一底視影像的一影像品質值、以及該底視影像的一影格率,並且當滿足以下條件1到3中的至少一個時,判定該地板材質為問題材質:<條件1>該影像品質值小於一預定參考影像品質值<條件2>該影格率低於一預定參考影格率<條件3>該地板的該反射值小於一預定參考反射值。
- 如請求項1所述的移動式機器人,進一步包括:一拖把負載訊息感測器,配置以感測該拖把馬達的一負載值;一懸崖感測器,配置以感測至該地板的距離;以及一加速度感測器,安裝至該本體上,以感測加速度值, 其中,當滿足以下條件4至7中的至少一個時,該控制器控制該拖把馬達以執行該進入限制操作:<條件4>該拖把馬達的該負載值大於一預定參考負載值<條件5>至該地板的距離小於一預定參考距離值<條件6>一平均加速度值大於一預定參考平均加速度值<條件7>加速度的偏差大於一預設參考偏差。
- 一種移動式機器人,包括:一本體;一對旋轉拖把,可旋轉地安裝至該本體;一拖把馬達,配置以向該對旋轉拖把提供一驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;以及一控制器,配置以基於由該光學流量感測器感測的該底視影像訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作,其中該控制器基於該底視影像訊息計算一底視影像的一影像品質值,並且當該影像品質值小於一預定參考影像品質值時,判定該地板材質為問題材質。
- 如請求項5所述的移動式機器人,其中該影像品質值基於由從一光源發出的光形成在該地板上的一影像形狀來判定。
- 一種移動式機器人,包括:一本體;一對旋轉拖把,可旋轉地安裝至該本體;一拖把馬達,配置以向該對旋轉拖把提供一驅動力; 一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;以及一控制器,配置以基於由該光學流量感測器感測的該底視影像訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作,其中該控制器基於該底視影像訊息計算一底視影像的一影格率,並且當該影格率低於一預定參考影格率時,判定該地板材質為問題材質。
- 一種移動式機器人,包括:一本體;一對旋轉拖把,可旋轉地安裝至該本體;一拖把馬達,配置以向該對旋轉拖把提供一驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;以及一控制器,配置以基於由該光學流量感測器感測的該底視影像訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作,其中該控制器基於該底視影像訊息計算該地板的一反射值,並且當該地板的該反射值小於一預定參考反射值時,判定該地板材質為問題材質。
- 一種移動式機器人,包括:一本體;一對旋轉拖把,可旋轉地安裝至該本體;一拖把馬達,配置以向該對旋轉拖把提供一驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;一控制器,配置以基於由該光學流量感測器感測的該底視影像訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作;以及一照相機或一3D感測器,配置以在一固定時間間隔獲得一頂視影像訊息,其中,該控制器基於該頂視影像訊息偵測一目前位置。
- 如請求項9所述的移動式機器人,其中在判定該地板材質是問題材質時,該控制器將該目前位置設定為一問題區域。
- 一種移動式機器人,包括:一本體;一對旋轉拖把,可旋轉地安裝至該本體;一拖把馬達,配置以向該對旋轉拖把提供一驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;一控制器,配置以基於由該光學流量感測器感測的該底視影像訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作;以及一拖把負載訊息感測器,配置以感測該拖把馬達的一負載值,其中,當該拖把馬達的該負載值大於一預定參考負載值時,該控制器控制該拖把馬達以執行該進入限制操作。
- 一種移動式機器人,包括:一本體;一對旋轉拖把,可旋轉地安裝至該本體;一拖把馬達,配置以向該對旋轉拖把提供一驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;一控制器,配置以基於由該光學流量感測器感測的該底視影像訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作;以及一懸崖感測器,配置以感測至該地板的距離,其中,當至該地板的距離小於一參考距離時,該控制器控制該拖把馬達以執行該進入限制操作。
- 如請求項12所述的移動式機器人,其中該懸崖感測器配置於相較該對旋轉拖把更前方。
- 如請求項12所述的移動式機器人,其中該懸崖感測器被設置使得其至少一部分在一垂直方向上與一假想的中心垂直平面重疊。
- 一種移動式機器人,包括:一本體;一對旋轉拖把,可旋轉地安裝至該本體;一拖把馬達,配置以向該對旋轉拖把提供一驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;一控制器,配置以基於由該光學流量感測器感測的該底視影像訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作;以及一加速度感測器,安裝至該本體上,用於感測加速度值,其中,該控制器基於該些加速度值計算一平均加速度值,並且在判定該平均加速度值大於一參考平均加速度值時,該控制器控制該拖把馬達以執行該進入限制操作。
- 一種移動式機器人,包括:一本體;一對旋轉拖把,可旋轉地安裝至該本體;一拖把馬達,配置以向該對旋轉拖把提供一驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;一控制器,配置以基於由該光學流量感測器感測的該底視影像訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作;以及一加速度感測器,安裝至該本體上,用於感測加速度值,其中,該控制器計算該些加速度值的偏差,並且在判定該偏差大於一參考偏差時,該控制器控制該拖把馬達以執行該進入限制操作。
- 一種移動式機器人,包括: 一本體;一對旋轉拖把,可旋轉地安裝至該本體上;一拖把馬達,配置以向該對旋轉拖把提供一驅動力;一光學流量感測器,配置以在一固定時間間隔使用光來獲得一底視影像訊息;一加速度感測器,安裝在該本體上,以感測加速度值;一懸崖感測器,配置以感測至該地板的距離;一拖把負載訊息感測器,配置以感測該拖把馬達的一負載值;以及一控制器,配置以基於從該光學流量感測器、該加速度感測器、該懸崖感測器、或該拖把負載訊息感測器中的至少一個所接收到的訊息,判定一地板材質是否為問題材質,並配置以當判定該地板材質為問題材質時,控制該拖把馬達以執行一進入限制操作。
- 如請求項17所述的移動式機器人,其中該光學流量感測器設置在相較於連接該對旋轉拖把的旋轉軸的一線更靠前方的位置,以使該光學流量感測器不與該對旋轉拖把垂直地重疊,以及其中,該懸崖感測器相較於該對旋轉拖把和該光學流量感測器的前端設置更靠前方。
- 如請求項17所述的移動式機器人,其中該對旋轉拖把設置為相對於一假想的中心垂直平面彼此左右對稱,以及其中,該光學流量感測器和該懸崖感測器被設置以與該假想的中心垂直平面垂直地重疊。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/KR2019/018254 WO2021125411A1 (ko) | 2019-12-20 | 2019-12-20 | 이동 로봇 |
WOPCT/KR2019/018254 | 2019-12-20 |
Publications (2)
Publication Number | Publication Date |
---|---|
TW202131853A TW202131853A (zh) | 2021-09-01 |
TWI794700B true TWI794700B (zh) | 2023-03-01 |
Family
ID=76476848
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW109144326A TWI794700B (zh) | 2019-12-20 | 2020-12-15 | 移動式機器人 |
Country Status (7)
Country | Link |
---|---|
US (1) | US20230022860A1 (zh) |
EP (1) | EP4079466A4 (zh) |
KR (1) | KR20220104185A (zh) |
CN (1) | CN114829083B (zh) |
AU (1) | AU2019479398B2 (zh) |
TW (1) | TWI794700B (zh) |
WO (1) | WO2021125411A1 (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20140011216A (ko) * | 2012-07-18 | 2014-01-28 | 엘지전자 주식회사 | 로봇 청소기 및 이의 제어 방법 |
TW201705892A (zh) * | 2015-05-28 | 2017-02-16 | Vorwerk Co Interholding | 由電動機驅動之設備的操作方法 |
KR20190015930A (ko) * | 2017-08-07 | 2019-02-15 | 엘지전자 주식회사 | 로봇청소기 및 그 제어방법 |
Family Cites Families (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120321759A1 (en) * | 2007-01-05 | 2012-12-20 | Myskin, Inc. | Characterization of food materials by optomagnetic fingerprinting |
KR101752190B1 (ko) * | 2010-11-24 | 2017-06-30 | 삼성전자주식회사 | 로봇청소기 및 그 제어방법 |
KR101995424B1 (ko) * | 2012-06-13 | 2019-07-02 | 엘지전자 주식회사 | 로봇 청소기 및 그 제어방법 |
US9798328B2 (en) * | 2014-10-10 | 2017-10-24 | Irobot Corporation | Mobile robot area cleaning |
US9993129B2 (en) * | 2015-02-13 | 2018-06-12 | Irobot Corporation | Mobile floor-cleaning robot with floor-type detection |
DE102015112174A1 (de) * | 2015-07-27 | 2017-02-02 | Vorwerk & Co. Interholding Gmbh | Gerät zur Bearbeitung einer Oberfläche |
US10788836B2 (en) * | 2016-02-29 | 2020-09-29 | AI Incorporated | Obstacle recognition method for autonomous robots |
KR101654014B1 (ko) | 2016-06-21 | 2016-09-06 | 주식회사 파인로보틱스 | 걸레 로봇 청소기 |
KR101918228B1 (ko) * | 2016-07-14 | 2019-01-29 | 엘지전자 주식회사 | 이동로봇 및 그 제어방법 |
CN106264357B (zh) * | 2016-08-30 | 2019-10-18 | 宁波菜鸟智能科技有限公司 | 扫地机器人的地毯判定方法及系统 |
JP6883352B2 (ja) * | 2016-12-16 | 2021-06-09 | 云鯨智能科技(東莞)有限公司Yunjing Intelligence Technology (Dongguan) Co.,Ltd. | ベースステーションおよび清掃ロボットシステム |
DE102017101936A1 (de) * | 2017-02-01 | 2018-08-02 | Vorwerk & Co. Interholding Gesellschaft mit beschränkter Haftung | Selbsttätig verfahrbares Bodenbearbeitungsgerät |
KR20180121244A (ko) * | 2017-04-28 | 2018-11-07 | 엘지전자 주식회사 | 이동 로봇 및 그 제어방법 |
JP7174505B2 (ja) * | 2017-05-23 | 2022-11-17 | 東芝ライフスタイル株式会社 | 電気掃除機 |
KR102021826B1 (ko) * | 2018-02-05 | 2019-09-17 | 엘지전자 주식회사 | 청소기 |
KR102070065B1 (ko) * | 2018-03-14 | 2020-03-02 | 엘지전자 주식회사 | 싸이클론 집진 장치 및 이를 포함하는 청소기 |
JP2021526446A (ja) * | 2018-06-08 | 2021-10-07 | ポジテック パワー ツールズ(スーチョウ)カンパニー,リミティド | 掃除ロボット及びその制御方法、掃除ロボットシステム |
US20200000302A1 (en) * | 2018-06-28 | 2020-01-02 | Irobot Corporation | Mobile cleaning robots systems and methods |
CN109846427A (zh) * | 2019-01-16 | 2019-06-07 | 深圳乐动机器人有限公司 | 一种清洁机器人的控制方法及清洁机器人 |
-
2019
- 2019-12-20 AU AU2019479398A patent/AU2019479398B2/en active Active
- 2019-12-20 WO PCT/KR2019/018254 patent/WO2021125411A1/ko unknown
- 2019-12-20 EP EP19956353.7A patent/EP4079466A4/en active Pending
- 2019-12-20 US US17/786,999 patent/US20230022860A1/en active Pending
- 2019-12-20 CN CN201980103092.7A patent/CN114829083B/zh active Active
- 2019-12-20 KR KR1020227019256A patent/KR20220104185A/ko not_active Application Discontinuation
-
2020
- 2020-12-15 TW TW109144326A patent/TWI794700B/zh active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20140011216A (ko) * | 2012-07-18 | 2014-01-28 | 엘지전자 주식회사 | 로봇 청소기 및 이의 제어 방법 |
TW201705892A (zh) * | 2015-05-28 | 2017-02-16 | Vorwerk Co Interholding | 由電動機驅動之設備的操作方法 |
KR20190015930A (ko) * | 2017-08-07 | 2019-02-15 | 엘지전자 주식회사 | 로봇청소기 및 그 제어방법 |
Also Published As
Publication number | Publication date |
---|---|
KR20220104185A (ko) | 2022-07-26 |
CN114829083A (zh) | 2022-07-29 |
AU2019479398B2 (en) | 2023-12-21 |
US20230022860A1 (en) | 2023-01-26 |
WO2021125411A1 (ko) | 2021-06-24 |
EP4079466A4 (en) | 2023-08-30 |
TW202131853A (zh) | 2021-09-01 |
AU2019479398A1 (en) | 2022-08-11 |
CN114829083B (zh) | 2024-04-09 |
EP4079466A1 (en) | 2022-10-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11906979B2 (en) | Plurality of autonomous mobile robots and controlling method for the same | |
US11490776B2 (en) | Cleaner | |
EP2677386B1 (en) | Robot cleaner and obstacle detection control method of the same | |
US11409308B2 (en) | Robot cleaner and a controlling method for the same | |
US10213082B2 (en) | Robot cleaner | |
KR101822942B1 (ko) | 로봇 청소기 및 이의 제어 방법 | |
US11740625B2 (en) | Plurality of autonomous mobile robots and controlling method for the same | |
EP3409177A1 (en) | Moving robot and controlling method thereof | |
KR102615962B1 (ko) | 이동 로봇 및 복수의 이동 로봇의 제어방법 | |
US20190339690A1 (en) | Plurality of autonomous mobile robots and controlling method for the same | |
US20220257074A1 (en) | Mobile robot using artificial intelligence and controlling method thereof | |
TWI788690B (zh) | 移動式機器人 | |
TWI794700B (zh) | 移動式機器人 | |
JP2024006218A (ja) | 移動制御システム、移動制御方法、及び、プログラム | |
JP2024042694A (ja) | カメラ装置及び清掃ロボット |