1 |
1
하나 이상의 구동 모터를 통하여 가동되는 하나 이상의 관절부를 구비하는 로봇 머니퓰레이터의 제어부의 감지 제어 신호에 따라 상기 관절부의 감지 관절 토크 정보를 취득하는 감지 단계와,상기 감지 단계에서 취득된 상기 감지 관절 토크 정보 및 상기 제어부와 연결되는 저장부에 사전 설정 저장된 추정 데이터에 기초하여 상기 관절부의 추정 관절 토크가 산출되고, 상기 추정 관절 토크의 주파수 성분이 분석되는 추정 분석 단계와,상기 추정 관절 토크의 주파수 성분과 상기 저장부에 저장된 사전 설정 작업 기준 데이터에 기초하여 상기 관절부의 사전 설정된 작업 수행 여부를 판단하고 판단 결과에 따라 상기 로봇 머니퓰레이터의 작업 모드를 설정하는 모드 결정 단계와,상기 제어부의 모드 실행 제어 신호에 따라 상기 모드 결정 단계에서 결정된 모드를 실행하는 모드 실행 단계를 포함하는 주파수 기반 로봇 머니퓰레이터 제어 방법
|
2 |
2
제 1항에 있어서,상기 추정 분석 단계는:상기 감지 관절 토크 정보와 상기 추정 데이터에 기초하여 상기 제어부의 추정 제어 신호에 따라 외력 추정 관측기에서 외력 추정 토크가 연산되는 외력 추정 토크 연산 단계와,상기 외력 추정 토크에 기초하여 상기 제어부의 분석 제어 신호에 따라 외력 변화 추정 관측기에서 상기 외력 추정 토크의 고주파 성분을 추출하여 외력 추정 고주파 토크를 산출하는 주파수 분석 단계를 포함하는 것을 특징으로 하는 주파수 기반 로봇 머니퓰레이터 제어 방법
|
3 |
3
제 2항에 있어서, 상기 모드 결정 단계는:상기 외력 추정 토크 및 상기 외력 추정 고주파 토크를 상기 사전 설정 작업 기준 데이터와 비교하는 모드 판단 단계와,상기 모드 판단 단계에서 판단된 결과에 기초하여 실행되어야 할 작동 모드를 설정하는 모드 설정 단계를 포함하는 것을 특징으로 하는 주파수 기반 로봇 머니퓰레이터 제어 방법
|
4 |
4
제 3항에 있어서, 상기 모드 판단 단계는:상기 제어부가 상기 외력 추정 고주파 토크와 상기 사전 설정 작업 기준 데이터의 고주파 문턱값을 비교하는 예상 충돌 판단 단계와, 상기 예상 충돌 판단 단계에서 상기 외력 추정 고주파 토크가 상기 고주파 문턱값 미만인 경우, 상기 제어부가 상기 외력 추정 토크와 상기 사전 설정 작업 기준 데이터의 안전 문턱값을 비교하는 안전 판단 단계를 포함하는 것을 특징으로 하는 주파수 기반 로봇 머니퓰레이터 제어 방법
|
5 |
5
제 4항에 있어서, 상기 모드 설정 단계는:상기 안전 판단 단계에서 상기 외력 추정 토크가 상기 안전 문턱값 미만인 경우 실행되어야 할 작업 모드로 사용자에 의하여 설정된 입력 작업을 수행하는 작업 수행 모드로 설정하는 작업 수행 모드 설정 단계와,상기 예상 충돌 판단 단계에서 상기 외력 추정 고주파 토크가 상기 고주파 문턱값 이상이 경우와, 상기 안전 판단 단계에서 상기 외력 추정 토크가 상기 안전 문턱값 이상인 경우에 실행되어야 할 작업 모드로 충돌 대응 모드를 설정하는 충돌 대응 모드 설정 단계를 포함하는 것을 특징으로 하는 주파수 기반 로봇 머니퓰레이터 제어 방법
|
6 |
6
제 5항에 있어서, 상기 작업 수행 모드 설정 단계에서 실행되어야 할 작업 모드가 작업 수행 모드로 설정된 경우, 상기 모드 실행 단계는:입력부를 통하여 작업자에 의한 명령을 수신하는 작업자 명령 수신 단계와,상기 작업자 명령 수신 단계에서 작업자에 의한 수신된 명령이 존재하는지 여부를 판단하는 수신 판단 단계와,상기 수신 판단 단계에서의 수신 여부에 따라 형성된 작업을 실행하는 작업 수행 단계를 포함하는 것을 특징으로 하는 주파수 기반 로봇 머니퓰레이터 제어 방법
|
7 |
7
제 5항에 있어서, 상기 작업 수행 모드 설정 단계에서 실행되어야 할 작업 모드가 충돌 상태로 판단하여 대응 실행이 요구되는 충돌 대응 모드로 설정된 경우,상기 모드 실행 단계는:상기 관절부의 감지 관절 토크 정보로부터 충돌 방향을 검출하는 충돌 방향 검출 단계와,상기 제어부가 상기 관절부의 감지 관절 토크 정보로부터 상기 관절부의 충돌 위치를 확인하는 충돌 위치 확인 단계와,상기 제어부가 상기 저장부에 저장된 사전 설정 대응 위치만큼 상기 관절부를 상기 충돌 방향과 반대 방향으로 가동시키는 대응 위치를 산출하는 대응 위치 결정 단계와,상기 구동 모터에 상기 관절부의 상기 대응 위치로의 이동을 위한 구동 제어 신호를 인가하는 충돌 대응 단계를 포함하는 것을 특징으로 하는 주파수 기반 로봇 머니퓰레이터 제어 방법
|
8 |
8
제 1항에 있어서, 상기 감지 관절 토크 정보는 감지부의 관절 토크 측정부에서 감지되는 것을 특징으로 하는 주파수 기반 로봇 머니퓰레이터 제어 방법
|