JP2019507448A - 大量のロボットに対する緊急停止制御方法及び装置 - Google Patents

大量のロボットに対する緊急停止制御方法及び装置 Download PDF

Info

Publication number
JP2019507448A
JP2019507448A JP2018553290A JP2018553290A JP2019507448A JP 2019507448 A JP2019507448 A JP 2019507448A JP 2018553290 A JP2018553290 A JP 2018553290A JP 2018553290 A JP2018553290 A JP 2018553290A JP 2019507448 A JP2019507448 A JP 2019507448A
Authority
JP
Japan
Prior art keywords
robot
emergency stop
robots
current
stop position
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
JP2018553290A
Other languages
English (en)
Other versions
JP6756849B2 (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.)
Zhejiang Libiao Robots Co Ltd
Original Assignee
Zhejiang Libiao Robots 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 Zhejiang Libiao Robots Co Ltd filed Critical Zhejiang Libiao Robots Co Ltd
Publication of JP2019507448A publication Critical patent/JP2019507448A/ja
Application granted granted Critical
Publication of JP6756849B2 publication Critical patent/JP6756849B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
    • B25J9/162—Mobile manipulator, movable base with manipulator arm mounted on it
    • 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
    • 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
    • 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
    • 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/0084—Programme-controlled manipulators comprising a plurality of manipulators
    • 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/1602—Programme controls characterised by the control system, structure, architecture
    • 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/1628—Programme controls characterised by the control loop
    • B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
    • 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
    • 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/1679—Programme controls characterised by the tasks executed
    • B25J9/1682—Dual arm manipulator; Coordination of several manipulators
    • 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
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
    • G05B19/4189—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the transport system
    • G05B19/41895—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the transport system using automatic guided vehicles [AGV]
    • 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
    • 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/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
    • G05D1/0291—Fleet control
    • 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/31—From computer integrated manufacturing till monitoring
    • G05B2219/31003—Supervise route, reserve route and allocate route to vehicle, avoid collision
    • 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/31—From computer integrated manufacturing till monitoring
    • G05B2219/31006—Monitoring of vehicle
    • 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/49—Nc machine tool, till multiple
    • G05B2219/49298—Probe identification
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/60—Electric or hybrid propulsion means for production processes

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Health & Medical Sciences (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Health & Medical Sciences (AREA)
  • General Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Quality & Reliability (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

【課題】大量のロボットに対する緊急停止制御方法及び装置を提供する。【解決手段】当該方法は、ロボットの作業現場内に複数の位置ポイント及び位置ポイントに対応される位置マークを配置し、ロボットの底部に対応される認識器を設置するステップと、ロボットから報告される故障信号がモニタリングされると、故障信号に基づいて現場内のすべてのロボットが緊急停止されるように制御する必要があるか否かを判断するステップと、制御する必要がある場合、各々のロボットの現在位置及び移動速度に基づいて各々のロボットに対してそれぞれの緊急停止位置として現場内の位置ポイントをそれぞれ配分するステップと、対応される緊急停止位置へ移動されるように各々のロボットを制御して、各々のロボットが対応される緊急停止位置まで移動されると、移動が停止されるように各々のロボットを制御するステップとを含む。【選択図】図１

Description

本発明は、ロボット制御分野に関し、特に、大量のロボットに対する緊急停止制御方法及び装置に関する。
物事のインターネットの急速な発展に伴い、より多くの自動化ロボットが物流・配送の分野に参加されている。自動化ロボットは、人力の代わりに、物品の運送、運搬、分類、保管、梱包等の作業を実行できて、自動化ロボットを使用して物流業界のサービスレベルを大幅に向上させることができる。物流業界のロボットは、既に、自動車業界に続いて２番目に大きいロボット応用分野となっている。
従来技術では、物流・配送センターでロボットを利用して物品運送、分類及び梱包を実行する場合、一般的には、現場内に大量のロボットを設置し、各々のロボットに対して固定された移動経路を設定して、ロボットがそれぞれの移動経路に沿って移動するように制御することで、すべてのロボットが現場内で秩序のある作業を行うように確保する。作業過程中に、一部のロボットに移動故障が発生すると、例えば、移動経路が予定経路から外れるか、或いは移動機構に故障が発生すると、その故障ロボットはその他のロボットと衝突することになり、このようになると、現場内の大量のロボットの相互の衝突を誘発するおそれがある。
しかしながら、従来技術では、一部のロボットに故障が発生することによって誘発される大量のロボット同士が互いに衝突する問題に対しては、よりよい解決方案が言及されなかった。
本発明は、上記問題点に鑑みて、大量のロボットに対する緊急停止制御方法及び装置を提供し、当該方法及び装置によると、現場内の一部のロボットに故障が発生した場合、現場内のすべてのロボットが緊急停止されるように制御できて、故障ロボットがその他のロボットと衝突することを回避でき、現場内で大量のロボット同士の相互の衝突を誘発することを回避できる。
第１の態様によると、本発明の実施例は、大量のロボットに対する緊急停止制御方法を提供し、前記方法は、
ロボットの作業現場内に複数の位置ポイントを設置し、複数の前記位置ポイントに対してそれぞれ位置マークを配置し、前記ロボットの底部に前記位置マークを認識するための認識器を設置するステップと、
現場内の各々のロボットの作業状況をモニタリングして、前記ロボットから報告される故障信号がモニタリングされると、前記故障信号に基づいて現場内のすべての前記ロボットが緊急停止されるように制御する必要があるか否かを判断するステップと、
制御する必要がある場合、前記各々のロボットの現在位置及び移動速度を検出して、各々の前記ロボットの現在位置及び移動速度に基づいて各々の前記ロボットに対してそれぞれの緊急停止位置として前記現場内の前記位置ポイントをそれぞれ配分するステップと、
対応される前記緊急停止位置へ移動されるように各々の前記ロボットを制御して、各々の前記ロボットが対応される前記緊急停止位置まで移動されると、移動が停止されるように各々の前記ロボットを制御するステップとを含む。
第１の態様に結合して、本発明の実施例は、第１の態様の第１の実施可能な実施態様を提供し、その中、前記故障信号に基づいて現場内のすべての前記ロボットが緊急停止されるように制御する必要があるか否かを判断する前記ステップは、
所定の故障処理リスト内で前記故障信号に対応される処理方法を検索するステップと、
検索された前記処理方法が現場全体に対する緊急停止処理であると、現場内のすべての前記ロボットが緊急停止されるように制御する必要がある場合を特定するステップとを含む。
第１の態様に結合して、本発明の実施例は、第１の態様の第２の実施可能な実施態様を提供し、その中、各々の前記ロボットの現在位置及び移動速度に基づいて各々の前記ロボットに対してそれぞれの前記緊急停止位置として前記現場内の前記位置ポイントをそれぞれ配分する前記ステップは、
現在の前記ロボットの現在位置を円心として、所定の半径に従って現在の前記ロボットの第１の緊急停止範囲を特定するステップと、
前記第１の緊急停止範囲内に余裕の前記位置ポイントが存在するか否かを検索するステップと、
余裕の前記位置ポイントが存在する場合、現在の前記ロボットの移動速度に基づいて現在の前記ロボットが余裕の前記位置ポイントまで移動するのにかかる時間を分析して、時間が一番短い余裕の前記位置ポイントを選択して現在の前記ロボットの前記緊急停止位置に設定し、余裕の前記位置ポイントが存在しない場合、設定サイズに従って前記第１の緊急停止範囲を拡大して、拡大後の前記第１の緊急停止範囲内で、現在の前記ロボットの前記緊急停止位置が特定されるまで、前記検索及び前記分析の動作を繰り返すステップとを含む。
第１の態様に結合して、本発明の実施例は、第１の態様の第３の実施可能な実施態様を提供し、その中、対応される前記緊急停止位置へ移動されるように各々の前記ロボットを制御する前記ステップは、
対応される前記緊急停止位置に対する現在の前記ロボットの移動方向及び移動距離を算出するステップと、
前記移動方向に基づいて現在の前記ロボットの方向調整角度を特定して、前記方向調整角度及び前記移動距離に従って対応される前記緊急停止位置まで移動するように前記ロボットを制御するステップとを含む。
第１の態様、第１の態様の第１乃至第３の実施可能な実施態様の中のいずれか一実施態様に結合して、本発明の実施例は、第１の態様の第４の実施可能な実施態様を提供し、その中、前記方法は、各々の前記ロボットの移動が停止されるように制御する前記ステップの前に、さらに
現在の前記ロボットが対応される前記緊急停止位置まで移動した後に返送した位置情報を受信するステップと、
前記位置情報に基づいて現在の前記ロボットと対応される前記緊急停止位置の前記位置マークとの間の距離を算出するステップと、
前記距離に基づいて、現在の前記ロボットの底部の認識器が対応される前記緊急停止位置の前記位置マークと一致されるまでに、現在の前記ロボットの位置を調整するステップとを含む。
第２態様によると、本発明の実施例は、大量のロボットに対する緊急停止制御装置を提供し、前記装置は、
ロボットの作業現場内に複数の位置ポイントを設置し、複数の前記位置ポイントに対してそれぞれ位置マークを配置し、前記ロボットの底部に前記位置マークを認識するための認識器を設置するための配置モジュールと、
現場内の各々の前記ロボットの作業状況をモニタリングして、前記ロボットから報告される故障信号がモニタリングされると、前記故障信号に基づいて現場内のすべての前記ロボットが緊急停止されるように制御する必要があるか否かを判断するための判断モジュールと、
制御する必要がある、各々の前記ロボットの現在位置及び移動速度を検出して、各々の前記ロボットの現在位置及び移動速度に基づいて各々の前記ロボットに対してそれぞれの緊急停止位置として前記現場内の前記位置ポイントをそれぞれ配分する配分モジュールと、
対応される前記緊急停止位置へ移動されるように各々の前記ロボットを制御して、各々の前記ロボットが対応される前記緊急停止位置まで移動されると、移動が停止されるように各々の前記ロボットを制御するための制御モジュールとを備える。
第２態様に結合して、本発明の実施例は、第２態様の第１の実施可能な実施態様を提供し、その中、前記判断モジュールは、
所定の故障処理リスト内で前記故障信号に対応される処理方法を検索するための検索ユニットと、
検索された前記処理方法が現場全体に対する緊急停止処理である場合、現場内のすべての前記ロボットが緊急停止されるように制御する必要があると特定するための特定ユニットとを備える。
第２態様に結合して、本発明の実施例は、第２態様の第２の実施可能な実施態様を提供し、その中、前記配分モジュールは、
現在の前記ロボットの現在位置を円心として、所定の半径に従って現在の前記ロボットの第１の緊急停止範囲を特定するための範囲特定ユニットと、
前記第１の緊急停止範囲内に余裕の前記位置ポイントが存在するか否かを検索するための検索ユニットと、
余裕の前記位置ポイントが存在する場合、現在の前記ロボットの移動速度に基づいて現在の前記ロボットが余裕の前記位置ポイントまで移動するのにかかる時間を分析して、時間が一番短い余裕の前記位置ポイントを選択して現在の前記ロボットの前記緊急停止位置に設定し、余裕の前記位置ポイントが存在しない場合、設定サイズに従って前記第１の緊急停止範囲を拡大して、拡大後の前記第１の緊急停止範囲内で、現在の前記ロボットの前記緊急停止位置が特定されるまで、前記検索及び前記分析の動作を繰り返すための選択ユニットとを備える。
第２態様に結合して、本発明の実施例は、第２態様の第３の実施可能な実施態様を提供し、その中、前記制御モジュールは、
対応される前記緊急停止位置に対する現在の前記ロボットの移動方向及び移動距離を算出するための算出ユニットと、
前記移動方向に基づいて現在の前記ロボットの方向調整角度を特定して、前記ロボットが前記方向調整角度及び前記移動距離に従って対応される前記緊急停止位置まで移動するように制御するための移動制御ユニットとを備える。
第２の態様、第２の態様の第１乃至第３の実施可能な実施態様の中のいずれか一実施態様に結合して、本発明の実施例は、第２態様の第４の実施可能な実施態様を提供し、その中、前記装置は、
現在の前記ロボットが対応される前記緊急停止位置まで移動した後に返送した位置情報を受信するための受信モジュールと、
前記位置情報に基づいて現在の前記ロボットと対応される前記緊急停止位置の前記位置マークとの間の距離を算出するための距離算出モジュールと、
前記距離に基づいて、現在の前記ロボットの底部の認識器が対応される前記緊急停止位置の前記位置マークと一致されるまで、現在の前記ロボットの位置を調整するための位置調整モジュールとをさらに備える。
本発明の実施例においては、まず、現場内に位置ポイントを設置した後、ロボットの故障状況に基づいて現場全体に対して緊急停止する必要があるか否かを判断して、現場全体に対して緊急停止する必要がある場合、ロボットの緊急停止位置としてロボットに対して現場内の位置ポイントを配分して、最後にロボットがそれぞれの緊急停止位置まで移動するように制御する。本実施例中の方法によると、現場内の一部のロボットに故障が発生した場合、現場内のすべてのロボットが緊急停止されるように制御できて、故障ロボットがその他のロボットと衝突することを回避でき、現場内で大量のロボット同士の間の相互の衝突を誘発することを回避できる。
以下、本発明の実施例の技術案をより明確に説明するために、実施例で使用される図面に対して簡単に紹介し、以下の図面は、ただ、本発明の一部の実施例を示すためのものであり、範囲に対する限定であると見なしてはならず、本分野の一般の技術者にとっては、創造的な労働を払わない前提の下で、これら図面に基づいてその他の関連する図面をさらに得ることができることを理解すべきである。
本発明の第１の実施例によって提供される大量のロボットに対する緊急停止制御方法の第１の流れ概略図である。 本発明の第１の実施例によって提供される大量のロボットに対する緊急停止制御方法の第２の流れ概略図である。 本発明の第２実施例によって提供される大量のロボットに対する緊急停止制御装置の第１の構成概略図である。 本発明の第２実施例によって提供される大量のロボットに対する緊急停止制御装置の第２の構成概略図である。
以下、本発明の実施例の目的、技術案及び利点をもっと明確にするために、本発明の実施例中の図面に結合して、本発明の実施例中の技術案を明確的且つ完全に説明するが、当然ながら、説明する実施例はただ本発明の一部の実施例であり、全部の実施例ではない。一般的に、当該図面で説明及び示す本発明の実施例のアセンブリは、互いに異なる多様な配置に従って手配及び設計してもよい。それで、以下、図面で提供する本発明の実施例の詳細説明は、保護しようとする本発明の範囲を制限するためでなく、ただ、本発明の選択された実施例を表す。本分野の技術者により、本発明の実施例を基に、創造的な労働を払わないことを前提にして得られるすべてのその他の実施例は、すべて本発明の保護範囲に属する。
本発明は、従来技術で一部のロボットに故障が発生することによって誘発される大量のロボット同士が互いに衝突する問題に対してよりよい解決方案がないという問題に鑑みて、大量のロボットに対する緊急停止制御方法及び装置を提供し、現場内の一部のロボットに故障が発生した場合、現場内のすべてのロボットが緊急停止されるように制御できて、故障ロボットがその他のロボットと衝突することを回避でき、現場内で大量のロボット同士の間の相互の衝突を誘発することを回避できる。以下、実施例に結合して具体的に説明する。
＜実施例１＞
図１に示したように、本発明の第１の実施例は、大量のロボットに対する緊急停止制御方法を提供し、当該方法は、少なくとも、ステップ１０２、ステップ１０４、ステップ１０６及びステップ１０８を含む。
ステップ１０２において、ロボットの作業現場内に複数の位置ポイントを設置し、複数の位置ポイントに対してそれぞれ位置マークを配置し、ロボットの底部に当該位置マークを認識するための認識器を設置する。
ステップ１０４において、現場内の各々のロボットの作業状況をモニタリングして、ロボットから報告される故障信号がモニタリングされると、当該故障信号に基づいて現場内のすべてのロボットが緊急停止されるように制御する必要があるか否かを判断する。
ステップ１０６において、制御する必要がある場合、各々のロボットの現在位置及び移動速度を検出して、各々のロボットの現在位置及び移動速度に基づいて各々のロボットに対してそれぞれの緊急停止位置として現場内の位置ポイントをそれぞれ配分する。
ステップ１０８において、対応される緊急停止位置へ移動されるように各々のロボットを制御して、各々のロボットが対応される緊急停止位置まで移動されると、移動が停止されるように各々のロボットを制御する。
本発明の実施例においては、まず、現場内に位置ポイントを設置した後、ロボットの故障状況に基づいて現場全体に対して緊急停止する必要があるか否かを判断して、現場全体に対して緊急停止する必要がある場合、ロボットの緊急停止位置としてロボットに対して現場内の位置ポイントを配分して、最後にロボットがそれぞれの緊急停止位置まで移動するように制御する。本実施例中の方法によると、現場内の一部のロボットに故障が発生した場合、現場内のすべてのロボットが緊急停止されるように制御できて、故障ロボットがその他のロボットと衝突することを回避でき、現場内で大量のロボット同士の間の相互の衝突を誘発することを回避できる。
ステップ１０２の具体的な一実施態様は、ロボットが作業する現場をリスト形式に従って面積が同じである複数の格子に分割し、各々の格子を一つの位置ポイントとして設定してもよい。各々の格子の中心に、位置マークである光学マークコードを設置し、ここで、当該光学マークコードは、二次元コードであってもよい。ロボットの底部に光学マークコードを認識するための光学認識器を設置し、ここで、当該光学認識器は、カメラであってもよい。
ステップ１０４において、ロボットの作業を制御するサーバは、現場内のロボットの作業状況をモニタリングできて、ロボットから報告される故障信号がモニタリングされると、故障信号に基づいて現場内のすべてのロボットが緊急停止されるように制御する必要があるか否かを判断する。その中、故障信号に基づいて現場内のすべてのロボットが緊急停止されるように制御する必要があるか否かを判断するステップは、以下の(１)及び(２)のステップを含み、ここで、ステップ(１)は、所定の故障処理リスト内で故障信号に対応される処理方法を検索し、ステップ(２)は、検索された処理方法が現場全体に対する緊急停止処理である場合、現場内のすべてのロボットが緊急停止されるように制御する必要があると特定する。具体的に、サーバ内部に故障処理リストが予め保存されており、当該故障処理リストは、互いに異なる故障信号に対応される互いに異なる処理方法を表す。サーバは、ロボットから報告される故障信号を受信した後、受信した故障信号に基づいて故障処理リスト中で対応される処理方法を検索し得て、検索された処理方法が現場全体に対する緊急停止処理である場合、現場内のすべてのロボットが緊急停止されるように制御する必要があると特定する。本実施例においては、サーバ内部に故障処理リストが設置されており、サーバはテーブル索引の方法によって現場内のすべてのロボットが緊急停止されるように制御する必要があるか否かを判断することで、操作効率が高く、演算が簡単で、実現がし易い利点がある。
ステップ１０６において、サーバは、ステップ１０４によって現場内のすべてのロボットが緊急停止されるように制御する必要があると判断すると、現場内の各々のロボットの現在位置及び移動速度を検出して、各々のロボットの現在位置及び移動速度に基づいて各々のロボットに対してそれぞれ現場内の位置ポイントを配分することで、それぞれの緊急停止位置に設定する。その中、各々のロボットの現在位置及び移動速度に基づいて各々のロボットに対してそれぞれ現場内の位置ポイントを配分することで、それぞれの緊急停止位置に設定するステップは、以下のステップ(１)、(２)及び(３)を含み、ここで、ステップ(１)は、現在のロボットの現在位置を円心として、所定の半径に従って現在のロボットの第１の緊急停止範囲を特定し、ステップ(２)は、第１の緊急停止範囲内に余裕の位置ポイントが存在するか否かを検索し、ステップ(３)は、余裕の位置ポイントが存在する場合、現在のロボットの移動速度に基づいて、現在のロボットが余裕の位置ポイントまで移動するのにかかる時間を分析して、時間が一番短い余裕の位置ポイントを選択して現在のロボットの緊急停止位置に設定し、余裕の位置ポイントが存在しない場合、設定サイズに従って第１の緊急停止範囲を拡大して、拡大後の第１の緊急停止範囲内で、現在のロボットの緊急停止位置が特定されるまで、上記の検索及び分析の動作を繰り返す。
具体的に、ステップ(１)で、サーバは、まず、現在のロボットの現在位置を円心として、１００ｃｍのような所定の半径に従って、現在のロボットの第１の緊急停止範囲を特定する。ステップ(２)で、サーバは、上記の特定の第１の緊急停止範囲内で、その他のロボットに配分されなかった余裕の位置ポイントが存在するか否かを検索する。ステップ(３)で、サーバは、余裕の位置ポイントが存在し、且つ余裕の位置ポイントが複数であると検索される場合、サーバは現在のロボットの移動速度に基づいて現在のロボットが各々の余裕の位置ポイントまで移動するのに所要される時間を算出して、所要時間が一番短い余裕の位置ポイントを選択して現在のロボットの緊急停止位置に設定する。当然ながら、第１の緊急停止範囲内で一つの余裕の位置ポイントのみ検索されると、当該余裕の位置ポイントを現在のロボットの緊急停止位置に設定する。ステップ(３)で、サーバは、余裕の位置ポイントが検索されないと、５０ｃｍのような設定サイズに従って、第１の緊急停止範囲の半径を１００ｃｍから１５０ｃｍまで拡大して、拡大後の第１の緊急停止範囲内で、現在のロボットの緊急停止位置が特定されるまで、上記の検索及び分析の動作を繰り返す。
サーバは、現場内の各々のロボットに対して、いずれも、上記のステップ(１)、(２)及び(３)を実行することで、各々のロボットに対してそれぞれの緊急停止位置を配分する。本実施例において、領域範囲の検索及び特定の方法に従って、各々のロボットに対してそれぞれの緊急停止位置を配分することで、作業効率が高く、配分速度が速い利点があり、短い時間内で現場内の各々のロボットに対していずれも適当な緊急停止位置を配分することにより、ロボットの緊急停止が便利になる。
ステップ１０８において、各々のロボットが対応される緊急停止位置へ移動されるように制御するステップは、対応される緊急停止位置に対する現在のロボットの移動方向及び移動距離を算出するステップと、移動方向に基づいて現在のロボットの方向調整角度を特定して、ロボットが方向調整角度及び移動距離に従って、対応される緊急停止位置まで移動するように制御するステップとを含む。具体的に、サーバは、まず、現在のロボットの現在位置に基づいて、対応される緊急停止位置に対する現在のロボットの移動方向及び移動距離を算出した後、当該移動方向に基づいて現在のロボットの方向調整角度を算出し、最後に、現在のロボットの方向調整角度及び現在のロボットの移動距離に基づいて、ロボットが対応される緊急停止位置まで移動するように制御する。本実施例においては、サーバは同じ方法を採用して、各々のロボットがそれぞれの対応される緊急停止位置まで移動するように制御する。本実施例中のロボット移動を制御する方法は、制御原理が簡単で、実現がし易い利点がある。本実施例においては、ロボットにより対応される緊急停止位置に移動する際に、ロボットの減速移動を制御できて、ロボットの移動の安全性を確保できる。
故障が発生したロボットが移動できなくなる状況を考えて、ステップ１０８において、各々のロボットが対応される緊急停止位置へ移動されるように制御するステップは、各々のロボットが故障ロボットの対応される故障領域を迂回して、それぞれの緊急停止位置まで移動するように制御する。具体的に、故障ロボットが現在移動できないか或いは移動が制御できない場合、各々のロボットが故障ロボットの対応される故障領域を迂回して、それぞれの緊急停止位置へ移動するように制御することで、故障ロボットとの衝突の発生を回避した。
ステップ１０８において、各々のロボットが対応される緊急停止位置まで移動されると、各々のロボットの移動が停止されるように制御する。また、各々のロボットの移動が停止されるように制御する前に、本実施例の方法はさらに、ステップ(１)、(２)及び(３)を含み、ここで、ステップ(１)は、現在のロボットが対応される緊急停止位置まで移動した後に返送した位置情報を受信し、ステップ(２)は、当該位置情報に基づいて、現在のロボットと対応される緊急停止位置の位置マークとの間の距離を算出し、ステップ(３)は、当該距離に基づいて、現在のロボットの底部の認識器が対応される緊急停止位置の位置マークと一致されるまで、現在のロボットの位置を調整する。具体的に、ステップ(１)で、現在のロボットは、対応される緊急停止位置まで移動した後に、サーバへ位置情報を返送し、サーバは当該位置情報を受信する。ステップ(２)で、サーバは、符号化の方法によって、各々のロボットを符号化し、また、対応的に、各々のロボットの緊急停止位置及び位置マークを符号化し、サーバには各々のロボットに対応される位置マークの位置情報が予め保存されている。サーバは、現在のロボットから返送される位置情報を受信すると、現在のロボットのコードに基づいて、現在のロボットに対応される位置マークの位置情報を検索できる。サーバは、受信された位置情報及び現在のロボットに対応される位置マークの位置情報に基づいて、現在のロボットと対応される位置マークとの間の距離を算出する。ステップ(３)で、サーバは、算出し得た距離に基づいて、ロボットに制御命令を送信して、ロボットが、現在のロボットの底部の認識器の中心が対応される位置マークの中心と一致されるまで、自身位置を調整するように制御する。本実施例においては、サーバは、上記のステップによって、ロボットの位置を微調整して、ロボットの認識器が対応される位置マークと正確に一致するようにすることで、ロボットが正確な位置上に滞在するように確保する。本実施例において、サーバは、各々のロボットに対して、いずれも、同一な微調整動作を実行することで、各々のロボットがいずれもそれぞれの緊急停止位置上に正確的に滞在するように確保する。
また、本実施例の方法は、さらに複数の位置ポイントに基づいて各々のロボットに対して移動経路を計画するステップと、現場内のすべてのロボットが緊急停止されるように制御する必要がある場合、現在のロボットの移動経路上においての現在のロボットから一番近い位置ポイントを、現在のロボットの緊急停止位置に設定するステップと、現在のロボットが当該緊急停止位置まで移動するように制御するステップとを含む。具体的に、ロボットの作業現場内に複数の位置ポイントが設置されているため、本実施例において、各々のロボットに対して、さらに、各々の位置ポイントが繋がってなる移動経路を計画できる。現在のロボットが移動経路上で移動する際に、直ちに緊急停止する必要がある場合、現在のロボットの移動経路上においての現在のロボットから一番近い位置ポイントを、現在のロボットの緊急停止位置に設定して、現在のロボットが当該緊急停止位置まで移動するように制御する。本実施例中では、移動経路によって緊急停止位置を特定することで、緊急停止方法が簡単に実現できて、実用性が高く、ロボットの再始動がし易い。
本発明の実施例は、上記の大量のロボットに対する緊急停止制御方法によって、さらに図２に示した大量のロボットに対するもう一つの緊急停止制御方法を提供し、ここで、当該方法は、ステップ２０１〜ステップ２０８を含む。
ステップ２０１において、サーバは、ロボットの作業状況をモニタリングする。
ステップ２０２において、サーバは、ロボットから返送される故障信号を受信する。
ステップ２０３において、サーバは、故障信号に基づいてすべてのロボットが緊急停止されるように制御する必要があるか否かを判断し、必要がある場合ステップ２０４を実行し、必要がない場合ステップ２０１に戻る。
ステップ２０４において、サーバは、現場内のすべてのロボットに対して対応される緊急停止位置を配分する。
ステップ２０５において、サーバは、各々のロボットの緊急停止位置に基づいて、各々のロボットに移動制御命令を送信して、各々のロボットがそれぞれの緊急停止位置へ移動されるように制御する。
ステップ２０６において、ロボットが緊急停止位置まで移動すると、サーバにより、各々のロボットの現在位置を受信する。
ステップ２０７において、各々のロボットの現在位置に基づいて、各々のロボットと対応される緊急停止位置の位置マークとの間の距離を算出する。
ステップ２０８において、サーバは、ステップ２０７で算出し得た距離に基づいて、各々のロボットの位置を微調整することで、各々のロボットの認識器の中心が対応される位置マークの中心と一致するようにする。
実際の操作において、ロボットも、底部の認識器を利用して位置ポイントの位置マークを自動的に認識して、ロボットが位置ポイントの付近まで移動した時に、認識器の中心を、位置マークの中心と一致するように自動的に調整して、サーバの操作を簡単にし、ロボットの自動化程度を高めることができる。
上記のように、本実施例によって提供される大量のロボットに対する緊急停止制御方法によると、現場内の一部のロボットに故障が発生した場合、現場内のすべてのロボットが直ちに緊急停止されるように制御できて、故障ロボットがその他のロボットと衝突することを回避でき、現場内で大量のロボット同士の間の相互の衝突を誘発することを回避できる。
本分野の技術者は、サーバを利用してロボットを制御して作業を開始する際に、ロボットはそれぞれの所定の位置に位置しているべきであり、もし、ロボットが作業現場内の任意の位置にランダムに位置していると、直ちに作業状態に進入できないことを理解すべきである。それで、実際に応用する時に、現場内の一部のロボットに故障が発生した場合、もし、現場内のすべてのロボットが現在位置で直ちに停止するようにすると、ロボットの後続の始動に不利になる。本実施例中の方法によると、現場内の一部のロボットに故障が発生した場合、すべてのロボットがそれぞれの緊急停止位置(それぞれの所定の位置に相当する)に停止されるように制御し、このような処理方法によると、ロボットの再始動が便利になり、次の作業ですべてのロボットを直ちに作業状態に進入させることが便利になる。
＜実施例２＞
本発明の実施例は、上記の実施例１に対応して、さらに実施例２を提供し、大量のロボットに対する緊急停止制御装置は、上記の方法を実行する。図３に示したように、大量のロボットに対する緊急停止制御装置は、
ロボットの作業現場内に複数の位置ポイントを設置し、複数の位置ポイントに対してそれぞれ位置マークを配置し、ロボットの底部に位置マークを認識するための認識器を設置するための配置モジュール３１と、
現場内の各々のロボットの作業状況をモニタリングして、ロボットから報告される故障信号がモニタリングされると、故障信号に基づいて現場内のすべてのロボットが緊急停止されるように制御する必要があるか否かを判断するための判断モジュール３２と、
制御する必要がある場合、各々のロボットの現在位置及び移動速度を検出して、各々のロボットの現在位置及び移動速度に基づいて各々のロボットに対してそれぞれの緊急停止位置として現場内の位置ポイントをそれぞれ配分するための配分モジュール３３と、
対応される緊急停止位置へ移動されるように各々のロボットを制御して、各々のロボットが対応される緊急停止位置まで移動されると、移動が停止されるように各々のロボットを制御するための制御モジュール３４とを備える。
本発明の実施例においては、まず、現場内に位置ポイントを設置した後、ロボットの故障状況に基づいて現場全体に対して緊急停止する必要があるか否かを判断して、現場全体に対して緊急停止する必要がある場合、ロボットに対して現場内の位置ポイントを配分してロボットの緊急停止位置を設定し、最後にロボットがそれぞれの緊急停止位置まで移動するように制御する。本実施例の装置によると、現場内の一部のロボットに故障が発生した場合、現場内のすべてのロボットが緊急停止されるように制御できて、故障ロボットがその他のロボットと衝突することを回避でき、現場内で大量のロボット同士の間の相互の衝突を誘発することを回避できる。
本実施例において、判断モジュール３２は、所定の故障処理リスト内で故障信号に対応される処理方法を検索するための検索ユニットと、検索された処理方法が現場全体に対する緊急停止処理である場合、現場内のすべてのロボットが緊急停止されるように制御する必要があると特定するための特定ユニットとを備える。本実施例において、サーバ内部に故障処理リストが設置されており、サーバはテーブル索引の方法によって、現場内のすべてのロボットが緊急停止されるように制御する必要があるか否かを判断することで、操作効率が高いし、演算が簡単し、実現が易い利点がある。
本実施例において、配分モジュール３３は、現在のロボットの現在位置を円心にして、所定の半径に従って現在のロボットの第１の緊急停止範囲を特定するための範囲特定ユニットと、第１の緊急停止範囲内に余裕の位置ポイントが存在するか否かを検索するための検索ユニットと、余裕の位置ポイントが存在する場合、現在のロボットの移動速度に基づいて、現在のロボットが余裕の位置ポイントまで移動するのにかかる時間を分析して、時間が一番短い余裕の位置ポイントを選択して現在のロボットの緊急停止位置に設定し、余裕の位置ポイントが存在しない場合、設定サイズに従って第１の緊急停止範囲を拡大して、拡大後の第１の緊急停止範囲内で、現在のロボットの緊急停止位置が特定されるまで、検索及び分析の動作を繰り返すための選択ユニットとを備える。本実施例において、領域範囲の検索及び特定の方法に従って、各々のロボットに対してそれぞれの緊急停止位置を配分することで、作業効率が高く、配分速度が速い利点があり、短い時間内で現場内の各々のロボットに対していずれも適当な緊急停止位置を配分することにより、ロボットの緊急停止が便利になる。
本実施例において、制御モジュール３４は、対応される緊急停止位置に対する現在のロボットの移動方向及び移動距離を算出するための算出ユニットと、移動方向に基づいて現在のロボットの方向調整角度を特定して、ロボットが方向調整角度及び移動距離に従って、対応される緊急停止位置まで移動するように制御するための移動制御ユニットとを備える。本実施例中の制御モジュール３４は、制御原理が簡単で、実現がし易い利点がある。本実施例においては、ロボットにより対応される緊急停止位置に移動する際に、ロボットの減速移動を制御できて、ロボットの移動の安全性を確保できる。
図４に示したように、本実施例の装置は、さらに現在のロボットが対応される緊急停止位置まで移動した後に返送した位置情報を受信するための受信モジュール４１と、位置情報に基づいて現在のロボットと対応される緊急停止位置の位置マークとの間の距離を算出するための距離算出モジュール４２と、上記の距離に基づいて、現在のロボットの底部の認識器が対応される緊急停止位置の位置マークと一致されるまで、現在のロボットの位置を調整するための位置調整モジュール４３とを備える。本実施例において、受信モジュール４１、距離算出モジュール４２及び位置調整モジュール４３を利用して、ロボットの位置を微調整して、ロボットの認識器が対応される位置マークと正確に一致されるようにすることで、ロボットが正確な位置上に滞在するように確保する。
上記のように、本実施例によって提供される大量のロボットに対する緊急停止制御方法及び装置によると、現場内の一部のロボットに故障が発生した場合、現場内のすべてのロボットが直ちに緊急停止されるように制御できて、故障ロボットがその他のロボットと衝突することを回避でき、現場内で大量のロボット同士の間の相互の衝突を誘発することを回避できる。
本発明の実施例によって提供される大量のロボットに対する緊急停止制御装置は、デバイス上の特定ハードウェア、或いは、デバイスにインストールされたソフトウェア或いはファームウェア等であってもよい。本発明の実施例によって提供される装置は、その実現原理及び達成する技術效果は、前記の方法実施例と同一であり、簡単に説明するために、装置実施例で一部の言及されなかった部分は、前記の方法実施例中の該当する内容を参考してもよい。本分野に属する技術者は、説明の便利と簡単のために、前記に説明したシステム、装置及びユニットの具体的な作業過程は、いずれも上記の方法実施例中の対応される過程を参考できるため、ここでは繰り返して説明しないことを明確に理解すべきである。
本発明によって提供する実施例において、開示した装置及び方法は、その他の態様によって実現してもよいことを理解すべきである。以上に説明した装置実施例は、ただ、模式的であり、例えば、前記ユニットの分割は、ただ、ロジック機能の分割であり、実際に実現する際には他の分割方法を採用してもよいし、また例えば、複数のユニット或いはアセンブリを統合させるか、或いは、もう一つのシステムに組み合わせるか、或いは、一部の特徴を無視するか或いは実行しないでもよい。その一方、表示、或いは、議論した相互の間のカップリング、直接カップリング、或いは、通信接続は、いくつかの通信インターフェイスを介する連結されてもよいし、装置、或いは、ユニットの間接カップリング、或いは、通信接続は、電気的、機械的、或いは、その他の形式であってもよい。
前記の分離部品として説明したユニットは、物理的に分かれたものであってもよいし、物理的に分かれていないものであってもよく、ユニットとして表示した部品は、物理的なユニットであってもよいし、物理的なユニットでなくてもよく、即ち、一つの現場に位置するか、或いは、複数のネットワークユニット上に分布されてもよい。実際の必要によって、その中の一部、或いは、全部のユニットを選択して、本実施例の方案の目的を実現してもよい。
また、本発明によって提供する実施例の各々の機能ユニットは、一つの処理ユニット中に統合してもよいし、各々のユニットが単独に物理的に存在してもよいし、二つ、或いは、二つ以上のユニットが一つのユニット中に統合されてもよい。
もし、前記機能をソフトウェア機能ユニットの形式によって実現し、また、独立な製品として販売、或いは、使用する際には、一つのコンピュータ可読記憶媒体に格納されてもよい。本発明の技術案は、このような理解を基に、本質的に、或いは、従来技術に対して、貢献した一部、或いは、当該技術案の一部は、ソフトウェア製品の形式で体現されてもよいし、当該コンピュータソフトウェア製品は、一つの記憶媒介に保存され、一部の命令を含むことで、一つのコンピュータデバイス(パーソナルコンピュータ、サーバ、或いは、ネットワークデバイス等である)が本発明の各々の実施例に説明した方法の全部、或いは、一部のステップを実行するようにしてもよい。前述の記憶媒介は、Ｕディスク、モバイルハードディスク、読み出し専用メモリ(ＲＯＭ、Ｒｅａｄ−Ｏｎｌｙ Ｍｅｍｏｒｙ)、ランダムアクセスメモリ(ＲＡＭ、Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ)、磁気ディスク、或いは、光ディスク等のプログラムコードを記憶できる多様な媒介を含む。
類似の符号及び文字は、以下の図面で類似項を表すため、一つの項を一つの図面で一度定義されると、その後の図面では、その項に対してさらに定義及び解釈する必要がないことを注意すべきであり、なお、術語である「第１」、「第２」、「第３」等は、ただ、区別して説明するためのものであり、相対的な重要性を示すか、或いは、暗示するものであると理解してはいけない。
以上の前記実施例は、ただ、本発明の具体的な実施態様であり、本発明の技術案を説明するためのものであり、制限するものではないし、本発明の保護範囲は前記実施例に制限されないことを最後に説明すべきであり、また、前記の実施例を参照して、本発明に対して詳細に説明したが、本分野の技術者は、本技術分野を熟通するいかなる技術者により、本発明によって開示した技術範囲内で、前記の実施例に記載した技術案に対して、依然として、修正、或いは、変更を簡単に発想できるか、或いは、その中の一部の技術特徴に対して、等しい置き換えを実現できるが、これら修正、変更、或いは、置き換えは、その該当する技術案の本質が本発明の実施例の技術案の精神及び範囲から離脱するようにされないことを理解すべきである。これら修正、変更、或いは、置き換えは、いずれも、本発明の保護範囲内にカバーされる。それで、本発明の保護範囲は、前記の特許請求の保護範囲を基準とする。

Claims (10)

  1. ロボットの作業現場内に複数の位置ポイントを設置し、複数の前記位置ポイントに対してそれぞれ位置マークを配置し、前記ロボットの底部に前記位置マークを認識するための認識器を設置するステップと、
    現場内の各々の前記ロボットの作業状況をモニタリングして、前記ロボットから報告される故障信号がモニタリングされると、前記故障信号に基づいて現場内のすべての前記ロボットが緊急停止されるように制御する必要があるか否かを判断するステップと、
    制御する必要がある場合、各々の前記ロボットの現在位置及び移動速度を検出して、各々の前記ロボットの現在位置及び移動速度に基づいて各々の前記ロボットに対してそれぞれの緊急停止位置として前記現場内の前記位置ポイントをそれぞれ配分するステップと、
    対応される前記緊急停止位置へ移動されるように各々の前記ロボットを制御して、各々の前記ロボットが対応される前記緊急停止位置まで移動されると、移動が停止されるように各々の前記ロボットを制御するステップと
    を含むことを特徴とする大量のロボットに対する緊急停止制御方法。
  2. 前記故障信号に基づいて現場内のすべての前記ロボットが緊急停止されるように制御する必要があるか否かを判断する前記ステップは、
    所定の故障処理リスト内で前記故障信号に対応される処理方法を検索するステップと、
    検索された前記処理方法が現場全体に対する緊急停止処理であると、現場内のすべての前記ロボットが緊急停止されるように制御する必要がある場合を特定するステップと
    を含むことを特徴とする請求項１に記載の大量のロボットに対する緊急停止制御方法。
  3. 各々の前記ロボットの現在位置及び移動速度に基づいて各々の前記ロボットに対してそれぞれの前記緊急停止位置として前記現場内の前記位置ポイントをそれぞれ配分する前記ステップは、
    現在の前記ロボットの現在位置を円心として、所定の半径に従って現在の前記ロボットの第１の緊急停止範囲を特定するステップと、
    前記第１の緊急停止範囲内に余裕の前記位置ポイントが存在するか否かを検索するステップと、
    余裕の前記位置ポイントが存在する場合、現在の前記ロボットの移動速度に基づいて現在の前記ロボットが余裕の前記位置ポイントまで移動するのにかかる時間を分析して、時間が一番短い余裕の前記位置ポイントを選択して現在の前記ロボットの前記緊急停止位置に設定し、余裕の前記位置ポイントが存在しない場合、設定サイズに従って前記第１の緊急停止範囲を拡大して、拡大後の前記第１の緊急停止範囲内で、現在の前記ロボットの前記緊急停止位置が特定されるまで、前記検索及び前記分析の動作を繰り返すステップと
    を含むことを特徴とする請求項１に記載の大量のロボットに対する緊急停止制御方法。
  4. 対応される前記緊急停止位置へ移動されるように各々の前記ロボットを制御する前記ステップは、
    対応される前記緊急停止位置に対する現在の前記ロボットの移動方向及び移動距離を算出するステップと、
    前記移動方向に基づいて現在の前記ロボットの方向調整角度を特定して、前記方向調整角度及び前記移動距離に従って対応される前記緊急停止位置まで移動するように前記ロボットを制御するステップと
    を含むことを特徴とする請求項１に記載の大量のロボットに対する緊急停止制御方法。
  5. 各々の前記ロボットの移動が停止されるように制御する前記ステップの前に、さらに
    現在の前記ロボットが対応される前記緊急停止位置まで移動した後に返送した位置情報を受信するステップと、
    前記位置情報に基づいて現在の前記ロボットと対応される前記緊急停止位置の前記位置マークとの間の距離を算出するステップと、
    前記距離に基づいて、現在の前記ロボットの底部の認識器が対応される前記緊急停止位置の前記位置マークと一致されるまでに、現在の前記ロボットの位置を調整するステップと
    を含むことを特徴とする請求項１乃至４のいずれか１項に記載の大量のロボットに対する緊急停止制御方法。
  6. ロボットの作業現場内に複数の位置ポイントを設置し、複数の前記位置ポイントに対してそれぞれ位置マークを配置し、前記ロボットの底部に前記位置マークを認識するための認識器を設置するための配置モジュールと、
    現場内の各々の前記ロボットの作業状況をモニタリングして、前記ロボットから報告される故障信号がモニタリングされると、前記故障信号に基づいて現場内のすべての前記ロボットが緊急停止されるように制御する必要があるか否かを判断するための判断モジュールと、
    制御する必要がある、各々の前記ロボットの現在位置及び移動速度を検出して、各々の前記ロボットの現在位置及び移動速度に基づいて各々の前記ロボットに対してそれぞれの緊急停止位置として前記現場内の前記位置ポイントをそれぞれ配分する配分モジュールと、
    対応される前記緊急停止位置へ移動されるように各々の前記ロボットを制御して、各々の前記ロボットが対応される前記緊急停止位置まで移動されると、移動が停止されるように各々の前記ロボットを制御するための制御モジュールと
    を備えることを特徴とする大量のロボットに対する緊急停止制御装置。
  7. 前記判断モジュールは、
    所定の故障処理リスト内で前記故障信号に対応される処理方法を検索するための検索ユニットと、
    検索された前記処理方法が現場全体に対する緊急停止処理である場合、現場内のすべての前記ロボットが緊急停止されるように制御する必要があると特定するための特定ユニットと
    を備えることを特徴とする請求項６に記載の大量のロボットに対する緊急停止制御装置。
  8. 前記配分モジュールは、
    現在の前記ロボットの現在位置を円心として、所定の半径に従って現在の前記ロボットの第１の緊急停止範囲を特定するための範囲特定ユニットと、
    前記第１の緊急停止範囲内に余裕の前記位置ポイントが存在するか否かを検索するための検索ユニットと、
    余裕の前記位置ポイントが存在する場合、現在の前記ロボットの移動速度に基づいて現在の前記ロボットが余裕の前記位置ポイントまで移動するのにかかる時間を分析して、時間が一番短い余裕の前記位置ポイントを選択して現在の前記ロボットの前記緊急停止位置に設定し、余裕の前記位置ポイントが存在しない場合、設定サイズに従って前記第１の緊急停止範囲を拡大して、拡大後の前記第１の緊急停止範囲内で、現在の前記ロボットの前記緊急停止位置が特定されるまで、前記検索及び前記分析の動作を繰り返すための選択ユニットと
    を備えることを特徴とする請求項６に記載の大量のロボットに対する緊急停止制御装置。
  9. 前記制御モジュールは、
    対応される前記緊急停止位置に対する現在の前記ロボットの移動方向及び移動距離を算出するための算出ユニットと、
    前記移動方向に基づいて現在の前記ロボットの方向調整角度を特定して、前記ロボットが前記方向調整角度及び前記移動距離に従って対応される前記緊急停止位置まで移動するように制御するための移動制御ユニットと
    を備えることを特徴とする請求項６に記載の大量のロボットに対する緊急停止制御装置。
  10. 現在の前記ロボットが対応される前記緊急停止位置まで移動した後に返送した位置情報を受信するための受信モジュールと、
    前記位置情報に基づいて現在の前記ロボットと対応される前記緊急停止位置の前記位置マークとの間の距離を算出するための距離算出モジュールと、
    前記距離に基づいて、現在の前記ロボットの底部の認識器が対応される前記緊急停止位置の前記位置マークと一致されるまで、現在の前記ロボットの位置を調整するための位置調整モジュールと
    をさらに備えることを特徴とする請求項６乃至９のいずれか１項に記載の大量のロボットに対する緊急停止制御装置。
JP2018553290A 2016-01-04 2016-12-27 大量のロボットに対する緊急停止制御方法及び装置 Active JP6756849B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN201610004679.0 2016-01-04
CN201610004679.0A CN105459117B (zh) 2016-01-04 2016-01-04 控制大量机器人急停的方法及装置
PCT/CN2016/112284 WO2017118316A1 (zh) 2016-01-04 2016-12-27 控制大量机器人急停的方法及装置

Publications (2)

Publication Number Publication Date
JP2019507448A true JP2019507448A (ja) 2019-03-14
JP6756849B2 JP6756849B2 (ja) 2020-09-16

Family

ID=55597493

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018553290A Active JP6756849B2 (ja) 2016-01-04 2016-12-27 大量のロボットに対する緊急停止制御方法及び装置

Country Status (6)

Country Link
US (1) US11602851B2 (ja)
EP (1) EP3385037B1 (ja)
JP (1) JP6756849B2 (ja)
KR (1) KR102141579B1 (ja)
CN (1) CN105459117B (ja)
WO (1) WO2017118316A1 (ja)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105459117B (zh) 2016-01-04 2017-05-03 杭州亚美利嘉科技有限公司 控制大量机器人急停的方法及装置
CN107618033B (zh) * 2016-07-13 2021-03-05 深圳市朗驰欣创科技股份有限公司 机器人急停控制系统与方法
GB201701615D0 (en) * 2017-02-01 2017-03-15 Ocado Innovation Ltd Safety system for an automated storage and picking system and method of operating thereof
CN110570687B (zh) * 2018-06-06 2021-04-27 杭州海康机器人技术有限公司 Agv的控制方法、装置及存储介质
WO2019242652A1 (zh) * 2018-06-21 2019-12-26 北京极智嘉科技有限公司 机器人调度、机器人路径的控制方法、服务器和存储介质
CN109352657B (zh) * 2018-11-29 2020-11-17 深圳前海达闼云端智能科技有限公司 一种控制方法、相关装置及存储介质
CN109746914B (zh) * 2018-12-29 2021-05-04 深圳镁伽科技有限公司 构建机器人的方法、机器人控制设备、系统及存储介质
CN111487931B (zh) * 2019-01-29 2024-04-12 北京京东乾石科技有限公司 一种agv异常时的处理方法和装置
CN113126603B (zh) * 2019-12-30 2023-06-23 杭州海康机器人股份有限公司 一种agv调度方法和装置
CN111775148B (zh) * 2020-06-15 2022-03-08 珠海格力电器股份有限公司 一种机器人控制方法、装置、存储介质及机器人
CN113093664A (zh) * 2021-03-19 2021-07-09 杭州晨龙智能科技有限公司 自动物流的方法以及系统
CN113198765B (zh) * 2021-05-03 2024-06-07 深圳怪虫机器人有限公司 一种可自动返航以及续航的光伏清洁机器人
CN113674549B (zh) * 2021-07-22 2022-11-29 安徽电信规划设计有限责任公司 基于ai移动机器人的车位引导及反向寻车方法、系统及其装置
CN114454162B (zh) * 2022-01-10 2023-05-26 广东技术师范大学 一种移动机器人复杂路口防碰撞方法及系统
CN117103287B (zh) * 2023-10-25 2024-09-10 深圳市协和传动器材有限公司 一种工业机器人的协同控制方法及系统
CN118262721B (zh) * 2024-05-29 2024-07-26 沈阳创高天誉科技有限公司 智能语音控制方法及相关设备

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH032908A (ja) * 1989-05-30 1991-01-09 Shinko Electric Co Ltd 移動ロボットシステムにおける衝突防止方法
JP2009215032A (ja) * 2008-03-12 2009-09-24 Oki Semiconductor Co Ltd 自動搬送システムおよび自動搬送システムにおける搬送車の待機位置設定方法
JP2012223847A (ja) * 2011-04-19 2012-11-15 Honda Motor Co Ltd ロボット群制御装置および方法

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3686301T2 (de) 1985-08-30 1993-01-21 Texas Instruments Inc Eigensichere bremse fuer ein mehrraedriges fahrzeug mit motorgesteuerter lenkung.
JP2814162B2 (ja) 1992-06-02 1998-10-22 株式会社日立製作所 移動式作業ロボットの救助装置
US7627394B2 (en) * 2005-12-20 2009-12-01 Kuka Roboter Gmbh Robot trajectory control including emergency evacuation path system and method
EP1972415B1 (en) 2007-03-23 2019-01-02 Honda Research Institute Europe GmbH Robots with collision avoidance functionality
KR101627132B1 (ko) * 2008-12-15 2016-06-13 삼성전자 주식회사 로봇 및 그 복구 방법
JP2012216151A (ja) 2011-04-01 2012-11-08 Mitsubishi Electric Corp 干渉回避制御装置
CN103389486B (zh) * 2012-05-07 2017-04-19 联想(北京)有限公司 控制方法和电子设备
CN104812535A (zh) * 2012-10-11 2015-07-29 Abb技术有限公司 自动产生用于将机器人从停止位置返回预设重启位置的无碰撞返回程序的方法和设备
CN103885444B (zh) * 2012-12-21 2017-05-24 联想(北京)有限公司 信息处理方法、可移动电子设备和决策控制设备
CN103268111A (zh) 2013-05-28 2013-08-28 重庆大学 一种网络化分布式多移动机器人系统
KR101375340B1 (ko) 2013-06-21 2014-03-18 한국기계연구원 협업 로봇의 정지 동기화 제어방법
US9152149B1 (en) * 2014-06-06 2015-10-06 Amazon Technologies, Inc. Fiducial markers with a small set of values
CN104199450A (zh) * 2014-09-17 2014-12-10 上海畔慧信息技术有限公司 群体机器人的控制系统
CN105459117B (zh) 2016-01-04 2017-05-03 杭州亚美利嘉科技有限公司 控制大量机器人急停的方法及装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH032908A (ja) * 1989-05-30 1991-01-09 Shinko Electric Co Ltd 移動ロボットシステムにおける衝突防止方法
JP2009215032A (ja) * 2008-03-12 2009-09-24 Oki Semiconductor Co Ltd 自動搬送システムおよび自動搬送システムにおける搬送車の待機位置設定方法
JP2012223847A (ja) * 2011-04-19 2012-11-15 Honda Motor Co Ltd ロボット群制御装置および方法

Also Published As

Publication number Publication date
WO2017118316A1 (zh) 2017-07-13
CN105459117B (zh) 2017-05-03
KR20180091045A (ko) 2018-08-14
US11602851B2 (en) 2023-03-14
EP3385037A4 (en) 2018-10-24
CN105459117A (zh) 2016-04-06
JP6756849B2 (ja) 2020-09-16
KR102141579B1 (ko) 2020-08-06
EP3385037A1 (en) 2018-10-10
US20200346348A1 (en) 2020-11-05
EP3385037B1 (en) 2021-11-03

Similar Documents

Publication Publication Date Title
JP2019507448A (ja) 大量のロボットに対する緊急停止制御方法及び装置
US10466707B2 (en) Planning robot stopping points to avoid collisions
WO2019141222A1 (zh) 多移动机器人的冲突管理方法及系统
US11099576B2 (en) Spatiotemporal robotic navigation
US11092973B2 (en) Coordinated operation of autonomous robots
US20190176328A1 (en) Dynamically Adjusting Roadmaps for Robots Based on Sensed Environmental Data
CN106228302A (zh) 一种用于在目标区域内进行任务调度的方法与设备
JP2017518940A5 (ja)
JP2018505785A (ja) ２つのロボット間の衝突を回避するための方法
KR20150137166A (ko) 복수의 이동 로봇 간의 충돌 회피를 위한 경로 생성 방법
CN110597261A (zh) 一种预防碰撞冲突的方法及装置
CN114815824A (zh) 路径规划方法、路径规划装置以及计算机可读存储介质
CN116700298A (zh) 路径规划方法、系统、设备及存储介质
JP6671506B2 (ja) ロボットホイール径補完方法及び装置
US20240103922A1 (en) Design execution apparatus and design execution method
US20150262478A1 (en) Setting update system and vehicle control system
JP5918097B2 (ja) 情報処理装置、情報処理方法及びプログラム
CN107102966A (zh) 多核处理器芯片、中断控制方法及控制器
CN105635155A (zh) 机器人终端中组成设备状态的检测方法和装置
Ashraf et al. Towards a realtime, collision-free motion coordination and navigation system for a UAV fleet
CN113741424A (zh) 机器人协同避障系统、方法、机器人及存储介质
CN113251620A (zh) 用于控制子母空调的方法、装置和智能空调
JP7136227B2 (ja) 経路探索支援装置、経路探索支援方法、及びプログラム
JP7372948B2 (ja) 倉庫内安全システム
CN110689094A (zh) 基于物联网的自动导引运输车任务分配方法及系统

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180704

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190719

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190730

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190930

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200128

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200413

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20200818

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200827

R150 Certificate of patent or registration of utility model

Ref document number: 6756849

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250