CN112894797A - 机器人的控制装置、机器人的控制方法及协同作业单元 - Google Patents

机器人的控制装置、机器人的控制方法及协同作业单元 Download PDF

Info

Publication number
CN112894797A
CN112894797A CN202011295323.XA CN202011295323A CN112894797A CN 112894797 A CN112894797 A CN 112894797A CN 202011295323 A CN202011295323 A CN 202011295323A CN 112894797 A CN112894797 A CN 112894797A
Authority
CN
China
Prior art keywords
robot
transport vehicle
unit
external force
control device
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202011295323.XA
Other languages
English (en)
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.)
Fanuc Corp
Original Assignee
Fanuc Corp
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 Fanuc Corp filed Critical Fanuc Corp
Publication of CN112894797A publication Critical patent/CN112894797A/zh
Pending legal-status Critical Current

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/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
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085—Force or torque sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06—Safety devices
    • 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/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
    • 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/0227—Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area
    • 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device

Landscapes

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

Abstract

本发明公开了一种机器人的控制装置、机器人的控制方法及协同作业单元。机器人(12)的控制装置(14)基于施加到搭载于运输车(16)的机器人(12)的外力(F)使所述机器人(12)停止，其具备：判定部(28)，其对所述运输车(16)是否在行驶中进行判定；以及控制部(30)，在所述运输车(16)在行驶中的情况下，所述控制部使所述机器人(12)停止，在所述运输车(16)不在行驶中的情况下，所述控制部使所述机器人(12)能够动作。

Description

机器人的控制装置、机器人的控制方法及协同作业单元
技术领域
本发明涉及一种搭载于运输车的机器人的控制装置及控制方法、以及具备运输车及搭载于运输车的机器人的协同作业单元。
背景技术
已知有一种协同作业单元，具备：与人协同的机器人；以及搭载有该机器人的运输车。该协同作业单元例如是日本专利特开2016－032858号公报的“机器人100”。该“机器人100”基于是否有意想不到的外力施加于自己来判断是否与人接触。
发明内容
发明要解决的问题
机器人和运输车的各方存在被控制成在机器人与障碍物接触时停止的情况。在该情况下，机器人的控制装置有时会将运输车通过台阶而产生的外力识别成与障碍物接触而产生的外力。其结果是，运输车在试图通过台阶时被控制成停止，从而导致运输车无法通过台阶。
因此，本发明涉及一种具备运输车和搭载于运输车的机器人的协同作业单元，其目的在于，提供一种能够抑制运输车在通过台阶时停止的机器人的控制装置、机器人的控制方法及协同作业单元。
解决问题的技术手段
本发明的一个形态是机器人的控制装置，其基于施加到搭载于运输车的所述机器人的外力使所述机器人停止，具备：判定部，其对所述运输车是否在行驶中进行判定；以及控制部，在所述运输车在行驶中的情况下，所述控制部使所述机器人停止，在所述运输车不在行驶中的情况下，所述控制部使所述机器人能够动作。
本发明的另一个形态是协同作业单元，其具备：上述形态的机器人的控制装置；机器人，其由所述控制装置控制；以及运输车，其搭载有所述控制装置和所述机器人。
本发明的另一个形态是机器人的控制方法，所述机器人搭载于运输车，该控制方法包括：判定步骤，对所述运输车是否在行驶中进行判定；机器人动作步骤，在所述运输车不在行驶中时，使所述机器人能够动作，并且，基于施加到所述机器人的外力对是否存在异常进行检测；以及机器人停止步骤，在所述运输车在行驶中的情况下、或者检测到所述异常的情况下，使所述机器人停止。
发明的效果
根据本发明，能够提供一种能够抑制运输车在通过台阶时停止的机器人的控制装置、机器人的控制方法及协同作业单元。
根据参考附图而进行说明的以下实施方式的说明，将容易地了解上述的目的、特征及优点。
附图说明
图1是第一实施方式的协同作业单元的整体构成图。
图2是第一实施方式的机器人的控制装置的功能构成图。
图3是表示第一实施方式的机器人的控制方法的一例的流程图。
图4是第二实施方式的协同作业单元的整体构成图。
图5是第二实施方式的机器人的控制装置的功能构成图。
图6是表示第二实施方式的机器人的控制方法的一例的流程图。
图7是第三实施方式的协同作业单元的整体构成图。
图8是第三实施方式的机器人的控制装置的功能构成图。
图9是表示第三实施方式的机器人的控制方法的一例的流程图。
具体实施方式
以下，一边列举优选的实施方式并参照附图，一边详细地对本发明的机器人的控制装置、机器人的控制方法及协同作业单元进行说明。
[第一实施方式]
图1是第一实施方式的协同作业单元10的整体构成图。
协同作业单元10例如在制造工业产品的工厂中自身一边移动一边与人协同进行作业。协同作业单元10具备机器人12、机器人12的控制装置14、以及搭载有机器人12和控制装置14的运输车16。需要说明的是，在以下，在指“机器人12的控制装置14”时仅记载为“控制装置14”。
本实施方式的机器人12是具有多个关节部的机器人臂。另外，本实施方式的运输车16通过行驶实现协同作业单元10的移动，通常也称为“无人运输车”、“AGV(Automatedguided vehicle：自动导引运输车)”。由于这样的机器人12以及运输车16各自本身是已知的，因此在以下适当地省略其说明。
机器人12所具有的多个关节部通过马达18的驱动而进行动作。马达18例如是伺服马达。马达18由通过未图示的馈电电路和放大器(增幅器)从控制装置14供应的驱动电流进行驱动。另外，在机器人12中设有传感器20，该传感器20对施加到该机器人12的外力F进行检测。
传感器20设置在关节部的马达18，从而基于从控制装置14供应到马达18的驱动电流、马达18的旋转轴的旋转扭矩对外力F进行检测。另外，传感器20将与检测到的外力F相应的信号输出至控制装置14的监视部32(稍后描述)。
图2是第一实施方式的机器人12的控制装置14的功能构成图。
控制装置14基于规定的控制程序22对机器人12进行控制。控制装置14具备存储部24和运算部26。
存储部24在构成中包括例如ROM(Read Only Memory)、RAM(Random AccessMemory)作为硬件。在存储部24中存储上述的规定的控制程序22。
运算部26在构成中包括例如CPU(Central Processing Unit)作为硬件。运算部26通过执行存储部24所存储的规定的控制程序22来实现机器人12的控制。与此相关地，运算部26具备判定部28、控制部30和监视部32。这些部分通过运算部26与存储部24协同执行控制程序22来实现。以下，将按照顺序对此进行说明。
判定部28对运输车16是否在行驶中进行判定。具体如何进行判定没有特别的限定。举例说明的话，例如，判定部28可以通过从运输车16接收表示运输车16是否在行驶中的信号来进行判定。或者，判定部28可以从设置于运输车16的速度传感器接收表示运输车16的行驶速度的信号来进行判定。或者，判定部28可以通过将GPS(Global PositioningSystem，全球定位系统)应用于协同作业单元10来依次获取协同作业单元10的当前位置，并且基于该获取的位置的变化进行判定。
基于判定部28的判定的结果，在运输车16在行驶中的情况下，控制部30使机器人12停止，在运输车16不在行驶中的情况下，控制部30使机器人12能够动作。在此，优选在运输车16在行驶中的情况下，控制部30切断向机器人12的电力供给。由此，能够更可靠地使机器人12停止。在使机器人12能够动作时，使电力供应返回到能够重新打开的状态即可。
切断向机器人12的电力供给是指，即切断向马达18的驱动电流的供给。这可以通过在向马达18供应驱动电流的电线中插入开关元件并且将该开关元件切换成断开来容易地实现。
另外，虽然将另行稍后描述，但有时也从监视部32将机器人12存在异常的主旨通知给控制部30。当从监视部32接收到该通知时，控制部30迅速使机器人12停止(固定机器人12的姿势)。
表示外力F的信号从传感器20输入到监视部32。监视部32基于该信号监视是否对作业中的机器人12施加了异常外力F。外力F是否异常基于该外力F是否超过预先确定的阈值Vth来进行判断。阈值Vth是基于控制程序假定施加到正常作业的机器人的外力F的大小而确定的。另外，当监视部32判断异常的外力F施加到作业中的机器人12时，监视部32判断在机器人12的作业中发生了异常并将该结果通知给控制部30。
例如，假设作业中的机器人12与障碍物接触(碰撞)。此时，传感器20从机器人12检测到超过阈值的异常的外力F。当表示超过预先确定的阈值Vth的外力F的信号从传感器20输入到监视部32时，监视部32判断在机器人12的作业中产生了异常并将该主旨通知给控制部30。由此，本实施方式的控制装置14在机器人12与障碍物接触这样的发生异常的情况下可以迅速使机器人12停止。
需要说明的是，若运输车16在行驶中，则本实施方式的机器人12不动作。因此，若运输车16在行驶中，则监视部32不需要对是否发生异常进行判断。
图3是表示第一实施方式的机器人12的控制方法的一例的流程图。
以下，对可由本实施方式的控制装置14执行的“机器人12的控制方法”(以下，简称为控制方法)进行说明。在该控制方法中，首先，对运输车16是否在行驶中进行判定(S1：第一判定步骤)。本步骤可以由判定部28进行。
在运输车16不在行驶中的情况下(否)，使机器人12能够动作(S2：机器人动作容许步骤)。机器人动作容许步骤包括如下两个步骤。即，机器人动作容许步骤包括基于控制程序22的机器人12的作业(S3：作业步骤)和对施加到机器人12的外力F是否在阈值Vth内的(是否存在异常)的监视(S4：监视步骤)。可通过控制部30执行控制程序22来进行作业步骤。另外，可通过监视部32监视传感器20检测到的外力F来进行监视步骤。
另一方面，在运输车16在行驶中的情况下(是)，使机器人12停止(S5：机器人停止步骤)。本步骤可由控制部30进行。在使机器人12停止时，如上所述，优选切断向机器人12的电力供给。
需要说明的是，在通过监视步骤检测到异常的情况下也执行机器人停止步骤。由此，即使在机器人12的作业中产生了异常，也能够迅速中断该作业。
在开始机器人停止步骤之后，进行是否结束该机器人停止步骤的判定(S6：第二判定步骤)。在本步骤中，根据是否满足规定的条件来判定是否结束机器人停止步骤。在此，可以适当确定规定的条件，规定的条件是指例如，在开始机器人停止步骤之后经过规定的时间、或者操作员指示解除停止。
像这样，在本实施方式中，若运输车16不行驶中则容许机器人12作业，若运输车16在行驶中则不容许机器人12作业。另外，在机器人12不作业时，即在运输车16正在行驶时，即使外力F施加到机器人12，运输车16也不停止行驶。
因此，根据本实施方式，对于具备机器人12和搭载有机器人12的运输车16的协同作业单元10，能够抑制运输车16在通过台阶时停止。
[第二实施方式]
以下，对第二实施方式进行说明。需要说明的是，对于与在第一实施方式已说明的要素相同的要素，适当省略其说明。
图4是第二实施方式的协同作业单元10’的整体构成图。
本实施方式的协同作业单元10’具备与第一实施方式相同的机器人12和运输车16。即、机器人12具有通过马达18进行动作的多个关节部，在马达18设有对外力F进行检测的传感器20。在本实施方式中，也将该传感器20称为第一传感器20。运输车16是在搭载有机器人12的状态下沿着行驶路径行驶的AGV。
另外，协同作业单元10’还具备第二实施方式的控制装置(机器人12的控制装置)14’和第二传感器34。本实施方式的控制装置14’是用于控制机器人12的装置，并且搭载于运输车16。第二传感器34用于对周边的地形进行检测，例如是视觉传感器。
需要说明的是，第二传感器34只要是对周边的地形进行检测的话则不限定于视觉传感器，例如也可以是超声波传感器。只要至少能够对运输车16的行进方向的地形进行检测，第二传感器34的数量及配置并不限定于图4所示的构成。
图5是第二实施方式的机器人12的控制装置14’的功能构成图。
控制装置14’具备运算部26’和存储部24’。运算部26’及存储部24’可具备与第一实施方式的运算部26及存储部24相同的构成作为硬件。存储部24’除了存储用于实现本实施方式的控制的控制程序22’之外，还适当存储机器人12的控制所需的信息。机器人12的控制所需的信息是指例如稍后描述的地形信息。
运算部26’具备控制部30’、台阶检测部36、监视部32’、判定部28’和紧急停止部38。这些部分通过运算部26’与存储部24’协同执行控制程序22’来实现。以下，将按照顺序对此进行说明。
控制部30’基于控制程序22’对马达18的驱动进行控制从而使机器人12动作。由此，机器人12以与人协同作业的方式进行动作。
另外，虽然将另行稍后描述，但有时会从紧急停止部要求控制部30’停止机器人12的动作。当从紧急停止部38要求控制部30’停止机器人12的动作时，通过停止马达18的驱动来迅速地使机器人12停止(固定姿势)。
台阶检测部36对运输车16的行驶路径上的台阶进行检测。本实施方式的台阶检测部36基于地形信息在行驶的运输车16到达台阶之前对该台阶进行检测。地形信息是指至少表示运输车16的行驶路径上的台阶的位置的信息。
通过第二传感器34对协同作业单元10’的周边的地形进行检测，伴随着运输车16的行驶能够依次获取地形信息。该方法通常也称为SLAM(Simultaneous Localization andMapping：同时定位与地图构建)。
另外，也可以通过在协同作业单元10’工作前预先调查台阶在工厂内的地面上的位置来获取地形信息。在该情况下，能够从协同作业单元10’的构成中省略第二传感器34。
在外力F施加到机器人12的情况下，判定部28’对该外力F是否是在运输车16通过台阶的期间内施加的外力进行判定。该判定能够通过将台阶检测部36检测到的台阶的位置和施加外力F时的协同作业单元10’的位置进行对照来进行。协同作业单元10’的位置可以例如通过GPS获取。判定部28’也可以根据SLAM匹配的结果来推定协同作业单元10’的位置。
当例如外力F施加到机器人12时的协同作业单元10’的位置与台阶的位置一致时，上述判定部28’判定施加到机器人12的外力F是在运输车16通过台阶期间内施加的外力。或者，当外力F施加到机器人12时的协同作业单元10’的位置在以台阶为中心的规定的范围内时，判定施加到机器人12的外力F是在运输车16通过台阶的期间内施加的外力。
在施加到机器人12的外力F不是在运输车16通过台阶的期间内施加的情况下，监视部32'基于该外力F对在作业中的机器人12中产生的异常进行检测。与第一实施方式的监视部32相同地，基于外力F是否在预先确定的阈值Vth内来进行通过监视部32’对异常的检测。
当检测到异常时，监视部32’将该主旨通知给紧急停止部38。在基于不是在运输车16通过台阶的期间内向机器人12施加的外力F而检测到异常的情况下，紧急停止部38向控制部30’要求停止机器人12。另外，要求运输车16停止行驶。
当从紧急停止部38要求控制部30’停止机器人12时，控制部30’与此相应地迅速使机器人12停止(固定姿势)。另外，当从紧急停止部38要求运输车16停止行驶时，运输车16当场迅速停止。
需要说明的是，在运输车16通过台阶的期间内向机器人12施加外力F的情况下，本来监视部32’就不会检测到异常。因此，在该情况下，紧急停止部38不会要求控制部30’停止机器人12的动作、以及要求运输车16停止行驶。
图6是表示第二实施方式的机器人12的控制方法的一例的流程图。
以下，对本实施方式的机器人12的控制方法进行说明。需要说明的是，在以下，除非另有说明，否则将说明运输车16沿着行驶路径行驶的情况。
首先，对运输车16的行驶路径上的台阶进行检测(S11：台阶检测步骤)。台阶检测步骤基于地形信息由台阶检测部36进行。
接下来，在向机器人12施加了外力F的情况下，对该外力F是否是在运输车16通过台阶的期间内施加的外力进行判定(S12：判定步骤)。该判定由判定部28’进行。
可以通过将根据地形信息检测到的台阶的位置和协同作业单元10’的当前位置进行对照来进行判定。若是在协同作业单元10’通过台阶附近时施加的外力F的话，则能够判定该外力F是在运输车16通过台阶的期间内施加的外力。
在施加到机器人12的外力F不是在运输车16通过台阶的期间内施加的外力情况下(判定结果是否)，停止机器人12并且要求运输车16停止(S13：紧急停止步骤)。基于紧急停止部38在判定步骤中进行判定的结果，通过紧急停止部38分别要求控制部30’和运输车16来进行紧急停止步骤。
在外力F是在运输车16通过台阶的期间内施加的外力情况下(判定结果为是)，不要求运输车16停止(结束)。因此，即使在运输车16通过台阶时向机器人12施加外力F，运输车16也继续照原样行驶。
像这样，根据本实施方式的机器人12的控制装置14’及控制方法，对于具备机器人12和搭载有机器人12的运输车16的协同作业单元10’，能够抑制运输车16在通过台阶时停止。另外，在本实施方式中，可同时进行运输车16的行驶和机器人12的作业。
[第三实施方式]
以下，对第三实施方式进行说明。第三实施方式的协同作业单元10”在运输车16到达台阶之后对该台阶进行检测这一点上与第二实施方式不相同。以下，对这样的协同作业单元10”的构成进行说明。需要说明的是，对于与在第一实施方式及第二实施方式中已说明的要素相同的要素，将适当省略其说明。
图7是第三实施方式的协同作业单元10”的整体构成图。
协同作业单元10”具备：具有马达18的机器人12；设置于马达18的第一传感器20；运输车16；第三传感器40；以及控制装置14”。这些中的机器人12、运输车16、马达18和第一传感器20已经在其他实施方式中进行了说明，因此在此省略其说明。
第三传感器40对基于施加到运输车16的外力F’的加速度进行检测。在向运输车16施加外力F’时，第三传感器40将与基于该外力F’的加速度相应的检测信号输出到控制装置14”。
图8是第三实施方式的机器人12的控制装置14”的功能构成图。
在本实施方式中，控制装置14”对机器人12进行控制。控制装置14”具备运算部26”和存储部24”。运算部26”和存储部24”可具备与运算部26和存储部24同样的构成作为硬件。在存储部24”中存储控制程序22”。运算部26”通过执行该控制程序22”来实现将在以下说明的控制方法。
运算部26”具备控制部30”、监视部32”、台阶检测部36’、判定部28”和紧急停止部38’。这些部分通过运算部26”与存储部24”协同执行控制程序22”来实现。
上述中的控制部30”基于控制程序22”使机器人12进行作业。另外，在控制部30”使机器人12进行作业时，监视部32”监视由第一传感器20检测到的外力F，从而对施加到作业中的机器人12的异常的外力F进行检测。
台阶检测部36’计算基于监视部32”检测到的异常的外力F的加速度。由此，求得基于施加到机器人12的外力F的加速度。另外，台阶检测部36’计算基于外力F的加速度与基于从第三传感器40输入的外力F’的加速度的差值。优选将两者分解成三维方向的各轴向的成分，并针对每个成分计算该差值。
并且，若计算出的差值在预先确定的范围内的话，则台阶检测部36’判断在运输车16经过的地方存在台阶(对台阶进行检测)。像这样，本实施方式的台阶检测部36’在运输车16到达台阶之后对该台阶进行检测。需要说明的是，在针对多个方向的每个成分计算加速度的差值的情况下，台阶检测部36’对所有方向上的差值是否在上述范围内进行判定。
台阶检测部36’判定是否检测到台阶，从而在向机器人12施加了外力F的情况下，判定部28”对该外力F是否是在运输车16通过台阶的期间内施加的外力进行判定。即、判定部28”对监视部32”是否检测到施加到机器人12的异常的外力F、且台阶检测部36’是否基于该外力F而检测到台阶进行判定。无论是否检测到异常的外力F，在台阶检测部36’没有基于该外力F而检测到台阶的情况下，判定部28”都呼叫紧急停止部38’。
当紧急停止部38’被判定部28”呼叫时，紧急停止部38’要求控制部30”停止机器人12。另外，要求运输车16停止行驶。
以上是本实施方式的协同作业单元10”的概要。接着，对可由本实施方式的控制装置14”执行的机器人12的控制方法进行说明。
图9是表示第三实施方式的机器人12的控制方法的一例的流程图。需要说明的是，在以下，与第二实施方式时相同地，除非另有说明，否则将说明运输车16沿着行驶路径行驶的情况。
在本实施方式的控制方法中，首先，监视部32”监视施加到机器人12的外力F，从而对在作业中的机器人12中发生的异常进行检测(S21：监视步骤)。在超过阈值Vth的外力F施加到机器人12时，监视部32”判定发生了异常。另外，在此期间，机器人12可与人协同进行作业。控制部30”基于控制程序22”进行作业中的机器人12的动作的控制。
当在监视步骤中检测到异常时(是)，台阶检测部36’基于施加到机器人12的外力F对台阶进行检测(S22：台阶检测步骤)。如上所述，台阶检测部36’可根据基于施加到机器人12的外力F的加速度与基于施加到运输车16的外力F’的加速度的差值是否在预先确定的范围内对台阶进行检测。
接下来，判定部28”接收台阶检测步骤的结果，并对外力F是否是在运输车16通过台阶的期间内施加的外力进行判定(S23：判定步骤)。在该判定中，在台阶检测部36’基于异常的外力F而检测到台阶时，则判定该外力F是在运输车16通过台阶的期间内施加的外力。
在判定监视步骤中所检测到的外力F是在运输车16通过台阶的期间内施加的外力情况下(是)，暂时结束图9的控制方法(结束)。在该情况下，运输车16若在行驶中，则继续行驶而不停止。
另一方面，在异常的外力F不是在运输车16通过台阶的期间内施加的外力情况下(否)，呼叫紧急停止部38’(S24：紧急停止步骤)。在紧急停止步骤中，若机器人12正在作业，则使机器人12停止，并且，若运输车16在行驶中，则使运输车16停止。
根据本实施方式的机器人12的控制装置14”及控制方法，即使是在异常的外力F施加到机器人12的情况下，在基于该外力F检测到台阶时，也不会呼叫紧急停止部38’。因此，对于具备机器人12和搭载有机器人12的运输车16的协同作业单元10”，能够抑制运输车16在通过台阶时停止。
[变形例]
以上，作为本发明的一例已经说明了实施方式，但是当然能够对上述实施方式进行各种变更或改进。从技术方案的记载中可以明显知道，进行这样的变更或改进的方式也可以包含在本发明的技术范围内。
[从实施方式中得到的发明]
以下记载可以从上述实施方式及变形例中掌握的发明。
＜第一发明＞
一种机器人(12)的控制装置(14)，其基于施加到搭载于运输车(16)的机器人(12)的外力(F)使所述机器人(12)停止，具备：判定部(28)，其对所述运输车(16)是否在行驶中进行判定；以及控制部(30)，在所述运输车(16)在行驶中的情况下，所述控制部使所述机器人(12)停止，在所述运输车(16)不在行驶中的情况下，所述控制部使所述机器人(12)能够动作。
由此，提供一种能够抑制运输车(16)在通过台阶时停止的机器人(12)的控制装置(14)。
也可以在所述运输车(16)在行驶中的情况下，所述控制部(30)切断向所述机器人(12)的电力供给，在所述运输车(16)停止的情况下，所述控制部(30)使向所述机器人(12)的电力供给能够进行。由此，能够更加可靠地使机器人(12)停止。
＜第二发明＞
一种协同作业单元(10)，其具备：上述第一发明的机器人(12)的控制装置(14)；机器人(12)，其由所述控制装置(14)控制；以及运输车(16)，其搭载有所述控制装置(14)和所述机器人(12)。
由此，提供一种能够抑制运输车(16)在通过台阶时停止的协同作业单元(10)。
＜第三发明＞
一种机器人(12)的控制方法，所述机器人搭载于运输车(16)，该控制方法包括：判定步骤，对所述运输车(16)是否在行驶中进行判定；机器人动作容许步骤，在所述运输车(16)不在行驶中时，使所述机器人(12)能够动作，并且，基于施加到所述机器人(12)的外力(F)对是否存在异常进行检测；以及机器人停止步骤，在所述运输车(16)在行驶中的情况下、或者检测到所述异常的情况下，使所述机器人(12)停止。
由此，提供一种能够抑制运输车(16)在通过台阶时停止的机器人(12)的控制方法。
在所述机器人停止步骤中，也可以通过切断向所述机器人(12)的电力供给来使所述机器人(12)停止。由此，能够更加可靠地使机器人(12)停止。
＜第四发明＞
一种所述机器人(12)的控制装置(14’、14”)，其基于施加到搭载于运输车(16)的机器人(12)的外力(F)而要求所述运输车(16)停止，具备：台阶检测部(36、36’)，其对所述运输车(16)的行驶路径上的台阶进行检测；判定部(28’、28”)，在向所述机器人(12)施加了外力(F)的情况下，所述判定部对所述外力(F)是否是在所述运输车(16)经过所述台阶的期间内施加的外力进行判定；以及紧急停止部(38、38’)，在所述外力(F)是在所述运输车(16)经过所述台阶的期间内施加的外力情况下，所述紧急停止部不要求所述运输车(16)停止。
由此，提供一种能够抑制运输车(16)在通过台阶时停止的机器人(12)的控制装置(14’、14”)。
也可以还具备存储部(24’、24”)，其存储表示所述行驶路径上的所述台阶的位置的地形信息，所述台阶检测部(36、36’)基于所述地形信息对所述台阶进行检测。由此，基于地形信息对台阶进行检测。
所述台阶检测部(36’)也可以基于施加到所述机器人(12)的所述外力(F)和施加到所述运输车(16)的外力(F’)的差值是否在预先确定的范围内来对所述台阶进行检测。由此，在向机器人(12)施加了外力(F)时，基于该外力(F)对台阶进行检测。
＜第五发明＞
一种机器人(12)的控制方法，所述机器人搭载于运输车(16)，该控制方法包括：台阶检测步骤，对所述运输车(16)的行驶路径上的台阶进行检测；判定步骤，在向所述机器人(12)施加了外力(F)的情况下，对所述外力(F)是否是所述运输车(16)在经过所述台阶的期间内施加的外力进行判定；以及紧急停止步骤，在所述外力(F)不是在所述运输车(16)经过所述台阶的期间内施加的外力情况下，要求所述运输车(16)紧急停止，在所述外力(F)是在所述运输车(16)经过所述台阶的期间内施加的外力情况下，不要求所述运输车(16)紧急停止。
由此，提供一种能够抑制运输车(16)在通过台阶时停止的机器人(12)的控制方法。
在所述台阶检测步骤中，也可以基于表示所述行驶路径上的所述台阶的位置的地形信息来进行判定。由此，基于地形信息对台阶进行检测。
在所述台阶检测步骤中，也可以基于施加到所述机器人(12)的所述外力(F)与施加到所述运输车(16)的外力(F’)的差值是否在预先确定的范围内来对所述台阶进行检测。由此，在向机器人(12)施加了外力(F)时，基于该外力(F)对台阶进行检测。

Claims (5)

1.一种机器人的控制装置，其基于施加到搭载于运输车的机器人的外力使所述机器人停止，所述控制装置的特征在于，具备：
判定部，其对所述运输车是否在行驶中进行判定；以及
控制部，在所述运输车在行驶中的情况下，所述控制部使所述机器人停止，在所述运输车不在行驶中的情况下，所述控制部使所述机器人能够动作。
2.根据权利要求1所述的机器人的控制装置，其特征在于，
在所述运输车在行驶中的情况下，所述控制部切断向所述机器人的电力供给，在所述运输车在停止中的情况下，所述控制部使向所述机器人的电力供给能够进行。
3.一种协同作业单元，其特征在于，具备：
如权利要求1或2所述的机器人的控制装置；
机器人，其由所述控制装置控制；以及
运输车，其搭载有所述控制装置和所述机器人。
4.一种机器人的控制方法，所述机器人搭载于运输车，所述机器人的控制方法的特征在于，包括：
判定步骤，对所述运输车是否在行驶中进行判定；
机器人动作容许步骤，在所述运输车不在行驶中时，使所述机器人能够动作，并且，基于施加到所述机器人的外力对是否存在异常进行检测；以及
机器人停止步骤，在所述运输车在行驶中的情况下、或者检测到所述异常的情况下，使所述机器人停止。
5.根据权利要求4所述的机器人的控制方法，其特征在于，
在所述机器人停止步骤中，通过切断向所述机器人的电力供给来使所述机器人停止。
CN202011295323.XA 2019-11-19 2020-11-18 机器人的控制装置、机器人的控制方法及协同作业单元 Pending CN112894797A (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019-208772 2019-11-19
JP2019208772A JP7405575B2 (ja) 2019-11-19 2019-11-19 ロボットの制御装置、ロボットの制御方法、および協働作業ユニット

Publications (1)

Publication Number Publication Date
CN112894797A true CN112894797A (zh) 2021-06-04

Family

ID=75683482

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011295323.XA Pending CN112894797A (zh) 2019-11-19 2020-11-18 机器人的控制装置、机器人的控制方法及协同作业单元

Country Status (4)

Country Link
US (1) US11717968B2 (zh)
JP (1) JP7405575B2 (zh)
CN (1) CN112894797A (zh)
DE (1) DE102020130021A1 (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7405575B2 (ja) * 2019-11-19 2023-12-26 ファナック株式会社 ロボットの制御装置、ロボットの制御方法、および協働作業ユニット

Family Cites Families (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0722907B2 (ja) * 1986-11-13 1995-03-15 神鋼電機株式会社 移動ロボツトの安全装置
JPH0557669A (ja) * 1991-09-02 1993-03-09 Hitachi Ltd 自走ロボツト用の安全装置
JP2603228Y2 (ja) * 1992-10-02 2000-03-06 神鋼電機株式会社 無人搬送車車載安全装置
JPH07160334A (ja) * 1993-12-02 1995-06-23 Mutoh Ind Ltd 走行ロボットの凹凸路面走行制御装置
JP2001096487A (ja) 1999-09-29 2001-04-10 Denso Corp 移動ロボット
JP2001287190A (ja) 2000-04-07 2001-10-16 Denso Corp ロボット
KR101106615B1 (ko) * 2009-06-25 2012-01-20 고려대학교 산학협력단 로봇의 회동기구와 이를 이용한 로봇팔
JP6140114B2 (ja) 2014-07-31 2017-05-31 ファナック株式会社 移動式人協調型ロボット
JP5927284B1 (ja) * 2014-12-22 2016-06-01 ファナック株式会社 人との接触力を検出してロボットを停止させるロボット制御装置
JP6034900B2 (ja) * 2015-03-06 2016-11-30 ファナック株式会社 動作プログラムの再開を判断するロボット制御装置
DE102015120058B3 (de) 2015-11-19 2017-03-02 Kuka Roboter Gmbh Ankoppeleinrichtung und Verfahren zum Ankoppeln einer mobilen Prozesseinrichtung
JP6799789B2 (ja) * 2016-06-29 2020-12-16 パナソニックＩｐマネジメント株式会社 歩行支援ロボット及び歩行支援方法
JP6431017B2 (ja) * 2016-10-19 2018-11-28 ファナック株式会社 機械学習により外力の検出精度を向上させた人協調ロボットシステム
WO2018087546A1 (en) * 2016-11-08 2018-05-17 Dogtooth Technologies Limited A robotic fruit picking system
JP2019059004A (ja) * 2017-09-28 2019-04-18 セイコーエプソン株式会社 ロボットシステム
JP7141232B2 (ja) * 2018-04-06 2022-09-22 川崎重工業株式会社 ロボットの制御装置
KR102070575B1 (ko) * 2018-06-01 2020-01-29 주식회사 로보쓰리 계단 승월형 구동장치의 승월 구동방법
US11092711B2 (en) * 2018-10-05 2021-08-17 Fairfield Industries Incorporated Systems and methods to control a moving underwater vehicle retrieving an ocean bottom seismic data acquisition unit
JP7405575B2 (ja) * 2019-11-19 2023-12-26 ファナック株式会社 ロボットの制御装置、ロボットの制御方法、および協働作業ユニット

Also Published As

Publication number Publication date
US20210146544A1 (en) 2021-05-20
US11717968B2 (en) 2023-08-08
DE102020130021A1 (de) 2021-05-20
JP7405575B2 (ja) 2023-12-26
JP2021079484A (ja) 2021-05-27

Similar Documents

Publication Publication Date Title
US10850742B2 (en) Safety stoppage device and autonomous road vehicle equipped therewith
US8355817B2 (en) Robot system
CN110612241B (zh) 自动驾驶辅助装置以及自动驾驶辅助方法
US9278451B2 (en) Robot system and method for controlling robot system
US20190001504A1 (en) Method For Detecting A Collision Of A Robot Arm With An Object, And A Robot With A Robot Arm
US20190079537A1 (en) Automatic guided vehicle
US10603798B2 (en) Robot
CN111216792B (zh) 一种自动驾驶车辆状态监测系统及方法、汽车
KR102418451B1 (ko) 로봇 제어 시스템
JP6997293B2 (ja) 自律走行作業機、及び制御システム
US20160089787A1 (en) Robot controller
WO1994018751A1 (en) Method of detecting and regulating load on servomotor
US10780579B2 (en) Work robot system
CN113246831B (zh) 作业系统
EP2019348A1 (en) Travel device for self-propelled device
CN110271019B (zh) 协作机器人的控制装置以及控制方法
CN112894797A (zh) 机器人的控制装置、机器人的控制方法及协同作业单元
US11312410B2 (en) Electric power steering apparatus
US11440577B2 (en) Steering system, abnormality determination method, and non-transitory storage medium
JP2019139696A (ja) 車両制御装置
CN110315558B (zh) 协作机器人的控制装置和控制方法
CN117204771A (zh) 自走式机器人、控制装置以及控制方法
JP4096866B2 (ja) 自律移動装置
US20230305162A1 (en) Obstacle sensor inspection device and method
CN113226879A (zh) 作业车辆

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination