KR870000966B1 - 로보트 운동방정식좌표계에 시스템 좌표계를 자동부합시키는 방법 - Google Patents

로보트 운동방정식좌표계에 시스템 좌표계를 자동부합시키는 방법 Download PDF

Info

Publication number
KR870000966B1
KR870000966B1 KR1019840006782A KR840006782A KR870000966B1 KR 870000966 B1 KR870000966 B1 KR 870000966B1 KR 1019840006782 A KR1019840006782 A KR 1019840006782A KR 840006782 A KR840006782 A KR 840006782A KR 870000966 B1 KR870000966 B1 KR 870000966B1
Authority
KR
South Korea
Prior art keywords
coordinate system
robot
limit switch
coordinate
equation
Prior art date
Application number
KR1019840006782A
Other languages
English (en)
Other versions
KR860003089A (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 KR1019840006782A priority Critical patent/KR870000966B1/ko
Publication of KR860003089A publication Critical patent/KR860003089A/ko
Application granted granted Critical
Publication of KR870000966B1 publication Critical patent/KR870000966B1/ko

Links

Images

Classifications

    • 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
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P70/00—Climate change mitigation technologies in the production process for final industrial or consumer products
    • Y02P70/10—Greenhouse gas [GHG] capture, material saving, heat recovery or other energy efficient measures, e.g. motor control, characterised by manufacturing processes, e.g. for rolling metal or metal working

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

내용 없음.

Description

로보트 운동방정식좌표계에 시스템 좌표계를 자동부합시키는 방법
제1도 (a)는 로보트에 내장된 운동 방정식 좌표계에 따른 매니 풀레이터(mani pulator)의 초기 자세도.
(b)는 사용자가 로보트를 현장 적응시킨 자세 즉, 시스템 좌표계에 따른 매니 풀레이터의 자세도.
제2도 (a)는 로보트가 시스템 좌표계 정방향 리미트 스위치 위치각을 인식하는 단계의 블록다이어그램.
(b)는 이러한 인식을 위한 로보트 모터축에 부착한 도그와 리미트 스위치와의 관계도이며 편의상 축은 도그의 각 운동량을 기준으로 전개하여 도시한 것임.
제3도는 로보트에 전원을 인가하여 운동방정식 좌표계 원점으로 복귀한 자세에서 시스템 좌표계의 인식동작을 보인 개념도.
제4도는 로보트 매니 풀레이터 동작 메카니즘에 따른 도그와 리미트 스위치의 설치예로서
(a)는 체인에 도그를 장착한 예.
(b)는 매니 풀레이터 아암에 도그를 장착한 예.
제5도는 운동방정식 좌표계와 시스템 좌표계 부합을 위한 매개변수 산출 과정의 설명도.
제6도는 이 발명 과정을 요약한 플로오챠트.
* 도면의 주요부분에 대한 부호의 설명
Figure kpo00002
: 회전링크
Figure kpo00003
: 상하링크 달린축
Figure kpo00004
: 앤드 이펙터(and effector)
θn+ : n축의 시스템 좌표계 정방향 리미트 스위치 위치각
θn- : n축의 시스템 좌표계 부방향 리미트 스위치 위치각
θn eff set : 운동방정식 좌표계와 시스템좌표계의 사이각(두 좌표계 부합상수)
θnPH : n축의 시스템 좌표계 원점 위치각,
θnKH : n축 운동방정식 좌표계의 원점 위치각,
θn max : n축의 정방향 최대위치각, θn min : n축의 부방향 위치각
θnk : n축의 시스템 좌표계상의 위치각 1 : 운동제어 CPU
2 : 구동제어 CPU 3 : D/A콘버터
4 : 속도제어기 5 : 모터
6 : 펄스 엔코더 7 : 축
8 : 도그 9 : 부방향 리미트 스위치
10 : 시스템 좌표계 원점 리미트 스위치 11 : 정방향 리미트 스위치.
이 발명은 로보트 매니 풀레이터(mani pulator)의 운동량, 운동시간 및 전력을 최소화하면서 로보트 작업을 행하기 위해 사용자가 설정하는 시스템 좌표계를 로보트에 고유하게 설정되어 있는 운동방정식 좌표계에 자동적으로 부합시킬 수 있게 하는 좌표계 자동부합방법에 관한 것이다.
제1도에 보인 매니 풀레이터의 자세는 로보트에 내장된 운동방정식 좌표계와 시스템 좌표계가 일치할때 원점 복귀 명령을 행한 경우이다.
이 자세에서 특정 작업을 반복 행하자면 매니 풀레이터의 운동량은 실제 작업동작보다 작업물에 접근하는 예비동작 운동량이 더 많아지게 되어 작업의 효율을 꾀할 수 있는 것이다.
제2도에서는 특정 작업에 적합하게 시스템 좌표계를 설정하고 운동방정식 좌표계에 부합시킴으로써 로보트가 현장 적응된 경우이다.
이때 로보트는 작업공간에 접근되어 있는 자세이므로 제어 명령을 받으면 직접 작업동작을 행할 수 있는 것이다.
이와 같이 시스템 좌표계를 운동방정식상의 좌표계에 맞추기 위해서는 원래 각축의 운동방정식 좌표계 원점에 일치도어 있던 시스템 좌표계 원점 리미트 스위치의 위치를 옮기고 이에 따른 좌표계 부합조작을 행해야 된다.
그러나, 이러한 로보트의 현장 적용 조작은 로보트의 운동 메카니즘을 완전히 파악치 못하고 변경시킬 수 없으며, 운동 메카니즘에 대하여 충분히 알고 있는 경우에도 수작업으로 측정한 리미트 스위치의 이동각도를 제어 프로그램에 반영하게 되면 측정오차가 로보트의 동작으로 나타나게 되는 것이다.
실제로 수작업 측정에서 측정오차, 계기오차, 시각오차 및 위치오차 등이 발생되며, 플레이백 방식의 로보트를 예로 하면 이러한 오차를 수정하여 작업을 행할 수 있게 로보트의 좌표계를 부합시키는데 전문 요원이 10시간 정도의 작업을 해야 하는 것이다.
이 발명은 위 문제점을 해결하는 발명이다.
즉, 좌표계 부합 모드가 진행되면 운동방정식 좌표계와 시스템 좌표계간의 부합상수를 로보트 내부에서 측정 및 산출해내고 이후의 모든 작업 모드에서 이 상수를 제어 명령의 산출식에 활용함으로써 두 좌표계간의 부합이 자동적으로 이루어지는 것이다.
따라서 전문 요원이 아니더라도 30초 정도의 짧은 시간내에 로보트 매니 풀레이터를 현장 적응시킬 수 있는 것이다.
제2도(a)는 좌표계 부합모드가 진행될때 시스템 좌표계 정방향 리미트 스위치 위치각의 인식 단계를 보여준다.
이 위치각을 측정하고 매개변수와 비교하여 두 좌표계의 사이각을 산출하며, 두 좌표계 사이각 산출의 알고리즘은 로보트 제작시 위치가 정해진 정방향 리미트 스위치의 위치를 기준으로 운동방정식 좌표계상의 매개변수로 미리 설정된 허용 최대정방향 위치각에 사용자가 자리를 옮긴 시스템 좌표계 원점 스위치의 위치를 비교하는 것이다.
부합 모드 진행프로그램은 이것이 속해있는 메인 제어프로그램 CPU(1)에서 실행함으로써 진행된다.
이때 데이타의 이동을 보면 운동제어 CPU(1)의 명령은 구동제어 CPU(2)에서 개개 모터들의 구체적 동작 지령으로 분기되고, D/A 변환기(3)와 속도 제어기(4)를 통해 필요한 양의 동작을 행하는 것이다.
좌표계 부합 모드에서 모터 축상의 도그는 시스템 좌표계 원점 리미트 스위치와 정방향 리미트 스위치에 순차로 접속되며, 두 리미트 스위치를 순차 접속했을 때 얻는 시스템 좌표계 정방향 리미트 스위치 위치각을 펄스 엔코더(6)가 검출하여 구동제어 CPU(2)에 송출하고 이 데이타를 받은 운동제어 CPU는 두 좌표계 부합상수를 산출하는 것이다.
제2도 (b)는 축(7)상에서 원호운동을 하는 도그(8)와 리미트 스위치(9)(10) (11)들의 대응관계를 편의상 도그의 각 운동량을 기준으로 직선상에 배열하였다.
리미트 스위치(10)는 사용자가 위치를 옮겨 시스템 좌표계의 원점을 설정하는 스위치이고, 리미트 스위치(9) 및 (11)은 로보트 동작의 최대치를 정하는 부방향 및 정방향 리미트 스위치이다.
제3도는 로보트 축상의 도그(8)가 시스템 좌표계 원점에 정합되어 제로펄스 (Zero Puls)를 얻는 상 도이며 원점 복귀명령을 행함으로써 이루어진다.
부합 모드에서 도그(8)는 상기 상태에서 초저속으로 정방향 리미트 스위치(11)를 향하여 진행하며, 일정한 시간후 정방향 리미드 스위치(11)에 접속되어 스위치를 가동한다.
이같은 도그의 운반수단은 상기한 축 이외에 매다풀레이터의 메카니즘에 따라 제4도 a와 같이 스프로켓(13)에 대응된 체인(12)일 수 있으며, 또, 같은 도면(b) 같이 메니풀레이터 아암(14)일 수 있다.
이 그림에서 모터 앞 부분은 감속기(5′)이다.
도그(8)가 리미트 스위치(11)에 닿는 순간 CPU(1)는 정지 명령을 송출하여 축 (7)을 정지시키고, 축에 장착된 펄스 엔코더(6)는 시스템 좌표계 원점 리미트 스위치 (10)와 정방향 리미트 스위치(11)의 사이각 즉, 시스템 좌표계 정방향 리미트 스위치 위치각을 인지하고, 구동제어 CPU(2)는 이 데이타를 운동제어 CPU(1)에 전송하며, CPU(1)에서는 이 데이타와 내장 매개변수를 참조하여 좌표계 부합상수를 산출하는 것이다.
두 좌표계의 부합상수 즉, 사이각(θn off set) 산출 과정을 보면, n축의 운동방정식 좌표계 원점 위치각 θn KH는 n축의 실제 위치각 θnp(미리트스위치 위치(11))을 기준으로 n축의 시스템 좌표계 원점 위치각 θn PH와 두 좌표계의 사이각 θn off set를 더한 것이므로 다음 식으로 쓸 수 있다.
θn KH=θn PH+θn off set (식 1)
이 관계에서 θn off set는 두 좌표계의 대응관계에 따라 한번 설정해 놓으면 두 좌표계 부합상수가 되는 것이고, 공간상의 어느 위치에서도(식 1)과 동일한 형태이므로,
θn K : n축의 시스템 계상의 위치각,
θn P : n축의 실제 위치각일때 다음 식이 성립한다.
θn K=θn P+θn off set (식 2)
따라서, θn off set를 구하기 위해 (식 1)을 활동하면 다음 식이 유도된다.
θn off set=θn KH-θn PH (식 3)
실제로 구동제어 CPU(2)에서 시스템 좌표계 원점 리미트 스위치(10)를 찾아 운동제어 CPU(1)에 제공하는 θn PH의 데이터는 언제나 “0”이다.
그러므로 θn KH를 구하면 θn off set를 구할 수 있다.
제5도는 실제 로보트 시스템에서 θn off set를 구하는 몇 가지 알고리즘을 보여주고 있다.
이 그림(a)를 설명하면 θn PH는 위치각이 “0”이므로 θn KH는 부의 값을 갖고 있으며, 다음 식이 유도된다.
θn KH=θn off set=-θn max+(θn +) (식 4)
다시, θn max : n축의 최대 정방향 위치각, θn+ : 정방향 리미트 스위치 위치각일 때, 이 관계를 θn off set에 대해 다시 정리하면,
θn off set+=(θn+)-θn max (식 5)
이 성립한다.
그림 (b)(c)에서도 같은 식이 유도될 수 있다.
여기서, θn K max는 로보트 제작시에 동작범위를 설정하는 것으로 두 좌표계 부합에 매 변수로서 활용되었다.
또, 로보트의 제작시에 θn KH=θn PH이며, θn K max=θn +이다.
따라서, 시스템 좌표계 원점스위치를 이동시킨 경우 θn +를 측정하면 상기와 같이 θn off set를 구할 수 있는 것이다.
제6도는 이 발명의 전 과정의 플로우챠트이다. 이 챠트를 인용하여 이 발명을 요약하면, 로보트의 시스템 좌표계 원점리미트 스위치를 옮겨 임의의 원점을 설정한다.
이 조작은 로보트 매니풀레이터가 현장 적응된 상태가 되게 하는 것으로 그 결과는 제1도 (b)와 같으며 원점 부함모드 진행전에 선행된다.
다음은 원점 부합모드이다.
플로우 챠트의 수텝을 기준으로 설명하면, 제1스텝은 로보트 축들의 원점 복귀 명령에 따라 매니풀레이터가 원점에 복귀하여 그 값을 “0”으로 정한다.
제2스텝은 초저속 정방향으로 측정동작 실행을 세트하는 것이며, 제3스텝에서 정방향 진행명령으로 측정동작이 개시된다.
제4스텝에서 각축의 도그가 정방향 리미트 스위치와 접촉되고, 제5스텝에서 축의 정지 명령으로 측정동작의 진행이 정지된다.
제6스텝에서 시스템 좌표계의 정방향 스위치 위치각 θn+가 측정되고 제7스텝에서 매개변수 θn K max와 상기 θn+를 비교하여 두 좌표계 부합상수 θn off set를 산출한다.
여기에서 펄스엔코더가 얻는 값은 기어비를 고려한 것으로 상술식에서 생략하고 있다.
이상에서 상술한 바와같이 이 발명의 방법은 로보트 운동 메카니즘의 이해나 측정에 필요없고 다만 사용자는 시스템 좌표계 원점 스위치를 이동시켜 매니 풀레이터를 임의의 자세로 현장 적응시키면 되는 것이며, 이후에는 로보트가 부합모드에서 두 좌표계 부합상수를 산출하여 저장하고, 이후에는 작업 명령의 산술식에서 상지 부합상수를 활용함으로써 로보트는 현장 적응상태에서 동작되는 것으로, 이러한 조작은 30초 정도면 완료할 수 있어로 로보트활용에 획지적인 전지를 갖게 함은 물론, 로보트 동작의 정밀성을 보장할 수 있게 하는 것이다.

Claims (1)

  1. 로보트 장치에 있어서, 시스템 좌표계 원점 리미트 스위치(10)를 이동 설치하여 매니플레이터를 현장 적응시키고, 좌표계 부합모드에서 축(7)상의 도그(8)가 임의의 위치에 설치된 시스템 좌표계 원점리미트 스위치(10)의 원점에 복귀하는 단계, 정방향 리미트 스위치(11)쪽으로 진행하여 시스템 좌표계 측정방향 위치각(θn+)을 측정하는 단계, 상지 θn+를 정방향 최대 위치각 θn max와 비교하여 두좌표계의 부합상수 θn off set를 산출하는 단계 및 상지 상수를 작업 동작 지령의 산술식에 활용하여 두 좌표계를 부합시키는 단계로 구성된 로보트 운동 방정식 좌표계에 시스템 좌표계를 자동 부합시키는 방법.
KR1019840006782A 1984-10-31 1984-10-31 로보트 운동방정식좌표계에 시스템 좌표계를 자동부합시키는 방법 KR870000966B1 (ko)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1019840006782A KR870000966B1 (ko) 1984-10-31 1984-10-31 로보트 운동방정식좌표계에 시스템 좌표계를 자동부합시키는 방법

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1019840006782A KR870000966B1 (ko) 1984-10-31 1984-10-31 로보트 운동방정식좌표계에 시스템 좌표계를 자동부합시키는 방법

Publications (2)

Publication Number Publication Date
KR860003089A KR860003089A (ko) 1986-05-19
KR870000966B1 true KR870000966B1 (ko) 1987-05-14

Family

ID=19235993

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1019840006782A KR870000966B1 (ko) 1984-10-31 1984-10-31 로보트 운동방정식좌표계에 시스템 좌표계를 자동부합시키는 방법

Country Status (1)

Country Link
KR (1) KR870000966B1 (ko)

Also Published As

Publication number Publication date
KR860003089A (ko) 1986-05-19

Similar Documents

Publication Publication Date Title
JP4130703B2 (ja) 作業領域操作方法及びベンディングプレス機に隷属するロボット
CA1185684A (en) Apparatus for automatically moving a robot arm along a nonprogrammed path
EP0383944A1 (en) Action teaching method and control apparatus for a robot
CN111002306B (zh) 一种基于电子凸轮的机器人运动控制方法及控制***
CN108189034B (zh) 一种机器人连续轨迹实现方法
KR102405096B1 (ko) 자동화된 작업 셀에 커맨드하기 위한 방법
JPS63291104A (ja) 産業用ロボットの端部エフェクターの制御方法
US6528963B1 (en) Robot and method for controlling motor speed of the robot
CN111775145A (zh) 一种串并联机器人的控制***
CN113084792B (zh) 关节奇异区域的确定方法、机器人及存储装置
CN109414820B (zh) 机器人的运转方法、储存部、及机器人***
KR19980086498A (ko) 한 평면내 다자유도 스카라형 로봇의 궤적 제어장치 및 궤적 제어방법 및 한 평면내 다자유도 스카라형 로봇의 궤적 제어 프로그램을 기록한 컴퓨터 판독 가능한 기록매체
KR870000966B1 (ko) 로보트 운동방정식좌표계에 시스템 좌표계를 자동부합시키는 방법
JPS6346844B2 (ko)
CN112223289A (zh) 一种路径偏差小的机械手实时运动方法、计算机可读存储介质及智能机械手***
CN116728397A (zh) 机器人***、机器人控制方法和计算机可读存储介质
CN114734436B (zh) 一种机器人的编码器校准方法、装置及机器人
CN116529035A (zh) 数值控制装置以及数值控制***
CN111699079B (zh) 协调***、操作设备和方法
CN115210048A (zh) 机器人曲面仿形控制方法
KR20040034167A (ko) 6축 수직다관절 매니퓰레이터의 직선이동 제어방법
US20230286152A1 (en) Robot system and controller
CN114750173A (zh) 一种带电作业机器人抓取控制方法
CN116787440A (zh) 一种基于大型语言模型的机器人运动控制方法
KR940003133B1 (ko) 로보트 엔드-이펙터(End-effector)의 이동궤적 판별방법

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
G160 Decision to publish patent application
E701 Decision to grant or registration of patent right
GRNT Written decision to grant
FPAY Annual fee payment

Payment date: 19960513

Year of fee payment: 12

LAPS Lapse due to unpaid annual fee