KR940015733A - 기계 운동 제어기 및 그 제어 방법 - Google Patents

Abstract

적어도 하나의 출력 요소를 갖는 기구는 상기 기구의 운동 모델에 근거하는 제어기에 의해 발생되고, 운동 모델이 제어 소프트웨어내에 존재하는 관절 변수를 나타내는 관절 제어 신호에 응답하여 기구의 관절부의 제어된 이동에 의해 위치되며, 제어 소프트웨어는 로드하에서의 열 팽창 및 마모와 같은 원인에 의해 일어나는 상기 기구의 길이 또는 각의 시간에 따른 변화의 영향을 고려하여 조절되야 하는 매개 변수를 포함한다. 센서는 관절 변수 세트에 응답하여 상기 기구의 하나 이상의 부분의 위치에 대한 외부 관찰을 위해 제공되며, 일반적으로 다른 관절 제어 변수에 응답하여 충분한 회수의 상기 관찰에 의해, 상기 매개 변수는 상기 외부 관찰치내의 불확실치를 나타내는 표준 편차를 고려하면서 최대 확률 평가에 의해 자동적으로 순응된다. 상기 매개 변수의 관찰치 및 적용은 상기 기구의 정상 작동 동안 실행된다. 더우기, 개발 비용 및 시간을 줄이기 위해, 상기 제어 소프트웨어는 상기 기구의 몸체부에 대해 고정된 기준 프레임에 관련된 운동 설명 파일을 컴파일하므로써 발생된다.

Description

기계 운동 제어기 및 그 제어방법

본 내용은 요부공개 건이므로 전문내용을 수록하지 않았음

제1도는 기구 제어를 위한 매개변수화된 소프트웨어의 발생과 제어기에 의한 상기 소프트웨어의 사용을 나타내는 데이타 흐름도, 제2도는 2개의 링크를 갖는 기구의 분해도, 제3A도는 5개의 관절부를 갖는 수치 제어기기의 개략도.

Claims (10)

1. 제어 가능한 장치에 있어서, 기구 관절부의 제어된 운동에 의해 위치된 적어도 하나의 출력 요소와, 시간에 따라 자유로이 변화하는 하나 이상의 디멘젼 또는 각을 가지며, 상기 변화는 정확한 위치 결정에 영향을 미치는 기구와; 소정의 출력 위치를 나타내는 출력 요소 위치 제어 신호를 수용하고, 관절부가 이동 명령을 받음에 따라 관절 변수를 나타내는 관절 제어 신호를 상기 관절부에 제공하며, 변화하는 상기 디멘젼 또는 각도중의 다른 하나의 적어도 한 요소를 각각 나타내는 하나 이상의 매개 변수의 현재값과 상기 관절 변수에 소정의 출력부 위치를 결부시키는 기구의 운동 모델에 따른 출력 요소 위치 제어 신호에 따라 상기 관절 제어 신호를 발생시키는 수단을 포함하는 제어기와; 상기 기구의 하나 이상의 부부의 위치 요소에 대한 일군의 관찰치를 나타내는 센서 신호를발생시키며,. 상기 관찰치는 상기 관절부에 제공된 관절 제어 신호에 따른 관절 변수의 관련된 세트를 갖는 센서와; 상기 운동 모델의 매개 변수의 측정값을 결정하기 위해 상기 관련된 관절 제어 변수 및 일군의 관찰치를 사용하며, 상기 모델의 매개 변수의 현재값을 강기 측정값으로 조절하는 교정 수단으로 포함하는 것을 특징으로 하는제어 가능한 장치.
2. 제1항에 있어서, 상기 각각의 관찰치는 예정된 관련 표준 편차에 의해 지적된 불확실치를 갖는 것을 특징으로 하는 제어 가능한 장치.
3. 제1항 또는 제2항에 있어서, 상기 교정 수단은 최대 확률 측정에 의해 상기 매개 변수의 측정값을 결정하기 위해 배열되는 것을 특징으로 하는 제어 가능한 장치.
4. 제1항, 제2항 또는 제3항에 있어서, 적어도 하나의 관찰치는 적어도 하나의 출력 요소 위치의 적어도 하나의 구성 요소로 구성되는 것을 특징으로 하는 제어 가능한 장치.
5. 출력 요소 위치 제어 신호에 응답하여 적어도 하나의 출력 요소를 위치 결정하는 다수의 제어 가능하게 이동하는 관절부와, 시간에 따라 자유로이 변화하는 하나 이상의 디멘젼 또는 각을 가지며, 상기 변화가 정밀한 위치 결정에 영향을 미치는 기구를 제어하는 방법에 있어서, 연속적인 출력 요소 위치 변수를 나타내는 출력 요소 위치 제어 신호를 수용하고, 변화하는 디멘젼 또는 각도중 다른 하나의 적어도 한 요소를 나타내는 하나 이상의 매개 변수의 현재값과 관절 변수의 세트로 상기 출력부 위치 변수를 결부시키는 상기 기구의 운동 모델에 따르며, 상기 관절부가 연속적으로 이동하도록 명령받는 양을 지적하는 관절 변수의 연속적인 세트를 나타내는 관절 제어 신호를 발생시키며, 관절부에 상기의 발생된 관절 제어 신호를 공급하고, 상기 관절 제어 신호는 다수의 관절 변수 세트이 각각을 나타내는 여러 순간에 상기 관절부에 제공되며 여러 순간에서 상기 기구의 적어도 한 부분의 관찰 된 위치의 하나 이상의 요소를 나타내는 적어도 하나의 센서 신호를 발생시키고, 여러 순간에서 관찰된 위치의 하나 이상의 요소와 다수의 관절 제어 변수 세트에 응답하여 상기 운동 모델의 매개 변수의 측정된 값을 결정하며, 상기 모델의 매개 변수를 측정된 값으로 조절하는 것을 특징으로 하는 제어 방법.
6. 관절 제어 신호를 관절부에 적용함으로써, 상기 관절 제어 신호는 각각의 관절 제어 신호에 의해 표시된 관절 변수 세트에 따라 상기 관절부의 이동을 명령하고, 출력 요소 위치 변수를 나타내는 출력 요소 위치 신호에 응답하여 적어도 하나의 출력 요소를 위치 결정시키며, 상기 기구의 몸체부에 연결된 다수의 제어 가능하게 이동하는 관절부를 갖는 기구를 제어하는 수단에 있어서, 상기 기구를 위해 운동 설명 언어로 된 판독 가능한 장치의 운동 설명 파일을 발생시키며, 상기 파일 설명부는 기구의 각각의 관련 몸체부에 고정된 다수의 기준 프레임 사이에 관절 결합 관계 및 변형을 나타내고, 적어도 하나의 출력 요소와 관련되어 고정된 기준 프레임을 포함하며, 상기 관곈는 매개 변수를 포함하고, 상기 매개 변수의 현재값과 출력 요소 위치로부터 관절 제어 변수를 결정하기 위해 운동 설명 파일을 제어 지시 세트로 컴파일링하며, 출력 요소 위치 변수를 나타내는 출력 요소 위치 제어 신호를 수용하고, 상기 제어 지시 세트를 사용하여 상기 출력부 위치 제어 신호에 대응하는 관절 제어 신호를 발생시키며, 상기의 발생된 관절 제어 신호를 갖는 상기 기구의 관절부에 발생된 관절 제어 신호를 적용하는 것을 특징으로 하는 제어 방법.
7. 제6항에 있어서, 상기 관절부에 적용된 관절 제어 신호에 응답하여 생성된 기구의 적어도 한 부분의 위치의 하나 이상의 요소에 관한 일군의 관찰치를 나타내는 적어도 하나의 센서 신호를 발생시키고, 상기 일군의 관찰치와 그 관찰치에 적용된 관절 제어 신호에 의해 표시된 관절 변수에 응답하여 상기 운동 모델의 매개 변수의 측정값을 결정하며, 상기 모델의 매개 변수의 현재값을 상기 측정값으로 조절하는 것을 특징으로 하는 제어 방법.
8. 제5항, 제6항 또는 제7항에 있어서, 상기 센서 신호는 예정된 표준 편차에 의해 지적된 불확실치를 갖는 상기 기구의 적어도 한 부분에 대한 관찰된 위치를 나타내는 것을 특징으로 하는 제어 방법.
9. 제5항, 제6항, 제7항 또는 제8항에 있어서, 상기 매개 변수의 측정값은 최대 확률 측정에 의해 결정되는 것을 특징으로 하는 제어 방법.
10. 제5항, 제6항, 제7항, 제8항 또는 제9항에 있어서, 적어도 하나의 센서 신호는 적어도 하나의 출력 요소의 관찰된 위치를 나타내는 것을 특징으로 하는 제어 방법.

    ※ 참고사항 : 최초출원 내용에 의하여 공개하는 것임.