KR970012054A - 로보트의 원점 복귀 제어 장치 및 방법 - Google Patents

로보트의 원점 복귀 제어 장치 및 방법 Download PDF

Info

Publication number
KR970012054A
KR970012054A KR1019950024849A KR19950024849A KR970012054A KR 970012054 A KR970012054 A KR 970012054A KR 1019950024849 A KR1019950024849 A KR 1019950024849A KR 19950024849 A KR19950024849 A KR 19950024849A KR 970012054 A KR970012054 A KR 970012054A
Authority
KR
South Korea
Prior art keywords
position sensor
driven
detected
robot
distance
Prior art date
Application number
KR1019950024849A
Other languages
English (en)
Other versions
KR0155867B1 (ko
Inventor
김상태
Original Assignee
김광호
삼성전자 주식회사
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 김광호, 삼성전자 주식회사 filed Critical 김광호
Priority to KR1019950024849A priority Critical patent/KR0155867B1/ko
Publication of KR970012054A publication Critical patent/KR970012054A/ko
Application granted granted Critical
Publication of KR0155867B1 publication Critical patent/KR0155867B1/ko

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

본 발명은 로봇의 원점 복귀 제어 장치 및 방법에 관한 것으로서, 본 발명에 따르면, 구동 수단(36)과, 볼 스크류(33)와, 피 구동 수단(31)과, 피 검지 수단(32)과, 기구적 경계 센서 수단(34, 35)과, 제1위치 센서수단(37) 및 제2위치 센서 수단(38)을 포함하는 로보트의 원점 복귀 제어 장치에 있어서, 상기 피 구동 수단(31)의 최대 이동 속도를 Vmax, 상기 피 구동 수단(31)의 최대 이동 속도로부터 정지시까지 감속하는데 걸리는 시간 T, 상기 피 검지 수단(32)의 길이를 b, 상기 하나의 기구적 경계 수단(35)을 향하는 피 검지 수단(32)의 일단부로부터 상기 피 구동 수단(31)의 일단부까지의 거리를 a, 상기 다른 하나의 기구적 경계 수단(34)을 향하는 피 검지 수단(32)의 일단부로부터 상기 피 구동 수단(31)의 일단부까지의 거리를 c라 할 경우, 상기 피 검지 수단(32)의 길이 (b)는 (Vmax×T) /2이고, 상기 제1위치 센서(37)는 기구적 경제 수단(35)로부터 a+b의 거리에 배치되며, 상기 제2위치 센서(38)는 리미트 센서(34)로부터 b+c의 거리에 배치되는 것을 특징으로 하는 로보트의 원점 복귀 제어 장치 및 그를 이용한 제어 방법이 제공된다. 본 발명에 따른 로보트의 원점 복귀 제어 장치는 위치 수단의 갯수가 감소되었을 뿐만 아니라, 피 구동 수단이 원점 복귀 제어시에 작업자의 임의대로 가속 이동할 수 있으므로 신속한 원점 복귀 제어가 이루어진다.

Description

로보트의 원점 복귀 제어 장치 및 방법
본 내용은 요부공개 건이므로 전문내용을 수록하지 않았음
제1도는 종래 기술에 따른 로보트의 원점 복귀 제어 장치를 도시하는 개략적인 정면도
제2도는 제1도의 C-C′를 절단한 단면도
제3도는 본 발명에 따른 로보트의 원점 복귀 제어 장치를 도시하는 개략적인 정면도
제4도는 본 발명에 따른 로보트의 원점 복귀 제어 방법을 도시하는 순서도.

Claims (5)

  1. 구동 수단(36)과, 상기 구동 수단(36)에 의해 회전하는 볼스크류(33)와,상기 볼 스크류(33)에 결합되어 직선 왕복 운동하는 피 구동 수단(31)과, 상기 피 구동수단(31)에 설치된 피 검지 수단(32)과, 상기 피 구동수단(31)의 직선 왕복 운동의 경계점에 배치된 2개의 기구적 경계 센서 수단(34, 35)과, 제1위치 센서수단(37) 및 제2위치 센서 수단(38)을 포함하는 로보트의 원점 복귀 제어 장치에 있어서, 상기 피 구동 수단(31)의 최대 이동 속도를 Vmax, 상기 피 구동 수단(31)의 최대 이동 속도로부터 정지시까지 감속하는데 걸리는 시간 T, 상기 피 검지 수단(32)의 길이를 b, 상기 하나의 기구적 경계 수단(35)을 향하는 피 검지 수단(32)의 일단부로부터 상기 피 구동 수단(31)의 일단부까지의 거리를 a, 상기 다른 하나의 기구적 경계 수단(34)을 향하는 피 검지 수단(32)의 일단부로부터 상기 피 구동 수단(31)의 일단부까지의 거리를 c라 할 경우, 상기 피 검지 수단(32)의 길이 (b)는 (Vmax×T) /2이고, 상기 제1위치 센서(37)는 리미트 센서(35)로부터 a+b의 거리에 배치되며, 상기 제2위치 센서(38)는 리미트 센서(34)로부터 b+c의 거리에 배치되는 것을 특징으로 하는 로보트의 원점 복귀 제어 장치
  2. 전원 인가시 피 구동 수단931)의 현재 위치를 판단하는 현재 위치 판단 단계, 구동수단(36)에 근접한 제2위치 센서 수단(38)에 검지될 때까지 피 구동 수단(31)이 최대 속도로 가속 이동하는 급속 이동 단계, 상기 피 구동 수단(31)이 구동 수단(38)에 근접한 제2위치 센서 수단(38)에 검지된 후에 감속 정지되는 정지 단계, 상기 제2위치 센서 수단(38)으로부터 이탈되는 방향으로 저속 이동하는 저속 이동 단계 및 구동 수단(36)으로부터 발생되는 Z펄스를 검지하여 정치하는 원점 정지 단계를 구비하는 로보트의 원점 복귀 제어 방법.
  3. 제2항에 있어서, 상기 현재 위치 판단 단계에서 전원 인가시의 피 구동 수단(31)의 현재 위치가 제1위치 센서(37)에 있는 것으로 판단되면 상기 제2위치 센서 수단(38)을 향해 이동하는 급속 이동 단계를 수행하는 것을 특징으로 하는 로보트의 원점 복귀 제어 방법.
  4. 제2항에 있어서, 상기 현재 위치 판단 단계에서 전원 인가시의 피 구동 수단(31)의 현재 위치가 제2위치 센서 수단(37)에 있는 것으로 판단되면 상기 급속 이동 단계 및 정지 단계를 수행하지 않고 저속 이동 단계 및 원점 정지 단계를 수행하는 것을 특징으로 하는 로보트의 원점 복귀 제어 방법.
  5. 제2항에 있어서, 상기 급속 이동 단계에서 피 구동 수단(31)의 이동 방향이 제1위치 센서 수단(37)을 향하는 방향일 경우 제1위치 센서 수단(37)에 의해 검지되어 정지된 이후에 다시 제2위치 센서 수단(38)을 향해 이동하는 것을 특징으로 하는 로보트의 원점 복귀 제어 방법.
    ※ 참고사항 : 최초출원 내용에 의하여 공개하는 것임.
KR1019950024849A 1995-08-11 1995-08-11 로보트의 원점 복귀 제어장치 및 방법 KR0155867B1 (ko)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1019950024849A KR0155867B1 (ko) 1995-08-11 1995-08-11 로보트의 원점 복귀 제어장치 및 방법

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1019950024849A KR0155867B1 (ko) 1995-08-11 1995-08-11 로보트의 원점 복귀 제어장치 및 방법

Publications (2)

Publication Number Publication Date
KR970012054A true KR970012054A (ko) 1997-03-29
KR0155867B1 KR0155867B1 (ko) 1998-12-15

Family

ID=19423353

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1019950024849A KR0155867B1 (ko) 1995-08-11 1995-08-11 로보트의 원점 복귀 제어장치 및 방법

Country Status (1)

Country Link
KR (1) KR0155867B1 (ko)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100555717B1 (ko) * 1999-02-02 2006-03-03 삼성전자주식회사 산업용 로봇의 원점좌표 오차보정장치 및 방법

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100555717B1 (ko) * 1999-02-02 2006-03-03 삼성전자주식회사 산업용 로봇의 원점좌표 오차보정장치 및 방법

Also Published As

Publication number Publication date
KR0155867B1 (ko) 1998-12-15

Similar Documents

Publication Publication Date Title
KR910001853B1 (ko) 자동문을 위한 문 개폐 모우터의 토오크 제어 방법
KR860008016A (ko) 사출성형기의 사출제어 방법 및 그 장치
CA2198688A1 (en) Automatic door controller
NO950833L (no) Blindnaglemutter - setteapparat
KR970071712A (ko) 전류콘트롤 에러를 줄이기 위한 적응 피이드 포워드 장치
KR930002653A (ko) 자동차용 엔진 제어장치
KR970012054A (ko) 로보트의 원점 복귀 제어 장치 및 방법
KR840000328A (ko) 가동부의 원점 복귀 제어법 및 그 장치
MY120366A (en) Method of force limitation for automatic elevator doors
KR960039582A (ko) 모터의 폭주 검출 방법 및 폭주 검출 장치
KR960031814A (ko) 실린더 위치 제어장치
KR950014401A (ko) 관교체 장치의 구동 제어방법
ES2148017A1 (es) Procedimiento para el posicionamiento de una parte.
KR900014077A (ko) 공작기계의 제어장치
KR970033629A (ko) 로보트 및 로보트의 원점 복귀 제어 방법
JPH03178586A (ja) 往復運動制御装置
KR880008936A (ko) 엘리베이터 제어장치
GB2317714A (en) Controlling a pressure application resistant welding machine
KR910019892A (ko) 동력도어시스템 및 그 제어방법
KR950701433A (ko) 수치 제어 장치의 가감속 제어 방식(Acceleration/Deceration Control System of Numeric Controller)
KR0155896B1 (ko) 로보트의 원점 복귀 제어 방법 및 장치
KR910019893A (ko) 엘리베이터 출입문의 제어장치
KR0124870Y1 (ko) 센서를 이용한 직선 운동기구의 원점 복귀장치
JP3593383B2 (ja) 位置決め装置の原点設定方法およびその装置
KR950026626A (ko) 로보트의 원점복귀 제어방법

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
FPAY Annual fee payment

Payment date: 20070628

Year of fee payment: 10

LAPS Lapse due to unpaid annual fee