JP2019518277A - 清掃ロボット及び障害物の乗越え方法 - Google Patents

清掃ロボット及び障害物の乗越え方法 Download PDF

Info

Publication number
JP2019518277A
JP2019518277A JP2018559319A JP2018559319A JP2019518277A JP 2019518277 A JP2019518277 A JP 2019518277A JP 2018559319 A JP2018559319 A JP 2018559319A JP 2018559319 A JP2018559319 A JP 2018559319A JP 2019518277 A JP2019518277 A JP 2019518277A
Authority
JP
Japan
Prior art keywords
obstacle
drive wheel
cleaning robot
state
disturbed
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.)
Granted
Application number
JP2018559319A
Other languages
English (en)
Other versions
JP7123810B2 (ja
Inventor
陽 何
陽 何
勇峰 夏
勇峰 夏
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.)
Beijing Xiaomi Mobile Software Co Ltd
Original Assignee
Beijing Xiaomi Mobile Software 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 Beijing Xiaomi Mobile Software Co Ltd filed Critical Beijing Xiaomi Mobile Software Co Ltd
Publication of JP2019518277A publication Critical patent/JP2019518277A/ja
Application granted granted Critical
Publication of JP7123810B2 publication Critical patent/JP7123810B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/4061—Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
    • 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/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • A—HUMAN NECESSITIES
    • A46—BRUSHWARE
    • A46B—BRUSHES
    • A46B9/00—Arrangements of the bristles in the brush body
    • A46B9/02—Position or arrangement of bristles in relation to surface of the brush body, e.g. inclined, in rows, in groups
    • A46B9/026—Position or arrangement of bristles in relation to surface of the brush body, e.g. inclined, in rows, in groups where the surface of the brush body or carrier is not in one plane, e.g. not flat
    • A—HUMAN NECESSITIES
    • A46—BRUSHWARE
    • A46B—BRUSHES
    • A46B13/00—Brushes with driven brush bodies or carriers
    • A46B13/001—Cylindrical or annular brush bodies
    • A—HUMAN NECESSITIES
    • A46—BRUSHWARE
    • A46B—BRUSHES
    • A46B13/00—Brushes with driven brush bodies or carriers
    • A46B13/02—Brushes with driven brush bodies or carriers power-driven carriers
    • 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/24—Floor-sweeping machines, motor-driven
    • 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/28—Floor-scrubbing machines, motor-driven
    • 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/28—Floor-scrubbing machines, motor-driven
    • A47L11/282—Floor-scrubbing machines, motor-driven having rotary 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/4002—Installations of electric equipment
    • 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/4041—Roll 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
    • 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/4072—Arrangement of castors or wheels
    • 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
    • B25J5/00—Manipulators mounted on wheels or on carriages
    • B25J5/007—Manipulators mounted on wheels or on carriages mounted on wheels
    • 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
    • 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/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676—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/02—Control of position or course in two dimensions
    • 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/60—Intended control result
    • G05D1/617—Safety or protection, e.g. defining protection zones around obstacles or avoiding hazards
    • 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/60—Intended control result
    • G05D1/648—Performing a task within a working area or space, e.g. cleaning
    • A—HUMAN NECESSITIES
    • A46—BRUSHWARE
    • A46B—BRUSHES
    • A46B2200/00—Brushes characterized by their functions, uses or applications
    • A46B2200/30—Brushes for cleaning or polishing
    • A46B2200/302—Broom
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Electromagnetism (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Electric Vacuum Cleaner (AREA)
  • Manipulator (AREA)
  • Electric Suction Cleaners (AREA)

Abstract

清掃ロボット（１０）及び障害物の乗越え方法は、自動清掃技術分野に属する。障害物の乗越え方法は、清掃ロボット（１０）が進行する際、清掃ロボット（１０）が障害物に邪魔されている状態にあるか否かを検出ステップ（５０１）と、清掃ロボット（１０）が障害物に邪魔されている状態にある場合、検出結果に基づいて、障害物を乗越えるように第１駆動輪（１３１）を制御し、それから障害物を乗越えるように第２駆動輪（１３２）を制御するステップ（５０２）とを含む。清掃ロボット（１０）が作業中に障害物に邪魔されて清掃任務が続けられなくなり、清掃任務を続けるには外部のヘルプが必要である問題が解決され、清掃ロボット（１０）が独立して障害物を乗越えることができるようになり、清掃ロボットの作業適応能力が向上する効果を奏する。

Description

関連出願の相互参照
本出願は、出願番号が２０１６１０３９４２２８.２で、出願日が２０１６年６月６日である中国特許出願に基づくものであって、当該中国特許出願の優先権の利益を主張するものであり、本明細書に当該中国特許出願の全ての内容を参照して取り込むものとする。
本発明は自動清掃技術分野に関し、特に清掃ロボット及び障害物の乗越え方法に関する。
経済及び科学技術の発展に伴い、掃除ロボット、モップロボットなどの清掃ロボットは人々の日常生活で幅広く利用され、人々の生活に利便さをもたらしている。
しかしながら、清掃ロボットの作業環境において様々な障害物が存在する。例えば、隣接する部屋間にある敷居、地面上に置かれた電線及び椅子などが挙げられ、清掃ロボットが作業中にこれらの障害物に邪魔されやすく、清掃を続けることができなくなる。
清掃ロボットが作業中に、障害物の邪魔によって清掃任務が続けられない問題を解決するために、本発明の実施例は清掃ロボット及び障害物の乗越え方法を提供する。その技術案は以下の通りである。
本発明の実施例の第１の側面は、清掃ユニットと、並列する第１駆動輪及び第２駆動輪を含む駆動ユニットと、検出ユニットと、算出ユニットと、制御ユニットとを含む清掃ロボットであって、
駆動ユニットが清掃ロボットを進行するように駆動する場合、検出ユニットは、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出し、
清掃ロボットが障害物に邪魔されている状態にある場合、制御ユニットが、検出ユニットと算出ユニットとによって取得された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御する清掃ロボットを提供する。
選択的には、制御ユニットが、検出ユニットと算出ユニットとによって共同検出された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することは、
検出ユニットと算出ユニットとによって取得された検出結果が、清掃ロボットが障害物に邪魔されている状態にあり、且つ傾斜ロボットの傾斜角度が第１角度より小さいである場合、制御ユニットが、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することを含む。
選択的には、制御ユニットが、障害物を乗越えるように第１駆動輪を制御することは、
制御ユニットが、第１進行方向に沿って進行するように第１駆動輪を制御し、第２進行方向に沿って進行するように第２駆動輪を制御すること、
又は、
制御ユニットが、第１速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第１速度は第２速度より大きいこと、
又は、
制御ユニットが、第１進行方向に沿って進行するように第１駆動輪を制御し、静止に維持するように第２駆動輪を制御することを含み、
ここで、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、制御ユニットが、静止に維持するように第２駆動輪を制御することは、
制御ユニットが、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第２駆動輪を制御することを含む。
選択的には、制御ユニットが第２駆動輪の回転速度をゼロに制御した後、検出ユニットは、第２駆動輪が第２進行方向へ回転するか否かを検出し、第２駆動輪が第２進行方向へ回転する場合、制御ユニットは、第１進行方向に沿う回転力を出力して静止に維持するように第２駆動輪を制御する。
選択的には、障害物を乗越えるように第２駆動輪を制御することは、
制御ユニットが、第１進行方向に沿って進行するように第２駆動輪を制御し、第２進行方向に沿って進行するように第１駆動輪を制御すること、
又は、
制御ユニットが、第１速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第１速度は第２速度より大きいこと、
又は、
制御ユニットが、第１進行方向に沿って進行するように第２駆動輪を制御し、静止に維持するように第１駆動輪を制御することを含み、
ここで、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、静止に維持するように第１駆動輪を制御するは、
制御ユニットが、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第１駆動輪を制御することを含む。
選択的には、制御ユニットが第１駆動輪の回転速度をゼロに制御した後、第１駆動輪が第２進行方向へ回転するか否かを検出し、第１駆動輪が第２進行方向へ回転する場合、制御ユニットは、第１進行方向に沿う回転力を出力して静止に維持するように第１駆動輪を制御する。
選択的には、検出ユニットと算出ユニットとによって取得された検出結果が、清掃ロボットの傾斜角度が第１角度より大きいことである場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、検出ユニットと算出ユニットとによって取得された検出結果が、清掃ロボットが障害物に邪魔されている状態であり、且つ清掃ロボットの傾斜角度が第２角度より小さいことである場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２角度は第１角度より小さい。
選択的には、検出ユニットは、第１駆動輪が障害物を乗越えたか否かを検出し、
検出ユニットが、第１駆動輪が障害物を乗越えていないことを検出した場合、第１駆動輪が障害物を乗越えなかった回数を記録し、
障害物を乗越えなかった回数が所定の値より大きい場合、制御ユニットは、後退の第２進行方向に沿って進行するように清掃ロボットを制御し、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、検出ユニットは、第１駆動輪が障害物を乗越えたか否かを検出し、
検出ユニットが、第１駆動輪が障害物を乗越えたことを検出した場合、障害物を乗越えるように第２駆動輪を制御するステップを実行する。
選択的には、清掃ロボットが障害物に邪魔されている状態にある場合、制御ユニットが、検出ユニットと算出ユニットとによって取得された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することは、
清掃ロボットが障害物に邪魔されている状態にあり、且つ、進行方向に平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、制御ユニットが、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することを含み、
ここで、第１駆動輪は、邪魔な障害物に近い駆動輪であり、第２駆動輪は、邪魔な障害物から離れた駆動輪である。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが、駆動輪がスリップ状態にあるか否かを検出し、スリップ状態とは、駆動輪がスライドするように接触面で回転する状態であることと、
駆動輪がスリップ状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含む。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが、駆動輪が引っ掛かっている状態にあるか否かを検出し、引っ掛かっている状態とは、駆動輪の回転中に外力によって回転が停止された状態であることと、
駆動輪が引っ掛かっている状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含む。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが駆動輪の走行距離と清掃ロボットの位置とを取得することと、
走行距離の変化値が所定の範囲を超え、且つ位置が変化しない場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含む。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが、駆動ユニットの駆動電流が所定の電流値より大きいか否かを検出することと、
駆動電流が所定の電流値より大きい場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含む。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが、清掃ロボットが傾斜したか否かを検出することと、
清掃ロボットが傾斜した場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含む。
本発明の実施例の第２の側面は、並列する第１駆動輪及び第２駆動輪と、制御ユニットとを含む清掃ロボットに用いられる障害物の乗越え方法を提供し、この方法は、
清掃ロボットが進行する際、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップと、
清掃ロボットが障害物に邪魔されている状態にある場合、検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップと、を含む。
選択的には、検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップは、
検出結果が、清掃ロボットが障害物に邪魔されている状態にあり、且つ傾斜ロボットの傾斜角度が第１角度より小さいことである場合、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップを含む。
選択的には、障害物を乗越えるように第１駆動輪を制御するステップは、
第１進行方向に沿って進行するように第１駆動輪を制御し、第２進行方向に沿って進行するように第２駆動輪を制御するステップ、
又は、
第１速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第１速度は第２速度より大きいステップ、
又は、
第１進行方向に沿って進行するように第１駆動輪を制御し、静止に維持するように第２駆動輪を制御するステップを含み、
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、静止に維持するように第２駆動輪を制御するステップは、
駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第２駆動輪を制御するステップを含む。
選択的には、当該方法は、
第２駆動輪の回転速度をゼロに制御した後、第２駆動輪が第２進行方向へ回転するか否かを検出し、第２駆動輪が第２進行方向へ回転する場合、第１進行方向に沿う回転力を出力して静止に維持するように第２駆動輪を制御するステップをさらに含む。
選択的には、障害物を乗越えるように第２駆動輪を制御するステップは、
第１進行方向に沿って進行するように第２駆動輪を制御し、第２進行方向に沿って進行するように第１駆動輪を制御するステップ、
又は、
第１速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第１速度は第２速度より大きいステップ、
又は、
第１進行方向に沿って進行するように第２駆動輪を制御し、静止に維持するように第１駆動輪を制御するステップを含み、
ここで、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、静止に維持するように第１駆動輪を制御するステップは、
駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第１駆動輪を制御するステップを含む。
選択的には、当該方法は、
第１駆動輪の回転速度をゼロに制御した後、第１駆動輪が第２進行方向へ回転するか否かを検出し、第１駆動輪が第２進行方向へ回転する場合、第１進行方向に沿う回転力を出力して静止に維持するように第１駆動輪を制御するステップをさらに含む。
選択的には、当該方法は、
検出結果が、清掃ロボットの傾斜角度が第１角度より大きいことである場合、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であるステップをさらに含む。
選択的には、当該方法は、
検出結果が、傾斜ロボットが障害物に邪魔されている状態であり、且つ清掃ロボットの傾斜角度が第２角度より小さいことである場合、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２角度は第１角度より小さいステップをさらに含む。
選択的には、当該方法は、
第１駆動輪が障害物を乗越えたか否かを検出するステップと、
第１駆動輪が障害物を乗越えていない場合、第１駆動輪が障害物を乗越えなかった回数を記録するステップと、
障害物を乗越えなかった回数が所定の値より大きい場合、後退の第２進行方向に沿って進行するように清掃ロボットを制御し、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であるステップと、をさらに含む。
選択的には、当該方法は、
第１駆動輪が障害物を乗越えたか否かを検出するステップと、
第１駆動輪が障害物を乗越えた場合、障害物を乗越えるように第２駆動輪を制御するステップを実行するステップと、をさらに含む。
選択的には、清掃ロボットが障害物に邪魔されている状態にある場合、検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップは、
清掃ロボットが障害物に邪魔されている状態にあり、且つ、進行方向に平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップを含み、
ここで、第１駆動輪は邪魔な障害物に近い駆動輪であり、第２駆動輪は邪魔な障害物から離れた駆動輪である。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
駆動輪がスリップ状態にあるか否かを検出し、スリップ状態とは、駆動輪がスライドするように接触面で回転する状態であるステップと、
駆動輪がスリップ状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含む。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
駆動輪が引っ掛かっている状態にあるか否かを検出し、引っ掛かっている状態とは、駆動輪の回転中に外力によって回転が停止された状態であるステップと、
駆動輪が引っ掛かっている状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含む。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
駆動輪の走行距離と清掃ロボットの位置とを取得するステップと、
走行距離の変化値が所定の範囲を超え、且つ位置が変化しない場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含む。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
駆動ユニットの駆動電流が所定の電流値より大きいか否かを検出するステップと、
駆動電流が所定の電流値より大きい場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含む。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
清掃ロボットが傾斜したか否かを検出するステップと、
清掃ロボットが傾斜した場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含む。
本発明の実施例における技術案は、以下の有益な効果を奏する。
清掃ロボットが進行する時に、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出し、清掃ロボットが障害物に邪魔されている状態にある場合に、センサの他のデータと合わせて、障害物を乗越えるように清掃ロボットを制御するか否かを決め、障害物を乗越えると決定した場合、障害物を乗越えるように第１駆動輪を制御し、それから前記障害物を乗越えるように第２駆動輪を制御し、これにより、清掃ロボットが作業中に障害物に邪魔されて清掃任務が続けられない問題が避けられ、清掃ロボットが独立して障害物を乗越えることができるようになり、清掃ロボットの作業適応能力が向上する。
なお、上記の一般的な説明及び後述する具体的な説明は、単に例示するものであり、本発明を限定するものと理解してはいけない。
本発明の実施例における技術案をより明瞭に説明するために、以下は実施例の説明に使用される図面を簡単に説明する。下記の記載における図面は、単に本発明の一部の実施例であり、当業者であれば、創作的な尽力を払わなくて、これらの図面に基づいて他の図面を得ることができる。
本発明の各実施例に係る清掃ロボットの概略構造図 本発明の各実施例に係る清掃ロボットの概略構造図 本発明の各実施例に係る清掃ロボットの構成ブロック図 本発明の実施例が提供する座標系 例示的な一実施例による障害物の乗越え方法のフローチャート 例示的な一実施例による障害物に邪魔されている状態の概略図 例示的な一実施例による障害物の乗越え方法のフローチャート 別の例示的な実施例による障害物に邪魔されている状態を検出する実行概略図 別の例示的な実施例による傾斜角度取得の実行概略図 別の例示的な実施例による傾斜角度取得の実行概略図 別の例示的な実施例による傾斜角度を取得の実行概略図 別の例示的な実施例による障害物の乗越え方法の実行概略図 別の例示的な実施例による障害物の乗越え方法の実行概略図 別の例示的な実施例による障害物の乗越え方法のフローチャート
ここでは例示的な実施例を詳細に説明し、その例は図面に示される。以下の説明が図面に関わる際、別途な記載がない限り、それぞれの図面における同一数字は同一又は類似する要素を意味する。以下の例示的な実施例に記載された実施形態は、本願と一致する全ての実施形態を表さない。むしろ、これらはただ特許請求の範囲に詳細に記載された、本願の幾つかの側面と一致する装置と方法の例に過ぎない。
図１と図２は、本発明の各実施例に係る清掃ロボットの概略図であり、図１に清掃ロボット１０の概略平面図が例示的に開示され、図２に該清掃ロボット１０の概略底面図が例示的に開示されている。図１と図２に示すように、当該清掃ロボット１０は、本体１１０と、検出部材１２０と、左輪１３１と、左輪１３１に接続されるモータ（図示せず）と、右輪１３２と、右輪１３２に接続されるモータ（図示せず）と、メインブラシ１４０と、を含む。
本体１１０は清掃ロボットのハウジングを形成して、他の部材を収容する。
選択的には、本体１１０は扁平な円柱形である。
検出部材１２０は清掃ロボットの周辺環境を測定し、障害物、壁、階段などの環境物体を見つけるためのものであり、検出部材１２０は清掃ロボット自身の運動状態も判断することができる。検出部材１２０は、オドメータ、ＬＤＳ（ＬａｓｅｒＤｉｓｔａｎｃｅ Ｓｅｎｓｏｒ，レーザー距離測定センサ）、崖センサ、３軸加速度計、ジャイロスコープ、衝突センサを含んでもよい。選択的には、検出部材１２０は、赤外線センサ、超音波センサ、カメラ、ホールセンサなどを含んでもよい。
本実施例は、検出部材１２０の数及び所在位置について限定しない。
清掃ロボットの本体１１０の左側に左輪１３１が設けられ、清掃ロボットの本体１１０の右側に右輪１３２が設けられ、左輪１３１と右輪１３２とが清掃ロボットの本体１１０の左右両側に並列に設けられる。左輪１３１と右輪１３２とは、それぞれに接続されるモータにより制御される。
清掃ロボットの本体１１０の左側に、左輪１３１に接続されるモータがさらに設けられ、左輪１３１に接続されるモータの駆動回路は、清掃ロボットの制御ユニットに接続され、制御ユニットは、異なるデューティー比に対応する第１制御信号をモータの駆動回路に送信し、モータの駆動回路は、第１制御信号に応じた駆動電流を生成してモータを回転させて、左輪１３１の駆動方向と回転速度とを制御する。ここで、デューティー比とは、パルス信号の通電時間と通電周期との比であり、デューティー比が大きいほど、左輪１３１の回転速度が大きく、デューティー比が小さいほど、左輪１３２の回転速度が小さい。例えば、左輪１３１に接続されるモータの駆動回路は、制御ユニットによって送信された、１/２であるデューティー比に対応する第１制御信号を受信し、第１制御信号に基づいて対応する駆動電流を生成し、駆動電流の作用で、左輪１３１に接続されるモータは、駆動方向が前進方向であり、且つ回転速度が５０ｒｐｍであるように左輪１３１を制御する。
清掃ロボットの本体１１０の右側に、右輪１３２に接続されるモータがさらに設けられ、右輪１３２に接続されるモータの駆動回路は清掃ロボットの制御ユニットに接続され、制御ユニットは、異なるデューティー比に対応する第２制御信号をモータの駆動回路に送信し、モータの駆動回路は、第２制御信号に応じた駆動電流を生成してモータを回転させて右輪１３２の駆動方向と回転速度とを制御する。例えば、右輪１３２に接続されるモータの駆動回路は、制御ユニットによって送信された、１/２であるデューティー比に対応する第２制御信号を受信し、第２制御信号に基づいて対応する駆動電流を生成し、駆動電流の作用で、右輪１３２に接続されるモータは、駆動方向が前進方向であり、且つ回転速度が５０ｒｐｍであるように右輪１３２を制御する。
清掃ロボット１０の左輪１３１と、左輪１３１に接続されるモータと、右輪１３２と、右輪１３２に接続されるモータとによって、清掃ロボット１０の駆動ユニットが構成される。
選択的には、該清掃ロボット１０は、本体１１０の前部に設置されたガイド輪１３３をさらに含み、ガイド輪１３３は清掃ロボットの進行中の走行方向を変更するためのものである。
メインブラシ１４０は本体１１０の底部に設けられる。選択的には、メインブラシ１４０は、接触面に対してローラ式で回転するドラム状の回転ブラシである。
なお、清掃ロボットは他のモジュール又は部材をさらに含んでもよいし、又は、前記一部のモジュール又は部材だけを含んでもよく、本実施形態はこれを限定せず、前述した清掃ロボットのみを例として説明する。
図３は例示的な一実施例による清掃ロボットの構造ブロック図である。清掃ロボットは、制御ユニット３１０と、記憶ユニット３２０と、検出ユニット３３０と、算出ユニット３４０と、駆動ユニット３５０と、清掃ユニット３６０と、を含む。
制御ユニット３１０は清掃ロボットの全体の動作を制御する。清掃命令を受信すると、制御ユニット３１０は、予め設定されたロジックに従って前進方向又は後退方向に沿って進行しながら、進行中に清掃するように清掃ロボットを制御することができる。進行命令を受信すると、制御ユニット３１０は、所定の進行モードで進行経路を進行するように清掃ロボットを制御する。本実施例は、制御ユニット３１０が受信するユーザーの他の命令について贅言しない。
記憶ユニット３２０は、少なくとも１つの命令を記憶するためのものであり、これらの命令は、所定の進行モードと進行経路とを実行するための命令と、清掃するための命令と、障害物に邪魔されている状態にあるか否かを検出するための命令と、傾斜角度を算出するための命令と、傾斜角度が第１角度より大きいか否かを検出するための命令などを含む。記憶ユニット３２０は、清掃ロボットの進行中の自身の位置データと、進行中の走行速度、走行距離、障害物に関するデータなども記憶する。
検出ユニット３３０は、清掃ロボットの進行領域における障害物と清掃ロボットの進行状態とを検出するためのものであり、障害物は家具、家電製品、オフィス機器、レンガの壁、木製の壁、床面上の電線、隣接する部屋間にある敷居などであってもよい。
算出ユニット３４０は、清掃ロボットが障害物に邪魔されている状態にある場合に、清掃ロボットの傾斜角度と、進行領域において清掃ロボットから障害物までの距離とを算出する。例えば、算出ユニット３４０は、３軸加速度計により清掃ロボットの傾斜角度を算出し、又は、算出ユニット３４０は、ジャイロスコープにより清掃ロボットの傾斜角度を算出し、又は、算出ユニット３４０は、６軸ジャイロスコープにより清掃ロボットの傾斜角度を取得し、又は、算出ユニット３４０は、清掃ロボットから障害物までの距離又は清掃ロボットの進行距離に基づいて清掃ロボットの傾斜角度を算出する。
駆動ユニット３５０は、制御ユニット３１０の第１制御信号に基づいて第１駆動輪の駆動方向と回転速度とを制御し、又は制御ユニット３１０の第２制御信号に基づいて第２駆動輪の駆動方向と回転速度とを制御する。
清掃ユニット３６０は、清掃命令を受信して、制御ユニット３１０が予め設定されたロジックに従って前進方向又は後退方向に沿って進行するように清掃ロボットを制御する際、進行中に、清掃ロボットの底部にあるメインブラシが回動する方式でメインブラシに接触する接触面を清掃するように制御する。
例示的な実施形態において、制御ユニット３１０は、１つ又は複数の特定用途向け集積回路（ＡＳＩＣ）、デジタル信号プロセッサ（ＤＳＰ）、デジタル信号処理デバイス（ＤＳＰＤ）、プログラマブルロジックデバイスロジック（ＰＬＤ）、フィールドプログラマブルゲートアレイ（ＦＰＧＡ）、コントローラ、マイクロコントローラ、マイクロプロセッサ又は他の電子部材により実装されて、本発明の実施例における清掃ロボットの制御方法を実行する。
選択的には、制御ユニット３１０は、さらに、
駆動ユニット３５０が清掃ロボットを進行するように駆動する場合、検出ユニット３３０は清掃ロボットが障害物に邪魔されている状態にあるか否かを検出し、
清掃ロボットが障害物に邪魔されている状態にある場合、制御ユニット３１０は、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するように構成される。
選択的には、制御ユニット３１０が、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することは、
検出ユニット３３０と算出ユニット３４０とによって取得された検出結果が、清掃ロボットが障害物に邪魔されている状態にあり、且つ傾斜ロボットの傾斜角度が第１角度より小さい場合、制御ユニット３１０が、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することを含む。
選択的には、制御ユニット３１０が、障害物を乗越えるように第１駆動輪を制御することは、
制御ユニット３１０が、第１進行方向に沿って進行するように第１駆動輪を制御し、第２進行方向に沿って進行するように第２駆動輪を制御すること、
又は、
制御ユニット３１０が、第１速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第１速度が第２速度より大きいこと、
又は、
制御ユニット３１０が、第１進行方向に沿って進行するように第１駆動輪を制御し、静止に維持するように第２駆動輪を制御することを含み、
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、制御ユニット３１０は静止に維持するように第２駆動輪を制御することは、
制御ユニットが、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第２駆動輪を制御することを含む。
選択的には、制御ユニット３１０が第２駆動輪の回転速度をゼロに制御した後、検出ユニット３３０は、第２駆動輪が第２進行方向へ回転するか否かを検出し、第２駆動輪が第２進行方向へ回転する場合、制御ユニット３１０は、第１進行方向に沿う回転力を出力して静止に維持するように第２駆動輪が制御することを含む。
選択的には、障害物を乗越えるように第２駆動輪を制御することは、
制御ユニット３１０が、第１進行方向に沿って進行するように第２駆動輪を制御し、第２進行方向に沿って進行するように第１駆動輪を制御することは、
又は、
制御ユニット３１０が、第１速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第１速度は第２速度より大きいこと、
又は、
制御ユニット３１０が、第１進行方向に沿って進行するように第２駆動輪を制御し、静止に維持するように第１駆動輪を制御することを含み、
ここで、第１進行方向は清掃ロボットが障害物に邪魔されて状態になる前の進行方向であり、第２進行方向は第１進行方向と反対であること。
選択的には、静止に維持するように第１駆動輪を制御することは、
制御ユニット３１０が、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第１駆動輪を制御することを含む。
選択的には、制御ユニット３１０は、第１駆動輪の回転速度をゼロに制御した後、第１駆動輪が第２進行方向へ回転するか否かを検出し、第１駆動輪が第２進行方向へ回転する場合、制御ユニット３１０は、第１進行方向に沿う回転力を出力して静止に維持するように第１駆動輪を制御する。
選択的には、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果が、清掃ロボットの傾斜角度が第１角度より大きいことである場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果が、傾斜ロボットが障害物に邪魔されている状態にあり、且つ清掃ロボットの傾斜角度が第２角度より小さいことである場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２角度は第１角度より小さい。
選択的には、検出ユニット３３０は、第１駆動輪が障害物を乗越えたか否かを検出し、
検出ユニット３３０は、第１駆動輪が障害物を乗越えていないと検出した場合、第１駆動輪が障害物を乗越えなかった回数を記録し、
障害物を乗越えなかった回数が所定の値より大きい場合、制御ユニットは、後退の第２進行方向に沿って進行するように清掃ロボットを制御し、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、検出ユニット３３０は、第１駆動輪が障害物を乗越えたか否かを検出し、
第１駆動輪が障害物を乗越えたと検出ユニット３３０が検出した場合、障害物を乗越えるように第２駆動輪を制御するステップを実行する。
選択的には、清掃ロボットが障害物に邪魔されている状態にある場合、制御ユニット３１０が、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果に基づいて障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することは、
清掃ロボットが障害物に邪魔されている状態にあり、且つ、進行方向に平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、制御ユニット３１０が、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することを含み、
ここで、第１駆動輪は邪魔な障害物に近い駆動輪であり、第２駆動輪は邪魔な障害物から離れた駆動輪である。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、駆動輪がスリップ状態にあるか否かを検出し、スリップ状態とは、駆動輪がスライドするように接触面で回転する状態であることと、
駆動輪がスリップ状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、駆動輪が引っ掛かっている状態にあるか否かを検出し、引っ掛かっている状態とは、駆動輪の回転中に外力によって回転が停止された状態であることと、
駆動輪が引っ掛かっている状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、駆動輪の走行距離と清掃ロボットの位置とを取得することと、
走行距離の変化値が所定の範囲を超え、且つ位置が変化しない場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、駆動ユニットの駆動電流が所定の電流値より大きいか否かを検出することと、
駆動電流が所定の電流値より大きい場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、清掃ロボットが傾斜したか否かを検出することと、
清掃ロボットが傾斜した場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
例示的な実施例において、命令を含む非一時コンピュータ読取可能な記憶媒体がさらに提供され、例えば、命令を含む記憶ユニット３２０。前記命令は、制御ユニット３１０により実行されて前記本発明の実施例における清掃ロボットの制御方法を実現する。例えば、前記非一時コンピュータ読取可能な記憶媒体はＲＯＭ、ランダムアクセスメモリ（ＲＡＭ）、ＣＤ-ＲＯＭ、カセット、フロッピーディスク、光データ記憶装置などであってもよい。
下記実施例において、清掃ロボットの左輪が第１駆動輪として決定され、清掃ロボットの右輪が第２駆動輪として決定される。他の可能な実施例において、清掃ロボットの右輪が第１駆動輪として決定し、清掃ロボットの左輪が第２駆動輪として決定されてもよく、本発明の実施例はこれを限定しない。
清掃ロボットの動きを容易に説明するために、図４に示すように、清掃ロボットに基づいた座標系を作成し、当該座標系は、Ｘ軸と、Ｙ軸と、Ｚ軸とを含み、座標系の原点が清掃ロボットの中心点であり、Ｘ軸とＹ軸とＺ軸とのうちいずれか２つが互いに垂直し、Ｘ軸とＹ軸とは同一平面にあり、Ｘ軸が清掃ロボットの本体の前後軸に平行し、座標系のＹ軸が清掃ロボットの本体の横軸に平行し、Ｚ軸が、Ｘ軸とＹ軸とによって画定された平面に垂直し、座標系のＺ軸が清掃ロボットの本体の鉛直軸に平行する。ここで、Ｘ軸に沿って前への駆動方向を前進方向とし、Ｘ軸に沿って後ろへの駆動方向を後退方向とする。
本発明の実施例は、前述した清掃ロボットに基づいてその障害物の乗越え方法を説明するが、本発明の実施例は清掃ロボットのタイプを限定しない。
例示的な一実施例による障害物の乗越え方法フローチャートが示されている図５Ａを参照し、当該障害物の乗越え方法は以下のステップ５０１とステップ５０２とを含む。
ステップ５０１において、清掃ロボットが進行する際、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出する。
選択的には、清掃ロボットの進行は、清掃ロボットが前進方向に沿って進行してもよいし、清掃ロボットが後退方向に沿って進行してもよい。
選択的には、障害物は一定の硬度を有し、且つ高さが比較的小さい棒状物であり、例えば、隣接する部屋間にある敷居が挙げられ、又は、障害物は柔軟で変形し易い線状物であり、例えば、電線が挙げられる。
清掃ロボットが障害物に邪魔されている状態にあることとは、清掃ロボットの２つの駆動輪が障害物を乗越えておらず、清掃ロボットの本体が傾斜した状態にあることを指す。図５Ｂに示ように、清掃ロボット５１が２つの部屋を通る際、敷居５２に邪魔され、第１駆動輪と第２駆動輪とが敷居５２を乗越えておらず、清掃ロボット５１の本体が傾斜状態にある。
ステップ５０２において、清掃ロボットが障害物に邪魔されている状態にある場合、検出結果に基づいて障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御する。
選択的には、清掃ロボットが障害物に邪魔されている状態にある場合、清掃ロボットが邪魔されている状態の検出結果に基づいて、障害物を乗越えるか否かのロジックを実行する。
以上により、本発明の実施例が提供した障害物の乗越え方法は、清掃ロボットが進行する際、ロボットが障害物に邪魔されている状態にあるか否かを検出することにより、清掃ロボットが障害物に邪魔されている状態にある場合、センサの他のデータと合わせて、障害物を乗越えるように清掃ロボットを制御するか否かを決め、障害物を乗越えると決定した場合、障害物を乗越えるように第１駆動輪を制御し、それから前記障害物を乗越えるように第２駆動輪を制御し、これにより、清掃ロボットが作業中に障害物に邪魔されて清掃任務が続けられない問題が避けられ、清掃ロボットが独立して障害物を乗越えることができるようになり、清掃ロボットの作業適応能力が向上する。
別の例示的な実施例による障害物の乗越え方法のフローチャートを示した図６Ａを参照し、当該障害物の乗越え方法は、以下のステップ６０１と、ステップ６０２と、ステップ６０３と、ステップ６０４とを含む。
ステップ６０１において、清掃ロボットが進行する際、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出する。
選択的には、清掃ロボットの進行は、清掃ロボットが前進方向に沿って進行してもよいし、清掃ロボットが後退方向に沿って進行してもよい。
清掃ロボットが前進方向に沿って進行することとは、清掃ロボットがＸ軸正方向に沿って進行することを指し、清掃ロボットがＸ軸逆方向に沿って進行することは、後退方向に沿って進行することである。
選択的には、第１駆動輪と第２駆動輪とがスリップ状態にあるか否かを検出することにより、清掃ロボットが障害物に邪魔されている状態にあるか否かを決定する。ここで、スリップ状態とは、駆動輪がスライドするように接触面で回転する状態であり、接触面とは、ロボットが清掃任務を行う平面であり、例えば、地面又はテーブル面などが挙げられる。駆動輪がスリップ状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定する。
選択的には、第１駆動輪と第２駆動輪とが引っ掛かっている状態にあるか否かを検出することにより、障害物に邪魔されている状態にあるか否かを決定する。ここで、引っ掛かっている状態とは、駆動輪の回転中に外力によって回転が停止された状態である。駆動輪が引っ掛かっている状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定する。
選択的には、ＬＤＳ（ＬａｓｅｒＤｉｓｔａｎｃｅ Ｓｅｎｓｏｒ，レーザー距離測定センサ）により前方の障害物までの距離を測定し、オドメータにより駆動輪の走行距離を取得し、走行距離の変化値と前方の障害物までの距離との関係が、清掃ロボットの通常作業時の走行距離の変化値と前方の障害物までの距離との変化規則に合致しない場合、清掃ロボットが障害物に邪魔されている状態にあると決定する。本方法は、駆動輪のスリップ状態を検出する方法であり、輪のスリープ行為の動き特徴及び電気的特性に応じて他の方法を設計してもよい。
図６Ｂに示すように、清掃ロボットの駆動輪６１が回転しているが、清掃ロボットのＬＤＳ６２が測定した、前方の障害物６３までの距離Ｌが変化しておらず、走行距離の変化値と距離Ｌとの関係は、通常作業時の変化規則に合致しないため、清掃ロボットが障害物に邪魔されている状態にあると決定する。ここで、通常作業とは、清掃ロボットが障害物に邪魔されていない時の作業状態を指す。
選択的には、駆動輪に接続されるモータの駆動電流が清掃ロボットの通常進行時の駆動電流を超えたか否かを検出することにより、障害物に邪魔されている状態にあるか否かを決定する。駆動輪に接続されるモータの駆動電流が所定の電流値より大きい場合、清掃ロボットが障害物に邪魔されている状態にあると決定し、ここで、所定の電流値は、清掃ロボットの通常進行中の最大電流値より大きい。本方法は、駆動輪の引っ掛かっている状態を検出する方法であり、輪の引っ掛かる行為の動き特徴及び電気的特性に応じて他の方法を設計してもよい。
選択的には、清掃ロボットの本体は傾斜したか否かを検出することにより、清掃ロボットが障害物に邪魔されている状態にあるか否かを決定する。清掃ロボットが傾斜した場合、清掃ロボットが障害物に邪魔されている状態にあると決定する。
ステップ６０２において、清掃ロボットが障害物に邪魔されている状態にある場合、清掃ロボットの邪魔されている状態の検出結果を取得する。
清掃ロボットの検出ユニットと算出ユニットとにより、清掃ロボットが障害物に邪魔されている状態にある時の本体状態を示すための検出結果を取得し、清掃ロボットの傾斜角度を取得し、傾斜角度に基づいて検出結果を決定し、検出結果が、清掃ロボットの傾斜角度が第１角度より小さいことである場合、ステップ６０３を実行する。
選択的には、第１角度は、通常の場合、清掃ロボットが障害物に邪魔されている状態にあり且つその障害物を乗越えることができる場合の清掃ロボットの本体の傾斜の角度である。
選択的には、第１角度は、清掃ロボットが障害物に邪魔されている状態にあり且つその障害物を乗越えることができる場合の清掃ロボットの本体の傾斜の最大角度である。例えば、清掃ロボットが最大高さが２センチメートルである障害物を乗越えることができ、清掃ロボットが高度が２センチメートルである障害物に邪魔される時に本体が傾斜し、傾斜角度が５°であり、つまり第１角度は５°である。
清掃ロボットの傾斜角度を取得する方法は、以下の七つがある。
一、３軸加速度計によりＸ軸における清掃ロボットの平均加速度成分を取得し、それから予め記憶された平均加速度成分と傾斜角度との対応関係により傾斜角度を決定する。
清掃ロボットの記憶ユニットにＸ軸における平均加速度成分と傾斜角度との一対一の対応関係が記憶されており、清掃ロボットの算出ユニットは、Ｘ軸における平均加速度成分を取得した後、それに対応する傾斜角度を決定する。
二、６軸ジャイロスコープにより清掃ロボットの傾斜角度を取得する。
６軸ジャイロスコープは、３軸加速度計と３軸ジャイロスコープとの機能を共に有する設備であり、清掃ロボットの算出ユニットは、６軸ジャイロスコープにより清掃ロボットのオイラー角を取得し、つまり、清掃ロボットの傾斜角度を取得する。
三、図６Ｃに示すように、３軸加速度計によりＸ軸方向における清掃ロボットの加速度成分Ｒｘと、Ｚ軸方向における加速度成分Ｒｚとを取得し、式１により清掃ロボットの傾斜角度θを取得する。
Figure 2019518277
四、ジャイロスコープにより、清掃ロボットが通常作業時から障害物に邪魔される状態になるまでの時間帯内に、所定の時間間隔にて瞬間角速度を取得し、取得された瞬間角速度と時間帯とを積分し、傾斜角度θを算出する。ここで、所定時間の間隔は、サンプリングの時間間隔である。式２により傾斜角度θを算出する。
Figure 2019518277
 ここで、ｗｎは瞬間角速度であり、Ｔは通常作業時から障害物に邪魔される状態になるまでの時間である。
五、ジャイロスコープにより、清掃ロボットが第１時点から第２時点までの時間帯内に、所定の時間間隔に基づいて瞬間角速度を取得し、取得された瞬間角速度と時間帯とを積分し、傾斜角度θ１を算出し、次に加速度計によりジャイロスコープのオフセット値を算出し、次にジャイロスコープと加速度計との融合アルゴリズムにより、より精確な傾斜角度θ２を算出し、ここで、第１時点は清掃ロボットが障害物に邪魔される状態になった時点であり、第２時点は清掃ロボットが邪魔される状態になる直前の時点である。
六、ＬＤＳにより、清掃ロボットが通常作業状態にある時の第１時点における前方の障害物までの距離Ｌ１を取得し、清掃ロボットが障害物に邪魔されている状態にある時の第２時点における前方の障害物までの距離Ｌ２を取得し、清掃ロボットが通常作業状態にある時の移動速度を利用して第２時点における前方の障害物までの理論的な距離Ｌ３を算出し、式３により清掃ロボットの傾斜角度を算出する。
Figure 2019518277
選択的には、前方の障害物は、清掃ロボットが障害物に邪魔されている状態にする障害物ではない。例えば、清掃ロボットが障害物に邪魔されている状態にする障害物は電線であり、前方の障害物は電線の前方にある壁である。
図６Ｄに示すように、時点Ｔ１に測定された前方の障害物までの距離がＬ１=１０であり、時点Ｔ２に測定された前方の障害物までの距離がＬ２=５であり、理論的な距離Ｌ３=４と算出され、Ｌ２とＬ３との関係により、式３を利用して傾斜角度を取得する。
七、崖センサにより、清掃ロボットが通常作業状態にある時の第１時点における地面までの距離Ｌ４を取得し、清掃ロボットが障害物に邪魔されている状態にある時の第２時点における地面までの距離Ｌ５を取得し、清掃ロボットが第１時点と第２時点との直線距離Ｌ６を取得し、式４を利用して傾斜角度を算出する。
Figure 2019518277
図６Ｅにおいて、図中の上半部分には、時点Ｔ３にて測定された距離Ｌ４と、時点Ｔ４にて測定された距離Ｌ５と、清掃ロボットの時点Ｔ３と時点Ｔ４との直線距離Ｌ６とが示されており、図中の下半部分には、Ｌ４とＬ５とＬ６との三角関係が示されており、式４により傾斜角度θを取得する。
なお、本発明の実施例に使用される１、２、及び３などの数詞は、コンテキストからそれが確かに順を意味しない限り、ただ区別するためのものであると理解すべきである。
検出結果が、傾斜角度が第１角度より大きいことである場合、第２進行方向に沿って進行するように清掃ロボットを制御し、ここで、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、傾斜角度が第１角度より大きい場合、さらに一定の角度回転した後、障害物に邪魔される状態になる前の進行方向と反対する進行方向に進行するように清掃ロボットを制御してもよく、つまり、傾斜角度が第１角度より大きい場合、清掃ロボットは障害物を乗越えない。
検出結果が清掃ロボットの傾斜角度が第２角度より小さいことである場合、障害物に邪魔される状態になる前の進行方向と反対する進行方向に進行するように清掃ロボットを制御する。第２角度は第１角度より小さい。
第２角度は、清掃ロボットが障害物に邪魔されている状態にあり、且つ、障害物が清掃ロボットの進行経路において移動不能であって鉛直方向から清掃ロボットの進行を邪魔する障害物である場合の清掃ロボットの本体の傾斜角度である。通常の場合、第２角度はゼロに近い。例えば、清掃ロボットが脱出中に後退動作を実行するが、後方にある障害物に邪魔され、例えば、壁に邪魔されると、前へ進行するように清掃ロボットを制御し、前進方向は前の運動方向、即ち、後退方向と反対する方向であるから。さらに例えば、清掃ロボットは、前部にある衝突センサが複数回連続にトリガされる場合、後退動作を実行するが、後退中に後方の障害物に邪魔される可能性がある場合、前へ進行するように清掃ロボットを制御する。
なお、本発明の実施例に使用される１、２、及び３などの数詞は、コンテキストからそれが確かに順を意味しない限り、ただ区別するためのものであると理解すべきである。
ステップ６０３において、障害物を乗越えるように第１駆動輪を制御する。
障害物を乗越えるように第１駆動輪を制御することは、以下の三つの実現形態がある。
一、第１進行方向に沿って進行するように第１駆動輪を制御し、第２進行方向に沿って進行するように第２駆動輪を制御し、第１進行方向は第２進行方向と反対である。
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
第１進行方向を前進方向とし、第２進行方向を後退方向とする場合、図６Ｆに示すように、第１駆動輪６４は前進方向に沿って進行し、第２駆動輪６５は後退方向に沿って進行する。
選択的には、第１駆動輪の進行速度は通常作業時の進行速度より大きい。ここで、通常作業とは、清掃ロボットが障害物に邪魔されていない時の作業状態である。
選択的には、第１駆動輪が第１進行方向に沿って進行する速度は、第２駆動輪が第２進行方向に沿って進行する速度より大きい。
二、第１速度で第１方向に沿って進行するように第１駆動輪を制御し、第２速度で第１方向に沿って進行するように第２駆動輪を制御し、第１速度は第２速度より大きい。
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
第１駆動輪が先に障害物を乗越えるのを確保するために、第１駆動輪の第１速度は第２駆動輪の第２速度より大きくされる。例えば、第１進行方向が前進方向であり、第１駆動輪は４０メートル/時間の速度で前進方向に沿って進行し、第２駆動輪は２０メートル/時間の速度で前進方向に沿って進行する。選択的には、第１速度は通常作業時の進行速度より大きく、例えば、通常作業時の速度が３０メートル/時間であり、第１速度が４０メートル/時間である。ここで、通常作業とは、清掃ロボットが障害物に邪魔されていない時の作業状態である。
第１進行方向を前進方向とする場合、図６Ｇに示すように、第１駆動輪６６は第１速度で前進方向に沿って進行し、第２駆動輪６７は第２速度で前進方向に沿って進行する。
三、第１方向に沿って進行するように第１駆動輪を制御し、静止に維持するように第２駆動輪を制御する。
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、静止に維持するように第２駆動輪を制御することとは、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第２駆動輪を制御することである。
選択的には、デューティー比をゼロに制御することにより、駆動輪の回転速度をゼロにすることができる。第２駆動輪は、駆動方向が第１進行方向であるとともに、回転速度がゼロである場合、第２駆動輪の逆方向の回転抵抗力が大きくなり、ブレーキの作用がある程度に奏され、第１駆動輪が障害物を乗越えることに寄与する。
選択的には、第２駆動輪の回転速度がセロに制御された後、第１駆動輪が第１進行方向に沿って進行するよってもたらされた作用力が、第２駆動輪を第２進行方向に回転させる可能性があるため、第２駆動輪が第２進行方向へ回転するか否かを検出し、第２駆動輪が第２進行方向へ回転する場合、ために、第１進行方向に沿う回転力を出力して静止を維持するよう第２駆動輪を制御する。ここで、第１進行方向に沿う回転力を出力して静止を維持するように第２駆動輪を制御することは、第２駆動輪に接続される駆動モータにデューティー比の小さい電流を与えることにより、第２駆動輪を第１進行方向へ回転させる回転力が生成され、生成された回転力は、第１駆動輪が第１進行方向へ進行する時に第２駆動輪に与えた第２進行方向へ回転する力を相殺することができ、第２駆動輪を静止に維持させる。ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第１進行方向は第２進行方向と反対である。
なお、本発明の実施例に使用される１、２、及び３などの数詞は、コンテキストからそれが確かに順を意味しない限り、ただ区別するためのものであると理解すべきである。
また、清掃ロボットが障害物に邪魔されている状態にあると検出され、且つ、進行方向と平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、障害物を乗越えるように第１駆動輪を制御し、ここで、第１駆動輪は邪魔な障害物に近い駆動輪である。
選択的には、邪魔な障害物は、清掃ロボットを障害物に邪魔される状態にする障害物ではなく、邪魔な障害物は、清掃ロボットが衝突によりその位置を移動させることができない障害物である。
例えば、邪魔な障害物が壁であり、すなわち、清掃ロボットが壁に沿って進行する時に障害物に邪魔される場合、清掃ロボットが片輪で乗越える過程で生じた回転によって清掃ロボットが壁にぶつかることを回避するために、壁に近い駆動輪を先に障害物を乗越えるようにさせ、つまり、本体を壁から離れた方向へ回転させる。
ステップ６０４において、障害物を乗越えるように第２駆動輪を制御する。
障害物を乗越えるように第２駆動輪を制御する。障害物を乗越えるように第２駆動輪を制御する方法は、障害物を乗越えるように第１駆動輪を制御する方法に似ており、以下の三つの実現形態が挙げられる。
一、第１進行方向に沿って進行するように第２駆動輪を制御し、第２進行方向に沿って進行するように第１駆動輪を制御し、ここで、第１進行方向は第２進行方向と反対であり、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、第２駆動輪の進行速度は通常作業時の進行速度より大きい。ここで、通常作業とは、清掃ロボットが障害物に邪魔されていない時の作業状態である。
選択的には、第２駆動輪が第１進行方向に沿って進行する速度は、第１駆動輪が第２進行方向に沿って進行する速度より大きい。
二、第１速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第１速度は第２速度より大きい。
障害物を乗越えるのが第２駆動輪であることを確保するために、第２駆動輪の第１速度は第１駆動輪の第２速度より大きくされる。
三、第１方向に沿って進行するように第２駆動輪を制御し、静止に維持するように第１駆動輪を制御する。
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、静止に維持するように第１駆動輪を制御することとは、駆動方向が第１進行方向であり、且つ回転速度がゼロになるように第１駆動輪を制御することである。
選択的には、デューティー比をゼロに制御することにより、駆動輪の回転速度をゼロにすることができる。第１駆動輪は、駆動方向が第１進行方向であるとともに、回転速度がゼロである場合、第１駆動輪の逆方向の回転抵抗力が大きくなり、ブレーキの作用がある程度で奏され、第２駆動輪が障害物を乗越えることに寄与する。
選択的には、第１駆動輪の回転速度がセロに制御された後、第２駆動輪が第１進行方向に沿って進行することによってもたらされた作用力が、第１駆動輪を第２進行方向に回転させる可能性があるため、第１駆動輪が第２進行方向へ回転するか否かを検出し、第１駆動輪が第２進行方向へ回転する場合、第１進行方向に沿う回転力を出力して静止を維持するよう第１駆動輪を制御する。ここで、第２進行方向は第１進行方向と反対である。
なお、本発明の実施例に使用される１、２、及び３などの数詞は、コンテキストからそれが確かに順を意味しない限り、ただ区別するためのものであると理解すべきである。
また、清掃ロボットが障害物に邪魔されている状態にあり、且つ、進行方向と平行するとともに接触面に垂直する方向に邪魔な障害物が存在すると検出した場合、障害物を乗越えるように第１駆動輪を制御した後に、障害物を乗越えるように第２駆動輪を制御する。ここで、第１駆動輪は邪魔な障害物に近い駆動輪であり、第２駆動輪は邪魔な障害物から離れた駆動輪である。
選択的には、邪魔な障害物は、清掃ロボットを障害物に邪魔される状態にする障害物ではなく、邪魔な障害物は、清掃ロボットが衝突によりその位置を移動させることができない障害物である。
例えば、邪魔な障害物が壁であり、すなわち、清掃ロボットが壁に沿って進行する時に障害物に邪魔される場合、清掃ロボットが片輪で乗越える過程で生じた回転によって清掃ロボットが壁にぶつかることを回避するために、まず障害物を乗越えるように壁に近い駆動輪を制御し、それから障害物を乗越えるように壁から離れた駆動輪を制御する。
以上により、本発明の実施例が提供する障害物の乗越え方法は、清掃ロボットが進行する時に、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出し、清掃ロボットが障害物に邪魔されている状態にある場合に、センサの他のデータと合わせて清掃ロボットが障害物を乗越えるように制御するか否かを決め、障害物を乗越えると決定した場合、障害物を乗越えるように第１駆動輪を制御し、それから前記障害物を乗越えるように第２駆動輪を制御する。これにより、清掃ロボットが作業中に障害物に邪魔されて清掃任務が続けられない問題が避けられ、清掃ロボットが独立して障害物を乗越えることができるようになり、清掃ロボットの作業適応能力が向上する。
また、本発明の実施例が提供する障害物の乗越え方法は、清掃ロボットが障害物に邪魔されている状態にある場合に清掃ロボットの傾斜角度を検出し、清掃ロボットの傾斜角度が第１角度より小さい場合、障害物を乗越え、傾斜角度が第１角度より大きい場合、第２進行方向に沿って進行する。これにより、清掃ロボットが障害物を乗越えることができない場合に障害物を乗越え続けることが防止され、清掃ロボットが柔軟に作業することに寄与し、作業効率が向上する。
図６Ａに示す実施例の好ましい実施例において、障害物を乗越えるように第１駆動輪を制御した後、第１駆動輪が障害物を乗越えたか否かを検出することにより、障害物を乗越えるように第２駆動輪を制御するか否かを決める。当該障害物の乗越え方法は、ステップ６０３ａと、ステップ６０３ｂと、ステップ６０３ｃとを含む。図７に示すように、
ステップ６０３ａにおいて、第１駆動輪が障害物を乗越えるか否かを検出する。
選択的には、第３時点を、清掃ロボットが障害物に邪魔されている状態にあり、且つ障害物を乗越えることをまだ開始していない一つの時点とし、第４時点を、清掃ロボットの第１駆動輪が障害物を乗越えた後の一つの時点とする。
第４時点に３軸加速度計により清掃ロボットの傾斜角度を取得し、第４時点における清掃ロボットの傾斜角度が第１角度より小さいことを検出した場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。又は、第４時点にジャイロスコープにより清掃ロボットの傾斜角度を取得し、第４時点における清掃ロボットの傾斜角度が第１角度より小さいことを検出した場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。又は、第３時点と第４時点とにＬＤＳにより清掃ロボットから前方の障害物までの距離を取得し、第４時点における前方の障害物までの距離が、第３時点における前方の障害物までの距離より小さいことを検出した場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。又は、第１駆動輪に接続されるモータの駆動電流を取得し、駆動電流が清掃ロボットの通常進行時の駆動電流である場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。又は、第３時点と第４時点とに清掃ロボットから接触面までの距離を取得し、第４時点における接触面までの距離が、第３時点における接触面までの距離より小さいことを検出した場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。
ステップ６０３ｂにおいて、第１駆動輪が障害物を乗越えていないと検出した場合、第１駆動輪が障害物を乗越えなかった回数を記録する。
ステップ６０３ｃにおいて、障害物を乗越えなかった回数が所定の値より大きい場合、第２進行方向に沿って進行するように清掃ロボットを制御する。
ここで、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、所定の値は、清掃ロボットが出荷する前にメーカによって設定され、又は、所定の値はユーザーによって設定され得る。
ステップ６０３ｄにおいて、第１駆動輪が障害物を乗越えた場合、ステップ６０４を実行する。
また、第１駆動輪が障害物を乗越えた後に、第２駆動輪が障害物を乗越える場合、第２駆動輪が障害物を乗越えたか否かを検出してもよい。第２駆動輪が障害物を乗越えていない場合、第２駆動輪が障害物を乗越えなかった回数を記録し、障害物を乗越えなかった回数が所定の値より大きい場合、第２進行方向に沿って進行するように清掃ロボットを制御する。
本発明の実施例が提供する障害物の乗越え方法は、さらに、第１駆動輪が障害物を乗越えたか否かを検出し、障害物を乗越えていない場合、障害物を乗越えなかった回数を記録し、回数が所定の値を超えた場合、清掃ロボットが障害物を乗越えることができないことが分かり、第２進行方向に沿って進行するように清掃ロボットを制御し、これにより、清掃ロボットが障害物を乗越えることができない場合に障害物を乗越え続けることが防止され、清掃ロボットが柔軟に作業することに寄与し、作業効率が向上する。
当業者は、明細書を考慮して明細書に記載された発明を実施した後、本発明の他の実施態様を容易に想到することができる。本発明は、本発明に対するいかなる変形、用途、または適宜な変化を含み、これらの変形、用途、または適宜な変化は、本発明の一般的な原理に従い、本発明では開示していない当分野の公知常識、または通常の技術手段を含む。明細書及び実施例は、ただの例示するものであって、本発明の本当の範囲と主旨は、以下の特許請求の範囲によって示される。
なお、本発明は、上記で記載された、図面で図示された特定の構成に限定されず、その範囲を離脱しない範囲内で、種々な修正及び変更を行うことができる。本発明の範囲は、添付の特許請求の範囲のみにより限定される。
関連出願の相互参照
本出願は、出願番号が２０１６１０３９４２２８.２で、出願日が２０１６年６月６日である中国特許出願に基づくものであって、当該中国特許出願の優先権の利益を主張するものであり、本明細書に当該中国特許出願の全ての内容を参照して取り込むものとする。
本発明は自動清掃技術分野に関し、特に清掃ロボット及び障害物の乗越え方法に関する。
経済及び科学技術の発展に伴い、掃除ロボット、モップロボットなどの清掃ロボットは人々の日常生活で幅広く利用され、人々の生活に利便さをもたらしている。
しかしながら、清掃ロボットの作業環境において様々な障害物が存在する。例えば、隣接する部屋間にある敷居、地面上に置かれた電線及び椅子などが挙げられ、清掃ロボットが作業中にこれらの障害物に邪魔されやすく、清掃を続けることができなくなる。
清掃ロボットが作業中に、障害物の邪魔によって清掃任務が続けられない問題を解決するために、本発明の実施例は清掃ロボット及び障害物の乗越え方法を提供する。その技術案は以下の通りである。
本発明の実施例の第１の側面は、清掃ユニットと、並列する第１駆動輪及び第２駆動輪を含む駆動ユニットと、検出ユニットと、算出ユニットと、制御ユニットとを含む清掃ロボットであって、
駆動ユニットが清掃ロボットを進行するように駆動する場合、検出ユニットは、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出し、
算出ユニットは、清掃ロボットが障害物に邪魔されている状態にある場合に、清掃ロボットの傾斜角度を算出し、
清掃ロボットが障害物に邪魔されている状態にある場合、制御ユニットが、検出ユニットと算出ユニットとによって取得された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御する清掃ロボットを提供する。
選択的には、制御ユニットが、検出ユニットと算出ユニットとによって共同検出された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することは、
検出ユニットと算出ユニットとによって取得された検出結果が、清掃ロボットが障害物に邪魔されている状態にあり、且つ清掃ロボットの傾斜角度が第１角度より小さいである場合、制御ユニットが、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することを含む。
選択的には、制御ユニットが、障害物を乗越えるように第１駆動輪を制御することは、
制御ユニットが、第１進行方向に沿って進行するように第１駆動輪を制御し、第２進行方向に沿って進行するように第２駆動輪を制御すること、
又は、
制御ユニットが、第１速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第１速度は第２速度より大きいこと、
又は、
制御ユニットが、第１進行方向に沿って進行するように第１駆動輪を制御し、静止に維持するように第２駆動輪を制御することを含み、
ここで、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、制御ユニットが、静止に維持するように第２駆動輪を制御することは、
制御ユニットが、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第２駆動輪を制御することを含む。
選択的には、制御ユニットが第２駆動輪の回転速度をゼロに制御した後、検出ユニットは、第２駆動輪が第２進行方向へ回転するか否かを検出し、第２駆動輪が第２進行方向へ回転する場合、制御ユニットは、第１進行方向に沿う回転力を出力して静止に維持するように第２駆動輪を制御する。
選択的には、障害物を乗越えるように第２駆動輪を制御することは、
制御ユニットが、第１進行方向に沿って進行するように第２駆動輪を制御し、第２進行方向に沿って進行するように第１駆動輪を制御すること、
又は、
制御ユニットが、第１速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第１速度は第２速度より大きいこと、
又は、
制御ユニットが、第１進行方向に沿って進行するように第２駆動輪を制御し、静止に維持するように第１駆動輪を制御することを含み、
ここで、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、静止に維持するように第１駆動輪を制御するは、
制御ユニットが、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第１駆動輪を制御することを含む。
選択的には、制御ユニットが第１駆動輪の回転速度をゼロに制御した後、第１駆動輪が第２進行方向へ回転するか否かを検出し、第１駆動輪が第２進行方向へ回転する場合、制御ユニットは、第１進行方向に沿う回転力を出力して静止に維持するように第１駆動輪を制御する。
選択的には、検出ユニットと算出ユニットとによって取得された検出結果が、清掃ロボットの傾斜角度が第１角度より大きいことである場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、検出ユニットと算出ユニットとによって取得された検出結果が、清掃ロボットが障害物に邪魔されている状態であり、且つ清掃ロボットの傾斜角度が第２角度より小さいことである場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２角度は第１角度より小さい。
選択的には、検出ユニットは、第１駆動輪が障害物を乗越えたか否かを検出し、
検出ユニットが、第１駆動輪が障害物を乗越えていないことを検出した場合、第１駆動輪が障害物を乗越えなかった回数を記録し、
障害物を乗越えなかった回数が所定の値より大きい場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、検出ユニットは、第１駆動輪が障害物を乗越えたか否かを検出し、
検出ユニットが、第１駆動輪が障害物を乗越えたことを検出した場合、障害物を乗越えるように第２駆動輪を制御するステップを実行する。
選択的には、清掃ロボットが障害物に邪魔されている状態にある場合、制御ユニットが、検出ユニットと算出ユニットとによって取得された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することは、
清掃ロボットが障害物に邪魔されている状態にあり、且つ、進行方向に平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、制御ユニットが、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することを含み、
ここで、第１駆動輪は、邪魔な障害物に近い駆動輪であり、第２駆動輪は、邪魔な障害物から離れた駆動輪であり、接触面は、清掃ロボットが清掃任務を行う平面である。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが、第１の駆動輪および第２駆動輪のうち少なくとも１つがスリップ状態にあるか否かを検出し、スリップ状態とは、第１の駆動輪および第２駆動輪のうち少なくとも１つがスライドするように接触面で回転する状態であることと、
第１の駆動輪および第２駆動輪のうち少なくとも１つがスリップ状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含み、
ここで、接触面は、清掃ロボットが清掃任務を行う平面である。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが、第１駆動輪および第２駆動輪のうち少なくとも１つが引っ掛かっている状態にあるか否かを検出し、引っ掛かっている状態とは、第１の駆動輪および第２駆動輪のうち少なくとも１つの回転中に外力によって回転が停止された状態であることと、
第１駆動輪および第２駆動輪のうち少なくとも１つが引っ掛かっている状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含む。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが第１駆動輪および第２駆動輪のうち少なくとも１つの走行距離と清掃ロボットの位置とを取得することと、
走行距離の変化値が所定の範囲を超え、且つ位置が変化しない場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含む。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが、駆動ユニットの駆動電流が所定の電流値より大きいか否かを検出することと、
駆動電流が所定の電流値より大きい場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含む。
選択的には、検出ユニットが、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニットが、清掃ロボットが傾斜したか否かを検出することと、
清掃ロボットが傾斜した場合、清掃ロボットが障害物に邪魔されている状態にあると決定することと、を含む。
本発明の実施例の第２の側面は、並列する第１駆動輪及び第２駆動輪と、制御ユニットとを含む清掃ロボットに用いられる障害物の乗越え方法を提供し、この方法は、
清掃ロボットが進行する際、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップと、
清掃ロボットが障害物に邪魔されている状態にある場合、検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップと、を含む。
選択的には、検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップは、
検出結果が、清掃ロボットが障害物に邪魔されている状態にあり、且つ清掃ロボットの傾斜角度が第１角度より小さいことである場合、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップを含む。
選択的には、障害物を乗越えるように第１駆動輪を制御するステップは、
第１進行方向に沿って進行するように第１駆動輪を制御し、第２進行方向に沿って進行するように第２駆動輪を制御するステップ、
又は、
第１速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第１速度は第２速度より大きいステップ、
又は、
第１進行方向に沿って進行するように第１駆動輪を制御し、静止に維持するように第２駆動輪を制御するステップを含み、
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、静止に維持するように第２駆動輪を制御するステップは、
駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第２駆動輪を制御するステップを含む。
選択的には、当該方法は、
第２駆動輪の回転速度をゼロに制御した後、第２駆動輪が第２進行方向へ回転するか否かを検出し、第２駆動輪が第２進行方向へ回転する場合、第１進行方向に沿う回転力を出力して静止に維持するように第２駆動輪を制御するステップをさらに含む。
選択的には、障害物を乗越えるように第２駆動輪を制御するステップは、
第１進行方向に沿って進行するように第２駆動輪を制御し、第２進行方向に沿って進行するように第１駆動輪を制御するステップ、
又は、
第１速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第１速度は第２速度より大きいステップ、
又は、
第１進行方向に沿って進行するように第２駆動輪を制御し、静止に維持するように第１駆動輪を制御するステップを含み、
ここで、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、静止に維持するように第１駆動輪を制御するステップは、
駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第１駆動輪を制御するステップを含む。
選択的には、当該方法は、
第１駆動輪の回転速度をゼロに制御した後、第１駆動輪が第２進行方向へ回転するか否かを検出し、第１駆動輪が第２進行方向へ回転する場合、第１進行方向に沿う回転力を出力して静止に維持するように第１駆動輪を制御するステップをさらに含む。
選択的には、当該方法は、
検出結果が、清掃ロボットの傾斜角度が第１角度より大きいことである場合、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であるステップをさらに含む。
選択的には、当該方法は、
検出結果が、清掃ロボットが障害物に邪魔されている状態であり、且つ清掃ロボットの傾斜角度が第２角度より小さいことである場合、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２角度は第１角度より小さいステップをさらに含む。
選択的には、当該方法は、
第１駆動輪が障害物を乗越えたか否かを検出するステップと、
第１駆動輪が障害物を乗越えていない場合、第１駆動輪が障害物を乗越えなかった回数を記録するステップと、
障害物を乗越えなかった回数が所定の値より大きい場合、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であるステップと、をさらに含む。
選択的には、当該方法は、
第１駆動輪が障害物を乗越えたか否かを検出するステップと、
第１駆動輪が障害物を乗越えた場合、障害物を乗越えるように第２駆動輪を制御するステップを実行するステップと、をさらに含む。
選択的には、清掃ロボットが障害物に邪魔されている状態にある場合、検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップは、
清掃ロボットが障害物に邪魔されている状態にあり、且つ、進行方向に平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するステップを含み、
ここで、第１駆動輪は邪魔な障害物に近い駆動輪であり、第２駆動輪は邪魔な障害物から離れた駆動輪であり、接触面は、清掃ロボットが清掃任務を行う平面である。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
第１駆動輪および第２駆動輪のうち少なくとも１つがスリップ状態にあるか否かを検出し、スリップ状態とは、第１駆動輪および第２駆動輪のうち少なくとも１つがスライドするように接触面で回転する状態であるステップと、
第１駆動輪および第２駆動輪のうち少なくとも１つがスリップ状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含み、
ここで、接触面は、清掃ロボットが清掃任務を行う平面である。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
第１駆動輪および第２駆動輪のうち少なくとも１つが引っ掛かっている状態にあるか否かを検出し、引っ掛かっている状態とは、第１駆動輪および第２駆動輪のうち少なくとも１つの回転中に外力によって回転が停止された状態であるステップと、
第１駆動輪および第２駆動輪のうち少なくとも１つが引っ掛かっている状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含む。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
第１駆動輪および第２駆動輪のうち少なくとも１つの走行距離と清掃ロボットの位置とを取得するステップと、
走行距離の変化値が所定の範囲を超え、且つ位置が変化しない場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含む。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
駆動ユニットの駆動電流が所定の電流値より大きいか否かを検出するステップと、
駆動電流が所定の電流値より大きい場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含む。
選択的には、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
清掃ロボットが傾斜したか否かを検出するステップと、
清掃ロボットが傾斜した場合、清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、を含む。
本発明の実施例における技術案は、以下の有益な効果を奏する。
清掃ロボットが進行する時に、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出し、清掃ロボットが障害物に邪魔されている状態にある場合に、センサの他のデータと合わせて、障害物を乗越えるように清掃ロボットを制御するか否かを決め、障害物を乗越えると決定した場合、障害物を乗越えるように第１駆動輪を制御し、それから前記障害物を乗越えるように第２駆動輪を制御し、これにより、清掃ロボットが作業中に障害物に邪魔されて清掃任務が続けられない問題が避けられ、清掃ロボットが独立して障害物を乗越えることができるようになり、清掃ロボットの作業適応能力が向上する。
なお、上記の一般的な説明及び後述する具体的な説明は、単に例示するものであり、本発明を限定するものと理解してはいけない。
本発明の実施例における技術案をより明瞭に説明するために、以下は実施例の説明に使用される図面を簡単に説明する。下記の記載における図面は、単に本発明の一部の実施例であり、当業者であれば、創作的な尽力を払わなくて、これらの図面に基づいて他の図面を得ることができる。
本発明の各実施例に係る清掃ロボットの概略構造図 本発明の各実施例に係る清掃ロボットの概略構造図 本発明の各実施例に係る清掃ロボットの構成ブロック図 本発明の実施例が提供する座標系 例示的な一実施例による障害物の乗越え方法のフローチャート 例示的な一実施例による障害物に邪魔されている状態の概略図 例示的な一実施例による障害物の乗越え方法のフローチャート 別の例示的な実施例による障害物に邪魔されている状態を検出する実行概略図 別の例示的な実施例による傾斜角度取得の実行概略図 別の例示的な実施例による傾斜角度取得の実行概略図 別の例示的な実施例による傾斜角度を取得の実行概略図 別の例示的な実施例による障害物の乗越え方法の実行概略図 別の例示的な実施例による障害物の乗越え方法の実行概略図 別の例示的な実施例による障害物の乗越え方法のフローチャート
ここでは例示的な実施例を詳細に説明し、その例は図面に示される。以下の説明が図面に関わる際、別途な記載がない限り、それぞれの図面における同一数字は同一又は類似する要素を意味する。以下の例示的な実施例に記載された実施形態は、本願と一致する全ての実施形態を表さない。むしろ、これらはただ特許請求の範囲に詳細に記載された、本願の幾つかの側面と一致する装置と方法の例に過ぎない。
図１と図２は、本発明の各実施例に係る清掃ロボットの概略図であり、図１に清掃ロボット１０の概略平面図が例示的に開示され、図２に該清掃ロボット１０の概略底面図が例示的に開示されている。図１と図２に示すように、当該清掃ロボット１０は、本体１１０と、検出部材１２０と、左輪１３１と、左輪１３１に接続されるモータ（図示せず）と、右輪１３２と、右輪１３２に接続されるモータ（図示せず）と、メインブラシ１４０と、を含む。
本体１１０は清掃ロボットのハウジングを形成して、他の部材を収容する。
選択的には、本体１１０は扁平な円柱形である。
検出部材１２０は清掃ロボットの周辺環境を測定し、障害物、壁、階段などの環境物体を見つけるためのものであり、検出部材１２０は清掃ロボット自身の運動状態も判断することができる。検出部材１２０は、オドメータ、ＬＤＳ（ＬａｓｅｒＤｉｓｔａｎｃｅ Ｓｅｎｓｏｒ，レーザー距離測定センサ）、崖センサ、３軸加速度計、ジャイロスコープ、衝突センサを含んでもよい。選択的には、検出部材１２０は、赤外線センサ、超音波センサ、カメラ、ホールセンサなどを含んでもよい。
本実施例は、検出部材１２０の数及び所在位置について限定しない。
清掃ロボットの本体１１０の左側に左輪１３１が設けられ、清掃ロボットの本体１１０の右側に右輪１３２が設けられ、左輪１３１と右輪１３２とが清掃ロボットの本体１１０の左右両側に並列に設けられる。左輪１３１と右輪１３２とは、それぞれに接続されるモータにより制御される。
清掃ロボットの本体１１０の左側に、左輪１３１に接続されるモータがさらに設けられ、左輪１３１に接続されるモータの駆動回路は、清掃ロボットの制御ユニットに接続され、制御ユニットは、異なるデューティー比に対応する第１制御信号をモータの駆動回路に送信し、モータの駆動回路は、第１制御信号に応じた駆動電流を生成してモータを回転させて、左輪１３１の駆動方向と回転速度とを制御する。ここで、デューティー比とは、パルス信号の通電時間と通電周期との比であり、デューティー比が大きいほど、左輪１３１の回転速度が大きく、デューティー比が小さいほど、左輪１３２の回転速度が小さい。例えば、左輪１３１に接続されるモータの駆動回路は、制御ユニットによって送信された、１/２であるデューティー比に対応する第１制御信号を受信し、第１制御信号に基づいて対応する駆動電流を生成し、駆動電流の作用で、左輪１３１に接続されるモータは、駆動方向が前進方向であり、且つ回転速度が５０ｒｐｍであるように左輪１３１を制御する。
清掃ロボットの本体１１０の右側に、右輪１３２に接続されるモータがさらに設けられ、右輪１３２に接続されるモータの駆動回路は清掃ロボットの制御ユニットに接続され、制御ユニットは、異なるデューティー比に対応する第２制御信号をモータの駆動回路に送信し、モータの駆動回路は、第２制御信号に応じた駆動電流を生成してモータを回転させて右輪１３２の駆動方向と回転速度とを制御する。例えば、右輪１３２に接続されるモータの駆動回路は、制御ユニットによって送信された、１/２であるデューティー比に対応する第２制御信号を受信し、第２制御信号に基づいて対応する駆動電流を生成し、駆動電流の作用で、右輪１３２に接続されるモータは、駆動方向が前進方向であり、且つ回転速度が５０ｒｐｍであるように右輪１３２を制御する。
清掃ロボット１０の左輪１３１と、左輪１３１に接続されるモータと、右輪１３２と、右輪１３２に接続されるモータとによって、清掃ロボット１０の駆動ユニットが構成される。
選択的には、該清掃ロボット１０は、本体１１０の前部に設置されたガイド輪１３３をさらに含み、ガイド輪１３３は清掃ロボットの進行中の走行方向を変更するためのものである。
メインブラシ１４０は本体１１０の底部に設けられる。選択的には、メインブラシ１４０は、接触面に対してローラ式で回転するドラム状の回転ブラシである。
なお、清掃ロボットは他のモジュール又は部材をさらに含んでもよいし、又は、前記一部のモジュール又は部材だけを含んでもよく、本実施形態はこれを限定せず、前述した清掃ロボットのみを例として説明する。
図３は例示的な一実施例による清掃ロボットの構造ブロック図である。清掃ロボットは、制御ユニット３１０と、記憶ユニット３２０と、検出ユニット３３０と、算出ユニット３４０と、駆動ユニット３５０と、清掃ユニット３６０と、を含む。
制御ユニット３１０は清掃ロボットの全体の動作を制御する。清掃命令を受信すると、制御ユニット３１０は、予め設定されたロジックに従って前進方向又は後退方向に沿って進行しながら、進行中に清掃するように清掃ロボットを制御することができる。進行命令を受信すると、制御ユニット３１０は、所定の進行モードで進行経路を進行するように清掃ロボットを制御する。本実施例は、制御ユニット３１０が受信するユーザーの他の命令について贅言しない。
記憶ユニット３２０は、少なくとも１つの命令を記憶するためのものであり、これらの命令は、所定の進行モードと進行経路とを実行するための命令と、清掃するための命令と、障害物に邪魔されている状態にあるか否かを検出するための命令と、傾斜角度を算出するための命令と、傾斜角度が第１角度より大きいか否かを検出するための命令などを含む。記憶ユニット３２０は、清掃ロボットの進行中の自身の位置データと、進行中の走行速度、走行距離、障害物に関するデータなども記憶する。
検出ユニット３３０は、清掃ロボットの進行領域における障害物と清掃ロボットの進行状態とを検出するためのものであり、障害物は家具、家電製品、オフィス機器、レンガの壁、木製の壁、床面上の電線、隣接する部屋間にある敷居などであってもよい。
算出ユニット３４０は、清掃ロボットが障害物に邪魔されている状態にある場合に、清掃ロボットの傾斜角度と、進行領域において清掃ロボットから障害物までの距離とを算出する。例えば、算出ユニット３４０は、３軸加速度計により清掃ロボットの傾斜角度を算出し、又は、算出ユニット３４０は、ジャイロスコープにより清掃ロボットの傾斜角度を算出し、又は、算出ユニット３４０は、６軸ジャイロスコープにより清掃ロボットの傾斜角度を取得し、又は、算出ユニット３４０は、清掃ロボットから障害物までの距離又は清掃ロボットの進行距離に基づいて清掃ロボットの傾斜角度を算出する。
駆動ユニット３５０は、制御ユニット３１０の第１制御信号に基づいて第１駆動輪の駆動方向と回転速度とを制御し、又は制御ユニット３１０の第２制御信号に基づいて第２駆動輪の駆動方向と回転速度とを制御する。
清掃ユニット３６０は、清掃命令を受信して、制御ユニット３１０が予め設定されたロジックに従って前進方向又は後退方向に沿って進行するように清掃ロボットを制御する際、進行中に、清掃ロボットの底部にあるメインブラシが回動する方式でメインブラシに接触する接触面を清掃するように制御する。
例示的な実施形態において、制御ユニット３１０は、１つ又は複数の特定用途向け集積回路（ＡＳＩＣ）、デジタル信号プロセッサ（ＤＳＰ）、デジタル信号処理デバイス（ＤＳＰＤ）、プログラマブルロジックデバイスロジック（ＰＬＤ）、フィールドプログラマブルゲートアレイ（ＦＰＧＡ）、コントローラ、マイクロコントローラ、マイクロプロセッサ又は他の電子部材により実装されて、本発明の実施例における清掃ロボットの制御方法を実行する。
選択的には、制御ユニット３１０は、さらに、
駆動ユニット３５０が清掃ロボットを進行するように駆動する場合、検出ユニット３３０は清掃ロボットが障害物に邪魔されている状態にあるか否かを検出し、
清掃ロボットが障害物に邪魔されている状態にある場合、制御ユニット３１０は、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御するように構成される。
選択的には、制御ユニット３１０が、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果に基づいて、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することは、
検出ユニット３３０と算出ユニット３４０とによって取得された検出結果が、清掃ロボットが障害物に邪魔されている状態にあり、且つ清掃ロボットの傾斜角度が第１角度より小さい場合、制御ユニット３１０が、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することを含む。
選択的には、制御ユニット３１０が、障害物を乗越えるように第１駆動輪を制御することは、
制御ユニット３１０が、第１進行方向に沿って進行するように第１駆動輪を制御し、第２進行方向に沿って進行するように第２駆動輪を制御すること、
又は、
制御ユニット３１０が、第１速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第１速度が第２速度より大きいこと、
又は、
制御ユニット３１０が、第１進行方向に沿って進行するように第１駆動輪を制御し、静止に維持するように第２駆動輪を制御することを含み、
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２進行方向は第１進行方向と反対である。
選択的には、制御ユニット３１０は静止に維持するように第２駆動輪を制御することは、
制御ユニットが、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第２駆動輪を制御することを含む。
選択的には、制御ユニット３１０が第２駆動輪の回転速度をゼロに制御した後、検出ユニット３３０は、第２駆動輪が第２進行方向へ回転するか否かを検出し、第２駆動輪が第２進行方向へ回転する場合、制御ユニット３１０は、第１進行方向に沿う回転力を出力して静止に維持するように第２駆動輪が制御することを含む。
選択的には、障害物を乗越えるように第２駆動輪を制御することは、
制御ユニット３１０が、第１進行方向に沿って進行するように第２駆動輪を制御し、第２進行方向に沿って進行するように第１駆動輪を制御することは、
又は、
制御ユニット３１０が、第１速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第１速度は第２速度より大きいこと、
又は、
制御ユニット３１０が、第１進行方向に沿って進行するように第２駆動輪を制御し、静止に維持するように第１駆動輪を制御することを含み、
ここで、第１進行方向は清掃ロボットが障害物に邪魔されて状態になる前の進行方向であり、第２進行方向は第１進行方向と反対であること。
選択的には、静止に維持するように第１駆動輪を制御することは、
制御ユニット３１０が、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第１駆動輪を制御することを含む。
選択的には、制御ユニット３１０は、第１駆動輪の回転速度をゼロに制御した後、第１駆動輪が第２進行方向へ回転するか否かを検出し、第１駆動輪が第２進行方向へ回転する場合、制御ユニット３１０は、第１進行方向に沿う回転力を出力して静止に維持するように第１駆動輪を制御する。
選択的には、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果が、清掃ロボットの傾斜角度が第１角度より大きいことである場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果が、清掃ロボットが障害物に邪魔されている状態にあり、且つ清掃ロボットの傾斜角度が第２角度より小さいことである場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第２角度は第１角度より小さい。
選択的には、検出ユニット３３０は、第１駆動輪が障害物を乗越えたか否かを検出し、
検出ユニット３３０は、第１駆動輪が障害物を乗越えていないと検出した場合、第１駆動輪が障害物を乗越えなかった回数を記録し、
障害物を乗越えなかった回数が所定の値より大きい場合、制御ユニットは、第２進行方向に沿って進行するように清掃ロボットを制御し、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、検出ユニット３３０は、第１駆動輪が障害物を乗越えたか否かを検出し、
第１駆動輪が障害物を乗越えたと検出ユニット３３０が検出した場合、障害物を乗越えるように第２駆動輪を制御するステップを実行する。
選択的には、清掃ロボットが障害物に邪魔されている状態にある場合、制御ユニット３１０が、検出ユニット３３０と算出ユニット３４０とによって取得された検出結果に基づいて障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することは、
清掃ロボットが障害物に邪魔されている状態にあり、且つ、進行方向に平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、制御ユニット３１０が、障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御することを含み、
ここで、第１駆動輪は邪魔な障害物に近い駆動輪であり、第２駆動輪は邪魔な障害物から離れた駆動輪である。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、駆動輪がスリップ状態にあるか否かを検出し、スリップ状態とは、駆動輪がスライドするように接触面で回転する状態であることと、
駆動輪がスリップ状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、駆動輪が引っ掛かっている状態にあるか否かを検出し、引っ掛かっている状態とは、駆動輪の回転中に外力によって回転が停止された状態であることと、
駆動輪が引っ掛かっている状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、駆動輪の走行距離と清掃ロボットの位置とを取得することと、
走行距離の変化値が所定の範囲を超え、且つ位置が変化しない場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、駆動ユニットの駆動電流が所定の電流値より大きいか否かを検出することと、
駆動電流が所定の電流値より大きい場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
選択的には、検出ユニット３３０が、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
検出ユニット３３０が、清掃ロボットが傾斜したか否かを検出することと、
清掃ロボットが傾斜した場合、清掃ロボットが障害物に邪魔されている状態にあると決定することとを含む。
例示的な実施例において、命令を含む非一時コンピュータ読取可能な記憶媒体がさらに提供され、例えば、命令を含む記憶ユニット３２０。前記命令は、制御ユニット３１０により実行されて前記本発明の実施例における清掃ロボットの制御方法を実現する。例えば、前記非一時コンピュータ読取可能な記憶媒体はＲＯＭ、ランダムアクセスメモリ（ＲＡＭ）、ＣＤ-ＲＯＭ、カセット、フロッピーディスク、光データ記憶装置などであってもよい。
下記実施例において、清掃ロボットの左輪が第１駆動輪として決定され、清掃ロボットの右輪が第２駆動輪として決定される。他の可能な実施例において、清掃ロボットの右輪が第１駆動輪として決定し、清掃ロボットの左輪が第２駆動輪として決定されてもよく、本発明の実施例はこれを限定しない。
清掃ロボットの動きを容易に説明するために、図４に示すように、清掃ロボットに基づいた座標系を作成し、当該座標系は、Ｘ軸と、Ｙ軸と、Ｚ軸とを含み、座標系の原点が清掃ロボットの中心点であり、Ｘ軸とＹ軸とＺ軸とのうちいずれか２つが互いに垂直し、Ｘ軸とＹ軸とは同一平面にあり、Ｘ軸が清掃ロボットの本体の前後軸に平行し、座標系のＹ軸が清掃ロボットの本体の横軸に平行し、Ｚ軸が、Ｘ軸とＹ軸とによって画定された平面に垂直し、座標系のＺ軸が清掃ロボットの本体の鉛直軸に平行する。ここで、Ｘ軸に沿って前への駆動方向を前進方向とし、Ｘ軸に沿って後ろへの駆動方向を後退方向とする。
本発明の実施例は、前述した清掃ロボットに基づいてその障害物の乗越え方法を説明するが、本発明の実施例は清掃ロボットのタイプを限定しない。
例示的な一実施例による障害物の乗越え方法フローチャートが示されている図５Ａを参照し、当該障害物の乗越え方法は以下のステップ５０１とステップ５０２とを含む。
ステップ５０１において、清掃ロボットが進行する際、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出する。
選択的には、清掃ロボットの進行は、清掃ロボットが前進方向に沿って進行してもよいし、清掃ロボットが後退方向に沿って進行してもよい。
選択的には、障害物は一定の硬度を有し、且つ高さが比較的小さい棒状物であり、例えば、隣接する部屋間にある敷居が挙げられ、又は、障害物は柔軟で変形し易い線状物であり、例えば、電線が挙げられる。
清掃ロボットが障害物に邪魔されている状態にあることとは、清掃ロボットの２つの駆動輪が障害物を乗越えておらず、清掃ロボットの本体が傾斜した状態にあることを指す。図５Ｂに示ように、清掃ロボット５１が２つの部屋を通る際、敷居５２に邪魔され、第１駆動輪と第２駆動輪とが敷居５２を乗越えておらず、清掃ロボット５１の本体が傾斜状態にある。
ステップ５０２において、清掃ロボットが障害物に邪魔されている状態にある場合、検出結果に基づいて障害物を乗越えるように第１駆動輪を制御し、それから障害物を乗越えるように第２駆動輪を制御する。
選択的には、清掃ロボットが障害物に邪魔されている状態にある場合、清掃ロボットが邪魔されている状態の検出結果に基づいて、障害物を乗越えるか否かのロジックを実行する。
以上により、本発明の実施例が提供した障害物の乗越え方法は、清掃ロボットが進行する際、ロボットが障害物に邪魔されている状態にあるか否かを検出することにより、清掃ロボットが障害物に邪魔されている状態にある場合、センサの他のデータと合わせて、障害物を乗越えるように清掃ロボットを制御するか否かを決め、障害物を乗越えると決定した場合、障害物を乗越えるように第１駆動輪を制御し、それから前記障害物を乗越えるように第２駆動輪を制御し、これにより、清掃ロボットが作業中に障害物に邪魔されて清掃任務が続けられない問題が避けられ、清掃ロボットが独立して障害物を乗越えることができるようになり、清掃ロボットの作業適応能力が向上する。
別の例示的な実施例による障害物の乗越え方法のフローチャートを示した図６Ａを参照し、当該障害物の乗越え方法は、以下のステップ６０１と、ステップ６０２と、ステップ６０３と、ステップ６０４とを含む。
ステップ６０１において、清掃ロボットが進行する際、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出する。
選択的には、清掃ロボットの進行は、清掃ロボットが前進方向に沿って進行してもよいし、清掃ロボットが後退方向に沿って進行してもよい。
清掃ロボットが前進方向に沿って進行することとは、清掃ロボットがＸ軸正方向に沿って進行することを指し、清掃ロボットがＸ軸逆方向に沿って進行することは、後退方向に沿って進行することである。
選択的には、第１駆動輪と第２駆動輪とがスリップ状態にあるか否かを検出することにより、清掃ロボットが障害物に邪魔されている状態にあるか否かを決定する。ここで、スリップ状態とは、駆動輪がスライドするように接触面で回転する状態であり、接触面とは、ロボットが清掃任務を行う平面であり、例えば、地面又はテーブル面などが挙げられる。駆動輪がスリップ状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定する。
選択的には、第１駆動輪と第２駆動輪とが引っ掛かっている状態にあるか否かを検出することにより、障害物に邪魔されている状態にあるか否かを決定する。ここで、引っ掛かっている状態とは、駆動輪の回転中に外力によって回転が停止された状態である。駆動輪が引っ掛かっている状態にある場合、清掃ロボットが障害物に邪魔されている状態にあると決定する。
選択的には、ＬＤＳ（ＬａｓｅｒＤｉｓｔａｎｃｅ Ｓｅｎｓｏｒ，レーザー距離測定センサ）により前方の障害物までの距離を測定し、オドメータにより駆動輪の走行距離を取得し、走行距離の変化値と前方の障害物までの距離との関係が、清掃ロボットの通常作業時の走行距離の変化値と前方の障害物までの距離との変化規則に合致しない場合、清掃ロボットが障害物に邪魔されている状態にあると決定する。本方法は、駆動輪のスリップ状態を検出する方法であり、輪のスリープ行為の動き特徴及び電気的特性に応じて他の方法を設計してもよい。
図６Ｂに示すように、清掃ロボットの駆動輪６１が回転しているが、清掃ロボットのＬＤＳ６２が測定した、前方の障害物６３までの距離Ｌが変化しておらず、走行距離の変化値と距離Ｌとの関係は、通常作業時の変化規則に合致しないため、清掃ロボットが障害物に邪魔されている状態にあると決定する。ここで、通常作業とは、清掃ロボットが障害物に邪魔されていない時の作業状態を指す。
選択的には、駆動輪に接続されるモータの駆動電流が清掃ロボットの通常進行時の駆動電流を超えたか否かを検出することにより、障害物に邪魔されている状態にあるか否かを決定する。駆動輪に接続されるモータの駆動電流が所定の電流値より大きい場合、清掃ロボットが障害物に邪魔されている状態にあると決定し、ここで、所定の電流値は、清掃ロボットの通常進行中の最大電流値より大きい。本方法は、駆動輪の引っ掛かっている状態を検出する方法であり、輪の引っ掛かる行為の動き特徴及び電気的特性に応じて他の方法を設計してもよい。
選択的には、清掃ロボットの本体は傾斜したか否かを検出することにより、清掃ロボットが障害物に邪魔されている状態にあるか否かを決定する。清掃ロボットが傾斜した場合、清掃ロボットが障害物に邪魔されている状態にあると決定する。
ステップ６０２において、清掃ロボットが障害物に邪魔されている状態にある場合、清掃ロボットの邪魔されている状態の検出結果を取得する。
清掃ロボットの検出ユニットと算出ユニットとにより、清掃ロボットが障害物に邪魔されている状態にある時の本体状態を示すための検出結果を取得し、清掃ロボットの傾斜角度を取得し、傾斜角度に基づいて検出結果を決定し、検出結果が、清掃ロボットの傾斜角度が第１角度より小さいことである場合、ステップ６０３を実行する。
選択的には、第１角度は、通常の場合、清掃ロボットが障害物に邪魔されている状態にあり且つその障害物を乗越えることができる場合の清掃ロボットの本体の傾斜の角度である。
選択的には、第１角度は、清掃ロボットが障害物に邪魔されている状態にあり且つその障害物を乗越えることができる場合の清掃ロボットの本体の傾斜の最大角度である。例えば、清掃ロボットが最大高さが２センチメートルである障害物を乗越えることができ、清掃ロボットが高度が２センチメートルである障害物に邪魔される時に本体が傾斜し、傾斜角度が５°であり、つまり第１角度は５°である。
清掃ロボットの傾斜角度を取得する方法は、以下の七つがある。
一、３軸加速度計によりＸ軸における清掃ロボットの平均加速度成分を取得し、それから予め記憶された平均加速度成分と傾斜角度との対応関係により傾斜角度を決定する。
清掃ロボットの記憶ユニットにＸ軸における平均加速度成分と傾斜角度との一対一の対応関係が記憶されており、清掃ロボットの算出ユニットは、Ｘ軸における平均加速度成分を取得した後、それに対応する傾斜角度を決定する。
二、６軸ジャイロスコープにより清掃ロボットの傾斜角度を取得する。
６軸ジャイロスコープは、３軸加速度計と３軸ジャイロスコープとの機能を共に有する設備であり、清掃ロボットの算出ユニットは、６軸ジャイロスコープにより清掃ロボットのオイラー角を取得し、つまり、清掃ロボットの傾斜角度を取得する。
三、図６Ｃに示すように、３軸加速度計によりＸ軸方向における清掃ロボットの加速度成分Ｒｘと、Ｚ軸方向における加速度成分Ｒｚとを取得し、式１により清掃ロボットの傾斜角度θを取得する。
Figure 2019518277
四、ジャイロスコープにより、清掃ロボットが通常作業時から障害物に邪魔される状態になるまでの時間帯内に、所定の時間間隔にて瞬間角速度を取得し、取得された瞬間角速度と時間帯とを積分し、傾斜角度θを算出する。ここで、所定時間の間隔は、サンプリングの時間間隔である。式２により傾斜角度θを算出する。
Figure 2019518277
 ここで、ｗｎは瞬間角速度であり、Ｔは通常作業時から障害物に邪魔される状態になるまでの時間である。
五、ジャイロスコープにより、清掃ロボットが第１時点から第２時点までの時間帯内に、所定の時間間隔に基づいて瞬間角速度を取得し、取得された瞬間角速度と時間帯とを積分し、傾斜角度θ１を算出し、次に加速度計によりジャイロスコープのオフセット値を算出し、次にジャイロスコープと加速度計との融合アルゴリズムにより、より精確な傾斜角度θ２を算出し、ここで、第１時点は清掃ロボットが障害物に邪魔される状態になった時点であり、第２時点は清掃ロボットが邪魔される状態になる直前の時点である。
六、ＬＤＳにより、清掃ロボットが通常作業状態にある時の第１時点における前方の障害物までの距離Ｌ１を取得し、清掃ロボットが障害物に邪魔されている状態にある時の第２時点における前方の障害物までの距離Ｌ２を取得し、清掃ロボットが通常作業状態にある時の移動速度を利用して第２時点における前方の障害物までの理論的な距離Ｌ３を算出し、式３により清掃ロボットの傾斜角度を算出する。
Figure 2019518277
選択的には、前方の障害物は、清掃ロボットが障害物に邪魔されている状態にする障害物ではない。例えば、清掃ロボットが障害物に邪魔されている状態にする障害物は電線であり、前方の障害物は電線の前方にある壁である。
図６Ｄに示すように、時点Ｔ１に測定された前方の障害物までの距離がＬ１=１０であり、時点Ｔ２に測定された前方の障害物までの距離がＬ２=５であり、理論的な距離Ｌ３=４と算出され、Ｌ２とＬ３との関係により、式３を利用して傾斜角度を取得する。
七、崖センサにより、清掃ロボットが通常作業状態にある時の第１時点における地面までの距離Ｌ４を取得し、清掃ロボットが障害物に邪魔されている状態にある時の第２時点における地面までの距離Ｌ５を取得し、清掃ロボットが第１時点と第２時点との直線距離Ｌ６を取得し、式４を利用して傾斜角度を算出する。
Figure 2019518277
図６Ｅにおいて、図中の上半部分には、時点Ｔ３にて測定された距離Ｌ４と、時点Ｔ４にて測定された距離Ｌ５と、清掃ロボットの時点Ｔ３と時点Ｔ４との直線距離Ｌ６とが示されており、図中の下半部分には、Ｌ４とＬ５とＬ６との三角関係が示されており、式４により傾斜角度θを取得する。
なお、本発明の実施例に使用される１、２、及び３などの数詞は、コンテキストからそれが確かに順を意味しない限り、ただ区別するためのものであると理解すべきである。
検出結果が、傾斜角度が第１角度より大きいことである場合、第２進行方向に沿って進行するように清掃ロボットを制御し、ここで、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、傾斜角度が第１角度より大きい場合、さらに一定の角度回転した後、障害物に邪魔される状態になる前の進行方向と反対する進行方向に進行するように清掃ロボットを制御してもよく、つまり、傾斜角度が第１角度より大きい場合、清掃ロボットは障害物を乗越えない。
検出結果が清掃ロボットの傾斜角度が第２角度より小さいことである場合、障害物に邪魔される状態になる前の進行方向と反対する進行方向に進行するように清掃ロボットを制御する。第２角度は第１角度より小さい。
第２角度は、清掃ロボットが障害物に邪魔されている状態にあり、且つ、障害物が清掃ロボットの進行経路において移動不能であって鉛直方向から清掃ロボットの進行を邪魔する障害物である場合の清掃ロボットの本体の傾斜角度である。通常の場合、第２角度はゼロに近い。例えば、清掃ロボットが脱出中に後退動作を実行するが、後方にある障害物に邪魔され、例えば、壁に邪魔されると、前へ進行するように清掃ロボットを制御し、前進方向は前の運動方向、即ち、後退方向と反対する方向であるから。さらに例えば、清掃ロボットは、前部にある衝突センサが複数回連続にトリガされる場合、後退動作を実行するが、後退中に後方の障害物に邪魔される可能性がある場合、前へ進行するように清掃ロボットを制御する。
なお、本発明の実施例に使用される１、２、及び３などの数詞は、コンテキストからそれが確かに順を意味しない限り、ただ区別するためのものであると理解すべきである。
ステップ６０３において、障害物を乗越えるように第１駆動輪を制御する。
障害物を乗越えるように第１駆動輪を制御することは、以下の三つの実現形態がある。
一、第１進行方向に沿って進行するように第１駆動輪を制御し、第２進行方向に沿って進行するように第２駆動輪を制御し、第１進行方向は第２進行方向と反対である。
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
第１進行方向を前進方向とし、第２進行方向を後退方向とする場合、図６Ｆに示すように、第１駆動輪６４は前進方向に沿って進行し、第２駆動輪６５は後退方向に沿って進行する。
選択的には、第１駆動輪の進行速度は通常作業時の進行速度より大きい。ここで、通常作業とは、清掃ロボットが障害物に邪魔されていない時の作業状態である。
選択的には、第１駆動輪が第１進行方向に沿って進行する速度は、第２駆動輪が第２進行方向に沿って進行する速度より大きい。
二、第１速度で第１方向に沿って進行するように第１駆動輪を制御し、第２速度で第１方向に沿って進行するように第２駆動輪を制御し、第１速度は第２速度より大きい。
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
第１駆動輪が先に障害物を乗越えるのを確保するために、第１駆動輪の第１速度は第２駆動輪の第２速度より大きくされる。例えば、第１進行方向が前進方向であり、第１駆動輪は４０メートル/時間の速度で前進方向に沿って進行し、第２駆動輪は２０メートル/時間の速度で前進方向に沿って進行する。選択的には、第１速度は通常作業時の進行速度より大きく、例えば、通常作業時の速度が３０メートル/時間であり、第１速度が４０メートル/時間である。ここで、通常作業とは、清掃ロボットが障害物に邪魔されていない時の作業状態である。
第１進行方向を前進方向とする場合、図６Ｇに示すように、第１駆動輪６６は第１速度で前進方向に沿って進行し、第２駆動輪６７は第２速度で前進方向に沿って進行する。
三、第１方向に沿って進行するように第１駆動輪を制御し、静止に維持するように第２駆動輪を制御する。
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、静止に維持するように第２駆動輪を制御することとは、駆動方向が第１進行方向であるとともに、回転速度がゼロになるように第２駆動輪を制御することである。
選択的には、デューティー比をゼロに制御することにより、駆動輪の回転速度をゼロにすることができる。第２駆動輪は、駆動方向が第１進行方向であるとともに、回転速度がゼロである場合、第２駆動輪の逆方向の回転抵抗力が大きくなり、ブレーキの作用がある程度に奏され、第１駆動輪が障害物を乗越えることに寄与する。
選択的には、第２駆動輪の回転速度がセロに制御された後、第１駆動輪が第１進行方向に沿って進行するよってもたらされた作用力が、第２駆動輪を第２進行方向に回転させる可能性があるため、第２駆動輪が第２進行方向へ回転するか否かを検出し、第２駆動輪が第２進行方向へ回転する場合、ために、第１進行方向に沿う回転力を出力して静止を維持するよう第２駆動輪を制御する。ここで、第１進行方向に沿う回転力を出力して静止を維持するように第２駆動輪を制御することは、第２駆動輪に接続される駆動モータにデューティー比の小さい電流を与えることにより、第２駆動輪を第１進行方向へ回転させる回転力が生成され、生成された回転力は、第１駆動輪が第１進行方向へ進行する時に第２駆動輪に与えた第２進行方向へ回転する力を相殺することができ、第２駆動輪を静止に維持させる。ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、第１進行方向は第２進行方向と反対である。
なお、本発明の実施例に使用される１、２、及び３などの数詞は、コンテキストからそれが確かに順を意味しない限り、ただ区別するためのものであると理解すべきである。
また、清掃ロボットが障害物に邪魔されている状態にあると検出され、且つ、進行方向と平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、障害物を乗越えるように第１駆動輪を制御し、ここで、第１駆動輪は邪魔な障害物に近い駆動輪である。
選択的には、邪魔な障害物は、清掃ロボットを障害物に邪魔される状態にする障害物ではなく、邪魔な障害物は、清掃ロボットが衝突によりその位置を移動させることができない障害物である。
例えば、邪魔な障害物が壁であり、すなわち、清掃ロボットが壁に沿って進行する時に障害物に邪魔される場合、清掃ロボットが片輪で乗越える過程で生じた回転によって清掃ロボットが壁にぶつかることを回避するために、壁に近い駆動輪を先に障害物を乗越えるようにさせ、つまり、本体を壁から離れた方向へ回転させる。
ステップ６０４において、障害物を乗越えるように第２駆動輪を制御する。
障害物を乗越えるように第２駆動輪を制御する。障害物を乗越えるように第２駆動輪を制御する方法は、障害物を乗越えるように第１駆動輪を制御する方法に似ており、以下の三つの実現形態が挙げられる。
一、第１進行方向に沿って進行するように第２駆動輪を制御し、第２進行方向に沿って進行するように第１駆動輪を制御し、ここで、第１進行方向は第２進行方向と反対であり、第１進行方向は、清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、第２駆動輪の進行速度は通常作業時の進行速度より大きい。ここで、通常作業とは、清掃ロボットが障害物に邪魔されていない時の作業状態である。
選択的には、第２駆動輪が第１進行方向に沿って進行する速度は、第１駆動輪が第２進行方向に沿って進行する速度より大きい。
二、第１速度で第１進行方向に沿って進行するように第２駆動輪を制御し、第２速度で第１進行方向に沿って進行するように第１駆動輪を制御し、第１速度は第２速度より大きい。
障害物を乗越えるのが第２駆動輪であることを確保するために、第２駆動輪の第１速度は第１駆動輪の第２速度より大きくされる。
三、第１方向に沿って進行するように第２駆動輪を制御し、静止に維持するように第１駆動輪を制御する。
ここで、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、静止に維持するように第１駆動輪を制御することとは、駆動方向が第１進行方向であり、且つ回転速度がゼロになるように第１駆動輪を制御することである。
選択的には、デューティー比をゼロに制御することにより、駆動輪の回転速度をゼロにすることができる。第１駆動輪は、駆動方向が第１進行方向であるとともに、回転速度がゼロである場合、第１駆動輪の逆方向の回転抵抗力が大きくなり、ブレーキの作用がある程度で奏され、第２駆動輪が障害物を乗越えることに寄与する。
選択的には、第１駆動輪の回転速度がセロに制御された後、第２駆動輪が第１進行方向に沿って進行することによってもたらされた作用力が、第１駆動輪を第２進行方向に回転させる可能性があるため、第１駆動輪が第２進行方向へ回転するか否かを検出し、第１駆動輪が第２進行方向へ回転する場合、第１進行方向に沿う回転力を出力して静止を維持するよう第１駆動輪を制御する。ここで、第２進行方向は第１進行方向と反対である。
なお、本発明の実施例に使用される１、２、及び３などの数詞は、コンテキストからそれが確かに順を意味しない限り、ただ区別するためのものであると理解すべきである。
また、清掃ロボットが障害物に邪魔されている状態にあり、且つ、進行方向と平行するとともに接触面に垂直する方向に邪魔な障害物が存在すると検出した場合、障害物を乗越えるように第１駆動輪を制御した後に、障害物を乗越えるように第２駆動輪を制御する。ここで、第１駆動輪は邪魔な障害物に近い駆動輪であり、第２駆動輪は邪魔な障害物から離れた駆動輪である。
選択的には、邪魔な障害物は、清掃ロボットを障害物に邪魔される状態にする障害物ではなく、邪魔な障害物は、清掃ロボットが衝突によりその位置を移動させることができない障害物である。
例えば、邪魔な障害物が壁であり、すなわち、清掃ロボットが壁に沿って進行する時に障害物に邪魔される場合、清掃ロボットが片輪で乗越える過程で生じた回転によって清掃ロボットが壁にぶつかることを回避するために、まず障害物を乗越えるように壁に近い駆動輪を制御し、それから障害物を乗越えるように壁から離れた駆動輪を制御する。
以上により、本発明の実施例が提供する障害物の乗越え方法は、清掃ロボットが進行する時に、清掃ロボットが障害物に邪魔されている状態にあるか否かを検出し、清掃ロボットが障害物に邪魔されている状態にある場合に、センサの他のデータと合わせて清掃ロボットが障害物を乗越えるように制御するか否かを決め、障害物を乗越えると決定した場合、障害物を乗越えるように第１駆動輪を制御し、それから前記障害物を乗越えるように第２駆動輪を制御する。これにより、清掃ロボットが作業中に障害物に邪魔されて清掃任務が続けられない問題が避けられ、清掃ロボットが独立して障害物を乗越えることができるようになり、清掃ロボットの作業適応能力が向上する。
また、本発明の実施例が提供する障害物の乗越え方法は、清掃ロボットが障害物に邪魔されている状態にある場合に清掃ロボットの傾斜角度を検出し、清掃ロボットの傾斜角度が第１角度より小さい場合、障害物を乗越え、傾斜角度が第１角度より大きい場合、第２進行方向に沿って進行する。これにより、清掃ロボットが障害物を乗越えることができない場合に障害物を乗越え続けることが防止され、清掃ロボットが柔軟に作業することに寄与し、作業効率が向上する。
図６Ａに示す実施例の好ましい実施例において、障害物を乗越えるように第１駆動輪を制御した後、第１駆動輪が障害物を乗越えたか否かを検出することにより、障害物を乗越えるように第２駆動輪を制御するか否かを決める。当該障害物の乗越え方法は、ステップ６０３ａと、ステップ６０３ｂと、ステップ６０３ｃとを含む。図７に示すように、
ステップ６０３ａにおいて、第１駆動輪が障害物を乗越えるか否かを検出する。
選択的には、第３時点を、清掃ロボットが障害物に邪魔されている状態にあり、且つ障害物を乗越えることをまだ開始していない一つの時点とし、第４時点を、清掃ロボットの第１駆動輪が障害物を乗越えた後の一つの時点とする。
第４時点に３軸加速度計により清掃ロボットの傾斜角度を取得し、第４時点における清掃ロボットの傾斜角度が第１角度より小さいことを検出した場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。又は、第４時点にジャイロスコープにより清掃ロボットの傾斜角度を取得し、第４時点における清掃ロボットの傾斜角度が第１角度より小さいことを検出した場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。又は、第３時点と第４時点とにＬＤＳにより清掃ロボットから前方の障害物までの距離を取得し、第４時点における前方の障害物までの距離が、第３時点における前方の障害物までの距離より小さいことを検出した場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。又は、第１駆動輪に接続されるモータの駆動電流を取得し、駆動電流が清掃ロボットの通常進行時の駆動電流である場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。又は、第３時点と第４時点とに清掃ロボットから接触面までの距離を取得し、第４時点における接触面までの距離が、第３時点における接触面までの距離より小さいことを検出した場合、第１駆動輪が障害物を乗越えたと決定し、そうでない場合は、第１駆動輪が障害物を乗越えていないと決定する。
ステップ６０３ｂにおいて、第１駆動輪が障害物を乗越えていないと検出した場合、第１駆動輪が障害物を乗越えなかった回数を記録する。
ステップ６０３ｃにおいて、障害物を乗越えなかった回数が所定の値より大きい場合、第２進行方向に沿って進行するように清掃ロボットを制御する。
ここで、第２進行方向は第１進行方向と反対であり、第１進行方向は清掃ロボットが障害物に邪魔される状態になる前の進行方向である。
選択的には、所定の値は、清掃ロボットが出荷する前にメーカによって設定され、又は、所定の値はユーザーによって設定され得る。
ステップ６０３ｄにおいて、第１駆動輪が障害物を乗越えた場合、ステップ６０４を実行する。
また、第１駆動輪が障害物を乗越えた後に、第２駆動輪が障害物を乗越える場合、第２駆動輪が障害物を乗越えたか否かを検出してもよい。第２駆動輪が障害物を乗越えていない場合、第２駆動輪が障害物を乗越えなかった回数を記録し、障害物を乗越えなかった回数が所定の値より大きい場合、第２進行方向に沿って進行するように清掃ロボットを制御する。
本発明の実施例が提供する障害物の乗越え方法は、さらに、第１駆動輪が障害物を乗越えたか否かを検出し、障害物を乗越えていない場合、障害物を乗越えなかった回数を記録し、回数が所定の値を超えた場合、清掃ロボットが障害物を乗越えることができないことが分かり、第２進行方向に沿って進行するように清掃ロボットを制御し、これにより、清掃ロボットが障害物を乗越えることができない場合に障害物を乗越え続けることが防止され、清掃ロボットが柔軟に作業することに寄与し、作業効率が向上する。
当業者は、明細書を考慮して明細書に記載された発明を実施した後、本発明の他の実施態様を容易に想到することができる。本発明は、本発明に対するいかなる変形、用途、または適宜な変化を含み、これらの変形、用途、または適宜な変化は、本発明の一般的な原理に従い、本発明では開示していない当分野の公知常識、または通常の技術手段を含む。明細書及び実施例は、ただの例示するものであって、本発明の本当の範囲と主旨は、以下の特許請求の範囲によって示される。
なお、本発明は、上記で記載された、図面で図示された特定の構成に限定されず、その範囲を離脱しない範囲内で、種々な修正及び変更を行うことができる。本発明の範囲は、添付の特許請求の範囲のみにより限定される。

Claims (36)

  1. 清掃ユニットと、並列する第１駆動輪及び第２駆動輪を含む駆動ユニットと、検出ユニットと、算出ユニットと、制御ユニットとを含む清掃ロボットであって、
    前記駆動ユニットが前記清掃ロボットを進行するように駆動する場合、前記検出ユニットが、前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出し、
    前記清掃ロボットが障害物に邪魔されている状態にある場合、前記制御ユニットが、前記検出ユニットと前記算出ユニットとによって取得された検出結果に基づいて、障害物を乗越えるように前記第１駆動輪を制御し、それから障害物を乗越えるように前記第２駆動輪を制御する、
    ことを特徴とする清掃ロボット。
  2. 前記制御ユニットが、前記検出ユニットと前記算出ユニットとによって取得された検出結果に基づいて、障害物を乗越えるように前記第１駆動輪を制御し、それから障害物を乗越えるように前記第２駆動輪を制御することは、
    前記検出ユニットと前記算出ユニットとによって取得された検出結果が、前記清掃ロボットが障害物に邪魔されている状態にあり、且つ前記清掃ロボットの傾斜角度が第１角度より小さい場合、前記制御ユニットが、障害物を乗越えるように前記第１駆動輪を制御し、それから障害物を乗越えるように前記第２駆動輪を制御することを含む、
    ことを特徴とする請求項１に記載の清掃ロボット。
  3. 前記制御ユニットが、障害物を乗越えるように前記第１駆動輪を制御することは、
    前記制御ユニットが、第１進行方向に沿って進行するように前記第１駆動輪を制御し、第２進行方向に沿って進行するように前記第２駆動輪を制御すること、
    又は、
    前記制御ユニットが、第１速度で前記第１進行方向に沿って進行するように前記第１駆動輪を制御し、第２速度で前記第１進行方向に沿って進行するように前記第２駆動輪を制御し、前記第１速度は前記第２速度より大きいこと、
    又は、
    前記制御ユニットが、前記第１進行方向に沿って進行するように前記第１駆動輪を制御し、静止に維持するように前記第２駆動輪を制御することを含み、
    ここで、前記第１進行方向は、前記清掃ロボットが障害物に邪魔される状態になる前の進行方向であり、前記第２進行方向は、前記第１進行方向と反対である、
    ことを特徴とする請求項２に記載の清掃ロボット。
  4. 前記制御ユニットが、静止に維持するように前記第２駆動輪を制御することは、
    前記制御ユニットが、駆動方向が前記第１進行方向であるとともに、回転速度がゼロになるように前記第２駆動輪を制御することを含む、
    ことを特徴とする請求項３に記載の清掃ロボット。
  5. 前記制御ユニットが前記第２駆動輪の回転速度をゼロに制御した後、前記検出ユニットは、前記第２駆動輪が前記第２進行方向へ回転するか否かを検出し、前記第２駆動輪が前記第２進行方向へ回転する場合、前記制御ユニットは、前記第１進行方向に沿う回転力を出力して静止に維持するように前記第２駆動輪を制御する、
    ことを特徴とする請求項４に記載の清掃ロボット。
  6. 前記障害物を乗越えるように前記第２駆動輪を制御することは、
    前記制御ユニットが、第１進行方向に沿って進行するように前記第２駆動輪を制御し、第２進行方向に沿って進行するように前記第１駆動輪を制御すること、
    又は、
    前記制御ユニットが、第１速度で前記第１進行方向に沿って進行するように前記第２駆動輪を制御し、第２速度で前記第１進行方向に沿って進行するように前記第１駆動輪を制御し、前記第１速度は前記第２速度より大きいこと、
    又は、
    前記制御ユニットが、前記第１進行方向に沿って進行するように前記第２駆動輪を制御し、静止に維持するように前記第１駆動輪を制御することを含み、
    ここで、前記第１進行方向は、前記清掃ロボットが前記障害物に邪魔される状態になる前の進行方向であり、前記第２進行方向は前記第１進行方向と反対である、
    ことを特徴とする請求項１〜５のいずれかに記載の清掃ロボット。
  7. 静止に維持するように前記第１駆動輪を制御することは、
    前記制御ユニットが、駆動方向が前記第１進行方向であるとともに、回転速度がゼロになるように前記第１駆動輪を制御することを含む、
    ことを特徴とする請求項６に記載の清掃ロボット。
  8. 前記制御ユニットが前記第１駆動輪の回転速度をゼロに制御した後、前記第１駆動輪が前記第２進行方向へ回転するか否かを検出し、前記第１駆動輪が前記第２進行方向へ回転する場合、前記制御ユニットは、前記第１進行方向に沿う回転力を出力して静止に維持するように前記第１駆動輪を制御する、
    ことを特徴とする請求項７に記載の清掃ロボット。
  9. 前記検出ユニットと前記算出ユニットとによって取得された検出結果が、前記清掃ロボットの傾斜角度が第１角度より大きいことである場合、前記制御ユニットは、第２進行方向に沿って進行するように前記清掃ロボットを制御し、前記第２進行方向は第１進行方向と反対であり、前記第１進行方向は、前記清掃ロボットが前記障害物に邪魔される状態になる前の進行方向である、
    ことを特徴とする請求項１に記載の清掃ロボット。
  10. 前記検出ユニットと前記算出ユニットとによって取得された検出結果が、前記清掃ロボットが障害物に邪魔されている状態にあり且つ前記清掃ロボットの傾斜角度が第２角度より小さいことである場合、前記制御ユニットは、第２進行方向に沿って進行するように前記清掃ロボットを制御し、前記第２進行方向は前記第１進行方向と反対であり、前記第１進行方向は、前記清掃ロボットが前記障害物に邪魔される状態になる前の進行方向であり、前記第２角度は前記第１角度より小さい、
    ことを特徴とする請求項１に記載の清掃ロボット。
  11. 前記検出ユニットは、前記第１駆動輪が前記障害物を乗越えたか否かを検出し、
    前記検出ユニットは、前記第１駆動輪が前記障害物を乗越えていないと検出した場合、前記第１駆動輪が前記障害物を乗越えなかった回数を記録し、
    前記障害物を乗越えなかった回数が所定の値より大きい場合、前記制御ユニットは、前記後退の第２進行方向に沿って進行するように前記清掃ロボットを制御し、前記第１進行方向は、前記清掃ロボットが前記障害物に邪魔される状態になる前の進行方向である、
    ことを特徴とする請求項１に記載の清掃ロボット。
  12. 前記検出ユニットは、前記第１駆動輪が前記障害物を乗越えたか否かを検出し、
    前記検出ユニットが、前記第１駆動輪が前記障害物を乗越えたと検出した場合、前記障害物を乗越えるように前記第２駆動輪を制御するステップを実行する、
    ことを特徴とする請求項１に記載の清掃ロボット。
  13. 前記清掃ロボットが障害物に邪魔されている状態にある場合、前記制御ユニットが、前記検出ユニットと前記算出ユニットとによって取得された検出結果に基づいて、障害物を乗越えるように前記第１駆動輪を制御し、それから前記障害物を乗越えるように前記第２駆動輪を制御することは、
    前記清掃ロボットが前記障害物に邪魔されている状態にあり、且つ、前記進行方向に平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、前記制御ユニットが、障害物を乗越えるように前記第１駆動輪を制御し、それから前記障害物を乗越えるように前記第２駆動輪を制御することを含み、
    ここで、第１駆動輪は前記邪魔な障害物に近い駆動輪であり、前記第２駆動輪は前記邪魔な障害物から離れた駆動輪である、
    ことを特徴とする請求項１に記載の清掃ロボット。
  14. 前記検出ユニットが、前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
    前記検出ユニットが、駆動輪がスリップ状態にあるか否かを検出し、前記スリップ状態とは、前記駆動輪がスライドするように接触面で回転する状態であることと、
    前記駆動輪が前記スリップ状態にある場合、前記清掃ロボットが前記障害物に邪魔されている状態にあると決定することと、
    を含む、
    ことを特徴とする請求項１に記載の清掃ロボット。
  15. 前記検出ユニットが、前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
    前記検出ユニットが、前記駆動輪が引っ掛かっている状態にあるか否かを検出し、前記引っ掛かっている状態とは、前記駆動輪の回転中に外力によって回転が停止された状態であることと、
    前記駆動輪が前記引っ掛かっている状態にある場合、前記清掃ロボットが前記障害物に邪魔されている状態にあると決定することと、
    を含む、
    ことを特徴とする請求項１に記載の清掃ロボット。
  16. 前記検出ユニットが、前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
    前記検出ユニットが駆動輪の走行距離と前記清掃ロボットの位置とを取得することと、
    前記走行距離の変化値が所定の範囲を超え、且つ前記位置が変化しない場合、前記清掃ロボットが障害物に邪魔されている状態にあると決定することと、
    を含む、
    ことを特徴とする請求項１に記載の清掃ロボット。
  17. 前記検出ユニットが、前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
    前記検出ユニットが、前記駆動ユニットの駆動電流が所定の電流値より大きいか否かを検出することと、
    前記駆動電流が所定の電流値より大きい場合、前記清掃ロボットが前記障害物に邪魔されている状態にあると決定することと、
    を含む、
    ことを特徴とする請求項１に記載の清掃ロボット。
  18. 前記検出ユニットが、前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出することは、
    前記検出ユニットが、前記清掃ロボットが傾斜したか否かを検出することと、
    前記清掃ロボットが傾斜した場合、前記清掃ロボットが前記障害物に邪魔されている状態にあると決定することと、
    を含む、
    ことを特徴とする請求項１に記載の清掃ロボット。
  19. 並列する第１駆動輪及び第２駆動輪と、制御ユニットとを含む清掃ロボットに使用される障害物の乗越え方法であって、前記方法は、
    前記清掃ロボットが進行する際、前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップと、
    前記清掃ロボットが障害物に邪魔されている状態にある場合、検出結果に基づいて、障害物を乗越えるように前記第１駆動輪を制御し、それから前記障害物を乗越えるように前記第２駆動輪を制御するステップと、
    を含む、
    ことを特徴とする障害物の乗越え方法。
  20. 検出結果に基づいて、障害物を乗越えるように前記第１駆動輪を制御し、それから前記障害物を乗越えるように前記第２駆動輪を制御するステップは、
    前記検出結果が、前記清掃ロボットが障害物に邪魔されている状態あり、且つ前記清掃ロボットの傾斜角度が第１角度より小さいことである場合、障害物を乗越えるように前記第１駆動輪を制御し、それから前記障害物を乗越えるように前記第２駆動輪を制御するステップを含む、
    ことを特徴とする請求項１９に記載の方法。
  21. 障害物を乗越えるように前記第１駆動輪を制御するステップは、
    第１進行方向に沿って進行するように前記第１駆動輪を制御し、第２進行方向に沿って進行するように前記第２駆動輪を制御するステップ、
    又は、
    第１速度で前記第１進行方向に沿って進行するように前記第１駆動輪を制御し、第２速度で前記第１進行方向に沿って進行するように前記第２駆動輪を制御し、前記第１速度は前記第２速度より大きいステップ、
    又は、
    前記第１進行方向に沿って進行するように前記第１駆動輪を制御し、静止に維持するように前記第２駆動輪を制御するステップを含み、
    ここで、前記第１進行方向は、前記清掃ロボットが前記障害物に邪魔される状態になる前の進行方向であり、前記第２進行方向は前記第１進行方向と反対である、
    ことを特徴とする請求項２０に記載の方法。
  22. 静止に維持するように前記第２駆動輪を制御するステップは、
    駆動方向が前記第１進行方向であるとともに、回転速度がゼロになるように前記第２駆動輪を制御するステップを含む、
    ことを特徴とする請求項２１に記載の方法。
  23. 前記方法は、
    前記第２駆動輪の回転速度をゼロに制御した後、前記第２駆動輪が前記第２進行方向へ回転するか否かを検出し、前記第２駆動輪が前記第２進行方向へ回転する場合、前記第１進行方向に沿う回転力を出力して静止に維持するように前記第２駆動輪を制御するステップをさらに含む、
    ことを特徴とする請求項２２に記載の方法。
  24. 前記障害物を乗越えるように前記第２駆動輪を制御するステップは、
    第１進行方向に沿って進行するように前記第２駆動輪を制御し、第２進行方向に沿って進行するように前記第１駆動輪を制御するステップ、
    又は、
    第１速度で前記第１進行方向に沿って進行するように前記第２駆動輪を制御し、第２速度で前記第１進行方向に沿って進行するように前記第１駆動輪を制御し、前記第１速度は前記第２速度より大きいステップ、
    又は、
    前記第１進行方向に沿って進行するように前記第２駆動輪を制御し、静止に維持するように前記第１駆動輪を制御するステップを含み、
    ここで、前記第１進行方向は、前記清掃ロボットが前記障害物に邪魔される状態になる前の進行方向であり、前記第２進行方向は前記第１進行方向と反対である、
    ことを特徴とする請求項１９〜２３のいずれか１項に記載の方法。
  25. 静止に維持するように前記第１駆動輪を制御するステップは、
    駆動方向が前記第１進行方向であるとともに、回転速度がゼロになるように前記第１駆動輪を制御するステップを含む、
    ことを特徴とする請求項２４に記載の方法。
  26. 前記方法は、
    前記第１駆動輪の回転速度をゼロに制御した後、前記第１駆動輪が前記第２進行方向へ回転するか否かを検出し、前記第１駆動輪が前記第２進行方向へ回転する場合、前記第１進行方向に沿う回転力を出力して静止に維持するように前記第１駆動輪を制御するステップをさらに含む、
    ことを特徴とする請求項２５に記載の方法。
  27. 前記方法は、
    前記検出結果が、前記清掃ロボットの傾斜角度が第１角度より大きいことである場合、第２進行方向に沿って進行するように前記清掃ロボットを制御し、前記第２進行方向は第１進行方向と反対であり、前記第１進行方向は、前記清掃ロボットが前記障害物に邪魔される状態になる前の進行方向であるステップをさらに含む、
    ことを特徴とする請求項１９に記載の方法。
  28. 前記検出結果が、前記清掃ロボットが障害物に邪魔されている状態にあり、且つ前記清掃ロボットの傾斜角度が第２角度より小さいことである場合、第２進行方向に沿って進行するように前記清掃ロボットを制御し、前記第２進行方向は第１進行方向と反対であり、前記第１進行方向は、前記清掃ロボットが前記障害物に邪魔される状態になる前の進行方向であり、前記第２角度は前記第１角度より小さいステップをさらに含む、
    ことを特徴とする請求項１９に記載の方法。
  29. 前記方法は、
    前記第１駆動輪が前記障害物を乗越えたか否かを検出するステップと、
    前記第１駆動輪が前記障害物を乗越えていない場合、前記第１駆動輪が前記障害物を乗越えなかった回数を記録するステップと、
    前記障害物を乗越えなかった回数が所定の値より大きい場合、前記後退の第２進行方向に沿って進行するように前記清掃ロボットを制御し、前記第１進行方向は、清掃ロボットが前記障害物に邪魔される状態になる前の進行方向であるステップと、
    をさらに含む
    ことを特徴とする請求項１９に記載の方法。
  30. 前記方法は、
    前記第１駆動輪が前記障害物を乗越えたか否かを検出するステップと、
    前記第１駆動輪が前記障害物を乗越えた場合、前記障害物を乗越えるように前記第２駆動輪を制御するステップを実行するステップと、
    をさらに含む、
    ことを特徴とする請求項１９に記載の方法。
  31. 前記清掃ロボットが障害物に邪魔されている状態にある場合、前記検出結果に基づいて、障害物を乗越えるように前記第１駆動輪を制御し、それから前記障害物を乗越えるように前記第２駆動輪を制御するステップは、
    前記清掃ロボットが前記障害物に邪魔されている状態にあり、且つ、前記進行方向に平行するとともに接触面に垂直する方向に邪魔な障害物が存在する場合、障害物を乗越えるように前記第１駆動輪を制御し、それから前記障害物を乗越えるように前記第２駆動輪を制御するステップを含み、
    ここで、前記第１駆動輪は、前記邪魔な障害物に近い駆動輪であり、前記第２駆動輪は、前記邪魔な障害物から離れた駆動輪である、
    ことを特徴とする請求項１９に記載の方法。
  32. 前記清掃ロボットが障害物に邪魔される状態になるか否かを検出するステップは、
    駆動輪がスリップ状態にあるか否かを検出し、前記スリップ状態とは、前記駆動輪がスライドするように接触面で回転する状態であるステップと、
    前記駆動輪が前記スリップ状態にある場合、前記清掃ロボットが前記障害物に邪魔されている状態にあると決定するステップと、
    を含む、
    ことを特徴とする請求項１９に記載の方法。
  33. 前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
    駆動輪が引っ掛かっている状態にあるか否かを検出し、前記引っ掛かっている状態とは、前記駆動輪の回転中に外力によって回転が停止された状態であるステップと、
    前記駆動輪が前記引っ掛かっている状態にある場合、前記清掃ロボットが前記障害物に邪魔されている状態にあると決定するステップと、
    を含む、
    ことを特徴とする請求項１９に記載の方法。
  34. 前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
    駆動輪の走行距離と前記清掃ロボットの位置とを取得するステップと、
    前記走行距離の変化値が所定の範囲を超え、且つ前記位置が変化しない場合、前記清掃ロボットが障害物に邪魔されている状態にあると決定するステップと、
    を含む、
    ことを特徴とする請求項１９に記載の方法。
  35. 前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出するステップは、
    駆動ユニットの駆動電流が所定の電流値より大きいか否かを検出するステップと、
    前記駆動電流が所定の電流値より大きい場合、前記清掃ロボットが前記障害物に邪魔されている状態にあると決定するステップと、
    を含む、
    ことを特徴とする請求項１９に記載の方法。
  36. 前記清掃ロボットが障害物に邪魔されている状態にあるか否かを検出ステップは、
    前記清掃ロボットが傾斜したか否かを検出するステップと、
    前記清掃ロボットが傾斜した場合、前記清掃ロボットが前記障害物に邪魔されている状態にあると決定するステップと、
    を含む、
    ことを特徴とする請求項１９に記載の方法。
JP2018559319A 2016-06-06 2017-05-04 清掃ロボット及び障害物の乗越え方法 Active JP7123810B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN201610394228.2 2016-06-06
CN201610394228.2A CN107456172B (zh) 2016-06-06 2016-06-06 清洁机器人及障碍物跨越方法
PCT/CN2017/083112 WO2017211151A1 (zh) 2016-06-06 2017-05-04 清洁机器人及障碍物跨越方法

Publications (2)

Publication Number Publication Date
JP2019518277A true JP2019518277A (ja) 2019-06-27
JP7123810B2 JP7123810B2 (ja) 2022-08-23

Family

ID=60544518

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018559319A Active JP7123810B2 (ja) 2016-06-06 2017-05-04 清掃ロボット及び障害物の乗越え方法

Country Status (8)

Country Link
US (2) US11076737B2 (ja)
EP (2) EP4085810A3 (ja)
JP (1) JP7123810B2 (ja)
KR (2) KR102228459B1 (ja)
CN (1) CN107456172B (ja)
AU (2) AU2017276408B2 (ja)
EA (1) EA035938B1 (ja)
WO (1) WO2017211151A1 (ja)

Families Citing this family (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101684072B1 (ko) * 2015-03-06 2016-12-07 엘지전자 주식회사 진공 청소기 및 그의 제어방법
CN108403006A (zh) * 2018-02-09 2018-08-17 芜湖市海联机械设备有限公司 一种清扫机器人
CN108836195A (zh) * 2018-06-28 2018-11-20 广东乐生智能科技有限公司 一种扫地机器人的脱困方法及扫地机器人
CN109445438B (zh) * 2018-12-05 2022-03-04 英华达（上海）科技有限公司 基于地图分享的巡航装置的巡航控制方法及系统
CN109772841B (zh) * 2019-01-23 2021-09-03 合肥仁洁智能科技有限公司 一种光伏组件清扫机器人及其越障控制方法和装置
CN109875470B (zh) * 2019-01-31 2021-04-20 科沃斯机器人股份有限公司 脱困方法、设备及存储介质
CN109765898A (zh) * 2019-01-31 2019-05-17 科沃斯机器人股份有限公司 自移动设备的控制方法、装置、设备及计算机可读存储介质
CN111714030B (zh) * 2019-03-19 2022-12-02 北京奇虎科技有限公司 清扫设备的脱困方法、装置、电子设备及可读存储介质
CN111736580B (zh) * 2019-03-19 2024-04-16 北京奇虎科技有限公司 扫地设备的避障脱困方法、装置、电子设备及存储介质
CN110151047A (zh) * 2019-05-21 2019-08-23 广州晒帝智能科技有限公司 自动擦窗机器人及其跨越障碍的驱动装置
CN110597260A (zh) * 2019-09-20 2019-12-20 深圳乐动机器人有限公司 一种机器人避障的方法及机器人
CN110693396B (zh) * 2019-10-21 2021-06-11 深圳市云鼠科技开发有限公司 一种基于free move技术的扫地机避障处理方式
CN112971642A (zh) * 2019-12-02 2021-06-18 广东美的白色家电技术创新中心有限公司 辅助越障机构及清洁机器人
CN110989623A (zh) * 2019-12-25 2020-04-10 广州极飞科技有限公司 地面无人作业设备及控制其移动的方法和装置、存储介质
CN113126604B (zh) * 2019-12-30 2024-04-30 北京猎户星空科技有限公司 一种机器人避障方法、装置、电子设备及存储介质
CN114145678A (zh) * 2020-09-07 2022-03-08 深圳乐动机器人有限公司 机器人的出水控制方法、装置、机器人和存储介质
CN114451814B (zh) * 2020-11-10 2023-12-08 苏州宝时得电动工具有限公司 自动行走设备和自动行走设备的控制方法
CN112804447B (zh) * 2020-12-30 2023-01-17 北京石头创新科技有限公司 一种检测近场物体的方法、装置、介质和电子设备
CN113679290B (zh) * 2021-02-10 2022-11-08 北京石头创新科技有限公司 自动清洁设备控制方法及装置、介质及电子设备
CN114610013A (zh) * 2021-07-26 2022-06-10 北京石头创新科技有限公司 自行走机器人的遇障处理方法、装置、机器人和存储介质
CN114098540B (zh) * 2021-12-07 2023-02-21 湖南格兰博智能科技有限责任公司 一种扫地机器人越障的方法
CN116360409A (zh) * 2021-12-28 2023-06-30 速感科技（北京）有限公司 自主移动设备及其越障方法和计算机可读存储介质
CN114532901B (zh) * 2022-01-31 2023-03-10 深圳市云鼠科技开发有限公司 用于清洁机器人的跌落处置方法和装置
CN115462703B (zh) * 2022-08-03 2023-10-31 云鲸智能(深圳)有限公司 障碍物跨越方法及清洁机器人
CN115437388B (zh) * 2022-11-09 2023-01-24 成都朴为科技有限公司 一种全向移动机器人脱困方法和装置

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0630807U (ja) * 1992-09-22 1994-04-22 株式会社明電舎 無人搬送車の制御装置
JPH10105240A (ja) * 1996-09-27 1998-04-24 Fujitsu General Ltd 無人走行車の制御方法
JP2004303134A (ja) * 2003-04-01 2004-10-28 Matsushita Electric Ind Co Ltd 走行装置
JP2007168602A (ja) * 2005-12-21 2007-07-05 Matsushita Electric Works Ltd 二輪移動台車
JP2010094802A (ja) * 2008-09-22 2010-04-30 Nihon Univ 車輪型ロボット
JP3163179U (ja) * 2010-03-30 2010-09-30 燕 成▲祥▼ 自動掃除機の検知エスケープ装置
JP2013230201A (ja) * 2012-04-27 2013-11-14 Sharp Corp 自走式電子機器
WO2015090405A1 (en) * 2013-12-19 2015-06-25 Aktiebolaget Electrolux Sensing climb of obstacle of a robotic cleaning device
JP2016049127A (ja) * 2014-08-28 2016-04-11 株式会社東芝 電気掃除機

Family Cites Families (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR960007469A (ko) * 1994-08-19 1996-03-22 조희남 지하수 심정의 청소와 살균을 위한 방법 및 장치
KR960007469B1 (en) * 1994-08-27 1996-06-03 Lg Electronics Inc Apparatus and method for preventing falling-down of cleaning robot
JP3027167U (ja) 1996-01-24 1996-07-30 株式会社東京レベックス 粒状木炭封入シート
ATE301302T1 (de) 2002-01-24 2005-08-15 Irobot Corp Verfahren und system zur roboterlokalisierung und beschränkung des arbeitsbereichs
KR100653165B1 (ko) * 2005-02-25 2006-12-05 삼성광주전자 주식회사 로봇 청소기 및 그 제어 방법
KR101245832B1 (ko) * 2006-05-23 2013-03-21 삼성전자주식회사 장애물을 감지하는 장치 및 방법
KR20090099324A (ko) * 2008-03-17 2009-09-22 웅진코웨이주식회사 로봇 청소기 제어 방법
JP5350899B2 (ja) * 2009-06-11 2013-11-27 株式会社マキタ 集塵機
CN102880175B (zh) * 2011-07-16 2016-02-17 苏州宝时得电动工具有限公司 自动行走设备
CN103622640B (zh) * 2012-08-24 2016-06-08 科沃斯机器人有限公司 移动装置、智能机器人及检测障碍物和外轮运动状态方法
EP3104194B1 (en) * 2012-08-27 2019-02-06 Aktiebolaget Electrolux Robot positioning system
CN103487066B (zh) * 2013-10-12 2016-05-25 惠州Tcl移动通信有限公司 一种智能设备及其安全行驶方法
US9480380B2 (en) * 2013-12-04 2016-11-01 Samsung Electronics Co., Ltd. Cleaning robot and control method thereof
KR102072387B1 (ko) * 2014-03-20 2020-02-03 삼성전자주식회사 로봇 청소기 및 로봇 청소기의 제어방법
CN104000541B (zh) * 2014-06-16 2016-05-04 成都北斗群星智能科技有限公司 支持门槛检测的扫地机器人及门槛检测方法
CN104188600A (zh) * 2014-09-16 2014-12-10 湖南格兰博智能科技有限责任公司 一种应用于自动地面清洁机装置的碰撞检测的方法及装置
CN204965182U (zh) * 2015-04-15 2016-01-13 小米科技有限责任公司 一种行走装置
CN204844187U (zh) * 2015-08-19 2015-12-09 深圳市云鼠科技开发有限公司 一种清扫机器人
CN105411468A (zh) * 2015-12-10 2016-03-23 王宏强 智能攀爬清洁机器人

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0630807U (ja) * 1992-09-22 1994-04-22 株式会社明電舎 無人搬送車の制御装置
JPH10105240A (ja) * 1996-09-27 1998-04-24 Fujitsu General Ltd 無人走行車の制御方法
JP2004303134A (ja) * 2003-04-01 2004-10-28 Matsushita Electric Ind Co Ltd 走行装置
JP2007168602A (ja) * 2005-12-21 2007-07-05 Matsushita Electric Works Ltd 二輪移動台車
JP2010094802A (ja) * 2008-09-22 2010-04-30 Nihon Univ 車輪型ロボット
JP3163179U (ja) * 2010-03-30 2010-09-30 燕 成▲祥▼ 自動掃除機の検知エスケープ装置
JP2013230201A (ja) * 2012-04-27 2013-11-14 Sharp Corp 自走式電子機器
WO2015090405A1 (en) * 2013-12-19 2015-06-25 Aktiebolaget Electrolux Sensing climb of obstacle of a robotic cleaning device
JP2016049127A (ja) * 2014-08-28 2016-04-11 株式会社東芝 電気掃除機

Also Published As

Publication number Publication date
KR20180132827A (ko) 2018-12-12
EP4085810A2 (en) 2022-11-09
EP3466314A4 (en) 2019-06-19
EA035938B1 (ru) 2020-09-03
US11076737B2 (en) 2021-08-03
AU2017276408B2 (en) 2020-05-21
EP4085810A3 (en) 2022-11-16
AU2020220188A1 (en) 2020-09-10
US11903540B2 (en) 2024-02-20
CN107456172B (zh) 2019-12-31
US20210321853A1 (en) 2021-10-21
AU2017276408A1 (en) 2019-01-31
KR102228459B1 (ko) 2021-03-18
WO2017211151A1 (zh) 2017-12-14
JP7123810B2 (ja) 2022-08-23
EP3466314A1 (en) 2019-04-10
KR20210031770A (ko) 2021-03-22
CN107456172A (zh) 2017-12-12
EA201990007A1 (ru) 2019-06-28
AU2020220188B2 (en) 2021-11-04
EP3466314B1 (en) 2022-08-03
US20190104908A1 (en) 2019-04-11

Similar Documents

Publication Publication Date Title
JP2019518277A (ja) 清掃ロボット及び障害物の乗越え方法
CN107092260B (zh) 移动机器人及该移动机器人跨越障碍物的方法
CN107456173B (zh) 障碍物跨越方法及装置
JP6656726B2 (ja) 自律式移動ロボット
US9844876B2 (en) Robot cleaner and control method thereof
JP4763359B2 (ja) 移動ロボットの物体位置認識装置及びその方法
KR101566207B1 (ko) 로봇 청소기 및 그 제어방법
CN109875470A (zh) 脱困方法、设备及存储介质
JP4962255B2 (ja) 自走式装置
JP2008023142A (ja) 自走式掃除機およびプログラム
JP2020058596A (ja) ロボット
JP4910972B2 (ja) 自走式装置およびプログラム
JP2005346477A (ja) 自律走行体

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20181220

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20181220

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200107

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200407

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201006

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20210601

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210922

C60 Trial request (containing other claim documents, opposition documents)

Free format text: JAPANESE INTERMEDIATE CODE: C60

Effective date: 20210922

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20210924

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20211210

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20220104

C21 Notice of transfer of a case for reconsideration by examiners before appeal proceedings

Free format text: JAPANESE INTERMEDIATE CODE: C21

Effective date: 20220105

A912 Re-examination (zenchi) completed and case transferred to appeal board

Free format text: JAPANESE INTERMEDIATE CODE: A912

Effective date: 20220128

C211 Notice of termination of reconsideration by examiners before appeal proceedings

Free format text: JAPANESE INTERMEDIATE CODE: C211

Effective date: 20220201

C22 Notice of designation (change) of administrative judge

Free format text: JAPANESE INTERMEDIATE CODE: C22

Effective date: 20220510

C302 Record of communication

Free format text: JAPANESE INTERMEDIATE CODE: C302

Effective date: 20220525

C13 Notice of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: C13

Effective date: 20220531

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220601

C23 Notice of termination of proceedings

Free format text: JAPANESE INTERMEDIATE CODE: C23

Effective date: 20220614

C03 Trial/appeal decision taken

Free format text: JAPANESE INTERMEDIATE CODE: C03

Effective date: 20220712

C30A Notification sent

Free format text: JAPANESE INTERMEDIATE CODE: C3012

Effective date: 20220712

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220810

R150 Certificate of patent or registration of utility model

Ref document number: 7123810

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150