KR960018817A - 로봇의 궤도 계획시에 있어서의 시정수의 설정 방법 - Google Patents

로봇의 궤도 계획시에 있어서의 시정수의 설정 방법 Download PDF

Info

Publication number
KR960018817A
KR960018817A KR1019950040203A KR19950040203A KR960018817A KR 960018817 A KR960018817 A KR 960018817A KR 1019950040203 A KR1019950040203 A KR 1019950040203A KR 19950040203 A KR19950040203 A KR 19950040203A KR 960018817 A KR960018817 A KR 960018817A
Authority
KR
South Korea
Prior art keywords
robot
time constant
axis
time
torque
Prior art date
Application number
KR1019950040203A
Other languages
English (en)
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 이나바 세이우에몬
Publication of KR960018817A publication Critical patent/KR960018817A/ko

Links

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/416—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 control of velocity, acceleration or deceleration
    • 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
    • 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/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40519—Motion, trajectory planning
    • 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/43—Speed, acceleration, deceleration control ADC
    • G05B2219/43099—Select acceleration deceleration time constants as function of weight, load, position

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)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

본 발명은 로봇의 궤도 계획시에 적정한 시정수를 설정하는 것을 목적으로 한다.
4축 수평 다관절 로봇을 상정하고, 제2축 및 제3축의 간섭 토크를 고려하여 시정수를 정한다. 시정수는 (1) 로봇의 운동 방정식, (2) 목표 궤도를 실현하기 위한 각 축의 구속 조건식(야코비안 행렬을 사용), (3) 로봇의 최대 토크에 의한 구속 조건을 감안하여 온 라인 처리로 결정된다.
우선, 제n축의 교시 속도 Vtn을 구한다(S1). 이어서, 토크 커브 데이타를 기초로 하여 Vth에 대응하는 최대 토크 Tmax(n)을 구하고, 정부하 토크 Twn을 감한 최대 토크 Tmax n을 구한다(S2,S3). 간섭 토크 비 고려축(n=1, 4)에 관해서는 Tmax(n)을 만족하는 가속도를 Acc n=Tmax n/In으로 구한다(S4,S5). 시정수 τn은 τn=Vth/Acc n으로 구한다(S6).
이상의 처리를 4회 반복하고(S7,S8), 최대 Acc(cal)을 구한다(S9). 이어서, τ2=Vt2/A2*Acc(cal). τ3=Vt3/A3*Acc(cal)을 계산한다(S10,S11) 계산된 τn(n=1,2,3,4)를 비교하고, 최대치를 각 축의 시정수로서 설정한다(S12).

Description

로봇의 궤도 계획시에 있어서의 시정수의 설정 방법
본 내용은 요부공개 건이므로 전문내용을 수록하지 않았음
제1도는 본원 발명의 방법이 적용되는 4축 수평 다관절 로봇의 축 구성을 나타낸 도면.
제2도는 본 실시예에 있어서의 시정수의 설정을 온 라인으로 실시하기 위해 사용되는 로봇 제어 장치의 대표적인 구성을 주요부 블럭도로 도시한 도면.

Claims (4)

  1. 각각 서보 모터에 의해 구동되는 복수의 축을 갖는 로봇의 궤도 계획시의 시정수의 설정 방법에 있어서, 시점 및 종점에서의 각 축의 속도를 0으로 간주할 수 있는 동작 구간의 시점 및 종점에서 상기 축 중, 적어도 2개의 축 사이의 간섭 토크의 영향을 받아 발생 토크의 포화를 일으키지 않는 조건으로 최단의 가감속 제어 시정수를 상기 적어도 2개의 축에 관하여 상기 로봇을 제어하는 로봇 제어 장치를 이용한 온 라인의 소프트웨어 처리에 의해 구하여, 상기 로봇을 제어하는 로봇 제어 장치에 설정하는 것을 특징으로 하는 로봇의 궤도 계획시에 있어서의 시정수의 설정 방법.
  2. 각각 서보 모터에 의해 구동되는 복수의 축을 갖는 로봇의 궤도 계획시의 시정수의 설정 방법에 있어서, 시점 및 종점에서의 각 축의 속도를 0으로 간주할 수 있는 동작 구간의 시점 및 종점에서 상기 축 중, 적어도 2개의 축 사이의 간섭 토크의 영향을 받아 발생 토크의 포화를 일으키지 않는 조건으로 최단의 가감속 제어 시정수를 상기 적어도 2개의 축에 관하여 상기 로봇을 제어하는 로봇 제어 장치를 이용한 온 라인의 소프트웨어 처리에 의해 구하고, 그 중의 최장의 시정수를 모든 축 공통의 시정수로서 상기 로봇을 제어하는 로봇 제어장치에 설정하는 것을 특징으로 하는 로봇의 궤도 계획시에 있어서의 시정수의 설정 방법,
  3. 제1항에 있어서, 상기 소프트웨어 처리가 로봇의 운동 방정식을 기초로 하여 결정되는 간섭 토크의 영향을 평가한 조건으로 목표 궤도를 실현하기 위한 각 축의 구속 조건과, 로봇의 최대 토크에 의한 구속 조건을 동시에 만족하는 시정수의 조건을 구하는 처리를 포함하고 있는 것을 특징으로 하는 로봇의 궤도 계획시에 있어서의 시정수의 설정 방법.
  4. 제2항에 있어서, 상기 소프트웨어 처리가 로봇의 운동 방정식을 기초로 하여 결정되는 간섭 토크의 영향을 평가한 조건으로 목표 궤도를 실현하기 위한 각 축의 구속 조건과, 로봇의 최대 토크에 의한 구속 조건을 동시에 만족하는 시정수의 조건을 구하는 처리를 포함하고 있는 것을 특징으로 하는 로봇의 궤도 계획시에 있어서의 시정수의 설정 방법.
    ※ 참고사항 : 최초출원 내용에 의하여 공개하는 것임.
KR1019950040203A 1994-11-09 1995-11-08 로봇의 궤도 계획시에 있어서의 시정수의 설정 방법 KR960018817A (ko)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP94-299108 1994-11-09
JP6299108A JPH08137524A (ja) 1994-11-09 1994-11-09 ロボットの軌道計画時における時定数の設定方法

Publications (1)

Publication Number Publication Date
KR960018817A true KR960018817A (ko) 1996-06-17

Family

ID=17868241

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1019950040203A KR960018817A (ko) 1994-11-09 1995-11-08 로봇의 궤도 계획시에 있어서의 시정수의 설정 방법

Country Status (5)

Country Link
US (1) US5751130A (ko)
EP (1) EP0744677A4 (ko)
JP (1) JPH08137524A (ko)
KR (1) KR960018817A (ko)
WO (1) WO1996015480A1 (ko)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
SE505981C2 (sv) * 1996-02-14 1997-10-27 Asea Brown Boveri Förfarande för styrning av en industrirobot med hänsyn till moment och belastning
JPH1153021A (ja) * 1997-08-05 1999-02-26 Yaskawa Electric Corp 産業用ロボットの加減速パターン生成方法
US7904182B2 (en) * 2005-06-08 2011-03-08 Brooks Automation, Inc. Scalable motion control system
KR101220121B1 (ko) * 2006-06-30 2013-01-11 스타 마이크로닉스 컴퍼니 리미티드 이동체의 이동 제어 장치, 이동체의 이동 제어 방법 및공작 기계의 이동 제어 장치
DE102011010505A1 (de) * 2011-02-07 2012-08-09 Dürr Systems GmbH Anpassung der Dynamik zumindest eines Roboters

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01164280A (ja) * 1987-12-21 1989-06-28 Fanuc Ltd 加減速制御方式
JPH0430203A (ja) * 1990-05-25 1992-02-03 Fanuc Ltd ロボットの加減速時定数制御方法
JP3038972B2 (ja) * 1991-04-03 2000-05-08 ソニー株式会社 加減速パターン生成装置及びパターン生成方法
JP3083870B2 (ja) * 1991-05-10 2000-09-04 ファナック株式会社 数値制御装置

Also Published As

Publication number Publication date
WO1996015480A1 (fr) 1996-05-23
EP0744677A4 (en) 1997-07-23
JPH08137524A (ja) 1996-05-31
US5751130A (en) 1998-05-12
EP0744677A1 (en) 1996-11-27

Similar Documents

Publication Publication Date Title
US10259118B2 (en) Robot system having function of simplifying teaching operation and improving operating performance by learning
KR960705267A (ko) 예비산출용 이동제어 장치 및 방법(motion control with precomputation)
KR840006459A (ko) 로보트의 동작 제어장치
KR900014964A (ko) 산업용 로보트의 속도 제어방법 및 장치
EP0357778A1 (en) Method of speed control for servomotor
KR890701290A (ko) 산업용 로봇에 있어서의 모우터 구동 방법
KR960018817A (ko) 로봇의 궤도 계획시에 있어서의 시정수의 설정 방법
EP0240570A1 (en) Acceleration and deceleration control system for horizontal-joint robots
JPH06250723A (ja) ロボットの振動低減装置
KR960039582A (ko) 모터의 폭주 검출 방법 및 폭주 검출 장치
JP2958978B2 (ja) 学習制御方法
JPH0336977A (ja) サーボモータの加減速制御方法および装置
RU2771456C1 (ru) Способ управления рабочим органом многостепенного манипулятора
JP2001154719A (ja) 自由曲線補間方法
JPH0732279A (ja) ロボット位置教示方式
JPS6132120A (ja) 位置決め制御方式
JPS62152020A (ja) デイジタルサ−ボ制御装置
JPS62172408A (ja) 速度制御方法
SU1682160A1 (ru) Способ управлени резонансной механической рукой
JP2601433B2 (ja) 工業用ロボットの補間制御方法および装置
JPH06214656A (ja) 制振要素を持つスライディングモード制御方法
JPH08263128A (ja) ロボットの位置決め制御時の加減速制御方法
JPS63253407A (ja) ロボツトの振動制御方法
KR0155685B1 (ko) 펜 플로터의 와인드-업 보상방법
JPH07302749A (ja) 多軸サンプリング制御装置

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
E601 Decision to refuse application