KR20100023846A - 탄성 로봇 구조를 위한 운동 제어기 - Google Patents
탄성 로봇 구조를 위한 운동 제어기 Download PDFInfo
- Publication number
- KR20100023846A KR20100023846A KR1020097025374A KR20097025374A KR20100023846A KR 20100023846 A KR20100023846 A KR 20100023846A KR 1020097025374 A KR1020097025374 A KR 1020097025374A KR 20097025374 A KR20097025374 A KR 20097025374A KR 20100023846 A KR20100023846 A KR 20100023846A
- Authority
- KR
- South Korea
- Prior art keywords
- robot
- axis
- path
- individual
- coordinates
- Prior art date
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/1628—Programme controls characterised by the control loop
- B25J9/1641—Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints
-
- 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/39181—Compensation of coulomb friction in joint
-
- 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/39186—Flexible joint
-
- 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/41127—Compensation for temperature variations of servo
-
- 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/41443—Position reference ffw for compensation of position
-
- 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/41448—Ffw friction compensation for speed error, derived from position reference
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
본 발명은 a) 기준점이 지나가기로 되며 각 경우에 대해 공간 좌표에 의해 정의되는 다수의 경로 점들을 이용하여 로봇 경로가 설정되는 단계와, b) 상기 개별 경로 점들의 공간 좌표가 역 로봇 운동학에 따라 각 경로 점들에서 상기 개별 로봇 축의 위치를 재생산하는 대응하는 축 좌표로 변경되는 단계와, c) 상기 변환된 축 좌표에 따라 상기 개별 로봇 축을 위한 축 관련 제어기가 구동되는 단계와, d) 상기 해당 축 관련 제어기에 의해 상기 개별 로봇 축의 축 관련 구동 모터가 구동되는 단계와, e) 로봇의 탄성 및/또는 마찰 및/또는 관성을 고려하여 동적 로봇 모델에 따라 상기 로봇 경로 상의 상기 개별 경로 점들에 대한 경로 수정 값이 계산되는 단계와, f) 상기 개별 경로 점들의 미수정 축 좌표와 상기 경로 수정 값으로부터 상기 개별 경로 점들에 대한 수정 축 좌표가 계산되는 단계와, g) 수정 축 좌표에 따라 축 관련 제어기가 구동되는 단계를 포함하는 페인트 도장 로봇용 제어 방법에 관한 것이다.
Description
본 발명은 다축 로봇 특히, 페인트 도장 로봇을 위한 제어방법에 관한 것이다.
독일공개특허공보 DE 103 42 471 A1은 사전 결정된 로봇 경로를 따라 공구 중심점(TCP: Tool Centre Point)를 이동시키는 다축 페인트 도장 로봇을 위한 로봇 제어 시스템을 개시하고 있다. 이 로봇 제어 시스템은 페인트 도장 로봇의 위치 정확성을 개선하기 위하여 개별 로봇 축의 기계적 탄성을 고려하고 보상할 수 있다. 이 경우에, 페인트 도장 로봇의 개별 로봇 축은 하나의 축 제어기에 의해 구동되며, 중첩되어 축결합되는 부분에서 상대적으로 유연한 로봇 축의 제어기의 편차가 상대적으로 단단한 축의 제어기를 따른다는 점에서 페인트 도장 로봇의 기계적 탄성이 고려된다.
상기 로봇 제어 시스템의 효과가 입증되기는 하였으나, 특히 고기동 로봇 운동의 경우에 위치 정확성을 높이기 위하여 페인트 도장 로봇의 기계적 탄성을 더욱 잘 고려하고 보상하는 것이 요구된다.
미국공개특허공보 US 2004/0093119는 마찰 관련 로봇의 위치 에러를 수정하 는 로봇 제어 시스템을 개시하고 있으나, 사전 결정된 로봇 경로가 수정되지 않은 상태로 개별 로봇 축의 구동 제어가 이루어진다. 따라서, 로봇의 위치 정확성은 충분히 개선되지 않으며, 이는 특히 로봇의 고기동 시에 더욱 두드러진다.
관련된 선행문헌으로서, DE 10 2004 056 861 A1, "제어 알고리즘에 대한 2005 IEEE 컨퍼런스 회보"(2000년 8월 28일 - 31일, 1170 - 1175 페이지), "로봇 제어에 대한 IFAC 심포지움 회보"(1994년 9월 19일 - 21일, 485 - 490 페이지), DE 698 29 559 T2, "로봇 공학과 자동화에 대한 1992 IEEE 컨퍼런스 회보"(1992년 5월, 1429 -1435 페이지), "제어 시스템 기술에 대한 IEEE 보고서" Vol. 12, No. 6, 2004년 11월 904 - 919 페이지) 및 EP 1 173 801 B1이 있다. 그러나, 상기한 어떤 선행문헌도 로봇의 위치 정확성을 만족시키지 못한다.
그에 따라, 본 발명의 목적은 로봇의 위치 정확성을 개선하기 위하여 로봇의 탄성을 보상하는 다축 로봇을 위한 제어방법을 제공하는 것이다.
상기 목적은 청구범위에 기재된 발명에 따른 제어방법에 의해 달성된다.
본 발명은 사전 결정된 로봇 경로에 따라 다축 로봇을 제어할 때, 경로 수정값 계산에 대한 일반적인 기술적 내용을 포함한다. 상기 경로 수정 값은 로봇의 탄성, 마찰 및/또는 관성을 고려함으로써, 그에 따라 수정된 로봇 경로를 갖는 로봇의 구동은 동적 위치 오차(예를 들면, 오버슈트, 로봇 축의 탄성 변형)를 보상한다.
본 발명에 따른 제어방법에서, 예를 들어 공구 중심점(TCP)과 같은 로봇의 기준점에 대하여, 로봇 경로가 상기 기준점이 지나기로 된 다수의 경로 점들에 의해 사전 결정된다. 상기 로봇 경로 상의 개별 경로 점들은 3개의 공간 방향 내에서 개별 경로 점들을 정의하는 공간 좌표에 의해 정의되는 것이 바람직하다. 예를 들어, 3개의 좌표로 이루어진 좌표 세트 또는 위치 벡터가 각 경로 점을 위해 사전 결정될 수 있으며, 각 경로 점은 3차원 직교 좌표계(3-D Cartesian coordinate system) 내에서 각 경로 점의 위치를 나타낸다.
사전 결정된 로봇 경로의 개별 경로 점들의 공간 좌표는 역 로봇 운동학에 따른 종래의 방법에 의해 본 발명의 제어방법을 위하여 각 경로 점들에서 개별 로봇 축의 위치를 나타내는 대응하는 축 좌표로 변환된다. 공간 좌표의 역 로봇 운동학에 따른 대응하는 축 좌표로의 변환은 종래 기술로부터 알 수 있으므로 이에 대한 보다 상세한 설명은 생략한다. 개별 경로 점들의 변환된 축 좌표는 축 좌표 시스템에서 위치 벡터의 형태로 간주된다.
개별 경로 점들의 변환된 축 좌표는 개별 로봇 축을 위한 축 관련 제어기를 구동하는데 이용되는데, 이는 예를 들면, 앞서 인용된 특허 DE 103 42 471 A1과 같은 종래의 기술로부터 알 수 있으며, 그 내용은 전체적으로 본 발명에 포함된다.
개별 로봇 축을 위한 축 관련 제어기는 기준점(예를 들면, 공구 중심점)이 사전 결정된 로봇 경로의 개별 경로 점들을 연속적으로 이동하도록 개별 로봇 축의 구동 모터를 구동한다.
앞서 설명된 종래의 방법에 더하여, 본원 발명에 따르면, 로봇 경로의 개별 경로 점들을 위한 경로 수정 값이 동적 로봇 모델에 따라 계산되며, 경로 수정 값은 로봇의 탄성, 마찰 및/또는 관성을 고려하고 동적 위치 오차를 보상하게 된다.
경로 수정 값은 사전 결정된 로봇 경로의 개별 경로 점들을 위한 수정된 축 좌표의 계산에 이용된다. 바람직하기로는, 수정된 축 좌표의 계산을 위하여 상기 경로 수정 값은 단순히 각 경로 점들의 미수정 축 좌표에 가산되어서 상쇄값(offset)을 형성하게 된다.
마지막으로, 개별 축 관련 제어기는 수정된 축 좌표에 의해 구동되어서 동적 위치 오차는 보상된다.
본 발명의 바람직한 실시예에서, 동적 로봇 모델이 내력(internal force) 및 로봇의 움직이는 물체를 위한 토크 계산을 위해 구비되며, 그 계산은 강체 모델에 따라 실시간("온라인")으로 진행되는 것이 바람직하다.
이 경우에, 본 발명에 따른 제어방법은 동적 로봇 모델에 따라 개별 경로 점들의 미수정 축 좌표로부터 계산될 내부 토크를 제공하며, 내부 토크는 구동 모터와 해당 로봇 축의 내부 토크를 나타낸다. 예를 들면, 이와 같은 방법으로 계산된 내부 토크 값들은 아래에서 상세히 설명될 개별 로봇 축의 정적 마찰 요소, 점성 마찰 요소 및/또는 구동 트레인의 관성을 고려할 수 있다.
본 발명의 실시예에서, 경로 수정 값은 내부 토크와 알려진 외부 토크로부터 계산되며, 가장 단순한 경우에 개별 로봇 축을 0차의 탄성 토션 스프링으로 간주함으로써 개별 로봇 축의 탄성이 고려된다. 경로 수정 값이, 선형 상호관련성에 따라, 사전 결정된 토션 스프링 계수와 내부 토크와 외부 토크의 합인 전체 토크로부터 얻어진다.
본 발명을 위해, 내부 토크 값은 각 구동 모터의 회전 방향으로 작용하는 속력-독립적 마찰을 나타내며 예를 들어 경로 점들의 미수정 축 좌표의 부호(sign)와 사전 결정된 정적 마찰 상수로부터 계산될 수 있는 정적 마찰 항 을 포함할 수 있다. 여기서 정적 마찰 항 은 정적 마찰 상수 와 미수정 축 좌표 로부터 다음과 같은 공식에 따라 계산될 수 있으며, i는 각 로봇 축을 나타낸다.
또한, 동적 로봇 모델에서 계산된 내부 토크 값은 각 구동 모터의 회전 속도에 비례하여 작용하는 선형 항인 동적 마찰 항 을 포함한다. 예를 들면, 동적 마찰 항은 동적 마찰 상수 와 경로 점들의 미수정 축 좌표의 시간에 대한 1차 미분인 로부터 다음과 같은 공식에 따라 계산될 수 있다.
마지막으로, 동적 로봇 모델에서 계산된 내부 토크 값은 각 로봇 축의 구동 트레인의 기계적 관성을 나타내고 각 구동 모터의 각 가속도에 비례하는 관성 항 를 포함하는 것이 바람직하다. 관성 항 은 경로 들점의 미수정 축 좌표의 시간에 대한 2차 미분인 와 관성 상수 로부터 다음과 같은 공식에 따라 계산될 수 있다.
본 발명의 바람직한 실시예에서, 앞서 언급한 마찰 항에 대한 온도 종속이 고려된다. 이를 위하여, 본 발명에 따른 제어방법에서 대기 온도가 측정되며, 모델 파라미터(예를 들면 정적 마찰 상수, 동적 마찰 상수 및 관성 상수)가, 측정된 온도의 함수로서 파라미터 메모리로부터 읽혀진다. 경로 수정 값은 현재 온도를 고려한 동적 로봇 모델의 모델 파라미터를 가지고 계산된다. 동적 로봇 모델의 모델 파라미터의 온도 조절은 로봇의 기계적 거동의 온도 종속성이 본 발명에 따른 제어방법에서 고려된다는 장점을 제공한다.
내부 파라미터 , 및 는 로봇 및 최적화용 특별 구동 프로그램에 의해 각 축에 대해 실험적으로 결정되는 것이 바람직하다. 이 구동 동안, 모터 토크 발생은 구동장치로부터 확인되고, 순전히 로봇의 물체로부터 기인하는 모터 토크는 동시에 계산된다. 내부 파라미터는 각 경우에 결과 토크 차이로부터 최소자승법을 이용하여 계산된다. 결정된 파라미터 세트는 각 축의 모터/기어 트레인의 현재 온도에 적용된다. 로봇의 작동 온도는 개별 단계들로 분리된다. 로봇은 구동에 따라 점차적으로 가열된다. 일단 각 단계에서 다음 단계에 이르면, 앞서서 언급된 확인 방법이 , 및 을 결정하기 위해 수행되고 관련된 온도가 동시에 저장된다. 이와 같은 방법에서, 관련된 파라미터의 세트가 각 온도 단계를 위해 각 축에 대해 획득된다. 다음 동작에서 현재 온도 값이 각 축에 대해 주기적으로 확인되며 관련된 파라미터 세트가 온라인으로 기록된다.
앞에서 설명된 동적 로봇 모델에 따른 내부 토크 값의 계산 이후에, 이미 위에서 언급되었듯이, 경로 수정 값이 내부 토크 값과 알려진 외부 토크 값으로부터 계산되며, 만일 개별 로봇 축의 기본 모델로서 0차 탄성 토션 스프링이 적용되는 경우라면, 이 계산은 가장 단순한 경우에 토크와 회전각 사이의 간단한 상호관계에 따라 이루어질 수 있다. 그러나, 바람직하기로는 경로 수정 값은 최적 모델링을 따르는 P 요소, PT1 요소 및/또는 PT2 요소에 의한 내부 토크 값으로부터 계산된다.
본 발명의 바람직한 실시예에서, 경로 수정 값으로 수정된 개별 경로 점들의 축 좌표은 축 좌표를 부드럽게 하기 위하여 축 관련 제어기의 구동에 앞서 필터링된다. 필터링 동안 예를 들어 평균 또는 가중 평균이 형성될 수 있다. 추가적으로, 필터링은 상(phase)-리드(lead) 필터 또는 FIR(Finite Impulse Response) 필터에 의해 수행될 수 있다. 축 관련 제어기의 구동에 앞서 수정된 축 좌표를 필터링하기 위한 다른 가능한 필터 형태는 대역 여파기(bandpass filter) 또는 저역 통과 필터(low-pass filter)이다.
본 발명은 위에서 설명된 제어 방법으로 제한되는 것이 아니며, 하드웨어의 관점에서 상기 제어 방법을 수행하기에 적합하고 그에 따라 설치된 로봇 제어 시스템를 포함한다.
마지막으로, 또한 본 발명은 본 발명에의 제어방법에 따른 로봇 제어방법에 의해 구동되는 다축 로봇, 특히 페인트 도장 로봇을 포함한다.
본 발명의 또 다른 진전이 종속항에서 확인되거나 첨부된 도면을 참조하여 본 발명의 바람직한 실시예의 설명을 통해 아래에서 더욱 상세하게 설명된다.
도 1은 다축 페인트 도장 로봇을 구동하기 위한 본 발명에 따른 로봇 제어 시스템을 개략적으로 도시한 것이다.
도 2a와 도 2b는 본 발명에 따른 제어 방법을 순서도 형태로 도시한 것이다.
도 3은 내부 토크 값으로부터 경로 수정 값을 계산하기 위한 도 1의 로봇 제어 시스템의 연산 유닛을 도시한 것이다.
도 4는 내부 마찰을 축 좌표의 시간 미분 함수로서 계산하기 위한 그래프를 도시한 것이다.
도 5는 측정 과정에서 동적 로봇 모델의 모델 파라미터를 결정하기 위한 개략도이다.
도 6은 도 5에 도시된 구성의 다른 실시예로서, 모델 파라미터가 다른 방법으로 계산된다.
도 7은 도 5에 도시된 구성의 또 다른 실시예로서 로봇 축에 브레이크가 걸려 정지하여 동적 로봇 모델의 로봇 파라미터를 결정한다.
도 1은 다축 페인트 도장 로봇을 구동하기 위한 본 발명에 따른 로봇 제어 시스템의 단순화된 개략도이다.
여기서 개별 로봇 축은 구동 모터(1)에 의해 구동되며, 이는 앞서서 인용된 독일공개특허 DE 103 42 471 A1를 통해 알 수 있다.
개별 로봇 축에 구비된 구동 모터(1)은 사전 결정된 전류 값()에 따라 각 경우에 개별 로봇 축에 대한 축 제어기(2)에 의해 구동되며, 여기서 밑줄 친 값은 개별 로봇 축을 위한 각 경우에 대한 요소를 포함하는 벡터를 나타낸다.
또한, 본 발명에 따른 로봇 제어 시스템은 경로 보간기(3)를 포함하는데, 경로 보간기(3)는 다수의 경로 점들이 통과하는 사전 결정된 로봇 경로를 입력 변수로서 받는다. 개별 경로 점들은 공구 중심점(TCP)이 지나가기로 된 점들로서, 각 경우에 3차원 위치 벡터로 정의되며, 위치 벡터의 개별 요소들은 3차원 직교 좌표에서 경로 점들의 공간 좌표를 나타낸다.
경로 보간기(3)는 사전 결정된 로봇 경로의 개별 경로 점들의 공간 좌표를 역 로봇 운동학에 따라 축 좌표로 변환한다. 축 좌표는 사전 결정된 로봇 경로의 각 경로 점들에서 페인트 도장 로봇의 개별 로봇 축의 위치를 나타낸다. 경로 보간기는 다차원의 위치 벡터()를 출력하며, 위치 벡터()의 차원 수는 로봇 축의 수와 동일하여, 위치 벡터()의 개별 요소()는 각 경로 점들에서 페인트 도 장 로봇의 개별 로봇 축들의 위치를 나타낸다.
위치 벡터()는 제1 연산 유닛(4)으로 전달되며, 제1 연산 유닛(4)은 위치 벡터()의 시간에 대한 1차 미분()와 시간에 대한 2차 미분() 즉, 축 좌표 시스템에서의 속도 및 가속도를 계산한다.
또한, 로봇 제어 시스템은 소프트웨어로 설치된 동적 로봇 모델(5)을 포함하며, 동적 로봇 모델(5)은 축 관련 위치 벡터(), 위치 벡터()의 시간에 대한 1차 미분()및 시간에 대한 2차 미분()으로부터 외부 토크()과 내부 토크()의 합인 토크 벡터()을 계산한다. 내부 토크()는 개별 로봇 축에서의 마찰 및 관성을 고려하여 다음의 식에 의해 계산된다.
토크 벡터()는 토크 벡터()로부터 경로 수정 벡터()를 계산하는 제2 연산 유닛(6)으로 전달된다. 토크 벡터()는 아래에서 상세히 설명는 바와 같이 경로 수정을 위해 사용된다. 경로 수정 벡터() 는 토크 벡터()로부터 다음 공식에 의해 계산된다.
수정 위치 벡터()는 위치 벡터 를 필터링하는 필터(8)에 전달된다. 필터(8)는 위치 벡터 를 평활화 하여 평활화된 위치 벡터()를 출력한다. 수정되고 평활화된 위치벡터()의 개별 요소들은 개별 로봇 축에 대한 개별 축 제어기(2)로 전달된다.
도 2a 및 도 2b의 순서도는 위에서 설명한 로봇 제어 시스템의 작동 방법을 더욱 명확히 한다.
제1 단계(S1)에서, 다수의 경로 점들의 경로 곡선이 경로 보간기(3)를 위해 사전 결정된다. 경로 점들은 공구 중심점(TCP)이 연속적으로 지나가기로 된 점들이며, 사전 결정된 경로 곡선의 개별 경로 점들은 3차원 직교 좌표에 의해 정의된다.
다음, 제 4 단계(S4)에서, 대기 온도(T)가 측정된다. 이는 동적 로봇 모델(5)이 후술하는 바와 같이 온도에 영향을 받기 때문이다.
제5 단계(S5)에서, 동적 로봇 모델(5)의 모델 파라미터들이 앞서 측정된 대기 온도(T)의 함수로서 파라미터 메모리로부터 읽혀진다. 모델 파라미터들은 정적 마찰 상수() 및 동적 마찰 상수() 및 관성 상수()이다.
다음, 제9 단계(S9)에서, 수정 축 좌표는 평활화를 위해 필터(8)에 의해 필터링된다.
마지막으로, 제11 단계(S11)에서, 개별 축에서 개별 구동 모터(1)가 축 제어기(2)에 의해 제어된다.
도 3은 도 1에 도시된 제2 연산 유닛(6)의 실시예를 보여준다. 제2 연산 유닛(6)은 토크 벡터()로부터 경로 수정 벡터()를 계산한다. 이 실시예에서, 제2 연산 유닛(6)은 P 요소(9), PT1 요소(10), PT2 요소(11) 및 가산기(12)를 구비한다. P 요소(9), PT1 요소(10) 및 PT2 요소(11)는 입력측에서 토크 벡터()을 받으며 출력측에서 가산기(12)에 연결된다. 가산기(12)는 경로 수정 벡터()를 계산하기 위하여 P 요소(9)의 출력 신호, PT1 요소(10)의 출력 신호 및 PT2 요소(11)의 출력 신호를 더한다.
P 요소는 종래 기술에 잘 알려져 있으며, 비례 전달 특성을 갖는다.
PT1 요소(10)도 종래 기술에 잘 알려져 있으며, 1차 지연의 비례 전달 특성 을 갖는다.
PT2 요소(11) 역시 종래 기술에 잘 알려져 있으녀, 2차 지연의 비례 전달 특성을 갖는다.
도 4는 축 좌표의 시간에 대한 1차 미분()의 함수인 내부 토크()을 계산하기 위한 그래프를 보여준다. 도 4로부터 마찰 토크()는 데드 존(dead zone)의 시작과 끝점 사이의 마찰 토크()의 값을 중간에 삽입함으로써 원점 주위의 데드 존에서 별도로 취급됨이 명백하다.
도 5는 앞서서 언급된 동적 로봇 모델의 모델 파라미터의 계산을 개략적으로 도시한 것이다. 예로서, 도면은 말단 장치(14)와 기어 연결부(15)를 구비하는 단일 로봇 축(13) 만을 보여준다.
기어 연결부(15)는 드라이브 모터에 의해 여기 유닛(16)을 통해 일시적으로, 주기적으로 또는 확률적으로 여기될 수 있다.
편차가 측정 유닛(17)에 의해 말단 장치(14)에서 측정되어서 제1 평가 유 닛(18)으로 전달된다. 제1 평가 유닛(18)은 로봇 축(13)의 기계적 전달 특성을 계산하기 위해 측정된 말단 장치의 편차에 대해 푸리에 해석(Fourier Analysis) 또는 상관관계 분석(correlation analysis)을 실시한다.
도 6의 도시는 도 5의 도시와 대부분 동일하며, 반복을 피하기 위해 도 5와 관련된 설명에 따라 동일한 도면부호가 사용된다.
도 6의 실시예의 특징은 측정 유닛(17)이 출력측에서 제2 평가 유닛(19)에 연결된다는 것이다. 제2 평가 유닛(17)은 측정된 편차를 품질 기준과 비교하고 그에 따라 수정 유닛(20)의 수정 명령문을 조절한다. 수정 유닛(20)은 번갈아 제2 평가 유닛(19)의 품질 기준에 영향을 미치는 계산 유닛(21)에 연결된다.
마지막으로, 도 5의 또 다른 실시예로서, 말단 장치(14)가 브레이크에 의해 정지되는 경우를 보여준다. 여기 유닛(16)은 축(13)의 스프링 상수(13)를 계산하기 위하여 계단식으로 전방으로 구동모터를 회전시키고 구동 모터에서 토크를 측정한다.
이상 본 발명을 상기 실시예들을 들어 설명하였으나, 본 발명은 이에 제한되는 것이 아니다. 당업자라면, 본 발명의 취지 및 범위를 벗어나지 않고 수정, 변경을 할 수 있으며 이러한 수정과 변경 또한 본 발명에 속하는 것임을 알 수 있을 것이다.
도면부호 목록 :
1 구동 모터 2 축 제어기
3 경로 보간기 4 제1 연산 유닛
5 로봇 모델 6 제2 연산 유닛
7 가산기 8 필터
9 P 요소 10 PT1 요소
11 PT2 요소 12 가산기
13 로봇 축 14 말단 장치
15 기어 연결부 16 여기 유닛
17 측정 유닛 18 제1 평가 유닛
19 제2 평가 유닛 20 수정 유닛
21 계산 모델
Claims (12)
- a) 각 경우에 대해 공간 좌표에 의해 정의되는 로봇의 기준점이 지나가기로 된 다수의 경로 점들을 거치는 로봇 경로를 사전 결정하는 단계(S1)와,d) 상기 해당 축 관련 제어기(2)에 의해 상기 개별 로봇 축의 축 관련 구동 모터(1)를 구동하는 단계(S11)를 포함하며,e) 로봇의 탄성 및/또는 마찰 및/또는 관성을 고려하여 동적 로봇 모델(5)에 따라 상기 로봇 경로 상의 상기 개별 경로 점들에 대한 경로 수정 값()을 계산하는 단계(S3-S7)와,
- 제1항 내지 제10항 중 어느 하나의 청구항에 따른 제어방법을 수행하기 위해 설치된 로봇 제어 시스템.
- 제11항에 따른 로봇 제어 시스템을 구비하는 로봇, 특히 페인트 도장 로봇.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102007024143.9 | 2007-05-24 | ||
DE102007024143A DE102007024143A1 (de) | 2007-05-24 | 2007-05-24 | Bewegungssteuerung für elastische Roboterstrukturen |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20100023846A true KR20100023846A (ko) | 2010-03-04 |
KR101548945B1 KR101548945B1 (ko) | 2015-09-02 |
Family
ID=39767045
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020097025374A KR101548945B1 (ko) | 2007-05-24 | 2008-05-07 | 탄성 로봇 구조를 위한 운동 제어기 |
Country Status (11)
Country | Link |
---|---|
US (1) | US8527092B2 (ko) |
EP (1) | EP2146825B1 (ko) |
KR (1) | KR101548945B1 (ko) |
CN (1) | CN101678551B (ko) |
AT (1) | ATE497865T1 (ko) |
BR (1) | BRPI0811741B1 (ko) |
DE (2) | DE102007024143A1 (ko) |
ES (1) | ES2360912T3 (ko) |
MX (1) | MX341554B (ko) |
RU (1) | RU2487796C2 (ko) |
WO (1) | WO2008141730A1 (ko) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101121474B1 (ko) * | 2010-12-01 | 2012-03-13 | 대성전기공업 주식회사 | Dc 서보모터 시스템의 관성모멘트와 마찰계수를 구하는 방법 |
KR20150105447A (ko) * | 2013-02-15 | 2015-09-16 | 가부시키가이샤 고베 세이코쇼 | 다관절 로봇의 탄성 변형 보상 제어 장치 |
Families Citing this family (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102009007026A1 (de) | 2009-02-02 | 2010-08-05 | Kuka Roboter Gmbh | Steuerung und Steuerungsverfahren für einen Manipulator |
DE102010004496B4 (de) | 2010-01-12 | 2020-06-18 | Hermann Müller | Verfahren zum Betrieb einer Vorrichtung zum Beschichten und/oder Bedrucken eines Werkstückes |
FR2960808B1 (fr) * | 2010-06-02 | 2012-05-25 | Commissariat Energie Atomique | Procede d'identification de frottements dans une articulation de bras de robot ou de bras manipulateur, et procede de compensation de couple faisant application |
DE102011010505A1 (de) | 2011-02-07 | 2012-08-09 | Dürr Systems GmbH | Anpassung der Dynamik zumindest eines Roboters |
DE102011111758A1 (de) | 2011-08-24 | 2013-02-28 | Dürr Systems GmbH | Steuerverfahren für einen Roboter |
JP2014034101A (ja) * | 2012-08-10 | 2014-02-24 | Toshiba Corp | ロボット制御装置 |
EP2890528B1 (en) * | 2012-08-28 | 2016-03-23 | Rethink Robotics Inc. | Monitoring robot sensor consistency |
EP2954986B1 (de) * | 2014-06-10 | 2020-05-06 | Siemens Aktiengesellschaft | Vorrichtung und Verfahren zum Steuern und Regeln eines Mehrkörpersystems |
US20160214261A1 (en) * | 2015-01-22 | 2016-07-28 | GM Global Technology Operations LLC | Collaborative robot system and method |
US10272573B2 (en) * | 2015-12-18 | 2019-04-30 | Ge Global Sourcing Llc | Control system and method for applying force to grasp a brake lever |
DE102015211405A1 (de) * | 2015-06-22 | 2016-12-22 | Kuka Roboter Gmbh | Verbesserung der Temperaturdriftkompensation durch Kalibrierung am Bauteil und Einlernen der Parametersätze |
DE102015211406A1 (de) * | 2015-06-22 | 2016-12-22 | Kuka Roboter Gmbh | Verbesserung der Temperaturdriftkompensation durch Einlernen der Restdrift |
AT518354B1 (de) * | 2016-02-02 | 2018-06-15 | B & R Ind Automation Gmbh | Verfahren zum Betreiben einer Fördereinrichtung in Form eines Langstatorlinearmotors |
AT518270B1 (de) * | 2016-02-05 | 2017-09-15 | Bernecker + Rainer Industrie-Elektronik Ges M B H | Verfahren zum Steuern der Bewegung einer Antriebsachse einer Antriebseinheit |
CN106003023A (zh) * | 2016-05-25 | 2016-10-12 | 珠海格力智能装备有限公司 | 机器人运动控制系统和方法 |
RU2671787C1 (ru) * | 2017-07-10 | 2018-11-06 | Общество с ограниченной ответственностью "Эйдос - Робототехника" | Способ повышения точности позиционирования промышленного робота |
JP6926882B2 (ja) * | 2017-09-21 | 2021-08-25 | 株式会社デンソーウェーブ | ロボットの制御装置 |
JP6915470B2 (ja) * | 2017-09-21 | 2021-08-04 | 株式会社デンソーウェーブ | ロボットの制御装置 |
DE102018209044B3 (de) * | 2018-06-07 | 2019-11-07 | Kuka Deutschland Gmbh | Kraftregelung eines Roboters |
CN109108973B (zh) * | 2018-08-29 | 2021-05-07 | 广州安商智能科技有限公司 | 单向式路径调度方法及系统 |
DE102018128175A1 (de) | 2018-11-12 | 2020-05-14 | Technische Universität Darmstadt | Verfahren und Vorrichtung zur Ermittlung von Verlagerungen eines Werkzeugmittelpunktes |
EP3764536A1 (en) * | 2019-07-11 | 2021-01-13 | DENTSPLY SIRONA Inc. | Method of operating a stepper motor in a dental tool machine |
US20220371196A1 (en) * | 2019-09-30 | 2022-11-24 | Siemens Ltd., China | Method, Device and System for Controlling Robot, Storage Medium and Terminal |
KR20230091280A (ko) | 2021-12-16 | 2023-06-23 | 주식회사 로보테크 | 통합 좌표계를 생성하는 로봇 제어 시스템 및 로봇 제어 시스템의 통합 좌표계 생성 방법 |
DE102022205011A1 (de) | 2022-05-19 | 2023-11-23 | Robert Bosch Gesellschaft mit beschränkter Haftung | Verfahren zum Bestimmen eines Moments für einen Betrieb eines Roboters unter Verwendung eines Modells und Verfahren zum Einlernen des Modells |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05277976A (ja) * | 1992-03-31 | 1993-10-26 | Nippon Telegr & Teleph Corp <Ntt> | 動力学モデルパラメータ同定装置 |
SE509443C2 (sv) * | 1997-05-15 | 1999-01-25 | Asea Brown Boveri | Förfarande för övervakning av en manipulators rörelsestyrning |
SE516720C2 (sv) * | 1999-04-01 | 2002-02-19 | Abb Ab | Utrustning för styrning av en industrirobot och förfarande för programmering och/eller justering av robotens rörelse |
CA2272966C (en) * | 1999-05-26 | 2004-07-20 | Camoplast Inc. | Twin chopper device for spray-up molding |
SE0001312D0 (sv) * | 2000-04-10 | 2000-04-10 | Abb Ab | Industrirobot |
US6519860B1 (en) * | 2000-10-19 | 2003-02-18 | Sandia Corporation | Position feedback control system |
RU2193480C1 (ru) * | 2002-01-25 | 2002-11-27 | Дальневосточный государственный технический университет | Устройство для управления приводом робота |
JP4391218B2 (ja) * | 2003-02-20 | 2009-12-24 | 三菱電機株式会社 | サーボ制御装置 |
JP4033050B2 (ja) * | 2003-06-16 | 2008-01-16 | トヨタ自動車株式会社 | ロボットハンドの把持制御装置 |
DE10342471B4 (de) | 2003-09-15 | 2007-08-16 | Dürr Systems GmbH | Regeleinrichtung für einen mehrachsigen Roboter |
JP2005335010A (ja) | 2004-05-26 | 2005-12-08 | Toyota Motor Corp | 把持制御装置 |
DE102004056861A1 (de) * | 2004-11-25 | 2006-06-08 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zum Regeln, Steuern von Manipulatoren |
-
2007
- 2007-05-24 DE DE102007024143A patent/DE102007024143A1/de not_active Withdrawn
-
2008
- 2008-05-07 CN CN2008800173215A patent/CN101678551B/zh active Active
- 2008-05-07 ES ES08749382T patent/ES2360912T3/es active Active
- 2008-05-07 DE DE502008002561T patent/DE502008002561D1/de active Active
- 2008-05-07 RU RU2009148022/02A patent/RU2487796C2/ru active
- 2008-05-07 KR KR1020097025374A patent/KR101548945B1/ko active IP Right Grant
- 2008-05-07 MX MX2009012527A patent/MX341554B/es active IP Right Grant
- 2008-05-07 WO PCT/EP2008/003674 patent/WO2008141730A1/de active Application Filing
- 2008-05-07 AT AT08749382T patent/ATE497865T1/de active
- 2008-05-07 EP EP08749382A patent/EP2146825B1/de active Active
- 2008-05-07 BR BRPI0811741-1A patent/BRPI0811741B1/pt active IP Right Grant
- 2008-05-07 US US12/601,745 patent/US8527092B2/en active Active
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101121474B1 (ko) * | 2010-12-01 | 2012-03-13 | 대성전기공업 주식회사 | Dc 서보모터 시스템의 관성모멘트와 마찰계수를 구하는 방법 |
KR20150105447A (ko) * | 2013-02-15 | 2015-09-16 | 가부시키가이샤 고베 세이코쇼 | 다관절 로봇의 탄성 변형 보상 제어 장치 |
Also Published As
Publication number | Publication date |
---|---|
WO2008141730A1 (de) | 2008-11-27 |
CN101678551B (zh) | 2012-02-22 |
RU2009148022A (ru) | 2011-06-27 |
US8527092B2 (en) | 2013-09-03 |
EP2146825A1 (de) | 2010-01-27 |
BRPI0811741B1 (pt) | 2019-09-17 |
RU2487796C2 (ru) | 2013-07-20 |
US20100198405A1 (en) | 2010-08-05 |
CN101678551A (zh) | 2010-03-24 |
DE502008002561D1 (de) | 2011-03-24 |
KR101548945B1 (ko) | 2015-09-02 |
MX341554B (es) | 2016-08-24 |
MX2009012527A (es) | 2009-12-03 |
BRPI0811741A2 (pt) | 2014-11-11 |
ES2360912T3 (es) | 2011-06-10 |
EP2146825B1 (de) | 2011-02-09 |
DE102007024143A1 (de) | 2008-11-27 |
ATE497865T1 (de) | 2011-02-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR20100023846A (ko) | 탄성 로봇 구조를 위한 운동 제어기 | |
EP3651942B1 (en) | Vibration control of systems with configuration dependent dynamics | |
US9434073B2 (en) | Robot apparatus and control method therefor | |
EP0321579A1 (en) | Articulated robot controller | |
CN106873383B (zh) | 一种降低工业机器人振动的在线控制方法 | |
JP2005242794A (ja) | ロボット制御装置およびロボットの制御方法 | |
CN112417755A (zh) | 一种主从式手术机器人轨迹预测控制方法 | |
Marton et al. | Control of robotic systems with unknown friction and payload | |
JP7118249B2 (ja) | モータ制御装置 | |
CN111347421A (zh) | 用于扭矩估计的方法和装置 | |
JP7068133B2 (ja) | 制御システム、制御方法、及び制御プログラム | |
JP4860277B2 (ja) | 多慣性共振系の振動抑制制御方法及び装置 | |
JPH10128688A (ja) | ロボットの非干渉化制御方法 | |
JP3081518B2 (ja) | ロボットの剛性同定方法及びその装置 | |
JP5208610B2 (ja) | 慣性共振系を制御対象とする特性同定方法及びモータ制御装置 | |
JP3936242B2 (ja) | サーボモータ制御用コントローラにおけるゲイン設定法、コントローラの有効性検証法およびロボット制御法 | |
JP6496167B2 (ja) | タンデム位置制御装置 | |
Lendermann et al. | Comparison of passivity based impedance controllers without torque-feedback for variable stiffness actuators | |
Fateh et al. | On the transforming of control space by manipulator Jacobian | |
CN114454150A (zh) | 一种基于复合学习的臂式机器人控制方法及机器人系统 | |
JPH02205489A (ja) | マニピュレータのインピーダンス制御方式 | |
JP2019219762A (ja) | 制御装置、制御方法及びプログラム | |
JPH06332535A (ja) | ロボットの制御装置 | |
JPH07121239A (ja) | ロボット装置の制御方法 | |
Jiang et al. | A vision-based endpoint trajectory and vibration control for flexible manipulators |
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 |