KR102370879B1 - 협동로봇제어장치 및 협동로봇을 제어하는 방법 - Google Patents

협동로봇제어장치 및 협동로봇을 제어하는 방법 Download PDF

Info

Publication number
KR102370879B1
KR102370879B1 KR1020170116665A KR20170116665A KR102370879B1 KR 102370879 B1 KR102370879 B1 KR 102370879B1 KR 1020170116665 A KR1020170116665 A KR 1020170116665A KR 20170116665 A KR20170116665 A KR 20170116665A KR 102370879 B1 KR102370879 B1 KR 102370879B1
Authority
KR
South Korea
Prior art keywords
collision
cooperative robot
joints
mode
compensation value
Prior art date
Application number
KR1020170116665A
Other languages
English (en)
Other versions
KR20190029286A (ko
Inventor
이윤
송창우
Original Assignee
주식회사 한화
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 주식회사 한화 filed Critical 주식회사 한화
Priority to KR1020170116665A priority Critical patent/KR102370879B1/ko
Priority to PCT/KR2017/012466 priority patent/WO2019054558A1/ko
Priority to US16/643,680 priority patent/US11534918B2/en
Priority to CN201780088838.2A priority patent/CN110494260B/zh
Priority to EP17925046.9A priority patent/EP3683022A4/en
Publication of KR20190029286A publication Critical patent/KR20190029286A/ko
Application granted granted Critical
Publication of KR102370879B1 publication Critical patent/KR102370879B1/ko

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/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
    • 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
    • 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
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • 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
    • 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
    • B25J19/063—Safety devices working only upon contact with an outside object
    • 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/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • 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/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • B25J9/041—Cylindrical coordinate type
    • B25J9/042—Cylindrical coordinate type comprising an articulated arm
    • 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
    • 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/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
    • 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • 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/39—Robotics, robotics to robotics hand
    • G05B2219/39082—Collision, real time collision avoidance
    • 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/39—Robotics, robotics to robotics hand
    • G05B2219/39089—On collision, lead arm around obstacle manually
    • 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/39—Robotics, robotics to robotics hand
    • G05B2219/39237—Torque disturbance control

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Manipulator (AREA)

Abstract

본 발명의 바람직한 일 실시예로서, 협동로봇제어장치는 협동로봇의 충돌을 감지하는 충돌감지부; 상기 충돌감지부에서 충돌 감지시 상기 협동로봇의 동작모드를 제어하는 제어부;및 상기 충돌감지부에서 충돌 감지시 상기 협동로봇을 구성하는 다수의 관절 각각에 충돌보완값을 적용하여 상기 다수의 관절 각각의 힘의 진행방향을 변경하는 충돌대응부;를 포함하는 것을 특징으로 한다.

Description

협동로봇제어장치 및 협동로봇을 제어하는 방법{Method and Apparatus for controlling a collaborativve robot}
본원 발명은 협동로봇에 관한 것이다. 보다 상세히 협동로봇의 충돌시 협착방지를 위한 제어방법에 관한 것이다.
일반 산업용 로봇은 인간에 의한 동작이나 감독이 없이도 정확한 작업을 수행하기 위해 생산 라인 등에서 광범위하게 사용되고 있다. 예를 들면 자동차 산업에서 사용되고 있는 로봇은 자동차의 몸체를 운반하거나 용접하는 등의 여러 가지 작업을 수행하고 있다.
지능형 서비스 로봇은 일반 산업용 로봇과는 달리 사람이 거주하고 활동하는 공간 내에서 작업을 수행하게 된다. 따라서, 인간과 부딪쳐서 인간에게 충격을 가할 위험성이 있으므로 로봇이 사람에 대해 어느 정도의 안전성을 확보할 수 있는가가 중요한 사양이 된다. 특히 지능형 서비스 로봇 중에서 사람과의 충돌 발생 가능성이 가장 높은 협동로봇의 경우 더욱 그러하다.
협동로봇이 충돌한 경우, 협동로봇의 드라이버에 에러가 발생하거나 또는 충돌이 발생한 장애물과 협착이 발생한 이후 2차 피해가 발생될 수 있다. 특히, 충돌시간이 길수록 충돌로 인한 피해가 커지는 문제가 있다. 이외에도 협동로봇이 고속으로 이동하다 충돌한 경우 협동로봇이 낙하할 수 있는 문제가 있다.
KR 10-1329853
본 발명의 바람직한 일 실시예에서는, 협동로봇에서 충돌을 감지한 경우, 충돌한 물체에 가장 적은 피해를 가하도록 충돌 시간을 최소화하는 방법을 제시한다.
본 발명의 또 다른 바람직한 일 실시예에서는, 협동로봇에서 충돌을 감지한 후 충돌 이전의 상태로 빠르게 복귀하여 작업을 지속하는 방법을 제시한다.
본 발명의 바람직한 일 실시예로서, 협동로봇제어장치는 협동로봇의 충돌을 감지하는 충돌감지부; 상기 충돌감지부에서 충돌 감지시 상기 협동로봇의 동작모드를 제어하는 제어부;및 상기 충돌감지부에서 충돌 감지시 상기 협동로봇을 구성하는 다수의 관절 각각에 충돌보완값을 적용하여 상기 다수의 관절 각각의 힘의 진행방향을 변경하는 충돌대응부;를 포함하는 것을 특징으로 한다.
본 발명의 바람직한 일 실시예로서, 상기 제어부는 상기 충돌감지부에서 충돌 감지시, 상기 동작모드를 포지션모드(Position Mode)에서 토크모드(Torque Mode)로 변환하는 것을 특징으로 한다.
본 발명의 바람직한 일 실시예로서, 상기 제어부는 상기 충돌대응부에서 상기 충돌보완값을 적용하여 힘의 진행방향을 변화시킨 후, 상기 동작모드를 토크모드에서 포지션모드로 변환하는 것을 특징으로 한다.
본 발명의 바람직한 일 실시예로서, 상기 충돌대응부는 상기 충돌감지부에서 충돌 감지시 상기 협동로봇을 구성하는 다수의 관절 각각에 상이한 충돌보완값을 적용하여 다수의 관절 각각에 적용되는 힘의 진행방향을 변화시키는 것을 특징으로 한다.
본 발명의 바람직한 일 실시예로서, 상기 충돌감지부는 상기 제어부에서 상기 협동로봇의 다이내믹스에 따라 각 관절에서 필요한 토크값을 예측한 예측토크값과 실시간으로 상기 협동로봇을 구성하는 다수의 관절 각각에서 측정된 측정토크값과의 차이가 기설정된 값을 초과하는 경우 충돌로 감지하는 것을 특징으로 한다.
본 발명의 또 다른 바람직한 일 실시예로서, 협동로봇제어장치는 협동로봇의 충돌을 감지하는 충돌감지부; 상기 충돌감지부에서 충돌 감지시 상기 협동로봇의 동작모드를 포지션모드에서 토크모드로 변경하는 제어부;및 상기 토크모드에서 상기 협동로봇을 구성하는 다수의 관절 각각에 충돌보완값을 적용하여 힘의 진행방향을 변화시키는 충돌대응부;를 포함하고, 상기 충돌대응부에서 상기 충돌보완값을 적용하면 상기 제어부는 상기 동작모드를 상기 토크모드에서 상기 포지션모드로 다시 변경하는 것을 특징으로 한다.
본 발명의 바람직한 일 실시예에서는 협동로봇을 제어하여 충돌이 발생한 경우, 충돌 시간을 짧게 최소화하도록 충돌이 가해진 방향의 힘의 반대방향에 해당하는 토크를 보완한다.
본 발명의 바람직한 일 실시예에서는 협동로봇의 충돌 발생시 동작모드를 변경하여 충돌에 유연하게 대응할 수 있는 효과가 있다.
본 발명의 바람직한 일 실시예에서는 협동로봇의 충돌 위치와 크기 및 방향 등 다양한 충돌 상황을 효과적으로 감지하여 이에 유연하게 대처함으로써, 더욱 효율적이고 안전하게 사람과 로봇의 협업을 가능하게 하는 효과가 있다.
도 1 은 본 발명의 바람직한 일 실시예로서, 협동로봇(100)의 일 예를 도시한다.
도 2 는 본 발명의 바람직한 일 실시예로서, 협동로봇(200)의 내부 구성도를 도시한다.
도 3 은 본 발명의 바람직한 일 실시예로서, 협동로봇(100)이 장애물(120)과 충돌이 발생한 경우(S310)와 충돌 이후 협착이 이루어진 경우(S320)의 일 예를 도시한다.
도 4 내지 5 는 본 발명의 바람직한 일 실시예로서, 도 3 의 일 실시예와 같이 협동로봇이 장애물과 충돌한 경우와 충돌 이후 협착이 이루어진 경우 협동로봇에 부가된 시간에 따른 힘의 변화량을 각각 도시한다.
도 6 은 본 발명의 바람직한 일 실시예로서, 협동로봇이 구동되는 시스템도를 도시한다.
도 7 은 본 발명의 바람직한 일 실시예로서, 협동로봇에서 충돌 발생시 이를 제어하는 방법의 흐름도를 도시한다.
이하, 본 발명의 바람직한 실시예를 첨부된 도면들을 참조하여 상세히 설명한다. 우선 각 도면의 구성요소들에 참조부호를 부가함에 있어서, 동일한 구성요소들에 대해서는 비록 다른 도면상에 표시되더라도 가능한 한 동일한 부호를 가지도록 하고 있음에 유의해야 한다. 또한, 본 발명을 설명함에 있어, 관련된 공지 구성 또는 기능에 대한 구체적인 설명이 본 발명의 요지를 흐릴 수 있다고 판단되는 경우에는 그 상세한 설명은 생략한다.
도 1 은 본 발명의 바람직한 일 실시예로서, 협동로봇(100)의 일 예를 도시한다.
본원 발명의 바람직한 일 실시예에서 협동로봇(100)은 링크(111, 112, 113, 114)와 관절(101, 102, 103)로 구성된 형태의 로봇 바디를 모두 지칭한다. 특히, 협동로봇(100)은 인간의 손과 팔의 형태로 이루어져 손과 팔의 동작을 제공할 수 있다.
협동로봇(100)은 다수개의 링크(111, 112, 113, 114)가 연결된 형태로 구성되고, 각각의 링크 연결부위에 관절(101, 102, 103)이 배치된다. 본 발명의 바람직한 일 실시예로서, 각 링크(111, 112, 113, 114)에는 일체형 액츄에이터(도 2 참고)가 장착되어 관절(101, 102, 103)을 중심으로 회전을 수행할 수 있다. 도 1 에서는 관절(101)이 회전하는(101) 일 예를 도시하고 있다.
각 관절(101, 102, 103)은 링크(111, 112, 113, 114)의 위치, 속도, 가속도, 무게 등에 따라 토크가 발생한다. 각 관절(101, 102, 103)은 해당 링크(111, 112, 113, 114)의 회전 운동시 발생하는 관절(101, 102, 103)과 링크(111, 112, 113, 114) 사이의 토크를 측정할 수 있다. 각 관절(101, 102, 103)은 실시간으로 토크를 측정한다. 도 6을 참고하면, 각 관절(101, 102, 103)에는 일체형 액츄에이터(620)가 설치되어 일체형 액츄에이터(620) 내의 드라이버에서 사용되는 모터 토크 상수를 이용하여 토크를 추정할 수 있다.
도 2 는 본 발명의 바람직한 일 실시예로서, 협동로봇(200)의 내부 구성도를 도시한다.
본 발명의 바람직한 일 실시예로서, 협동로봇(200)은 충돌감지부(210), 제어부(220) 및 충돌 대응부(230)를 포함한다.
본 발명의 바람직한 일 실시예로서, 협동로봇(200)은 충돌감지부(210)에서 충돌이 감지되면, 제어부(220)에서 협동로봇(200)의 구동모드를 제어한다. 제어부(220)는 충돌감지부(210)로부터 충돌이 감지되었다는 신호를 수신하면, 협동로봇(200)의 구동모드를 포지션모드(Position Mode)에서 토크모드(Torque Mode)로 변경시키고, 충돌대응부(230)에서 협동로봇(200)의 각 관절(도 1, 101, 102, 103 참고)에 충돌보완값을 적용하여 협동로봇(200)이 충돌로 인해 협착(도 3, S320 참고)되는 것을 방지한다. 충돌대응부(230)에서 충돌보완값을 적용하여 충돌 상황이 해소된 경우, 제어부(220)는 구동모드를 토크모드에서 포지션모드로 재변경할 수 있다.
각 구성에 대해 상세히 살펴본다.
본 발명의 바람직한 일 실시예로서, 충돌감지부(210)는 도 3을 참고하면 협동로봇(100)과 장애물(120)과의 충돌(S310)을 감지한다. 도 3 에서는 협동로봇(100)의 관절(101)이 회전하면서(S300) 물체(120)와 충돌(S310)이 발생하였고, 충돌(S310) 이후 일정 시간이 경과하여 협착(S320)이 발생된 예를 도시하고 있다.
본 발명의 바람직한 일 실시예로서, 충돌감지부(210)는 협동로봇의 다이내믹스에 따라 각 관절에서 필요한 토크값을 예측한 예측토크값과 실시간으로 상기 협동로봇을 구성하는 다수의 관절 각각에서 측정된 측정토크값과의 차이가 기설정된 값을 초과하는 경우 충돌로 감지한다.
본 발명의 바람직한 일 실시예로서, 제어부(220)는 각 관절에 필요한 토크값을 예측한 예측토크값을 기저장할 수 있다. 예측토크값은 실제로 로봇이 움직이는데 필요한 토크값을 제어부(220)에서 계산한 값을 지칭한다. 제어부(220)는 또한 각 관절의 토크를 실시간으로 측정한 측정토크값을 관리한다. 측정토크값은 각 관절에 설치된 모터의 전류값을 측정하여, 실시간으로 파악한 토크값을 지칭할 수 있다.
제어부(220)는 협동로봇의 다이내믹스와 마찰모델을 이용하여 예측토크값을 계산하고 기저장할 수 있다.다이내믹스는 협동로봇을 구성하는 링크와 관절들 사이의 기하학적인 관계에 따른 운동 특성을 지칭한다. 다이내믹스는 로봇 동역학, 로봇의 위치, 속도, 가속도, 중력, 로봇 링크의 무게, 링크의 무게중심, 링크의 관성모멘트 등을 통해 로봇 운동시 각 관절에서 토크를 계산한다. 다이내믹스는 링크에 따른 Inertia 항, Coriolis 항 및 중력항을 포함하는 방정식으로 표시할 수 있다. 마찰모델(Friction Model)은 협동로봇에 설치된 모터의 출력(도 6, 622 참고)와 감속기(도 6, 621) 출력 간의 손실 토크를 수학적으로 모델링한 것이다.
본 발명의 바람직한 일 실시예로서, 제어부(220)에서 충돌감지부(210)로부터 충돌이 발생하였다는 신호를 수신하면, 협동로봇(200)의 동작모드를 포지션모드에서 토크모드로 변환한다.
본원 발명의 바람직한 일 실시예로서, 협동로봇(200)이 포지션모드(Position Mode)로 동작할 경우, 협동로봇(200)은 충돌과 같은 외력과 무관하게 포지션(Position)명령에 따라 제어된다. 포지션모드에서 협동로봇(100)에 충돌이 발생할 경우, 액츄에이터의 드라이버(도 2, 264)는 피드백 루프(Feedback loop)로 구성되어 외력에 무관하게 포지션명령을 내려, 협동로봇(100)의 다이내믹스를 제어한다. 협동로봇(200)의 다이내믹스는 제어부(220)가 협동로봇(200)의 각 링크(도 1 ,111, 112, 113, 114 참고)에 장착된 일체형 액츄에이터의 드라이버(도 6, 601~606 참고)에 제공한 포지션명령에 따라 제어된다. 포지션명령은 모터가 가야할 위치정보를 포함한다.
그러나, 제어부(220)가 협동로봇(200)의 충돌을 감지하고, 협동로봇(200)에 멈춤(Stop) 명령을 내리기까지 협동로봇(200)이 포지션모드로 계속 동작할 경우 도 3의 일 실시예와 같이 충돌방향에서 협착상태(S320)가 발생할 수 있는 문제점이 있다. 또한, 멈춤명령이 해제될때까지 협동로봇(100)이 정지한 위치에 고정되므로 협착시 협착상태가 유지될 수 있는 문제가 있다. 이러한 문제점을 해결하기 위해, 본 발명의 바람직한 일 실시예에서는 충돌 발생시 협동로봇(200)의 동작모드를 토크 모드로 변환한다.
본원 발명의 바람직한 일 실시예로서, 협동로봇(200)이 토크 모드(Torque Mode)로 동작할 경우, 협동로봇(200)은 충돌과 같은 외력과 무관하게 토크(Torque)명령에 따라 제어된다. 토크모드에서 협동로봇(200)에 충돌이 발생할 경우, 액츄에이터의 드라이버(도 6, 601~605 참고)는 오픈 루프(open loop)로 구성되어 외력에 무관하게 토크 명령을 내려, 협동로봇(200)의 다이내믹스를 제어한다. 제어부(200)는 일체형 액츄에이터의 모터(도 2, 262)가 출력한 토크값을 계산하여 드라이버(도 6, 622)에 제공하여, 협동로봇(200)의 다이내믹스를 제어한다.
본원 발명의 바람직한 일 실시예에서는, 협동로봇(200)이 토크 모드(Torque Mode)로 동작하는 동안 사용자가 필요한 경우 수동으로 협동로봇(200)의 위치를 안전한 곳으로 이동할 수 있다.
본원 발명의 바람직한 일 실시예에서, 충돌대응부(230)는 충돌 발생시 협동로봇(200)의 각 관절의 위치, 속도 내지 가속도 값에 기초하여 충돌보완값을 계산한다. 충돌대응부(230)는 충돌 발생시 협동로봇(200)의 각 관절의 위치, 속도 내지 가속도 값에 기초하여 충돌의 크기, 방향을 파악할 수 있고, 충돌의 크기 및 방향에 반작용의 힘으로 적용할 수 있는 충돌보완값을 계산한다.
예를 들어, n개의 관절을 가진 협동 로봇(200)의 관절 k에 충돌이 발생할 경우, 1 부터 k까지의 관절에 가해지는 외력은 충돌로 인해 급격히 상승하며, k+1부터 n까지 관절에서의 외력은 크게 변화하지 않는다. 외력이 급격히 상승한 1 부터 k까지의 관절은 관절의 위치, 속도 및 가속도의 변화량이 높을 가능성이 높다. 반면, 외력의 변화가 크지 아니한 k+1부터 n까지의 관절은 관절의 위치, 속도 및 가속도의 변화량이 낮을 가능성이 높다.
본 발명의 바람직한 일 실시예로서, 충돌대응부(230)는 협동로봇(200)의 충돌이 검출된 경우, 각 관절의 위치변화량에 비례하는 충돌보완값을 계산할 수 있다. 위치변화량을 위치벡터로 검출하고, 위치변화량에 비례하는 충돌보완값을 계산하여 각 관절마다 상이하게 적용할 수 있다.
본 발명의 바람직한 일 실시예로서, 충돌대응부(230)는 협동로봇(200)의 충돌이 검출된 경우, 각 관절의 속도값에 비례하는 충돌보완값을 계산할 수 있다. 속도값이 높은 관절일수록 높은 충돌보완값을 적용할 수 있다.
본 발명의 바람직한 일 실시예로서, 충돌대응부(230)는 협동로봇(200)의 충돌이 검출된 경우, 각 관절의 가속도값의 변화량에 비례하는 충돌보완값을 계산할 수 있다.
본 발명의 바람직한 일 실시예로서, 충돌대응부(230)는 협동로봇(200)의 충돌이 검출된 경우, 각 관절의 위치, 속도 및 가속도 중 적어도 하나 이상의 변수에 기초하여 충돌보완값을 계산할 수 있다.
본 발명의 바람직한 일 실시예로서, 충돌대응부(230)는 충돌보완값의 범위를 협동로봇(200)의 충돌이 검출되기 일정시간 이전 동작 또는 직전 동작의 위치 및 속도를 참고하여 설정할 수 있다.
본 발명의 바람직한 일 실시예로서, 충돌감지부(210)에서 충돌을 감지한 후 제어부(220)에서 동작모드를 포지션 모드(221)에서 토크모드(222)로 변환하여 충돌대응부(230)에서 충돌보완값을 적용하여 협동로봇(200)에서 충돌이 사라진 경우, 제어부(220)는 동작모드를 토크모드(222)에서 포지션 모드(221)로 재설정할 수 있다.
도 3 은 본 발명의 바람직한 일 실시예로서, 협동로봇(100)이 장애물(120)과 충돌이 발생한 경우(S310)와 충돌 이후 협착이 이루어진 경우(S320)의 일 예를 도시한다.
협동로봇(100)의 운동시 도 3에 도시된 바와 같이 링크(111)의 운동 경로 상에 장애물(120)이 위치할 경우, 협동로봇(100)의 링크(111)와 장애물(120)간에 충돌(S310)이 발생하게 되고, 충돌 이후 협착(S320)이 발생할 수 있다.
본 발명의 바람직한 일 실시예에서는, 협동로봇(100)이 장애물(120)과 충돌(S310)이 발생한 경우, 협동로봇(100)이 힘을 작용한 방향(S300)과 반대방향으로 반작용의 힘을 충돌보완값으로 적용할 수 있다.
도 4 내지 5 는 본 발명의 바람직한 일 실시예로서, 도 3 의 일 실시예와 같이 협동로봇이 장애물과 충돌한 경우와 충돌 이후 협착이 이루어진 경우 협동로봇에 부가된 시간에 따른 힘의 변화량을 각각 도시한다.
도 4 는 도 3 에서 협동로봇(100)이 장애물(120)과 충돌한 경우, 협동로봇(100)의 충돌부위가 받는 힘의 변화량을 그래프(400)로 도시한다. 0.5 sec에서 충돌이 발생하여, 충돌 방향의 힘(S310)이 가해진 것을 확인할 수 있다. 본 발명의 바람직한 일 실시예에서는 충돌보완값(S410)을 충돌 방향의 힘(S310)의 반대방향으로 가하도록 설정할 수 있다.
도 5 는 도 3 에서 협동로봇(100)이 장애물(120)과 충돌한 후 협착(S320)이 발생한 경우(S320) 협동로봇(100)의 협착부위가 받는 힘의 변화량을 그래프(500)로 도시한다.
도 6 은 본 발명의 바람직한 일 실시예로서, 협동로봇이 구동되는 시스템도를 도시한다.
협동로봇(600)은 다수의 관절과 링크로 구현될 수 있으며, 다수의 관절 각각에는 일체형 액츄에이터(Actuator)(620)가 설치될 수 있다. 도 6의 협동로봇(600)은 6개의 관절에 6개의 일체형 액츄에이터(601~606)가 설치되어 있는 일 예를 도시한다. 일체형액츄에이터(620)는 감속기(621), 모터(622), 브레이크(623), 드라이버(624)가 하나로 이루어진 모듈로, 드라이버(624)는 모터(622)를 제어한다. 도 6에는 6개의 드라이버(601~606)로 표시되어 있으나, 6개의 일체형액츄에이터로 설치할 수 있다.
협동로봇(600)은 제어부(620)와 제어프로토콜을 이용하여 통신을 수행할 수 있다. 제어부(620)는 또한 단말기(640)와 유무선으로 통신이 가능하며, 단말기(640)를 통해 제어부(620)의 기능을 제어할 수 있다.
이하에서, 제어부(620)의 내부 구성도 및 각 구성의 특징을 살펴본다.
제어부(620)의 내부 구성도를 참고하면, 제어부(620)는 사용자인터페이스(621), 컨트롤러(622), 필드프로토콜서비스(630, Field Protocol Service) 및 하드웨어 추상화부(631, Hardware Abstraction Layer)를 포함한다.
본 발명의 바람직한 일 실시예로서, 컨트롤러(622)는 이벤트컨트롤러(623), 다이내믹컨트롤러(624, Dynamic Controller), 마찰모델링부(625, Friction Model), 충돌관리부(626), 안전관리부(627), 운동학 제어부(628, Kinematic Controller) 및움직임제어부(629)를 포함한다.
본 발명의 바람직한 일 실시예로서, 이벤트컨트롤러(623)는 협동로봇(600)에서 발생하는 이벤트를 검출한다. 이벤트는 충돌 이벤트를 포함한다.
본 발명의 바람직한 일 실시예로서, 다이내믹컨트롤러(624)와 마찰모델링부(625)는 협동로봇(600)의 각 관절에 부가되는 토크값을 예상하여 예상토크값을계산하고, 이를 저장한다. 다이내믹컨트롤러(624)는 로봇의 다이내믹마다 요구되는 토크값을 계산한다. 마찰모델링부(625)는 모터의 출력토크와 감속기의 출력토크간의 차이를 수학적으로 모델링한다. 일 예로, 감속기, 로봇 관절 내부의 기계적 요소로 발생하는 손실등을 수학적으로 모델링할 수 있다.
충돌관리부(626)는 충돌 발생시 협동로봇(200)의 각 관절의 위치, 속도 내지 가속도 값에 기초하여 충돌보완값을 계산한다. 안전관리(627)는 협동로봇(600)이 토크모드인 경우, 로봇을 안전한 위치로 수동으로 이동시키도록 구현될 수 있다.
운동학 제어부(628, Kinematic Controller) 및 움직임제어부(629)는 협동로봇의 관절과 링크 간의 기하학적 관계에 따라 운동 특성을 결정하고, 링크가 관절을 중심으로 회전하며 다양한 운동을 하도록 구현될 수 있다. 필드프로토콜서비스(630)는 협동로봇(600)과 제어부(620)간의 제어프로토콜을 관리하도록 구현된다. 제어프로토콜의 일 예로는 EtherCAT이 있다.
도 7 은 본 발명의 바람직한 일 실시예로서, 협동로봇에서 충돌 발생시 이를 제어하는 방법의 흐름도를 도시한다.
본 발명의 바람직한 일 실시예에서는 충돌감지부에서 협동로봇을 구성하는 다수의 관절 각각 중 적어도 하나에서 충돌을 감지한다(S710). 충돌감지부는 예상토크값과 측정토크값의 크기가 기설정된 값을 초과할 경우 충돌이 발생한 것으로 감지한다.
제어부는 충돌감지부에서 충돌을 감지하면, 협동로봇의 동작모드를 포지션모드에서 토크모드로 변경하여, 외력에 유연하게 대응한다(S720). 토크모드로 동작모드가 변경되면, 충돌대응부는 협동로봇의 다수의 관절 각각에 충돌로 발생한 힘의 반작용힘에 대응하는 충돌보완값을 적용하여 다수의 관절 각각의 힘의 진행방향을 변화시킨다(S730).
본 발명의 또 다른 바람직한 일 실시예에서 제어부는 다수의 관절 각각에 충돌보완값이 적용된 이후, 협동로봇의 동작모드를 토크모드에서 다시 포지션모드로 재변경을 수행할 수 있다(S740).
이상의 설명은 본 발명의 기술 사상을 예시적으로 설명한 것에 불과한 것으로서, 본 발명이 속하는 기술 분야에서 통상의 지식을 가진 자라면 본 발명의 본질적인 특성에서 벗어나지 않는 범위에서 다양한 수정 및 변형이 가능할 것이다. 따라서, 본 발명에 개시된 실시예들은 본 발명의 기술 사상을 한정하기 위한 것이 아니라 설명하기 위한 것이고, 이러한 실시예에 의하여 본 발명의 기술 사상의 범위가 한정되는 것은 아니다. 본 발명의 보호 범위는 아래의 청구범위에 의하여 해석되어야 하며, 그와 동등한 범위 내에 있는 모든 기술 사상은 본 발명의 권리범위에 포함되는 것으로 해석되어야 할 것이다.
100, 200, 600 협동로봇
S310 충돌
S320 협착

Claims (14)

  1. 협동로봇의 충돌을 감지하는 충돌감지부;
    상기 충돌감지부에서 충돌 감지시 상기 협동로봇의 동작모드를 제어하는 제어부;및
    상기 충돌감지부에서 충돌 감지시 상기 협동로봇을 구성하는 다수의 관절 각각의 위치, 속도 및 가속도를 기초로 계산된 충돌보완값을 적용하여 상기 다수의 관절 각각의 힘의 진행방향을 변경하는 충돌대응부;를 포함하고,
    상기 제어부는 상기 충돌대응부에서 상기 충돌보완값을 적용하여 힘의 진행방향을 변화시켜 충돌 상황이 해소된 경우, 상기 동작모드를 토크모드에서 포지션모드로 재변경 하며, 상기 협동로봇을 구성하는 다수의 관절 각각에 상이한 충돌보완값을 적용하는 것을 특징으로 하는 협동로봇제어장치.
  2. 제 1 항에 있어서, 상기 제어부는
    상기 충돌감지부에서 충돌 감지시, 상기 동작모드를 포지션모드(Position Mode)에서 토크모드(Torque Mode)로 변환하는 것을 특징으로 하는 협동로봇제어장치.
  3. 삭제
  4. 삭제
  5. 제 1 항에 있어서, 상기 충돌대응부는
    상기 다수의 관절 각각에 상기 계산된 충돌보완값을 적용하여 다수의 관절 각각에 적용되는 힘의 진행방향을 변화시키는 것을 특징으로 하는 협동로봇제어장치.
  6. 제 5 항에 있어서, 상기 충돌대응부에서 계산하는
    상기 충돌보완값은 상기 충돌로 상기 다수의 관절에 부가된 충돌의 크기 및 방향에 반작용 힘으로 적용할 수 있는 값인 것을 특징으로 하는 협동로봇제어장치.
  7. 삭제
  8. 삭제
  9. 삭제
  10. 제 2 항에 있어서, 상기 제어부에서 동작모드를 토크모드로 변환한 경우 상기 토크모드 상태에서 상기 협동로봇의 위치를 수동으로 변경이 가능한 것을 특징으로 하는 협동로봇제어장치.
  11. 협동로봇의 충돌을 감지하는 충돌감지부;
    상기 충돌감지부에서 충돌 감지시 상기 협동로봇의 동작모드를 포지션모드에서 토크모드로 변경하는 제어부;및
    상기 토크모드에서 상기 협동로봇을 구성하는 다수의 관절 각각에 충돌보완값을 적용하여 힘의 진행방향을 변화시키는 충돌대응부;를 포함하고, 상기 충돌대응부에서 상기 충돌보완값을 적용하면 상기 제어부는 상기 동작모드를 상기 토크모드에서 상기 포지션모드로 다시 변경하며
    상기 충돌보완값은 상기 충돌감지부에서 충돌 감지시 상기 협동로봇을 구성하는 다수의 관절 각각의 위치, 속도 및 가속도를 기초로 계산되는 것을 특징으로 하는 협동로봇제어장치.
  12. 제 11 항에 있어서, 상기 토크모드에서
    상기 협동로봇의 위치를 수동으로 변경가능한 것을 특징으로 하는 협동로봇제어장치.
  13. 제 11 항에 있어서, 상기 충돌보완값은
    상기 충돌로 인하여 상기 협동로봇을 구성하는 다수의 관절 각각에 발생한 힘의 반작용힘이며, 상기 다수의 관절 각각에서 검출된 모터의 전류값을 기초로 파악한 토크값을 기초로 계산되는 것을 특징으로 하는 협동로봇제어장치.
  14. 협동로봇을 제어하는 방법으로서,
    충돌감지부에서 협동로봇을 구성하는 다수의 관절 각각 중 적어도 하나에서 충돌을 감지하는 단계;
    충돌 감지시 제어부에서 상기 협동로봇의 동작모드를 변경하는 단계;
    충돌 감지시 충돌대응부에서 상기 협동로봇을 구성하는 다수의 관절 각각에 충돌보완값을 적용하여 상기 다수의 관절 각각의 힘의 진행방향을 변화시키는 단계;및
    상기 충돌보완값을 적용하면 상기 제어부는 상기 동작모드를 상기 토크모드에서 상기 포지션모드로 다시 변경하는 단계;를 포함하고,
    상기 충돌보완값은 상기 충돌감지부에서 충돌 감지시 상기 협동로봇을 구성하는 다수의 관절 각각의 위치, 속도 및 가속도를 기초로 계산되며, 상기 협동로봇을 구성하는 다수의 관절 각각에 상이한 충돌보완값이 적용되는 것을 특징으로 하는 방법.
KR1020170116665A 2017-09-12 2017-09-12 협동로봇제어장치 및 협동로봇을 제어하는 방법 KR102370879B1 (ko)

Priority Applications (5)

Application Number Priority Date Filing Date Title
KR1020170116665A KR102370879B1 (ko) 2017-09-12 2017-09-12 협동로봇제어장치 및 협동로봇을 제어하는 방법
PCT/KR2017/012466 WO2019054558A1 (ko) 2017-09-12 2017-11-06 협동로봇제어장치 및 협동로봇을 제어하는 방법
US16/643,680 US11534918B2 (en) 2017-09-12 2017-11-06 Device and method for controlling cooperative robot
CN201780088838.2A CN110494260B (zh) 2017-09-12 2017-11-06 用于控制协作机器人的装置和方法
EP17925046.9A EP3683022A4 (en) 2017-09-12 2017-11-06 DEVICE AND PROCEDURE FOR CONTROLLING A COOPERATIVE ROBOT

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020170116665A KR102370879B1 (ko) 2017-09-12 2017-09-12 협동로봇제어장치 및 협동로봇을 제어하는 방법

Publications (2)

Publication Number Publication Date
KR20190029286A KR20190029286A (ko) 2019-03-20
KR102370879B1 true KR102370879B1 (ko) 2022-03-07

Family

ID=65723699

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020170116665A KR102370879B1 (ko) 2017-09-12 2017-09-12 협동로봇제어장치 및 협동로봇을 제어하는 방법

Country Status (5)

Country Link
US (1) US11534918B2 (ko)
EP (1) EP3683022A4 (ko)
KR (1) KR102370879B1 (ko)
CN (1) CN110494260B (ko)
WO (1) WO2019054558A1 (ko)

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102418451B1 (ko) * 2017-12-27 2022-07-07 주식회사 한화 로봇 제어 시스템
KR102356660B1 (ko) * 2019-11-01 2022-02-07 주식회사 뉴로메카 다자유도 협동 로봇의 마찰 보상 방법
CN111113487B (zh) * 2019-12-25 2021-08-27 深圳市优必选科技股份有限公司 一种机器人及其碰撞检测装置
TWI764377B (zh) * 2020-11-16 2022-05-11 達明機器人股份有限公司 機器人安全補償重量的系統及方法
CN112549024B (zh) * 2020-11-26 2022-05-24 华南理工大学 基于时间序列分析的机器人免传感碰撞检测方法及应用
KR102521151B1 (ko) 2021-05-26 2023-04-13 주식회사 뉴로메카 충돌감지 기능을 갖는 협동로봇 및 협동로봇의 충돌감지 방법
CN113352331B (zh) * 2021-08-11 2022-04-22 苏州艾利特机器人有限公司 一种机器人与外部对象力协作的方法及协作机器人
KR20230136435A (ko) 2022-03-18 2023-09-26 호남대학교 산학협력단 영상 기반 로봇 제어 시스템
CN114851189A (zh) * 2022-04-21 2022-08-05 上海发那科机器人有限公司 一种协作机器人的控制方法及协作机器人
CN114872041A (zh) * 2022-04-21 2022-08-09 上海发那科机器人有限公司 基于力觉传感器的协作机器人控制方法及协作机器人
CN115389077B (zh) * 2022-08-26 2024-04-12 法奥意威(苏州)机器人系统有限公司 碰撞检测方法、装置、控制设备及可读存储介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005100143A (ja) * 2003-09-25 2005-04-14 Kobe Steel Ltd モータ駆動装置の制御方法及び制御装置
JP2007249524A (ja) * 2006-03-15 2007-09-27 Daihen Corp ロボット制御装置
KR101329853B1 (ko) * 2012-11-14 2013-11-14 고려대학교 산학협력단 머니퓰레이터 충돌 감지 장치와 이를 이용한 머니퓰레이터 제어 장치 및 제어 방법

Family Cites Families (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2506214B2 (ja) * 1990-01-17 1996-06-12 オークマ株式会社 数値制御工作機械の衝突検出装置
JPH06332538A (ja) * 1993-05-19 1994-12-02 Fanuc Ltd 柔軟なサーボ制御方法
JP3212571B2 (ja) * 1999-03-26 2001-09-25 ファナック株式会社 産業用ロボット
CN100592967C (zh) * 2003-07-29 2010-03-03 松下电器产业株式会社 控制机器人的方法和设备
US8676379B2 (en) * 2006-07-04 2014-03-18 Panasonic Corporation Device and method for controlling robot arm, robot, and robot arm control program
JP4550849B2 (ja) * 2007-03-22 2010-09-22 株式会社東芝 アーム搭載移動ロボット
JP5017379B2 (ja) 2008-01-22 2012-09-05 パナソニック株式会社 ロボットアーム
KR101214685B1 (ko) * 2011-03-23 2013-01-09 고려대학교 산학협력단 주파수 기반 로봇 머니퓰레이터 제어 방법
CN107961076B (zh) * 2012-08-15 2020-07-07 直观外科手术操作公司 使用者启动的手术安装平台的断开式离合
KR101487624B1 (ko) 2013-11-01 2015-01-29 고려대학교 산학협력단 로봇 머니퓰레이터 제어 방법
KR20150080050A (ko) 2013-12-30 2015-07-09 전자부품연구원 다관절로봇의 충돌 감지 장치 및 이를 이용한 충돌 감지 방법
JP5937706B1 (ja) * 2015-01-21 2016-06-22 ファナック株式会社 ロボットに加わる外力に基づいてロボットを制御するロボット制御装置、およびロボットシステム
JP6517567B2 (ja) * 2015-03-31 2019-05-22 日本電産サンキョー株式会社 サーボモータ制御装置及び衝突検出方法
CN104985598B (zh) * 2015-06-24 2016-11-23 南京埃斯顿机器人工程有限公司 一种工业机器人碰撞检测方法
WO2017073052A1 (ja) * 2015-10-30 2017-05-04 川崎重工業株式会社 ロボットシステムの監視装置
US9917903B2 (en) * 2015-12-28 2018-03-13 Verizon Patent And Licensing Inc. Internet of things provisioning
CN107717982B (zh) * 2016-08-12 2020-09-25 财团法人工业技术研究院 机械手臂的控制装置及操作方法
JP7427358B2 (ja) * 2017-07-20 2024-02-05 キヤノン株式会社 ロボットシステム、物品の製造方法、制御方法、制御プログラム、および記録媒体

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005100143A (ja) * 2003-09-25 2005-04-14 Kobe Steel Ltd モータ駆動装置の制御方法及び制御装置
JP2007249524A (ja) * 2006-03-15 2007-09-27 Daihen Corp ロボット制御装置
KR101329853B1 (ko) * 2012-11-14 2013-11-14 고려대학교 산학협력단 머니퓰레이터 충돌 감지 장치와 이를 이용한 머니퓰레이터 제어 장치 및 제어 방법

Also Published As

Publication number Publication date
KR20190029286A (ko) 2019-03-20
EP3683022A1 (en) 2020-07-22
US11534918B2 (en) 2022-12-27
US20200269423A1 (en) 2020-08-27
EP3683022A4 (en) 2021-06-16
CN110494260A (zh) 2019-11-22
CN110494260B (zh) 2023-05-02
WO2019054558A1 (ko) 2019-03-21

Similar Documents

Publication Publication Date Title
KR102370879B1 (ko) 협동로봇제어장치 및 협동로봇을 제어하는 방법
CN111479660B (zh) 包括确保停止时间和距离的安全系统的机器人
KR101265903B1 (ko) 머니퓰레이터를 정지시키기 위한 방법 및 장치
US9579798B2 (en) Human collaborative robot system
US9452532B2 (en) Robot, device and method for controlling robot, and computer-readable non-transitory recording medium
KR101973709B1 (ko) 로봇 머니퓰레이터 제어 방법
US9821459B2 (en) Multi-joint robot having function for repositioning arm
US9421687B2 (en) Robot control apparatus and robot control method
US9469031B2 (en) Motion limiting device and motion limiting method
JP5218524B2 (ja) ロボットシステムおよびロボット動作規制方法
JP6445150B2 (ja) ロボット・マニピュレータを制御する方法、コンピュータ・システム、デジタル記録媒体、コンピュータ・プログラム製品、コンピュータ・プログラム、装置およびロボット
US8180488B2 (en) Robot system
JP4335286B2 (ja) 部品保護機能を備えたロボット制御装置及びロボット制御方法
CN108453728B (zh) 具有多模式控制框架的冗余欠驱动机器人
KR102418451B1 (ko) 로봇 제어 시스템
KR20150080050A (ko) 다관절로봇의 충돌 감지 장치 및 이를 이용한 충돌 감지 방법
KR101329853B1 (ko) 머니퓰레이터 충돌 감지 장치와 이를 이용한 머니퓰레이터 제어 장치 및 제어 방법
JP6417034B2 (ja) コボティックマニピュレーター
Je et al. Current based compliance control method for minimizing an impact force at collision of service robot arm
Freund et al. The basic ideas of a proven dynamic collision avoidance approach for multi-robot manipulator systems
KR20220120009A (ko) 로봇의 충돌 감지 장치 및 그 방법
Sekiya et al. Motion Control Considering Fusion of Mechanical and Virtual Impedance in Mobile Robot Systems
KR102645792B1 (ko) 로봇 매니퓰레이터의 충격량을 산출하는 검출장치 및 방법
JP7283994B2 (ja) ロボットの制御装置およびプログラミング装置

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
E701 Decision to grant or registration of patent right
GRNT Written decision to grant