KR101867626B1 - 적어도 하나의 공통 영역을 포함하여 각자의 작업 공간을 가지는 2대 이상의 로봇을 제어하는 방법 - Google Patents
적어도 하나의 공통 영역을 포함하여 각자의 작업 공간을 가지는 2대 이상의 로봇을 제어하는 방법 Download PDFInfo
- Publication number
- KR101867626B1 KR101867626B1 KR1020120033099A KR20120033099A KR101867626B1 KR 101867626 B1 KR101867626 B1 KR 101867626B1 KR 1020120033099 A KR1020120033099 A KR 1020120033099A KR 20120033099 A KR20120033099 A KR 20120033099A KR 101867626 B1 KR101867626 B1 KR 101867626B1
- Authority
- KR
- South Korea
- Prior art keywords
- robot
- region
- interference
- interference region
- hybrid
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 230000033001 locomotion Effects 0.000 claims description 15
- 238000012544 monitoring process Methods 0.000 claims description 7
- 230000002085 persistent effect Effects 0.000 claims description 2
- 230000000903 blocking effect Effects 0.000 claims 1
- 230000008859 change Effects 0.000 description 3
- 230000004913 activation Effects 0.000 description 2
- 230000009849 deactivation Effects 0.000 description 2
- 230000005764 inhibitory process Effects 0.000 description 2
- 230000002452 interceptive effect Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007257 malfunction Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
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
- 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
-
- 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/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]
-
- 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/39083—Robot interference, between two robot arms
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40219—Detect contact, proximity of other 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40306—Two or more independent robots
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Quality & Reliability (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
- General Factory Administration (AREA)
Abstract
적어도 하나의 공통 영역을 포함하여 각자의 작업 공간을 가지는 2대 이상의 로봇(3, 4)을 제어하는 방법은, 기본 기하학적 도형으로 각각 구성된 하나 이상의 간섭 영역(IR)을 형성함으로써, 로봇의 작업 공간에 존재하는 물체를 고려하여, 각 로봇의 작업 공간이 모델링 된다는 사실을 포함한다. 상기 간섭 영역은 다음의 세 개의 서로 다른 카테고리로 분류된다: 로봇의 존재가 절대적으로 금지되는 공간의 영역으로 정의되는 금지 간섭 영역(PIR); 로봇의 존재가 허용되지만 제어되는 공간의 영역으로 정의되는 감시 간섭 영역으로서(MIR), 로봇은 감시되는 영역으로 진입할 때 및 감시되는 영역으로 탈출할 때마다 중앙 제어 유닛에 신호를 전송하도록 구성되는 감시 간섭 영역; 상기 중앙 제어 유닛(7)에 의해 로봇으로 전송되는 입력 신호의 함수로서, 감시되는 간섭 영역의 상태와 금지 간섭 영역의 상태 간 변경이 가능한 공간의 영역으로 정의되는 하이브리드 간섭 영역(HIR); 하이브리드 영역으로 진입하려고 할 때마다, 진입 예약의 역할을 하는 제 1 출력 신호 및 하이브리드 영역으로 진입하려고 할 때마다, 진입 또는 존재의 경고 역할을 하는 제 2 출력 신호를 중앙 제어 유닛으로 전송하도록 각 로봇은 구성된다. 로봇(3, 4)의 동작 동안, 하이브리드 영역을 감시 영역 또는 금지 영역으로 만드는 입력 신호를 중앙 제어 유닛(7)으로부터 로봇으로 전송함에 따라, 각각의 하이브리드 영역의 상태가 각각의 로봇에 대해 동적으로 변한다.
Description
본 발명은, 다양한 로봇과 통신하고, 로봇의 공동 작업 영역에서 로봇 간의 간섭을 방지하면서 로봇의 동작을 통제하기 위해 제공되는 중앙 전자 유닛이 미리 구비되어 있는 적어도 하나의 공통 영역을 포함하여 각자의 작업 공간을 가지는 2대 이상의 로봇을 제어하는 방법에 관한 것이다.
공유 공간에서 작업을 해야 하는 많은 수의 로봇을 포함하는 산업용 셀의 표준화된 프로그래밍에 있어서, 로봇이 다음의 공정을 연속적으로 실행할 수 있도록 하기 위하여 각 로봇의 프로그램 내의 명령어를 결정하는 일이 필요하다.
1. 공용 영역 진입을 위한 예약 요청(제어 유닛으로의 출력 신호)
2. 공용 영역 진입에 대한 제어 유닛으로부터의 승낙 대기(제어 유닛에서 로봇으로의 입력 신호)
3. 공용 영역 내 존재 여부(출력 신호)
4. 공용 영역으로부터의 탈출
상기 연속의 명령어들은, (공용 영역의 작업 단계(working step)에 대응하는) 소위 말하는 인터블록(interblock) 프로그래밍이 예상되어지는, 프로그램의 각 개개의 파트에서 반복돼야 한다. 하나 이상의 공용 영역으로의 접속을 통제하는 정책 관리(management of the policy)는 제어 유닛(PLC)에 맡겨져 있는데, 제어 유닛은 상기 영역으로의 접속을 얻을 수 있는 로봇의 우선순위를 통제하는 작업을 맡는다. 두 개의 로봇만이 하나의 공통 작업 영역을 공유하는 프로그램의 간단한 예에서, 로봇 R1으로부터 접속 요청이 주어지는 경우에, PLC는 로봇 R2로부터의 어떠한 계류중인 요청이 있지 않다는 것과 로봇 R2는 공용 영역에서 작동 중이 아님을 체크한다. 상기의 경우라면, 로봇 R1으로의 접속이 허용된다. 비슷하게, R2의 접속에 대해 정책을 다시 만드는 것도 가능하다. PLC 접속의 상기 시스템은 첨부된 도 1에서 보이듯이 도식적으로 표현될 수 있다.
로봇 프로그램은, 자신의 파트에 있어서, 공용 영역으로의 접속 및 공용 영역으로부터의 탈출 정책을 적절히 관리하기 위한 방식으로 (접속을 위한)입력신호 및 (예약 및 공용 영역 내 존재 여부에 대해 PLC와 통신하기 위한) 출력을 관리할 수 있어야 한다. 로봇 프로그램의 보기는 다음과 같다.
send(req_I2, ON)
wait(cons_I2, ON)
send(interf_I2, OFF)
send(req_I2, OFF)
MOVEFLY JOINT TO pnt0650x ADVANCE
MOVEFLY JOINT TO pnt0150x ADVANCE
MOVEFLY JOINT TO pnt0653x ADVANCE
MOVE JOINT TO wp4661,
WITH CONDITION[spot(1, 4661, 1, FALSE)],
ENDMOVE
MOVEFLY JOINT TO pnt0444x ADVANCE
MOVEFLY JOINT TO pnt0443x ADVANCE
MOVEFLY JOINT TO pnt0442x ADVANCE
MOVE JOINT TO xtn0008X
Send (interf_I2, ON)
보여지듯이, 인터블록 영역 I2로의 접속 요청을 나타내는 신호 req_I2의 전송이 고려된다. 이 신호에 이어서, 시스템은 인터블록 영역으로의 접속을 가능하게 하기 위하여 PLC에 의해 전송되어야 할 신호 cons_I2를 기다리고 있다. 일단 PLC로부터 승인이 얻어지면, 로봇은 간섭 영역 점령의 신호 interf_I2를 송신하고 예약 신호인 req_I2를 영에 송신한다. 결국, 상기의 행동을 수행한 후, 로봇은 인터블록 영역 점령의 신호인 interf_I2를 영에 송신한다.
위와 같은 종류의 구조에서, 주요 제한들은 다음과 같다:
- 로봇 프로그램의 흐름이 수정되면, 시스템을 부조화의 상황으로 세팅할 가능성이 높아진다; 예를 들면, 만약 로봇이 수동으로 공용 영역으로 움직여지는 경우(PROG에서), PLC는 로봇의 존재에 대한 경고를 받지 못하고, 이는 결과로서 예상되는 로봇 간의 충돌과 더불어, 인터블록 시스템의 전체적인 오작동을 야기할 수 있다;
- 각각의 단일 인터블록에 대해 공용 영역의 예약, 대기, 존재 여부 및 포기에 대한 명령을 입력할 필요가 있는 한, 로봇 프로그램의 복잡도가 특히 높다;
- 공용 영역에서 로봇의 존재 여부를 식별하기 위한, 로봇의 위치에 대한 실시간 제어는 존재하지 않는다; 로봇 동작 프로그램의 비활성화(de-activation)는, 프로그래밍에 있어서 로봇 간 충돌 방지를 위한 어떤 타입의 제어도 존재하지 않음을 의미한다;
- 로봇 작동 프로그램에 대한 가능한 수정이, 반드시 하나 또는 복수의 프로그램의 각각의 파트의 인터블록에 관한 명령의 일관된 수정을 의미하지는 않는다;
- 다른 제한으로, 사용자가 작동 프로그램에서 몇몇 명령어를 빠뜨릴 수도 있다는 것(로봇의 작동 프로그램의 시험을 위하여, 프로그램의 초기 단계에서 일반적으로 만들어지는 바이패스(bypass)) 또는 프로그램 내에서 커서를 잘못 옮겨, 예를 들면 인터블록 영역의 접속 또는 점령의 요청 연산을 건너뛰는 것이 매우 빈번하게 발생한다는 것이다.
본 발명의 목적은 상기의 단점을 극복하는 것이다.
상기의 목적을 이루기 위한, 본 발명의 주제는, 다양한 로봇과 통신하고, 로봇의 공동 작업 영역에서 로봇 간의 간섭을 방지하면서 로봇의 동작을 통제하기 위해 제공되는 중앙 전자 유닛이 미리 구비되어 있는 적어도 하나의 공통 영역을 포함하여 각자의 작업 공간을 가지는 2대 이상의 로봇을 제어하는 방법으로서,
상기 방법의 특징은 다음과 같다:
- 기본 기하학적 도형으로 각각 구성된 하나 이상의 간섭 영역(IR)을 형성함으로써, 로봇의 작업 공간에 존재하는 물체를 고려하여, 각 로봇의 작업 공간이 모델링 된다.
- 상기 간섭 영역은 다음의 세 개의 서로 다른 카테고리로 분류된다.
- 예를 들면 로봇과 간섭을 일으키지 말아야 될 하나 또는 그 이상의 물체의 지속적인 존재 때문에, 로봇의 존재가 절대적으로 저지되는 공간의 영역으로 정의되는 금지 간섭 영역(prohibited interference regions: RIP);
- 로봇의 존재가 허용되지만 제어되는 공간의 영역으로 정의되는 감시 간섭 영역(monitored interference regions: MIR)으로서, 로봇은 감시되는 영역으로 진입할 때 및 감시되는 영역에서 탈출할 때마다 중앙 제어 유닛에 신호를 전송하도록 구성되는 특징의, 감시 간섭 영역(monitored interference regions: MIR); 그리고
- 상기 중앙 제어 유닛에 의해 로봇으로 전송되는 입력 신호의 함수로서, 감시되는 간섭 영역의 상태와 금지 간섭 영역의 상태 간 변경이 가능한 공간의 영역으로 정의되는 하이브리드 간섭 영역(hybrid interference regions: HIR);
- 하이브리드 영역으로 진입하려고 할 때마다, 진입 예약의 역할을 하는 제 1 출력 신호 및 하이브리드 영역으로 진입할 때마다, 진입 또는 존재의 경고 역할을 하는 제 2 출력 신호를 중앙 제어 유닛으로 전송하도록, 각 로봇은 구성된다; 그리고
- 로봇의 동작 동안, 하이브리드 영역에 타 로봇이 존재하는지 여부에 따라, 하이브리드 영역을 감시 영역 또는 금지 영역으로 만드는 입력 신호를 중앙 제어 유닛으로부터 로봇으로 전송함에 따라, 각각의 하이브리드 영역의 상태가 각각의 로봇에 대해 동적으로 변한다.
다른 특징에 의하면, 주어진 로봇에 대해, 상기 입력 신호를 중앙 제어 유닛에 의해 상기 로봇으로 전송함으로써, 특정 로봇에 대해 하이브리드 영역이 금지 영역의 상태로 전환되고, 상기 로봇이 상기 영역을 향해 이동하는 경우, 로봇은 자신의 속력이 0이 되는 하이브리드 영역의 한계에 도달할 때까지 제어되는 방식으로 감속되는 반면, 상기 영역이, 이 영역을 감시 영역의 상태로 만드는 새로운 입력 신호를 이용해 다시 활성화되는 경우, 이 시스템은, 로봇이 여전히 진행하는 상태에서 로봇의 계류중인 움직임을 막지 않고서도, 자동으로 로봇의 움직임을 복구한다.
보여지듯이, 본 발명에 따른 상기 방법은 기본적으로 종래 기술인 순차 동작 모드(sequential operating mode)를 채용하는 대신, 로봇을 병렬로 제어하는 데에 특징이 있다. 특히, 본 발명의 방법은, 로봇으로부터의 출력 신호를 수단으로 하는 각 로봇의 작업 공간 제어의 예상과 더불어, PLC로부터 로봇으로의 입력 신호를 가지고 하이브리드 영역으로의 진입 저지의 활성화/비활성화를 관리할 가능성을 또한 예정하고 있으며 더욱이 하이브리드 영역으로의 진입 예약을 위한 PLC로의 더 많은 출력 신호를 규정할 가능성도 예정하고 있다. 상기 방법은 더욱이, 금지 간섭 영역의 한계 부근에서의 급정지를 막고 가능하면 빨리 로봇의 운동을 재개하는 방식으로 로봇 운동의 자동 정지 및 재개와, 정지 및 재개 속도의 조절을 관리한다.
본 발명의 또 다른 특징과 장점은 첨부된 도면을 참고하여 후속 설명으로부터 나올 것인데, 도면은 오로지 무제한의 예시 및 다음과 같은 방식에 의하여 제공된다:
- 도 1은 알려진 기술에 따른 방법에 대응하면서, 상기 이미 설명된 블록도를 표현한다.
- 도 2는 공용 영역을 포함하여 각자의 작업 공간을 가진 두 개의 산업용 로봇을 포함하는 셀의 도식적인 투시도이다;
- 도 3 내지 도 6은 각 로봇의 작업 공간에서 간섭 영역을 규정하는데 사용하는 여러 다른 기하학적 그림들이다.
- 도 1은 알려진 기술에 따른 방법에 대응하면서, 상기 이미 설명된 블록도를 표현한다.
- 도 2는 공용 영역을 포함하여 각자의 작업 공간을 가진 두 개의 산업용 로봇을 포함하는 셀의 도식적인 투시도이다;
- 도 3 내지 도 6은 각 로봇의 작업 공간에서 간섭 영역을 규정하는데 사용하는 여러 다른 기하학적 그림들이다.
도 2를 참고로 하면, 셀(1)은 예를 들면 부품의 조립 및/또는 용접 작업을 수행하는 두 대의 로봇(3, 4)이 있는 작업대(2)가 구비된 워크스테이션으로 예상된다. 두 대의 로봇(3, 4)은 각자의 전자 제어 유닛(5, 6)에 의하여 제어되는데, 유닛(5, 6) 모두 차례로 본 발명에 따르는 방법을 구현하는데 사용되는 중앙 전자 제어 유닛(7)에 연결되어 있다. 예를 들면, 중앙 유닛(7)은 셀(1)을 제어하기 위한 PLC로 구성될 수 있다. 그러나 중앙 제어의 기능은 개개의 로봇의 제어를 위한 두 개의 유닛(5, 6) 중 하나에 위임될 수도 있다. 또한, 상세한 설명과 청구항에서, 서로 간섭할 수 있는 적어도 두 개의 로봇에 대한 참조가 이뤄지며 적어도 두 개의 암이 서로 따로 제어되고 서로 간섭할 수 있는, 다중-암 로봇의 경우 또한 포함된다. 이 경우에, 단일의 로봇은 단일의 제어 유닛을 가지며, 상기 제어 유닛에서 본 발명에 따른 상기 방법이 구현된다.
로봇(3, 4)은 공용 영역을 포함하는 각자의 작업 공간을 가지는데, 이 공용 영역은 두 대의 로봇 사이의 간섭의 잠재적인 위험을 수반한다. 로봇의 작업 공간에는, 로봇의 작업 공간에 대응되는 영역 모두를 로봇에 접근 불가능하게 하는 물체(예를 들면 고정된 작업대(2))가 제공된다.
각각의 로봇과 로봇 주변 환경 간의 간섭에 대한 문제를 다루기 위해, 로봇의 작업 공간 내에 있는 물체와 일치하는 공간 및 체적 상의 모델링을 갖는 방식으로, 로봇의 작업 공간 내로 도입될, 예를 들면, 실질적으로 원통(도 3), 직육면체(도 4), 평면(도 5) 또는 구(도 6) 모양의 간섭 영역(IR)이라 불리는 본 발명에 따른 기본적인 기하학적 도형이 정의된다. (비고: 각각의 로봇과 로봇 주변 환경 간의 간섭에 대한 문제를 다루기 위해, 본 발명에 따르면, 실질적으로 원통(도 3), 직육면체(도 4), 평면(도 5) 또는 구(도 6) 모양의, 간섭 영역(IR)이라고 지칭되는 기본적인 기하학적 도형이 정의되며, 상기 기본적인 기하학적 도형은 로봇의 작업 공간 내에 존재하는 물체와 일치하는 공간 및 체적 모델링을 갖는 방식으로 로봇의 작업 공간 내로 도입될 것이다.) 도 3, 도 4, 그리고 도 6에서, 간섭 영역은, 실 선으로 표현되어 경고 영역으로서 기능을 하는 큰 공간 안에 포함되도록, 파선으로 표현되는 공간으로 구성되는데 (비고: 간섭 영역은 점선으로 표현되는 공간으로 구성되고, "경고" 영역으로 기능을 하는 실선으로 표현되는 더 큰 공간 내에 포함되는데), 상기 경고 영역 내에서, 로봇의 움직이는 부분의 간섭 영역 경계로의 접근이 신호화 된다. 도 5의 경우, 간섭 영역은 수직면 A로 구성된다. 이와 마주보는 평면 B는 경고 신호가 활성화되는 경계의 한계를 정한다.
본 발명에 따른 방법에 있어서, 많은 개수, 가령, 최대 16개의 간섭 영역을 정의하는 것도 가능하다. 본 발명에 따르면, 간섭 영역은 다음의 세 가지의 서로 다른 카테고리로 구분된다.
- 감시 간섭 영역(MIRs)
- 금지 간섭 영역(PIRs)
- 하이브리드 간섭 영역(HIRs)
감시 영역은 로봇의 존재가 제어되는 공간이며, 로봇이 이 영역에 접속하는 경우, 외부를 향한(예를 들면 PLC를 향한) 출력 신호가 높아질 것이며, 비슷한 방식으로 상기 영역을 탈출하는 경우, 상기 신호는 낮아질 것이다(출력의 로직을 선택하는 것도 가능하다).
금지 영역은 로봇의 존재가 절대적으로 금지되는 공간이다. 로봇의 작업 공간에서 이러한 타입의 공간의 규명은, 상기 공간에 도달되는 것을 방지하는 방식으로, 로봇 위치의 계속적인 제어를 수반한다; 이러한 제어는 로봇의 상태(로봇의 프로그래밍인지 또는 로봇의 자동 동작인지)에 무관하게 이뤄진다. 이 과정은 간섭 영역으로부터의 로봇의 거리에 기초하여 로봇의 속도를 자동 제어함으로써 선언된 간섭 영역과의 접촉을 방지한다. 어떠한 출력 신호도 PLC에 전달되지는 않을 것이나 IR이 근접되어지는 경우에, 시스템은 오류를 배출할 것이고 로봇을 정지시킨다.
마지막으로, 하이브리드 영역은, 영역의 상태를 입력 신호의 논리 상태에 기초하여 감시 영역에서 금지 영역으로 또는 그 반대로 바꿀 수 있는 공간이다. 동시에, 하이브리드 영역으로의 진입 예약으로 기능 하는 출력 신호 및 하이브리드 영역으로의 접속을 위한 또 다른 출력 신호를 정하는 것이 가능하다. 이러한 방법으로, 이전 단락에서 설명되었듯이 (종래의 기술과 비교하여) 다용도의 혁신적인 방식으로 인터블록을 관리하는 것이 가능하다. 하이브리드 영역이 입력에 의하여 금지 영역이 된 때, 이 영역은 더욱이 로봇에 있어서 로봇의 속력이 영에 도달하는 영역 한계까지 제어 감속이 유도되는 특징을 보인다. 상기 영역이 입력에 의해서 감시 영역이 되도록 재활성화되면, 시스템은 계류중인 움직임을 저지하지 않고 로봇의 움직임을 자동으로 복구한다; 상기 영역이 감시 영역이 되면, 이 시점에서 시스템은 출력을 이용해 외부로 예약 영역 내 또는 간섭 영역 내의 로봇의 존재 여부를 전하게 된다.
상기의 준비 덕분에, 본 발명은 진보된 인터블록 프로그래밍을 가능하도록 한다.
감시 영역에서 금지 영역으로 변하는 상태를 바꿀 수 있는 하이브리드 영역을 형성할 수 있음으로써, 실제 자동화된 셀에서 사용되는 고전적인 인터블록의 진보된 관리가 가능해 진다. 본 발명의 기본적인 양상은 서로 다른 모양/기하학적 구조를 가지면서, 입력에 의해서 동적으로 활성화/비활성화 될 수 있고 두 가지 종류의 출력(공유 영역으로의 진입 예약에 대한 출력과 공유 영역 자체 내 존재 여부에 대한 출력)의 세팅을 자동으로 관리하는 영역을 형성하는 가능성에 있다. 이러한 세 개의 신호를 이용해 도 1에 표시된 PLC의 접속 정책의 관리가 변하지 않게 유지하지만(현재의 시스템과의 호환성 면에 관한 상당한 장점을 제공함), 로봇 프로그램 내에서의 인터블록 관리를 극단적으로 단순하게 할 수 있다. 사실, (둘 이상의 로봇 사이에서 공유되는 작업 공간을 나타내는) 하이브리드 간섭 영역의 형성 이후, PLC에 의하여 다루어 질 수 있는 방법으로, 정확한 입력과 출력을 프로그램 내에서 선언된 간섭 영역과 서로 연관 짓는 것도 충분하다. 구모양(spherical) 하이브리드 간섭 영역의 프로그래밍의 일례가 이하와 같이 재생된다.
IR_SET(IR_RESERVATION,$FMO[1],1,1,ON)
IR_SET(IR_PRESENCE,$FMO[1],2,1,OFF)
IR_SET(IR_CONSENT,$FMI[1],1,1,ON)
IR_CreateSphere(pnt0007P, 200, 1, 1)
IR_SWITCH(ON,1)
MOVEFLY JOINT TO pnt0650x ADVANCE
MOVEFLY JOINT TO pnt0150x ADVANCE
MOVEFLY JOINT TO pnt0653x ADVANCE
MOVE JOINT TO wp4661,
WITH CONDITION[spot(1, 4661, 1, FALSE)],
ENDMOVE
MOVEFLY JOINT TO pnt0444x ADVANCE
MOVEFLY JOINT TO pnt0443x ADVANCE
MOVEFLY JOINT TO pnt0442x ADVANCE
MOVE JOINT TO xtn0008X
위에서 제시된 첫 세 개의 명령은 간섭 영역이 하이브리드 타입이라는 것을 선언하는 일 및 어떠한 출력 및 입력에 예약, 존재 여부, 및 접속 요청을 위한 포트가 맵핑될 것인지를 정의하는 일을 한다. 명령 IR _ CreateSphere (…)는 로봇의 작업 공간에, 이전에 선언된 출력 및 입력과 연관될 구모양의 하이브리드 간섭 영역을 형성하는 목적을 가지고 있다. 영역 선언(the declaration of the region)은 프로그램 시작시 단 한 번만 행해지며 프로그램 자체의 흐름에 관계없이, 인터블록의 완전 자동화된 관리를 제공할 것이며, 이때 (종래 기술에 따른 해법과는 달리) 신호의 송신 및 대기에 대한 명시적 명령이 더 이상 존재하지 않을 것이다.
어떠한 작동 상태에서든지(로봇 프로그래밍 단계이든 로봇 자동 동작 단계이든), 시스템은, 들어오는 입력에 의해 설정된 하이브리드 간섭 영역의 상태를 자동으로 확인할 것이다. 이러한 방식으로, (예를 들면 입력을 0으로 설정함으로써)간섭 영역으로의 접속이 로봇에게 금지되면, 가령, 로봇에 대한 임의의 운동 프로그래밍이 실행 중인 경우 로봇은 상기 영역에 자율적으로 진입할 수 없을 것이고, 마찬가지로, 로봇을 프로그래밍하는 인간 오퍼레이터가 로봇을 금지 영역 안으로 가지고 오려고 하는 때에 로봇에 대해 진입이 제한될 것이다. 둘 중 어느 경우라도, 로봇의 행동은, 로봇이 금지 간섭 영역에 접근함에 따라 속도를 영으로 하기 위하여, 툴중심점(Tool Center Point)과 간섭 영역 사이의 최근접점으로부터의 거리에 비례하는 일반적 오버라이드(override)의 감소와 함께, 제어된 감속을 수행하는 것이다.
하이브리드 간섭 영역이라고 소개된 혁신은, 주로 하이브리드 간섭 영역의 상태 제어를 위한 입력의 변화가 주어진 상태에서, 로봇의 운동을 자동으로 복구하는 가능성에 관한 것이다. 다른 말로 하자면 로봇은, 입력 신호가 0(출입 금지 상태)에서 1(접속 가능 상태)로 변하는 경우, 금지 간섭 영역(inhibited IR)과 근접한 곳에서의 정지보다 선행했던 운동을, (오버라이드의 매끄러운 증가와 함께)자동으로 재개할 수 있다.
앞선 설명에서 분명하듯이, 본 발명에 따른 방법은 기본적으로, 이 방법이 종래 기술에 따른 순차 동작 모드(sequential operating mode)를 채용하는 대신에, 로봇을 병렬로 제어한다는 것에 특징지어진다. 특히, 본 발명에 따른 방법은, 로봇으로부터의 출력 신호를 수단으로 하는 각 로봇의 작업 공간 제어의 예상과 더불어, PLC로부터 로봇으로의 입력 신호를 가지고 하이브리드 영역으로의 진입 저지의 활성화/비활성화를 관리할 가능성을 또한 예정하고 있으며 더욱이 하이브리드 영역으로의 진입 예약을 위한 PLC로의 더 많은 출력 신호를 규정할 가능성도 예정하고 있다. 상기 방법은 더욱이, 금지 간섭 영역의 한계 부근에서의 급정지를 막고 가능하면 빨리 로봇의 운동을 재개하는 방식으로 로봇 운동의 자동 정지 및 재개와, 정지 및 재개 속도의 조절을 관리한다.
물론, 본 발명의 원리에 따라, 본원에 기재되고 도시된 것은 단지 예시에 불과하며, 구성과 실시예의 세부 사항은 본 발명의 범위로부터 벗어남이 없이 폭넓게 변할 수 있다.
Claims (2)
- 로봇을 제어하기 위한 중앙 전자 제어 유닛(7)이 사전-구성되고, 적어도 하나의 공통 영역을 포함한 각자의 작업 공간을 가진 적어도 2대의 로봇(3, 4)을 제어하는 방법으로서, 상기 중앙 전자 제어 유닛(7)은 로봇(3, 4)과 통신하고, 로봇의 공통 작업 영역에서 로봇들 간 간섭을 막고 로봇의 운동을 통제하기 위해 제공되며, 상기 방법은
- 기본 기하학적 도형으로 각각 구성된 간섭 영역들(IRs)을 형성함으로써, 로봇의 작업 공간에 존재하는 물체를 고려하여, 각 로봇의 작업 공간을 모델링하는 단계 - 상기 간섭 영역은 다음의 세 개의 서로 다른 카테고리로 분류되며;
- 로봇과 간섭을 일으키지 말아야 될 하나 이상의 물체의 지속적인 존재 때문에, 로봇의 존재가 절대적으로 금지되는 공간의 영역으로 정의되는 금지 간섭 영역(prohibited interference regions: PIR);
- 로봇의 존재가 허용되지만 제어되는 공간의 영역으로 정의되는 감시 간섭 영역(monitored interference regions: MIR)으로서, 로봇은 감시 간섭 영역으로 진입할 때 및 감시 간섭 영역에서 탈출할 때마다 중앙 전자 제어 유닛으로 신호를 전송하도록 사전-구성되는 특징의, 감시 간섭 영역(monitored interference regions: MIR), 그리고
- 상기 중앙 전자 제어 유닛에 의해 로봇으로 전송되는 입력 신호에 따라, 감시 간섭 간섭 영역의 상태와 금지 간섭 영역의 상태 간 변경이 가능한 공간의 영역으로 정의되는 하이브리드 간섭 영역(hybrid interference regions: HIR) - ;
- 각 로봇(3, 4)이 하이브리드 간섭 영역으로 진입하려고 할 때마다, 진입 예약의 역할을 하는 제 1 출력 신호 및 하이브리드 간섭 영역으로 진입했을 때마다, 진입 또는 존재의 경고 역할을 하는 제 2 출력 신호를 중앙 전자 제어 유닛(7)으로 전송하도록 각 로봇(3, 4)을 설정하는 단계;
- 로봇의 동작 동안, 하이브리드 간섭 영역에 타 로봇이 존재하는지 여부에 따라, 하이브리드 간섭 영역을 감시 간섭 영역 또는 금지 간섭 영역으로 만드는 입력 신호를 중앙 전자 제어 유닛(7)으로부터 로봇으로 전송함에 따라, 각각의 하이브리드 간섭 영역의 상태를 각각의 로봇(3, 4)에 대해 동적으로 변화시키는 단계를 포함하되,
중앙 전자 제어 유닛(7)에 의해 상기 로봇으로 상기 입력 신호를 전송함으로써, 특정 로봇(3, 4)에 대해 하이브리드 간섭 영역이 금지 간섭 영역의 상태로 전환될 때, 상기 로봇이 금지 간섭 영역의 상태로 스위칭되었던 상기 하이브리드 간섭 영역을 향해 이동하는 경우, 로봇은 자신의 속력이 0이 되는, 금지 간섭 영역의 상태로 스위칭되었던 상기 하이브리드 간섭 영역의 한계에 도달할 때까지 제어되는 방식으로 감속되는 반면, 로봇에 대해 상기 하이브리드 간섭 영역이 감시 간섭 영역의 상태로 만드는 새로운 입력 신호를 이용해 다시 활성화되는 경우, 시스템은, 로봇이 계속하여 움직이는 경우에 로봇의 움직임을 막지 않으면서, 로봇의 움직임을 자동으로 복구하는 것을 특징으로 하는 로봇 제어 방법. - 삭제
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
IT000994A ITTO20110994A1 (it) | 2011-10-31 | 2011-10-31 | Metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comune |
ITTO2011A000994 | 2011-10-31 |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20130047544A KR20130047544A (ko) | 2013-05-08 |
KR101867626B1 true KR101867626B1 (ko) | 2018-06-15 |
Family
ID=45814435
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020120033099A KR101867626B1 (ko) | 2011-10-31 | 2012-03-30 | 적어도 하나의 공통 영역을 포함하여 각자의 작업 공간을 가지는 2대 이상의 로봇을 제어하는 방법 |
Country Status (8)
Country | Link |
---|---|
US (1) | US8818558B2 (ko) |
EP (1) | EP2586574B1 (ko) |
JP (1) | JP6118509B2 (ko) |
KR (1) | KR101867626B1 (ko) |
CN (1) | CN103085057A (ko) |
BR (1) | BR102012010254B8 (ko) |
IT (1) | ITTO20110994A1 (ko) |
RU (1) | RU2593816C2 (ko) |
Families Citing this family (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6229324B2 (ja) | 2013-06-14 | 2017-11-15 | セイコーエプソン株式会社 | ロボット、ロボット制御装置およびロボットの制御方法 |
US10073434B1 (en) * | 2014-07-25 | 2018-09-11 | Jonathan Marc Hollander | Manufacturing systems and methods with multiple independent toolheads |
DE102014222857A1 (de) | 2014-11-10 | 2016-05-12 | Kuka Roboter Gmbh | Flexibles taktzeitoptimiertes Teilen eines Arbeitsraums für Roboter |
EP3180661B1 (de) * | 2014-11-13 | 2020-03-04 | Siemens Aktiengesellschaft | Produktionsmodul zur durchführung einer produktions-funktion an einem produkt |
CN104476027B (zh) * | 2014-11-14 | 2016-01-20 | 南京熊猫电子股份有限公司 | 一种多机器人焊接系统的群控装置及其方法 |
US10766139B2 (en) | 2015-02-13 | 2020-09-08 | Abb Schweiz Ag | Method for avoiding collisions between two robots |
DE102015104821A1 (de) * | 2015-03-27 | 2016-09-29 | Medineering Gmbh | Chirurgisches Instrument, System, Haltearm sowie Verfahren |
US9744668B1 (en) | 2015-08-21 | 2017-08-29 | X Development Llc | Spatiotemporal robot reservation systems and method |
CN108290285B (zh) * | 2015-11-17 | 2021-08-06 | Abb瑞士股份有限公司 | 用于在机器人系统中优化工作周期的方法 |
JP6654926B2 (ja) * | 2016-02-24 | 2020-02-26 | 本田技研工業株式会社 | 処理時間の予測方法 |
CN109153134B (zh) * | 2016-05-26 | 2021-08-13 | 三菱电机株式会社 | 机器人控制装置 |
DE102017005604A1 (de) * | 2017-06-12 | 2018-12-13 | Kuka Deutschland Gmbh | Überwachung eines Roboters |
EP3427904B1 (de) * | 2017-07-13 | 2020-06-10 | Siemens Aktiengesellschaft | Anordnung mit einem manipulator und einer begrenzungseinrichtung zur begrenzung des arbeitsbereichs |
JP6521021B2 (ja) * | 2017-10-18 | 2019-05-29 | セイコーエプソン株式会社 | ロボット、ロボット制御装置およびロボットの制御方法 |
CN109093622B (zh) * | 2018-08-20 | 2021-10-01 | 珠海格力智能装备有限公司 | 机械手的监控方法和装置 |
CN109159118B (zh) * | 2018-08-29 | 2020-10-27 | 苏州精濑光电有限公司 | 干涉机构交叉作业防撞方法及装置 |
JP7143776B2 (ja) * | 2019-01-31 | 2022-09-29 | オムロン株式会社 | 制御システム、及び、制御システムの制御方法 |
DE102019115571B4 (de) * | 2019-06-07 | 2021-11-11 | Bystronic Laser Ag | Schnelles Abtransportieren von geschnittenen Teilen aus einer Verarbeitungsanlage |
RU2755994C1 (ru) * | 2021-02-17 | 2021-09-24 | Общество С Ограниченной Ответственностью "Дс-Роботикс" | Автономная сборочная модульная ячейка |
TW202406697A (zh) * | 2022-04-06 | 2024-02-16 | 美商即時機器人股份有限公司 | 採用前瞻規劃之共享工作空間中機器人的運動規劃和控制 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0836410A (ja) * | 1994-07-21 | 1996-02-06 | Nissan Motor Co Ltd | ロボットの干渉防止方法およびその装置 |
JPH10264058A (ja) * | 1997-03-21 | 1998-10-06 | Nissan Motor Co Ltd | ロボット干渉域設定プログラム作成方法 |
Family Cites Families (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0623927B2 (ja) * | 1983-05-06 | 1994-03-30 | 株式会社日立製作所 | 協調動作をする産業用ロボットの安全運転制御方式 |
JPS6151204A (ja) * | 1984-08-20 | 1986-03-13 | Kobe Steel Ltd | ロボツトの動作空間識別システム |
JPH0419084A (ja) * | 1990-05-15 | 1992-01-23 | Matsushita Electric Ind Co Ltd | ロボット |
JP2895672B2 (ja) * | 1992-01-28 | 1999-05-24 | ファナック株式会社 | 複数ロボット制御方法 |
JPH07299793A (ja) * | 1994-05-11 | 1995-11-14 | Toyota Autom Loom Works Ltd | ロボットの干渉防止制御装置 |
US5798627A (en) * | 1995-01-04 | 1998-08-25 | Gilliland; Malcolm T. | Method for simultaneous operation of robot welders |
JP3203305B2 (ja) * | 1996-05-28 | 2001-08-27 | 宇部興産株式会社 | 金型スプレイロボットの簡易干渉チェック方法 |
JPH103308A (ja) * | 1996-06-18 | 1998-01-06 | Fanuc Ltd | 産業用ロボットの干渉回避方法 |
JPH11134017A (ja) * | 1997-10-27 | 1999-05-21 | Honda Motor Co Ltd | オフラインティーチング方法 |
JP3937080B2 (ja) * | 2002-06-19 | 2007-06-27 | 株式会社安川電機 | ロボットの干渉判断方法および制御装置 |
FR2861857B1 (fr) * | 2003-10-29 | 2006-01-20 | Snecma Moteurs | Deplacement d'un objet articule virtuel dans un environnement virtuel en evitant les collisions internes entre les elements articules de l'objet articule |
DE102004027944B4 (de) * | 2004-06-08 | 2012-02-16 | Kuka Laboratories Gmbh | Verfahren zum Schützen eines Roboters gegen Kollisionen |
JP3907649B2 (ja) * | 2004-09-02 | 2007-04-18 | ファナック株式会社 | ロボット間の干渉防止制御装置 |
EP1716983B1 (en) * | 2005-04-19 | 2008-05-14 | COMAU S.p.A. | Process for controlling industrial robots, and related robots, robot systems and computer programs |
JP2007144524A (ja) * | 2005-11-24 | 2007-06-14 | Denso Wave Inc | ロボットの干渉回避方法およびロボット |
JP4544145B2 (ja) * | 2005-11-24 | 2010-09-15 | 株式会社デンソーウェーブ | ロボットの干渉回避方法およびロボット |
JP4159577B2 (ja) * | 2005-12-13 | 2008-10-01 | ファナック株式会社 | 複数のロボット間のインターロック自動設定装置及び自動設定方法 |
EP1815949A1 (en) * | 2006-02-03 | 2007-08-08 | The European Atomic Energy Community (EURATOM), represented by the European Commission | Medical robotic system with manipulator arm of the cylindrical coordinate type |
DE602006012485D1 (de) * | 2006-09-14 | 2010-04-08 | Abb Research Ltd | Verfahren und Vorrichtung zur Vermeidung von Kollisionen zwischen einem Industrieroboter und einem Objekt |
JP4951783B2 (ja) * | 2008-02-01 | 2012-06-13 | 株式会社デンソーウェーブ | ロボット制御装置及びロボット制御方法 |
US9144904B2 (en) * | 2008-05-21 | 2015-09-29 | Fanuc Robotics America Corporation | Method and system for automatically preventing deadlock in multi-robot systems |
-
2011
- 2011-10-31 IT IT000994A patent/ITTO20110994A1/it unknown
-
2012
- 2012-03-19 EP EP12160063.9A patent/EP2586574B1/en active Active
- 2012-03-30 KR KR1020120033099A patent/KR101867626B1/ko active IP Right Grant
- 2012-04-30 BR BR102012010254A patent/BR102012010254B8/pt not_active IP Right Cessation
- 2012-05-16 US US13/473,124 patent/US8818558B2/en active Active
- 2012-05-30 JP JP2012122936A patent/JP6118509B2/ja active Active
- 2012-05-30 RU RU2012122451/02A patent/RU2593816C2/ru active
- 2012-05-31 CN CN2012101877990A patent/CN103085057A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0836410A (ja) * | 1994-07-21 | 1996-02-06 | Nissan Motor Co Ltd | ロボットの干渉防止方法およびその装置 |
JPH10264058A (ja) * | 1997-03-21 | 1998-10-06 | Nissan Motor Co Ltd | ロボット干渉域設定プログラム作成方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103085057A (zh) | 2013-05-08 |
EP2586574B1 (en) | 2014-04-23 |
RU2593816C2 (ru) | 2016-08-10 |
JP6118509B2 (ja) | 2017-04-19 |
ITTO20110994A1 (it) | 2013-05-01 |
US20130110288A1 (en) | 2013-05-02 |
JP2013094956A (ja) | 2013-05-20 |
BR102012010254A2 (pt) | 2014-04-01 |
KR20130047544A (ko) | 2013-05-08 |
BR102012010254B8 (pt) | 2021-08-03 |
RU2012122451A (ru) | 2013-12-10 |
US8818558B2 (en) | 2014-08-26 |
BR102012010254B1 (pt) | 2021-04-20 |
EP2586574A1 (en) | 2013-05-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101867626B1 (ko) | 적어도 하나의 공통 영역을 포함하여 각자의 작업 공간을 가지는 2대 이상의 로봇을 제어하는 방법 | |
KR101885415B1 (ko) | 로봇들을 위한 작업 공간의 유연하면서도 클럭 사이클 최적화된 공유 | |
KR102096234B1 (ko) | 오작동하는 시퀀싱 태그를 식별하기 위한 산업용 차량 | |
CN102189552B (zh) | 机器人系统 | |
KR20210024576A (ko) | 로봇 스케줄링, 로봇 경로 제어 방법, 서버 및 저장 매체 | |
AU2020202659A1 (en) | A method for autonomously controlling a vehicle | |
CN111158353A (zh) | 用于多个机器人的移动控制方法以及其系统 | |
US20210208592A1 (en) | System for evacuating one or more mobile robots | |
US20210138649A1 (en) | Method, robot system and computer readable medium for determining a safety zone and for path planning for robots | |
KR20120058945A (ko) | 무선 네트워크기반 로봇 청소기 제어 장치 및 방법 | |
JP7226101B2 (ja) | 安全監視システム、安全監視制御装置、および安全監視方法 | |
CN115185286B (zh) | 一种移动机器人自主绕障规划方法及其任务调度系统 | |
Drabek et al. | Safe interaction of automated forklifts and humans at blind corners in a warehouse with infrastructure sensors | |
KR102291577B1 (ko) | 복수의 무인 반송차를 제어하는 방법, 시스템 및 비일시성 컴퓨터 판독 가능기록 매체 | |
CN113219974A (zh) | 自动导航机器人多机避障方法、系统、介质及设备 | |
JP7091425B2 (ja) | 作業機械 | |
KR102515061B1 (ko) | 무인운반차 시스템의 무인운반차 충돌 방지방법 | |
US20230273622A1 (en) | Method, system, and non-transitory computer-readable recording medium for controlling plurality of automated guided vehicles | |
WO2022195949A1 (ja) | 管理装置及び荷役車両 | |
WO2022244393A1 (ja) | 人機械協調制御システム並びに人機械協調制御方法 | |
CN113359770B (zh) | 自动行走设备间的协同运行控制方法及系统 | |
US20240066702A1 (en) | Method of handling safety of industrial robot, and system | |
CN116820111A (zh) | 一种基于激光雷达区域配置的避障控制方法及装置 | |
CN116758759A (zh) | 一种用于多移动机器人的交通管控方法及系统 | |
CN114093065A (zh) | 一种码头堆场与自动化轨道吊的安全控制系统及方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right |