KR20210083362A - 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 - Google Patents
피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 Download PDFInfo
- Publication number
- KR20210083362A KR20210083362A KR1020217018105A KR20217018105A KR20210083362A KR 20210083362 A KR20210083362 A KR 20210083362A KR 1020217018105 A KR1020217018105 A KR 1020217018105A KR 20217018105 A KR20217018105 A KR 20217018105A KR 20210083362 A KR20210083362 A KR 20210083362A
- Authority
- KR
- South Korea
- Prior art keywords
- joint
- manipulator
- link
- actuator
- axis
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 33
- 230000000694 effects Effects 0.000 claims abstract description 12
- 239000012636 effector Substances 0.000 claims description 30
- 238000006073 displacement reaction Methods 0.000 claims description 12
- 230000005484 gravity Effects 0.000 claims description 4
- 206010028980 Neoplasm Diseases 0.000 claims 5
- 201000011510 cancer Diseases 0.000 claims 5
- 230000033001 locomotion Effects 0.000 description 30
- 238000010586 diagram Methods 0.000 description 14
- 238000004891 communication Methods 0.000 description 10
- 230000006870 function Effects 0.000 description 10
- 239000011159 matrix material Substances 0.000 description 5
- 230000007246 mechanism Effects 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 230000004044 response Effects 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000005520 cutting process Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000003754 machining Methods 0.000 description 3
- 230000007935 neutral effect Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 206010023230 Joint stiffness Diseases 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 238000007781 pre-processing Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000005489 elastic deformation Effects 0.000 description 1
- 238000007730 finishing process Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 238000005498 polishing Methods 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
- 238000003825 pressing Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000003746 surface roughness Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000001052 transient effect Effects 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
- 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/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/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/023—Cartesian coordinate type
- B25J9/026—Gantry-type
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/005—Manipulators for mechanical processing tasks
-
- 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/046—Revolute 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/106—Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links
- B25J9/1065—Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links with parallelograms
-
- 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
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- 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/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position 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/1679—Programme controls characterised by the tasks executed
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41426—Feedforward of torque
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Automation & Control Theory (AREA)
- Forklifts And Lifting Vehicles (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
Abstract
본 개시의 일 실시 예는 피니싱 작업을 위한 매니퓰레이터(manifulator)에 있어서, 베이스(base); 복수의 링크(link), 상기 복수의 링크를 연결하는 복수의 조인트(joint) 및 상기 복수의 조인트 중에서 적어도 일부의 조인트의 회전을 발생시키는 복수의 액츄에이터(actuator)를 포함하는 암(arm); 및 상기 매니퓰레이터의 자중 효과를 고려하여 상기 복수의 액츄에이터 각각의 구동 토크(driving torque)를 결정하고, 상기 결정된 구동 토크에 기초하여 상기 복수의 액츄에이터를 제어하는 프로세서를 포함하는, 매니퓰레이터를 제공한다.
Description
본 개시(disclosure)는 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법에 관한 것이다.
지금까지 피니싱 작업(또는 표면 마감 작업)은 긴 생산 시간과 높은 비용이 필요한 유인 작업으로 간주됐다. 대형 금형 및 3D 인쇄 제품에 대한 수요가 증가함에 따라 자동 피니싱 공정이 더욱 중요해지고 있다. 그러나, 로봇 피니싱 작업은 기존의 산업용 로봇을 채용하는데 어려움을 겪고 있다. 산업용 로봇은 강성이 현저히 낮아, 특히 가공력(machining force) 하에서, 경로 편차를 상당히 초래한다는 결정적인 단점이 있다. 또한, 일부 산업용 로봇은 사용자의 접근성을 제한하는 폐쇄 서보(servo) 시스템을 채택하고 있기 때문에, 수동적 또는 능동적 메커니즘에서의 교란을 막기 위해 특수한 엔드 이펙터(end-effector)가 필요하다.
본 개시는 안정적인 토크를 제공하여 안정적인 피니싱 작업을 수행하는 매니퓰레이터 및 그의 제어 방법을 제공한다.
본 개시의 일 실시 예는, 피니싱 작업을 위한 매니퓰레이터(manifulator)에 있어서, 베이스(base); 복수의 링크(link), 상기 복수의 링크를 연결하는 복수의 조인트(joint) 및 상기 복수의 조인트 중에서 적어도 일부의 조인트의 회전을 발생시키는 복수의 액츄에이터(actuator)를 포함하는 암(arm); 및 상기 매니퓰레이터의 자중 효과를 고려하여 상기 복수의 액츄에이터 각각의 구동 토크(driving torque)를 결정하고, 상기 결정된 구동 토크에 기초하여 상기 복수의 액츄에이터를 제어하는 프로세서를 포함하는, 매니퓰레이터를 제공한다.
또한, 본 개시의 일 실시 예는, 상기 암은 일 변이 상기 베이스에 고정되고 평행사변형 구조를 갖는 평행사변형 링크 세트를 더 포함하는, 매니퓰레이터를 제공한다.
또한, 본 개시의 일 실시 예는, 상기 암은 제1 링크, 제2 링크, 제1 액츄에이터, 제2 액츄에이터, 제1 조인트 및 제2 조인트를 더 포함하고, 상기 평행사변형 링크 세트는 일 변이 이중 링크이고, 상기 이중 링크는 서로 평행한 상기 제1 링크와 상기 제2 링크를 포함하고, 상기 제1 링크는 상기 제1 액츄에이터에 의해 회전하는 상기 제1 조인트를 통해 상기 베이스와 연결되고, 상기 제2 링크는 상기 제2 액츄에이터에 의해 회전하는 상기 제2 조인트를 통해 상기 베이스와 연결되는, 매니퓰레이터를 제공한다.
또한, 본 개시의 일 실시 예는, 상기 제1 조인트와 상기 제2 조인트는 각각의 회전 축이 작업면에 평행하고 동일한 일직선에 배치되고, 동역학적으로 디커플링되는(decoupled), 매니퓰레이터를 제공한다.
또한, 본 개시의 일 실시 예는, 상기 제2 조인트는 상기 평행사변형 구조에 의해 상기 암에 대한 지렛대 효과를 제공하고, 상기 프로세서는 상기 제2 액츄에이터를 통해 피드 포워드 토크 제어(feed forward torque control)를 수행하는, 매니퓰레이터를 제공한다.
또한, 본 개시의 일 실시 예는, 상기 피드 포워드 토크 제어는 상기 암에 대한 위치 피드백과 상기 암에 대한 포스 피드백(force feedback)을 수반하지 않는, 매니퓰레이터를 제공한다.
또한, 본 개시의 일 실시 예는, 상기 암은 제3 조인트, 제3 액츄에이터 및 스윙 암 링크(swing arm link)를 더 포함하고, 상기 스윙 암 링크는 상기 평행사변형 링크 세트의 상기 베이스에 연결되지 않은 변의 말단에서 상기 제3 조인트를 통해 연결되고, 상기 제3 조인트는 상기 제3 액츄에이터에 의해 상기 작업면에 수직한 방향의 회전 축을 따라 회전하는, 매니퓰레이터를 제공한다.
또한, 본 개시의 일 실시 예는, 상기 암은 제4 조인트, 제5 조인트, 제4 액츄에이터, 제5 액츄에이터, 핸드 링크(hand link) 및 엔드 이펙터(end effector)를 더 포함하고, 상기 핸드 링크는 상기 스윙 암 링크의 말단에서 상기 제4 조인트를 통해 연결되고, 상기 제4 조인트는 상기 제4 액츄에이터에 의해 상기 핸드 링크의 방향의 회전 축을 따라 회전하고, 상기 엔드 이펙터는 상기 핸드 링크의 말단에서 상기 제5 조인트를 통해 연결되고, 상기 제5 조인트는 상기 제5 액츄에이터에 의해 상기 작업면과 평행하고 상기 핸드 링크의 방향과 수직한 회전 축을 따라 회전하는, 매니퓰레이터를 제공한다.
또한, 본 개시의 일 실시 예는, 상기 제2 액츄에이터의 피드 포워드 토크는 이고, 상기 g2는 상기 제2 조인트에서의 상기 매니퓰레이터의 중력, 상기 q는 상기 제1 조인트 내지 상기 제5 조인트의 변위 벡터, 상기 q2는 상기 제2 조인트의 변위, 상기 h는 상기 매니퓰레이터의 구속 조건 함수, 상기 λ는 상기 엔드 이펙터에서의 외력 벡터인, 매니퓰레이터를 제공한다.
또한, 본 개시의 일 실시 예는, 상기 베이스는 갠트리 구조물(gantry structure)에 연결되는, 매니퓰레이터를 제공한다.
본 개시의 다양한 실시 예에 따르면, 평행사변형 구조의 링크를 포함하는 매니퓰레이터의 자중 효과를 이용하여 피드 포워드 토크 제어를 수행함으로써, 포스 피드백에 기초한 컴플라이언스 제어 방법에 비교하여 균일하고 부드러운 토크 제어가 가능하다.
또한, 본 개시의 다양한 실시 예에 따르면, 매니퓰레이터가 스윙 암 구조를 채택함으로써 보다 넓은 작업 범위를 확보할 수 있다.
도 1은 본 개시의 일 실시 예에 따른 피니싱 머신(finishing machine)을 나타낸 도면이다.
도 2는 본 개시의 일 실시 예에 따른 매니퓰레이터를 나타낸 블록도이다.
도 3 내지 5는 본 개시의 일 실시 예에 따른 5축 매니퓰레이터를 나타낸 도면이다.
도 6은 본 개시의 일 실시 예에 따른 역 기구학적 모델 기반의 매니퓰레이터의 제어 방법을 나타낸 도면이다.
도 7은 본 개시의 일 실시 예에 따른 매니퓰레이터에 대한 시뮬레이션 과정을 나타낸 도면이다.
도 8은 본 개시의 일 실시 예에 따른 매니퓰레이터의 구속된 동작(constrained motion)을 설명하는 도면이다.
도 9은 본 개시의 일 실시 예에 따른 매니퓰레이터의 피드 포워드 토크 제어를 설명하는 도면이다.
도 10은 본 개시의 일 실시 예에 따른 매니퓰레이터에 대한 제어 블록 다이어그램이다.
도 11은 연마 휠이 없는 경우에 컴플라이언스 제어(compliance control)에 따른 힘 제어 결과를 나타낸 도면이다.
도 12는 연마 휠이 없는 경우에 피드 포워드 토크 제어(feed-forward torque control)에 따른 힘 제어 결과를 나타낸 도면이다.
도 13은 종래의 포스 피드백(force feedback) 제어와 본 개시에서 제안된 피드 포워드 제어를 비교한 도면이다.
도 2는 본 개시의 일 실시 예에 따른 매니퓰레이터를 나타낸 블록도이다.
도 3 내지 5는 본 개시의 일 실시 예에 따른 5축 매니퓰레이터를 나타낸 도면이다.
도 6은 본 개시의 일 실시 예에 따른 역 기구학적 모델 기반의 매니퓰레이터의 제어 방법을 나타낸 도면이다.
도 7은 본 개시의 일 실시 예에 따른 매니퓰레이터에 대한 시뮬레이션 과정을 나타낸 도면이다.
도 8은 본 개시의 일 실시 예에 따른 매니퓰레이터의 구속된 동작(constrained motion)을 설명하는 도면이다.
도 9은 본 개시의 일 실시 예에 따른 매니퓰레이터의 피드 포워드 토크 제어를 설명하는 도면이다.
도 10은 본 개시의 일 실시 예에 따른 매니퓰레이터에 대한 제어 블록 다이어그램이다.
도 11은 연마 휠이 없는 경우에 컴플라이언스 제어(compliance control)에 따른 힘 제어 결과를 나타낸 도면이다.
도 12는 연마 휠이 없는 경우에 피드 포워드 토크 제어(feed-forward torque control)에 따른 힘 제어 결과를 나타낸 도면이다.
도 13은 종래의 포스 피드백(force feedback) 제어와 본 개시에서 제안된 피드 포워드 제어를 비교한 도면이다.
이하, 첨부된 도면을 참조하여 본 명세서에 개시된 실시 예를 상세히 설명하되, 도면 부호에 관계없이 동일하거나 유사한 구성요소는 동일한 참조 번호를 부여하고 이에 대한 중복되는 설명은 생략하기로 한다. 이하의 설명에서 사용되는 구성요소에 대한 접미사 '모듈' 및 '부'는 명세서 작성의 용이함만이 고려되어 부여되거나 혼용되는 것으로서, 그 자체로 서로 구별되는 의미 또는 역할을 갖는 것은 아니다. 또한, 본 명세서에 개시된 실시 예를 설명함에 있어서 관련된 공지 기술에 대한 구체적인 설명이 본 명세서에 개시된 실시 예의 요지를 흐릴 수 있다고 판단되는 경우 그 상세한 설명을 생략한다. 또한, 첨부된 도면은 본 명세서에 개시된 실시 예를 쉽게 이해할 수 있도록 하기 위한 것일 뿐, 첨부된 도면에 의해 본 명세서에 개시된 기술적 사상이 제한되지 않으며, 본 개시의 사상 및 기술 범위에 포함되는 모든 변경, 균등물 내지 대체물을 포함하는 것으로 이해되어야 한다.
제1, 제2 등과 같이 서수를 포함하는 용어는 다양한 구성요소들을 설명하는데 사용될 수 있지만, 상기 구성요소들은 상기 용어들에 의해 한정되지는 않는다. 상기 용어들은 하나의 구성요소를 다른 구성요소로부터 구별하는 목적으로만 사용된다.
어떤 구성요소가 다른 구성요소에 '연결되어' 있다거나 '접속되어' 있다고 언급된 때에는, 그 다른 구성요소에 직접적으로 연결되어 있거나 또는 접속되어 있을 수도 있지만, 중간에 다른 구성요소가 존재할 수도 있다고 이해되어야 할 것이다. 반면에, 어떤 구성요소가 다른 구성요소에 '직접 연결되어' 있다거나 '직접 접속되어' 있다고 언급된 때에는, 중간에 다른 구성요소가 존재하지 않는 것으로 이해되어야 할 것이다.
도 1은 본 개시의 일 실시 예에 따른 피니싱 머신(finishing machine, 1)을 나타낸 도면이다.
도 1을 참조하면, 본 개시의 일 실시 예에 따른 피니싱 머신(1)은 매니퓰레이터(100), 갠트리 구조물(gantry structure, 200) 및 제1 슬라이드 테이블(slide table, 300) 등을 포함할 수 있다.
도 1에 도시된 갠트리 구조물(200)에는 x축 방향으로 움직이는 이동부가 포함되지 않았고, 이를 대신하여 x축 방향으로 움직이며 작업물(workpiece)을 거치하는 제2 슬라이딩 테이블(400)이 구비될 수 있다. 그러나, 본 개시가 이에 한정되지 않는다. 예컨대, 다른 일 실시 예에서, 피니싱 머신(1)의 갠트리 구조물(200)은 x축 방향으로 움직이는 이동부(예컨대, 바퀴 등)를 포함할 수 있다.
매니퓰레이터(100)는 제1 슬라이드 테이블(300)를 통해 갠트리 구조물(200)에 연결될 수 있고, 제1 슬라이드 테이블(300)의 움직임에 따라 높이 또는 z축 위치가 조절될 수 있다.
제1 슬라이드 테이블(300)은 갠트리 구조물(200)에서 y축 방향으로 움직일 수 있다. 갠트리 구조물(200)을 이용한 병진 축(translational axes)은 중공업 로봇과 비교하여 높은 강성(stiffness)을 가지며, 더 넓은 작업 공간을 제공할 수 있다.
매니퓰레이터(100)는 엔드 이펙터(end-effector)에 장착된 전기 스핀들(electro-spindle)이나 공압 스핀들(pneumatic-spindle)과 같은 회전 공구를 이용하여 작업물에 대한 표면 피니싱 작업을 수행할 수 있다. 매니퓰레이터(100)는 엔드 이펙터의 위치와 방향에 따라 서로 다른 컴플라이언스 특성(compliance characteristic)을 갖기 때문에, 피니싱 작업은 지정된 자세에서 허용 가능한 순응을 생성하는 제한된 영역에서만 수행될 수 있다.
매니퓰레이터(100)는 허용 가능한 컴플라이언스 범위와 작업물의 작동 위치를 모두 만족시키기 위해, x, y, z 축에서 원하는 작업 영역에 위치할 수 있다.
도 2는 본 개시의 일 실시 예에 따른 매니퓰레이터(100)를 나타낸 블록도이다.
도 2를 참조하면, 본 개시의 일 실시 예에 따른 매니퓰레이터(100)는 통신부(110), 메모리(120), 액츄에이터(130) 및 프로세서(190) 등을 포함할 수 있다.
통신부(110)는 유무선 통신 기술을 이용하여 매니퓰레이터(100) 또는 피니싱 머신(1)을 제어하는 외부 장치(미도시)와 데이터를 송수신할 수 있다. 통신부(110)는 외부 장치(미도시)로부터 제어 신호 또는 제어 프로파일 등을 수신할 수 있다.
통신부(110)가 이용하는 통신 기술에는 GSM(Global System for Mobile communication), CDMA(Code Division Multi Access), LTE(Long Term Evolution), 5G, WLAN(Wireless LAN), Wi-Fi(Wireless-Fidelity), 블루투스(Bluetooth??), RFID(Radio Frequency Identification), 적외선 통신(Infrared Data Association; IrDA), ZigBee, NFC(Near Field Communication) 등이 있다.
메모리(120)는 매니퓰레이터(100)의 다양한 기능을 지원하는 데이터를 저장할 수 있다. 또한, 메모리(120)는 매니퓰레이터(100)에서 구동되는 다양한 응용 프로그램(application program), 매니퓰레이터(100)의 동작을 위한 데이터와 명령어들을 저장할 수 있다.
메모리(120)는 매니퓰레이터(100)의 구동에 이용되는 펌웨어나 액츄에이터(130)의 제어에 이용되는 응용 프로그램, 제어 프로파일 등을 저장할 수 있다.
액츄에이터(130)는 매니퓰레이터(100)의 움직임을 발생시키며, 적어도 하나 이상을 포함할 수 있다. 액츄에이터(130)는 모터라 칭할 수도 있다.
액츄에이터(130)는 미리 정해진 축을 중심으로 회전하는 움직임을 발생시킬 수도 있고, 미리 정해진 경로를 따라 병진하는 움직임을 발생시킬 수도 있다.
액츄에이터(130)는 매니퓰레이터(100)에 대한 자중 효과(self-weight effect)를 고려하여 동작될 수 있다. 즉, 액츄에이터(130)는 매니퓰레이터(100)의 자세와 그에 따른 무게를 고려하여 결정된 토크의 세기로 동작할 수 있다.
일 실시 예에서, 액츄에이터(130)는 5개 포함되고, 이에 따라 매니퓰레이터(100)는 5축 매니퓰레이터일 수 있다. 일 실시 예에 따른 5축 매니퓰레이터(100)는 도 3 및 4에 도시된 구조를 가질 수 있다.
센서부(140)는 다양한 센서들을 이용하여 매니퓰레이터(100)의 상태 정보, 액츄에이터(130)의 상태 정보(예컨대, 동작 정보, 힘 정보 등) 등을 획득할 수 있다. 예컨대, 센서부(140)는 액츄에이터(130)의 동작에 의한 각도, 회전 속도, 엔드 이펙터에 장착된 회전 공구의 회전 속도 등을 획득할 수 있다.
센서부(140)는 다양한 센서들을 이용하여 작업물의 모양, 작업물의 위치, 작업물의 상태, 작업물의 표면 정보 등을 획득할 수 있다.
센서부(140)에 포함되는 센서에는 근접 센서, 조도 센서, 가속도 센서, 자기 센서, 자이로 센서, 관성 센서, RGB 센서, IR 센서, 지문 인식 센서, 초음파 센서, 광 센서, 마이크로폰, 라이다, 레이더 등이 있다.
프로세서(190)는 메모리(120)에 저장된 응용 프로그램을 구동하여 액츄에이터(130) 등을 제어할 수 있다.
프로세서(190)는 제어 신호에 기초하여 액츄에이터(130)를 제어할 수 있다. 프로세서(190)는 통신부(110)를 통해 외부 장치로부터 제어 신호를 수신하거나, 입력부(미도시)를 통해 제어 신호를 입력받을 수 있다.
프로세서(190)는 액츄에이터(130)의 상태 정보를 고려하여 액츄에이터(130)에 대한 제어 신호를 생성할 수 있다.
프로세서(190)는 센서부(140)를 통해 획득한 센서 정보를 고려하여 설정된 제어 신호를 조정할 수도 있다.
프로세서(190)는 컨트롤러 또는 모션 컨트롤러라 칭할 수도 있다.
도 3 내지 5는 본 개시의 일 실시 예에 따른 5축 매니퓰레이터(100)를 나타낸 도면이다.
도 3 내지 5를 참조하면, 본 개시의 일 실시 예에 따른 5축 매니퓰레이터(100)는 5개의 모터 또는 액츄에이터를 포함할 수 있고, 이에 따라 5개 축(311, 312, 313, 314 및 315)에 따른 다양한 움직임이 가능할 수 있다. 이하에서, 용어 "모터"와 용어 "액츄에이터"는 혼용될 수 있다.
제1 조인트(511)에 대한 회전을 발생시키는 모터 또는 액츄에이터는 제1 모터 또는 제1 액츄에이터라 칭할 수 있다. 마찬가지로, 제2 조인트(512)에 대한 회전을 발생시키는 모터 또는 액츄에이터는 제2 모터 또는 제2 액츄에이터, 제3 조인트(513)에 대한 회전을 발생시키는 모터 또는 액츄에이터는 제3 모터 또는 제3 액츄에이터, 제4 조인트(514)에 대한 회전을 발생시키는 모터 또는 액츄에이터는 제4 모터 또는 제4 액츄에이터, 제5 조인트(515)에 대한 회전을 발생시키는 모터 또는 액츄에이터는 제5 모터 또는 제5 액츄에이터라 칭할 수 있다. 그리고, 제1 조인트(511)의 회전 축을 제1 축(311), 제2 조인트(512)의 회전 축을 제2 축(312), 제3 조인트(513)의 회전 축을 제3 축(313), 제4 조인트(514)의 회전 축을 제4 축(314), 제5 조인트(515)의 회전 축을 제5 축(315)라 칭할 수 있다. 이하에서, 용어 축(311 내지 315)과 용어 조인트(511 내지 515)는 혼용될 수 있다.
5축 매니퓰레이터(100)에서 제1 조인트(511), 제2 조인트(512), 제3 조이트(513), 제4 조인트(514) 및 제5 조인트(515)만이 액츄에이터가 구비되어 능동적으로 회전이 제어되는 능동 조인트(active joint)이고, 그 이외의 조인트(521, 522, 523)는 능동적으로 회전이 제어되지 않는 수동 조인트(passive joint)일 수 있다. 제1 수동 조인트(521), 제2 수동 조인트(522) 및 제3 수동 조인트(523)는 피니싱 작업 중 부하를 지지하고 정확한 자세를 유지하는데 중요한 역할을 수행한다.
일 실시 예에서, 능동 조인트들(511, 512, 513, 514, 515) 및 수동 조인트들(521, 522, 523) 중에서 일부 또는 전부가 앵귤러 컨택트 볼 베어링(angular contact ball bearing) 구조를 가질 수 있다. 여기서, 앵귤러 컨택트 볼 베어링은 단열 앵귤러 컨택트 볼 베어링, 복열 앵귤러 컨택트 볼 베어링 등이 다양한 앵귤러 컨텍트 볼 베어링 구조를 가질 수 있으며, 두 개 이상의 앵귤러 컨택트 볼 베어링이 하나의 쌍으로 조립된 구조를 가질 수도 있다. 앵귤러 컨텍트 볼 베어링은 축 방향 및 반경 방향에서 높은 강성을 가지며, 가공 작업시 발생하는 진동을 효과적으로 줄여줄 수 있다. 특히, 제1 조인트(511), 제2 조인트(512) 및 제3 수동 조인트(523)가 앵귤러 컨택트 볼 베어링 구조를 가질 수 있다.
5축 매니퓰레이터(100)는 평행사변형 구조를 갖는 링크들(이하, 평행사변형 링크 세트, 412)을 포함하며, 평행사변형 구조의 일 측(z축 방향)의 두 꼭지점 (또는 평행사변형 구조의 일 변)은 5축 매니퓰레이터(100)의 베이스(411)의 미리 정해진 위치에 고정될 수 있다. 여기서, 베이스(411)에 고정된 평행사변형 링크 세트(412)의 두 꼭지점 중에서 암 방향(arm direction) 또는 x축 방향의 하나의 꼭지점에 대응하는 위치에는 제1 조인트(511)와 제2 조인트(512)가 배치될 수 있다. 여기서, 암 방향은 x축 방향일 수 있다. 제1 조인트(511)에 대응하는 제1 액츄에이터와 제2 조인트(512)에 대응하는 제2 액츄에이터는 디커플링되어(decoupled), 서로 기구학적으로 분리될 수 있다. 제1 축(311)과 제2 축(312)은 y축 방향과 평행할 수 있다. 또한, 제1 축(311)과 제2 축(312)은 동일한 일직선 상에 위치할 수 있다. 즉, 제1 축(311)과 제2 축(312)은 작업면에 평행한 방향일 수 있다.
xy평면은 작업면에 평행한 평면을 의미하고, z축은 작업면에 수직한 방향의 축 또는 상하 방향의 축을 의미할 수 있다. x축은 매니퓰레이터(100)의 중립 상태에서의 암 방향, 작업 방향 또는 정면 방향을 의미할 수 있다. 암 방향은 후술하는 핸드 링크(hand link, 414)의 방향을 의미할 수 있다.
평행사변형 링크 세트(412)는 제1 조인트(511)와 연결된 제1 링크(531) 및 제2 조인트(512)와 연결된 제2 링크(532)를 포함하며, 제1 링크(531)와 제2 링크(532)는 평행하여 이중 링크 구조를 가지며, 평행사변형 링크 세트(412)에서 평행사변형의 동일한 변에 위치한다. 제1 링크(531)와 제2 링크(532) 각각은 서로 대응하는 제1 조인트(511)와 제2 조인트(512)에 의하여 일 끝단만이 베이스(411)와 연결된다.
제2 조인트(512)에 대응하는 제2 액츄에이터는 5축 매니퓰레이터(100)의 베이스(411)에 연결 또는 배치될 수 있고, 이에 따라 제2 액츄에이터에 의한 암(arm)의 부하가 줄어들고 제2 조인트(512)의 구동 토크가 최대화될 수 있다.
평행사변형 링크 세트(412)에 포함된 링크 중에서 베이스(411)에 연결되지 않는 링크는 암 방향 또는 x축 방향으로 연장된 방향에 돌출된 링크 구조를 가지며, 돌출된 링크에는 제3 조인트(513)가 배치될 수 있다. 즉, 평행사변형 링크 세트(412)에 포함된 링크 중에서 베이스(411)에 연결되지 않는 링크에는 제3 조인트(513), 제2 수동 조인트(522) 및 제3 수동 조인트(523)가 배치될 수 있다.
스윙 암 링크(swing arm link, 413)는 제3 조인트(513)를 통해 평행사변형 링크 세트(412)와 연결될 수 있다. 제3 축(313)은 z축 방향과 평행할 수 있다. 즉, 제3 축(313)은 작업면에 수직한 방향일 수 있다.
스윙 암 링크(413)의 암 방향 말단에는 제4 조인트(514)가 배치될 수 있다. 핸드 링크(hand link, 414)는 제4 조인트(514)를 통해 스윙 암 링크(413)와 연결될 수 있다. 제4 축(314)은 스윙 암 링크(413)이 중립 상태일 때 y축 방향과 평행할 수 있다. 즉, 제4 축(314)는 핸드 링크(414)의 방향일 수 있다.
핸드 링크(414)에는 제5 조인트(515)가 배치될 수 있다. 엔드 이펙터는 제5 조인트(515)를 통해 핸드 링크(414)와 연결될 수 있다. 제5 축(315)은 스윙 암 링크(413)와 핸드 링크(414)가 중립 상태일 때 y축 방향과 평행할 수 있다. 즉, 제5 축(315)는 작업면과 평행하고 제4 축(314)과 수직한 방향일 수 있다.
즉, 엔드 이펙터는 제1 조인트(511)와 제2 조인트(512)에서의 회전에 의해 z축 방향의 위치(보다 구체적으로는 xz평면에서의 위치)가 조정될 수 있고, 제3 조인트(513)에서의 회전에 의해 xy평면에서의 위치가 조정될 수 있고, 제4 조인트(514) 및 제5 조인트(515)에서의 회전에 의해 방향이 결정될 수 있다.
하기 [표 1]은 5축 매니퓰레이터(100)의 링크의 수치의 예시를 나타내고, 하기 [표 2]는 5축 매니퓰레이터(100)의 모터의 특징을 나타낸다. [표 1]와 [표 2]에 도시된 수치는 하나의 예시에 불과하며, 다양한 실시 예에 따라 그 값들이 달라질 수 있다.
5축 매니퓰레이터(100)는 평행사변형 매커니즘(parallelogram machenism)을 채택함으로써 매니퓰레이터(100)의 베이스(411) 근처에 질량 중심(center of mass)이 배치될 수 있다. 이는 질량 중심이 액츄에이터의 성능에 직접적으로 관련되고, 질량 중심이 베이스(411)에 가까워짐으로써 각 관절에 부과되는 부하가 감소하기 때문이다. 또한, 이는 평행사변형 매커니즘은 운동학적으로 및 동적으로 분리된 구조를 갖기 때문이다. 상술한 바와 같이, 제1 조인트(511)와 제2 조인트(512)는 xz평면에서의 위치를 결정할 수 있다.5축 매니퓰레이터(100)는 스윙 암 매커니즘(swing arm mechanism)을 채택함으로써 평면 동작(planar operation)에서 동적 응답을 향상시킬 수 있다. 제3 모터 또는 제3 액츄에이터는 평면 방향(xy평면)에 평행한 제3 축(313)에 대하여 회전하는 스윙 암 링크(413)를 회전시킬 수 있다.
5축 매니퓰레이터(100)는 자중 효과(self-weight effect)를 이용한 피드 포워드 토크 제어 기능을 채용할 수 있다. 피니싱 작업을 시작하면, 5축 매니퓰레이터(100)에서 제2 조인트(512)에 대응하는 제2 모터의 기능이 위치 제어 기능이 아닌 피드 포워드 토크 제어 기능으로 전환될 수 있다. 그리고, 링크의 무게, 설정된 토크 값에 따라 엔드 이펙터가 작업물을 누르는 힘(normal force)이 일정하게 유지될 수 있다. 이에 따라, 5축 매니퓰레이터(100)는 조인트 강성, 응답 속도, 대역폭 등 로봇 피드백 제어의 한계를 극복하고 피니싱 가공을 수행할 수 있다. 5축 매니퓰레이터(100)는 자중 효과를 이용함에 따라 링크 또는 암(arm)의 무게를 가공력에 대한 반력으로 활용할 수 있다.
일 실시 예에서, 베이스를 제외한 매니퓰레이터(100)의 총 무게는 약 25kg일 수 있다. 매니퓰레이터(100)의 베이스는 피니싱 머신(1)의 z축 슬라이드 또는 제1 슬라이딩 테이블(300)에 장착되며, 마운팅 지그를 포함할 수 있다.
매니퓰레이터(100)의 운동은 각 액츄에이터(130)의 구동 토크에 의해 결정되며, 이는 시스템의 운동 에너지 함수와 위치 에너지 함수에 의해 계산될 수 있다. 그리고, 선형화(linearization) 성능을 높이기 위해 동작 제어 프로세스에 매니퓰레이터(100)의 역 기구학적 모델(inverse kinematic model)이 적용될 수 있다.
매니퓰레이터(100)의 컴플라이언스는 하기 [수학식 1] 내지 [수학식 4]와 같이 주어질 수 있다. M은 관성 모멘트 행렬, C는 코리올리 및 원심력 행렬, G는 중력 벡터, λ는 매니퓰레이터(100)의 자코비안(Jacobian)을 포함하는 외력 벡터, 그리고 τ는 특정 움직임을 생성하는데 필요한 일련의 액츄에이터들(130)의 토크 벡터를 의미할 수 있다. q는 각 축 또는 각 조인트의 변위 벡터, Kq는 조인트 회전 강성 행렬, Δq는 조인트 강성으로 인한 각 조인트의 변형 값을 의미할 수 있다.
상기 [수학식 1]은 매니퓰레이터 컴플라이언스가 조인트 토크에 의해 생성된 회전 변위에 의해 좌우됨을 의미하며, 상기 [수학식 2]는 외력의 유무에 의한 토크의 차이값을 의미할 수 있다.
조인트 좌표로부터 획득한 카르테시안 좌표는 하기 [수학식 3]과 같이 표현될 수 있다. ΔX는 엔드 이펙터의 변형 벡터, CX는 카르테시안 공간 컴플라이언스 행렬(Cartesian space compliance matrix)을 의미할 수 있다.
결과적으로, 외력에 의한 엔드 이펙터의 변위는 하기 [수학식 4] 및 [수학식 5]와 같이 정의될 수 있다.
전체 컴플라이언스는 매니퓰레이터와 휠로 구성되어 있다. 만약 휠의 강성이 높으면 매니퓰레이터는 정확한 기계 깊이를 생성하는 위치 제어 방법에 의하여 제어될 수 있다. 규정된 휠은 사전에 가공된 원본 형상을 손상시키지 않도록 힘 제어가 이루어지면서 툴 마크(tool mark)를 제거할 때 권장될 수 있다. 하기 [표 3]은 각 휠 사용 사례에 대한 z축 전체 컴플라이언스(z-axis overall compliance)를 나타낸다.
상기 [표 3]을 참조하면, 연마 휠이 없는 경우에 비하여 연마 휠이 있는 경우에 컴플라이언스 값이 높고, 메쉬 수(mesh number)가 증가할수록 컴플라이언스 값이 높음을 확인할 수 있다.
도 6은 본 개시의 일 실시 예에 따른 역 기구학적 모델(inverse kinematic model) 기반의 매니퓰레이터(100)의 제어 방법을 나타낸 도면이다.
구체적으로, 도 6은 피드 포워드(feedforward) 토크 제어를 수반하는 매니퓰레이터(100)의 제어 방법의 일 예를 나타낸다.
도 6을 참조하면, 본 개시의 일 실시 예에 따른 역 기구학적 모델 기반의 매니퓰레이터(100)의 제어 방법은 별도의 PC(610)가 모션 컨트롤러(620)에 대하여 위치 명령과 토크 명령을 전송할 수 있다. 모션 컨트롤러(620)는 도 2에 도시된 프로세서(190)를 의미할 수 있다.
도 6에서는 매니퓰레이터(100)가 별도의 PC(610)의 제어에 의하여 동작하는 실시 예를 도시하고 있으나, 본 개시가 이에 한정되지 않는다. 즉, 일 실시 예에서, 프로세서(180)가 도 6에 도시된 PC(610)의 역할과 모션 컨트롤러(620)의 역할을 모두 수행할 수 있다.
모션 컨트롤러(620)는 로봇(650)의 모션 정보(또는 동작 정보, 661), 위치 명령과 토크 명령에 기초하여 실시간 토크 값을 서보(630)에 전달할 수 있다. 로봇(650)은 매니퓰레이터(100)의 엔드 이펙터 또는 엔드 이펙터에 장착된 회전 공구를 의미할 수 있다. 로봇(650)의 모션 정보(661)는 로봇(650)의 자세 정보를 의미할 수 있고, 로봇(650)의 자세 정보는 각 모터 또는 각 관절의 자세를 의미할 수 있다.
서보(630)는 모션 컨트롤러(620)로부터 수신한 실시간 토크 값과 로봇(650)의 모션 정보(661)에 기초하여 모터(640)에 대하여 위치 제어 및 토크 제어를 수행할 수 있다. 그리고, 모터(640)의 동작에 의해 로봇(650)이 제어될 수 있다.
일 실시 예에서, 모터 또는 액츄에이터는 서보(630)와 모터(640)를 통칭하는 용어로 이용될 수도 있다. 즉, 단순히 모터 또는 액츄에이터라 칭하더라도 이는 서보(630)를 포함하는 모터(640)를 의미할 수도 있다.
PC(610)는 로봇(650)의 모션 정보(661)와 힘 정보(671)를 이용하여 모터(640)의 제어에 대한 캘리브레이션(calibration, 681)을 수행할 수 있다. 모터(640)의 제어에 대한 캘리브레이션에는 위치 보정(position correction), 동역학적 보정(dynamics correction), 비틀림 컴플라이언스(torsional compliance), 베어링 컴플라이언스(bearing compliance) 등이 포함될 수 있다.
PC(610)는 캘리브레이션(681) 과정에서, 기구학적 모델(kinematic model), 동적 모델(dynamic mode), 피니싱 조건(finishing doncition), 컴플라이언스 모델(compliance model)을 이용하여 전처리(691)를 수행할 수 있다. 그리고, PC(610)는 캘리브레이션(681) 및 전처리(691)에 기초하여 매니퓰레이터(100)의 제어 과정을 개선할 수 있다.
일 실시 예에서, PC(610)는 힘 정보(671)에 기초하여 K를 조정하고, 토크를 보정할 수 있다. K는 역 기구학적 모델에서 질량 및 길이 파라미터를 의미할 수 있다.
비록 도 6에서는 매니퓰레이터(100)의 프로세서(180)가 액츄에이터(130)에 대한 제어 신호를 생성함으로써 매니퓰레이터(100)의 동작을 제어하는 방법을 도시하였지만, 본 개시가 이에 한정되지는 않는다. 즉, 다른 실시 예에서, 외부 장치, 예컨대 PC(610),가 매니퓰레이터(100)의 액츄에이터(130)에 대한 제어 신호 또는 제어 명령어를 생성하고, 매니퓰레이터(100)의 프로세서(180)가 외부 장치에서 생성된 제어 신호 또는 제어 명령어에 기초하여 액츄에이터(130)를 제어할 수도 있다.
도 7은 본 개시의 일 실시 예에 따른 매니퓰레이터(100)에 대한 시뮬레이션 과정을 나타낸 도면이다.
도 7을 참조하면, 매니퓰레이터(100)에 대한 시뮬레이션은 온라인 계산(710)과 오프라인 계산(720)을 포함할 수 있다.
매니퓰레이터(100)의 동적 성능은 가상 컨트롤러, 서보 드라이브 및 하드웨어를 채택함으로써 추정할 수 있다. 모션 컨트롤러 파트는 PID 제어 루프(PID control loop)와 주파수 응답에 대한 필터를 포함하고, 서보 드라이브 파트는 모터 매커니즘을 포함하고, 하드웨어 파트는 강성있는 매니퓰레이터(100)와 기어 비와 전송 효율을 갖는 전송 매커니즘을 포함할 수 있다.
온라인 계산(710)은 매니퓰레이터(100)와 컨트롤러 사이의 실제 통신을 엔코더 신호와 전류로 나타낼 수 있다. 오프라인 계산(720)은 가상 통신을 나타낼 수 있다.
도 8은 본 개시의 일 실시 예에 따른 매니퓰레이터(100)의 구속된 동작(constrained motion)을 설명하는 도면이다.
도 8을 참조하면, 매니퓰레이터(100)의 엔드 이펙터에 부착된 연마 휠은 주어진 작업 표면에 의해 구속(constraint)되어 움직이며, 절삭력(cutting force)에 의해 생성된 반발력(reaction force)의 영향을 받는다. 따라서, 표면 형상 데이터에 기반한 순 기구학 동작(forward kinematics motion)보다는 주어진 구속된 경로(constrained path)에 대처하기 위한 구동 토크(driving torque)의 계산이 필요하다.
표면 구속 조건은 하기 [수학식 6]과 같이 가정할 수 있다. 그리고, 도 8에 도시된 궤적 φ(811)과 매니퓰레이터(100)의 운동학적 요소 사이의 관계를 통해 하기 [수학식 7]과 같이 구속 조건을 정의할 수 있다. h는 매니퓰레이터(100)에 대한 제약 조건을 나타내는 함수이고, hj는 j축 방향이 구속된 경우의 구속 조건을 나타내는 함수이다.
나아가, 공칭 공구 궤적(nominal tool trajectory)와 실제 공구 궤적(actual tool trajectory) 사이의 편차로 인한 탄성 변형이 추가된 구속 조건은 하기 [수학식 8] 및 [수학식 9]와 같이 정의할 수 있다.
결국, x방향과 z방향의 구속 조건에 따른 구속된 동작은 하기 [수학식 10] 및 [수학식 11]과 같이 표현될 수 있다. T는 베이스에서 엔드 이펙터로의 변환 행렬, t는 엔드 이펙터의 접선 벡터(tangent vector), n은 엔드 이펙터의 법선 벡터(normal vector)를 의미할 수 있다.
도 9은 본 개시의 일 실시 예에 따른 매니퓰레이터(100)의 피드 포워드 토크 제어를 설명하는 도면이다.
도 9을 참조하면, 매니퓰레이터(100)의 평행사변형 구조에 의해 절삭력이 주로 제2 조인트(512)에 의존한다. 피드 포워드 토크 제어 방법은 구속된 동작에서 일정한 반발력을 유지하기 위해 채용될 수 있다. 이 경우, 힘 제어 규칙에 의한 각 조인트(511 내지 515)에 대한 추정 구동 토크(estimated driving torque)에 상응하여, 각 조인트(511 내지 515)의 위치와 힘이 동시에 제어될 수 있다. 이러한 제어 방법은 지연 시간 없는 힘 제어가 가능하고, 힘 오차가 표면에서 구속되지 않은 방향(non-constrained direction)으로의 동적 동작에 영향받지 않는다는 장점이 있다. 나아가, 랩핑이나 폴리싱과 같이 표면 거칠기(surface roughness)가 중요한 이러한 동작들은 액츄에이터로부터 부드럽고 균일한 토크를 생성하는 것이 센서 피드백에 의한 잦은 힘 제어 응답을 생성하는 것보다 더 적합하다.
결과적으로, 중력 피드의 형태의 피드 포워드 토크 제어는 간접적 힘 제어에 채용될 수 있으며, 엔드 이펙터의 힘은 툴을 포함하는 매니퓰레이터(100)의 중량(deadweight)과 제2 조인트(512)의 구동 토크에 의해 결정될 수 있다.
동작 구속 조건을 고려한 동적 관계는 하기 [수학식 12]와 같이 표현할 수 있다. τφ는 구속되지 않은 매니퓰레이터의 구동 토크, τh는 오직 구속에 의한 구동 토크를 의미할 수 있다.
구속되지 않은 매니퓰레이터의 구동 토크는 상기 [수학식 1]에 기초하여 하기 [수학식 13]과 같이 표현될 수 있고, 이는 조인트 동작이 매우 느리기 때문에 운동 에너지 항이 무시될 수 있기 때문이다.
따라서, 래핑 동작의 구동 토크는 하기 [수학식 14] 및 [수학식 15]과 같이 모델을 생성할 수 있으며, 구속 조건의 그래디언트 항은 상기 [수학식 10] 및 [수학식 11]에 의해 획득할 수 있다.
본 개시의 일 실시 예에 따른 5축 매니퓰레이터(100)는 제2 조인트(512)가 지렛대 효과를 제공하도록 설계되었으며, 이에 따라 제2 조인트(512)가 매니퓰레이터(100)의 중량을 이용하여 평면에서의 반발력에 대응하는데 최적화된 구조를 갖는다. 따라서, 제2 조인트(512)만에 하기 [수학식 16]에 따른 피드 포워드 토크 제어 규칙을 적용할 수 있다. 즉, 제2 조인트(512) 또는 제2 조인트(512)에 대응하는 제2 액츄에이터만이 모션 컨트롤러 또는 프로세서(190)에 의한 변환된 제어 전압을 수신함으로써 피드 포워드 토크 제어를 수행할 수 있고, 이러한 피드 포워드 토크 제어는 위치 피드백과 포스 피드백(force feedback)을 수반하지 않는다.
5축 매니퓰레이터(100)가 제1 축(311)과 제2 축(312)이 동적 디커플링된 평행사변형 구조를 가짐에 따라, 제2 조인트(512)에 의한 피드 포워드 토크는 하기 [수학식 17]과 같이 간략화할 수 있다. k1과 k2는 제어 게인(control gain)이다. 게인이 높을수록 액츄에이터에서 더 큰 토크가 발생하고, 엔드 이펙터에서 발생하는 힘도 증가한다. 게인 값들은 엔드 이펙터 힘과 게인 값 사이의 관계를 정의하는 사전 실험에 의해 결정 및 조정될 수 있다.
상기 [수학식 17]을 참조하면, x축 방향 또는 작업 방향의 외력 λx이 0이고, 제3 액츄에이터의 변위 q3와 제4 액츄에이터의 변위 q4가 0일 때, 제2 액츄에이터의 피드 포워드 토크 τ2는 제2 액츄에이터의 변위 q2와 제5 액츄에이터의 변위 q5에 기초하여 결정될 수 있다.
도 10은 본 개시의 일 실시 예에 따른 매니퓰레이터(100)에 대한 제어 블록 다이어그램이다.
도 10을 참조하면, 원하는 힘이 명령될 때, 제2 조인트(512)에 대응하는 제2 액츄에이터의 구동 토크는 피드 포워드 토크 모델을 통하여 생성되며, 피드백 제어 모드가 종료될 수 있다. 만약, 힘 제어가 종료되면, 피드 포워드 제어 모드가 종료되고, 목표 지점까지 이동하기 위하여 피드백 제어 모드로 전환될 수 있다. 제2 액츄에이터를 제외한 나머지 액츄에이터들은 제어 상황과 무관하게 위치 제어만을 유지할 수 있다.
도 11은 연마 휠이 없는 경우에 컴플라이언스 제어(compliance control)에 따른 힘 제어 결과를 나타낸 도면이다.
구체적으로, 도 11의 (a)는 엔드 이펙터 힘을 나타내고, 도 11의 (b)는 모터 제어 토크 전달을 위한 명령 전압을 나타낸다.
도 11의 (a)를 참조하면, 감속 기어 또는 컴플라이언스 연마 휠(compliant abrasive wheel)의 비틀림 강성에 의해 생성된 힘이 가해지기 때문에, 힘 명령 직후의 과도 상태(transient state)에서의 힘 응답이 갑자기 변경된다.
도 11의 (b)를 참조하면, 힘 제어의 성능은 수동 시스템의 물리적 강성(physical rigidity)에 의해 결정되므로, 로봇 역학에 기초하여 조정된 모터의 피드백은 불안정하다.
도 12는 연마 휠이 없는 경우에 피드 포워드 토크 제어(feed-forward torque control)에 따른 힘 제어 결과를 나타낸 도면이다.
구체적으로, 도 12의 (a)는 엔드 이펙터 힘을 나타내고, 도 12의 (b)는 모터 제어 토크 전달을 위한 명령 전압을 나타낸다.
도 12의 (a)를 참조하면, 피드 포워드 토크 제어에 따를 경우 엔드 이펙터 힘이 명령 값을 따라 잘 제어되고 유지된다.
도 12의 (b)를 참조하면, 모터의 구동 전압은 -6V에서 +6V 사이의 값을 가지며, 정격 토크의 100%를 생성한다. 상술한 바와 같이, 본 개시에서 제안하는 피드 포워드 토크 제어에 따라 가해지는 힘은 제2 액츄에이터의 구동 토크에 의해 결정되므로, 제1 액츄에이터 (또는 제1 모터)와 제5 액츄에이터 (또는 제5 모터)의 구동 토크는 매니퓰레이터(100)의 위치 제어에만 집중하여 일정하게 유지될 수 있다.
컴플라이언스 제어와 비교할 때, 피드 포워드 토크 제어는 급격한 동적 절삭력에 의한 매니퓰레이터(100)의 진동을 억제하는데 도움을 주는 이점이 있다.
도 13은 종래의 포스 피드백(force feedback) 제어와 본 개시에서 제안된 피드 포워드 제어를 비교한 도면이다.
도 13을 참조하면, 본 개시에서 제안된 피드 포워드 제어는 피드백 진동의 제한되지 않고 간접적인 힘 제어 양태를 보여준다. 매니퓰레이터(100)의 엔드 이펙터는 선형 보간법에 따라 x축에서 100mm의 위치에서 200mm의 위치로 이동했다.
피드 포워드 제어 사례에서, 두 번째 모터만 계산된 토크 명령을 따르고, 나머지 모터는 서보 제어 룰을 따를 수 있다. 이 경우, 매니퓰레이터(100)의 자세가 변경됨에 따른 컴플라이언스 에러로 인하여, 불안정한 자세에서 힘 에러가 발생할 수 있다.
힘 피드백 제어 사례에서, 모든 모터는 서보 제어 규칙을 따르고, 엔드 이펙터는 가상의 힘-제어 도구(force-controlled tool)라 가정하였다. 이 경우, 컴플라이언스 에러는 제거되지만, 엔드 이펙터와 반응 표면(reaction surface) 사이의 임피던스 조건으로 인하여, 피드백 진동이 발생하였음을 확인할 수 있다.
Claims (13)
- 피니싱 작업을 위한 매니퓰레이터(manifulator)에 있어서,
베이스(base);
복수의 링크(link), 상기 복수의 링크를 연결하는 복수의 조인트(joint) 및 상기 복수의 조인트 중에서 적어도 일부의 조인트의 회전을 발생시키는 복수의 액츄에이터(actuator)를 포함하는 암(arm); 및
상기 매니퓰레이터의 자중 효과를 고려하여 상기 복수의 액츄에이터 각각의 구동 토크(driving torque)를 결정하고, 상기 결정된 구동 토크에 기초하여 상기 복수의 액츄에이터를 제어하는 프로세서
를 포함하는, 매니퓰레이터. - 청구항 1에 있어서,
상기 암은
일 변이 상기 베이스에 고정되고 평행사변형 구조를 갖는 평행사변형 링크 세트를 더 포함하는, 매니퓰레이터. - 청구항 2에 있어서,
상기 암은
제1 링크, 제2 링크, 제1 액츄에이터, 제2 액츄에이터, 제1 조인트 및 제2 조인트를 더 포함하고,
상기 평행사변형 링크 세트는
일 변이 이중 링크이고,
상기 이중 링크는
서로 평행한 상기 제1 링크와 상기 제2 링크를 포함하고,
상기 제1 링크는
상기 제1 액츄에이터에 의해 회전하는 상기 제1 조인트를 통해 상기 베이스와 연결되고,
상기 제2 링크는
상기 제2 액츄에이터에 의해 회전하는 상기 제2 조인트를 통해 상기 베이스와 연결되는, 매니퓰레이터. - 청구항 3에 있어서,
상기 제1 조인트와 상기 제2 조인트는
각각의 회전 축이 작업면에 평행하고 동일한 일직선에 배치되고, 동역학적으로 디커플링되는(decoupled), 매니퓰레이터. - 청구항 4에 있어서,
상기 제2 조인트는
상기 평행사변형 구조에 의해 상기 암에 대한 지렛대 효과를 제공하고,
상기 프로세서는
상기 제2 액츄에이터를 통해 피드 포워드 토크 제어(feed forward torque control)를 수행하는, 매니퓰레이터. - 청구항 5에 있어서,
상기 피드 포워드 토크 제어는
상기 암에 대한 위치 피드백과 상기 암에 대한 포스 피드백(force feedback)을 수반하지 않는, 매니퓰레이터. - 청구항 5에 있어서,
상기 암은
제3 조인트, 제3 액츄에이터 및 스윙 암 링크(swing arm link)를 더 포함하고,
상기 스윙 암 링크는
상기 평행사변형 링크 세트의 상기 베이스에 연결되지 않은 변의 말단에서 상기 제3 조인트를 통해 연결되고,
상기 제3 조인트는
상기 제3 액츄에이터에 의해 상기 작업면에 수직한 방향의 회전 축을 따라 회전하는, 매니퓰레이터. - 청구항 7에 있어서,
상기 암은
제4 조인트, 제5 조인트, 제4 액츄에이터, 제5 액츄에이터, 핸드 링크(hand link) 및 엔드 이펙터(end effector)를 더 포함하고,
상기 핸드 링크는
상기 스윙 암 링크의 말단에서 상기 제4 조인트를 통해 연결되고,
상기 제4 조인트는
상기 제4 액츄에이터에 의해 상기 핸드 링크의 방향의 회전 축을 따라 회전하고,
상기 엔드 이펙터는
상기 핸드 링크의 말단에서 상기 제5 조인트를 통해 연결되고,
상기 제5 조인트는
상기 제5 액츄에이터에 의해 상기 작업면과 평행하고 상기 핸드 링크의 방향과 수직한 회전 축을 따라 회전하는, 매니퓰레이터. - 청구항 1에 있어서,
상기 베이스는
갠트리 구조물(gantry structure)에 연결되는, 매니퓰레이터. - 피니싱 작업을 위한 매니퓰레이터(manifulator)의 제어 방법에 있어서,
상기 매니퓰레이터의 자중 효과를 고려하여 상기 매니퓰레이터에 포함된 복수의 액츄에이터 각각의 구동 토크를 결정하는 단계; 및
상기 결정된 구동 토크에 기초하여 상기 복수의 액츄에이터를 제어하는 단계
를 포함하는, 제어 방법. - 청구항 11에 있어서,
상기 매니퓰레이터는
베이스(base) 및 암(arm)을 포함하고,
상기 암은
일 변이 상기 베이스에 고정되고 평행사변형 구조를 갖는 평행 사변형 링크 세트를 포함하고,
상기 평행사변형 링크 세트는
일 변이 이중 링크이고,
상기 이중 링크는
서로 평행한 상기 제1 링크와 상기 제2 링크를 포함하고,
상기 제1 링크는
상기 제1 액츄에이터에 의해 회전하는 상기 제1 조인트를 통해 상기 베이스와 연결되고,
상기 제2 링크는
상기 제2 액츄에이터에 의해 회전하는 상기 제2 조인트를 통해 상기 베이스와 연결되고,
상기 제1 조인트와 상기 제2 조인트는
각각의 회전 축이 작업면에 평행하고 동일한 일직선에 배치되고, 동역학적으로 디커플링되는(decoupled), 제어 방법. - 청구항 12에 있어서,
상기 제2 조인트는
상기 평행사변형 구조에 의해 상기 암에 대한 지렛대 효과를 제공하고,
상기 복수의 액츄에이터를 제어하는 단계는
상기 제2 액츄에이터를 통해 피드 포워드 토크 제어(feed forward torque control)를 수행하는 단계
를 포함하는, 제어 방법.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020237043717A KR20240000643A (ko) | 2019-06-03 | 2020-06-03 | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 |
Applications Claiming Priority (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR20190065060 | 2019-06-03 | ||
KR1020190065060 | 2019-06-03 | ||
US201962924807P | 2019-10-23 | 2019-10-23 | |
US62/924,807 | 2019-10-23 | ||
PCT/KR2020/007224 WO2020246808A1 (ko) | 2019-06-03 | 2020-06-03 | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020237043717A Division KR20240000643A (ko) | 2019-06-03 | 2020-06-03 | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 |
Publications (1)
Publication Number | Publication Date |
---|---|
KR20210083362A true KR20210083362A (ko) | 2021-07-06 |
Family
ID=73652999
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020237043717A KR20240000643A (ko) | 2019-06-03 | 2020-06-03 | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 |
KR1020217018105A KR20210083362A (ko) | 2019-06-03 | 2020-06-03 | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020237043717A KR20240000643A (ko) | 2019-06-03 | 2020-06-03 | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 |
Country Status (3)
Country | Link |
---|---|
US (1) | US11745342B2 (ko) |
KR (2) | KR20240000643A (ko) |
WO (1) | WO2020246808A1 (ko) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220092448A (ko) | 2020-12-24 | 2022-07-01 | 부산대학교 산학협력단 | 원자로 내부 해체를 위한 힘 기반 임피던스 제어 시스템 및 방법 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7141847B2 (ja) * | 2018-05-11 | 2022-09-26 | 川崎重工業株式会社 | 撓み量推定装置、ロボット制御装置、及び撓み量推定方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4148280B2 (ja) | 2005-10-18 | 2008-09-10 | セイコーエプソン株式会社 | 平行リンク機構及び産業用ロボット |
DE102009007026A1 (de) | 2009-02-02 | 2010-08-05 | Kuka Roboter Gmbh | Steuerung und Steuerungsverfahren für einen Manipulator |
US9119655B2 (en) * | 2012-08-03 | 2015-09-01 | Stryker Corporation | Surgical manipulator capable of controlling a surgical instrument in multiple modes |
KR101683526B1 (ko) | 2015-02-12 | 2016-12-07 | 현대자동차 주식회사 | 중력 보상 링키지 유니트 |
KR101724490B1 (ko) | 2015-12-02 | 2017-04-07 | 기아자동차 주식회사 | 협업로봇을 이용한 차량 생산시스템 및 생산방법 |
US10173323B2 (en) * | 2017-06-09 | 2019-01-08 | Precise Automation, Inc. | Collaborative robot |
US10252420B2 (en) | 2017-06-09 | 2019-04-09 | Precise Automation, Inc. | Collaborative robot |
-
2020
- 2020-06-03 KR KR1020237043717A patent/KR20240000643A/ko active Application Filing
- 2020-06-03 KR KR1020217018105A patent/KR20210083362A/ko active Application Filing
- 2020-06-03 WO PCT/KR2020/007224 patent/WO2020246808A1/ko active Application Filing
- 2020-06-03 US US17/616,593 patent/US11745342B2/en active Active
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220092448A (ko) | 2020-12-24 | 2022-07-01 | 부산대학교 산학협력단 | 원자로 내부 해체를 위한 힘 기반 임피던스 제어 시스템 및 방법 |
Also Published As
Publication number | Publication date |
---|---|
US11745342B2 (en) | 2023-09-05 |
WO2020246808A1 (ko) | 2020-12-10 |
US20220226992A1 (en) | 2022-07-21 |
KR20240000643A (ko) | 2024-01-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9785138B2 (en) | Robot and robot controller | |
US8099188B2 (en) | Parallel kinematic robot and method for controlling this robot | |
JP5236596B2 (ja) | 加工ロボットシステム | |
KR20150051892A (ko) | 잉여 산업 로봇의 운동 시퀀스를 프로그래밍하기 위한 방법 및 관련 산업 로봇 | |
KR101744962B1 (ko) | 다관절로봇을 이용한 목재부재 가공시스템 | |
JP2019534165A (ja) | ロボット支援による表面加工機械 | |
KR20120135418A (ko) | 위치 결정 장치 및 가공 시스템과, 열간 가공 장치 | |
JP6418483B2 (ja) | 加工軌道生成装置と方法 | |
US11745342B2 (en) | Manipulator for finishing work, and control method therefor | |
JP6875348B2 (ja) | ロボットおよび第1アーム部材 | |
Yeshmukhametov et al. | Design and kinematics of serial/parallel hybrid robot | |
JP2020049550A (ja) | ロボットユニット | |
WO2014123054A1 (ja) | ロボット制御装置及びロボット制御方法 | |
US11220004B2 (en) | Robot system | |
Deng et al. | A review of robot grinding and polishing force control mode | |
JP6390832B2 (ja) | 加工軌道生成装置と方法 | |
CN114269520B (zh) | 具有多功能刀具定向的并联运动装备 | |
Flixeder et al. | Combined path following and compliance control with application to a biaxial gantry robot | |
Park et al. | Gantry type lapping manipulator toward unmanned lapping process for a large work surface | |
Ghaffari et al. | Kinematic design of a novel 4-DOF parallel mechanism for turbine blade machining | |
JP5195181B2 (ja) | 工作機械のncデータ作成装置 | |
JP2014076498A (ja) | 多関節ロボット及び半導体ウェハ搬送装置 | |
JPH1158285A (ja) | ハンド機構の力制御システム | |
Hong et al. | Design of a force-controlled end-effector with low-inertia effect for robotic polishing using macro-mini robot approach | |
KR100774077B1 (ko) | 다관절 로봇 및 그 제어 장치 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
E902 | Notification of reason for refusal | ||
AMND | Amendment | ||
E601 | Decision to refuse application | ||
AMND | Amendment | ||
X601 | Decision of rejection after re-examination | ||
A107 | Divisional application of patent |