KR100235191B1 - 산업용로보트의최단시간속도제어방법 - Google Patents
산업용로보트의최단시간속도제어방법 Download PDFInfo
- Publication number
- KR100235191B1 KR100235191B1 KR1019920009361A KR920009361A KR100235191B1 KR 100235191 B1 KR100235191 B1 KR 100235191B1 KR 1019920009361 A KR1019920009361 A KR 1019920009361A KR 920009361 A KR920009361 A KR 920009361A KR 100235191 B1 KR100235191 B1 KR 100235191B1
- Authority
- KR
- South Korea
- Prior art keywords
- speed
- time
- acceleration
- industrial robot
- deceleration
- Prior art date
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
본 발명은 산업용 로보트의 최단 시간 속도 제어 방법에 관한 것으로, 산업용 로보트가 최단 시간에 목표 지점에 이동할 수 있도록 제어하는 방법에 관한 것으로, 산업용 로보트가 최단 시간에 목표 지점에 이동할 수 있도록 로보트의 이동방향에 따라 미리 정해진 비율로 속도를 변경하는 속도 오버라이드 방식을 이용하여, 감속시간(또는 가속)이 T1인 속도 V1에서 속도V2로 변경될 때(즉, V1<V2, 또는 V1<V2)의 천이 시간 Tt=T1×[2V1/V1+V2]로 결정되어, 가감속 시간이 최소화된다.
Description
본 발명은 산업용 로보트의 최단 시간 속도 제어 방법에 관한 것으로, 산업용 로보트가 최단 시간에 목표 지점에 이동할 수 있도록 속도를 제어하는 방법에 관한 것이다.
일반적으로 로보트나 MC에서 목표점까지 이동동작을 부드럽게 하기 위해 가감속에 의해 원하는 속도를 만들어 내며, 이때의 이동 속도는 프로그램에 의해 정해진다.
따라서, 한번 제어 프로그램을 정하면 이동 경로 및 속도는 항상 같은 상태로 유지된다.
하지만, 종래의 다축 교시형 로보트(Multiple Axis teaching-type Robot)를 프로그램하여 시험 가동할 때 속도 오버라이드(over-ride)작용에 의해 이동 속도가 프로그램된 것과는 달리 설정될 수가 있다(이때, 가속시 이동되거나 감속시 이동거리가 다를 수 있다.).
도면 제4도는 NC로 어떤 물체의 구석 부분을 가공할 때의 문제점을 보여주기 위한 것으로 점 P1-Q-P2를 통과하는 경로에서 속도 오버라이드에 의해 변화된 속도 크기에 따른 실제 경로의 변화를 나타낸다.
여기에서, 종래의 속도 제어방식은 속도 오버라이드에 의해 변화된 속도 크기에 따라 경로가 변하지 않도록 하기 위해서 오버라이드에 의해 설정된 속도 크기에 반비례하도록 가감속 구간을 설정한다.
즉, 제5도와 같은 속도 명령에 의해 속도 V1이 설정되고 속도 오버라이드에 의해 속도 V2(=0.5 V1)가 결정되면, 속도 V2의 가속 시간은 속도 V1의 2배인 2T로 설정한다.
일반적으로 오버라이드에 의해 속도 비율이 X%에서 Y%로 변화했을 때 속도 Y%에 해당하는 가감속시간 Ty는 다음과 같이 정해진다.
Ty=Tx×(X/Y)
여기서, Tx는 속도 비율이 X%일 때의 가감속시간이다.
이러한 방법에 의해서 가감속 시간이 정해지면 제6도의 빗금친 삼각형 S1의 면적이 제8도의 빗금친 삼각형 S2와 같아지므로 구석에서의 경로가 속도 변화에 관계없이 일정하게 유지된다.
여기에서 각축이 정지하고 있을 때 가감속 시간의 변경은 제6도와 제8도에서 보는 바와 같이 행해지나, 때때로 한 축이 움직이고 있을 때 오버라이드가 변하는 경우는 두 가감속 방법에 의하여 가감속 시간을 변경할 필요가 있다.
제2도는 오버라이드 변화에 의하여 이러한 가감속 시간의 변경을 나타낸다.
모터는 오버라이드 V1특성에 의하여 처음에 가속되기 시작하여 등속에 도달한 후 ta-tb 구간에서 감속된다.
또한 오버라이드 V2특성에 의하여 가속이 tb-to 구간에서 이루어진다.
따라서, 모터는 가속특성 ①-②와 감속특성 ③-④에 의하여 ①-④로 구성된 속도 프로파일(profile)을 따르게 된다.
도면 제3도에서 가감속 회로 A는 오버라이드 V1특성에 맞게 이루어져 있고, 가감속회로 B는 오버라이드 V2특성에 맞게 이루어져 있으므로, 0-tb구간 동안은 가감속 회로 A를 이용하기 위해 스위치 S1이 닫히고, ta-to구간 동안은 가감속 회로 B를 이용하기 위해 스위치 S2가 닫힌다.
그래서, ta-tb 구간 동안은 스위치 S1, S2가 동시에 닫히게 되어 가감속 회로 A, B를 동시에 이용한다.
그러나, 상기 종래의 속도 제어 방법은 한 축이 동작 중일 때도 모든 축이 정지했을 때와 마찬가지로 가감속 시간을 설정함으로써 오버라이드에 의해 큰 속도에서 작은 속도로 변경될 때 불필요하게 많이 소요되는 문제점이 있었다.
즉, 오버라이드에 의해 감속 시간이 T1인 속도 V1에서 V2로 변환될 때의 천이 시간은 V2의 가속시간 T2=T1×(V1/V2)로 결정된다.
이때, V2=0.01 V1이면 천이 시간은 100 T1으로 결정되어 많은 시간이 소요되는 문제점이 있었던 것이다.
본 발명은 상기한 목적을 달성하기 위하여, 산업용 로보트가 최단 시간에 목표 지점에 이동할 수 있도록 로보트의 이동 속도를 제어해 주는 산업용 로보트의 최단 시간 속도 제어 방법을 제공하는데 그 목적이 있다.
본 발명은 상기한 목적을 달성하기 위하여, 산업용 로보트의 최단 시간 속도제어 방법에 있어서, 산업용 로보트가 최단 시간에 목표 지점에 이동할 수 있도록 로보트의 이동 방향에 따라 미리 정해진 비율로 속도를 변경하는 속도 오버라이드 방식을 이용하여, 감속시간(또는 가속)이 T1인 속도 V1에서 속도 V2로 변경될 때(즉, V1<V2, 또는 V1<V2)의 천이 시간 Tt=T1×[2V1/V1+V2]로 결정되어, 가감속 시간이 최소화되는 것을 특징으로 하는 산업용 로보트의 최단 시간 속도 제어 방법을 제공한다.
제1도는 본 발명에 따른 속도 변화 프로파일.
제2도는 종래의 속도 제어 방식에 의한 장치의 블록도.
제3도는 종래의 속도 제어 방식에 의한 장치의 블록도.
제4도는 속도 크기에 따른 경로 변화를 보여 주기 위한 예시도.
제5, 6도는 속도 명령에 의해 설정된 속도 프로파일.
제7, 8도는 속도 오버라이드와 가감속 구간에 대해 설명하기 위한 속도 프로파일.
본 발명에 따른 산업용 로보트의 최단 시간 속도 제어방법에 대하여 본 발명의 일 실시예를 통하여 상세하게 설명한다.
첨부한 도면, 제1도는 본 발명에 따른 속도 변화 프로파일, 제4도는 속도 크기에 따른 경로 변화를 주기 위한 예시도, 제5, 6도는 속도 명령에 의해 설정된 속도 프로파일, 제7, 8도는 속도 오버라이드와 가감속 구간에 대해 설명하기 위한 속도 프로파일이다.
본 발명에 따른 산업용 로보트의 최단 시간 속도 제어 방법은 산업용 로보트가 최단 시간에 목표 지점에 이동할 수 있도록 로보트의 이동 방향에 따라 미리 정해진 비율로 속도를 변경하는 속도 오버라이드 방식을 이용하여, 감속시간(또는 가속)이 T1인 속도 V1에서 속도 V2로 변경될 때(즉, V1<V2, 또는 V1<V2)의 천이 시간 Tt=T1×[2V1/V1+V2]로 결정되어, 가감속 시간을 최소화하도록 되어 있다.
이를 보다 자세하게 설명하면 다음과 같다.
본 발명에서는 동작중인 축이 오버라이드에 의해 큰 속도에서 작은 속도로 변경될 때는 종래의 방법과는 다른 방법으로 가감속 시간을 설정함으로써, 속도 변경시 천이(遷移)시간을 최소로 하고 있다.
이에 대한 설명은 제1도에서 보는 바와 같이, 속도 오버라이드에 의해 감속시간이 T1인 속도 V1에서 속도 V2로 변경될 때(즉, V1>V2) 천이 사간 Tt는 다음과 같이 결정된다.
Tt=T1×[2V1/V1+V2]
이때, 빗금친 사다리꼴 도형의 St는 다음과 같다.
St=0.5 ×Tt*[V1+V2]=2T1V1
따라서, 속도 V1에서 속도 V2로 변경되는 동안의 거리는 종전의 방법과 같으므로, 속도 오버라이드에 의해 속도 크기가 변하더라도 경로의 변화는 일어나지 않는다.
그리고, 속도 V1에서 속도 V2로 변경시 천이 시간은 종전의 천이 시간에 비해 짧다.
이에 대한 증명은 아래 식과 같다.
T2-Tt=T1×(V1/V2)-T1×[2V1/V1+V2]
=T1×V1(V1+V2)-2V1V2/V2×(V1+V2)
=T1×V1(V1+V2)/V2×(V2+V2)>0
또한 V2는 양수이므로
Tt=T1×[2V1/V1+V2]<T1×[V1+V1/V2]=2T1
따라서, Tt<2T1이다.
결과적으로, 천이 시간 Tt는 속도 V1과 속도 V2의 크기에 관계없이 2T1보다 작다.
반면에, 종래의 방법은 천이 시간이 속도에 반비례하게 결정되므로 속도 크기 차이가 클 때는 천이하는데 많은 시간이 소요된다.
또한, 속도 V1에서 속도 V2로 변환할 때 종래의 방법에서 생기는 속도 변화점(제2도에서 Pd 점)도 없어지므로 더욱 부드러운 천이 동작을 행할 수 있는 이점이 있다.
상기한 바와 같이 이루어진 본 발명에 따른 산업용 로보트의 최단 시간 속도제어 방법은 산업용 로보트가 최단 시간에 목표 지점에 이동할 수 있도록 로보트의 이동 속도를 제어해 주는 효과를 제공한다.
Claims (1)
- 산업용 로보트의 최단 시간 속도 제어 방법에 있어서, 산업용 로보트가 최단 시간에 목표 지점에 이동할 수 있도록 로보트의 이동방향에 따라 미리 정해진 비율로 속도를 변경하는 속도 오버라이드 방식을 이용하여, 감속시간(또는 가속)이 T1인 속도 V1에서 속도 V2로 변경될 때(즉, V1<V2, 또는 V1<V2)의 천이 시간 Tt=T1×[2V1/V1+V2]로 결정되어, 가감속 시간이 최소화되는 것을 특징으로 하는 산업용 로보트의 최단 시간 속도 제어 방법.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1019920009361A KR100235191B1 (ko) | 1992-05-30 | 1992-05-30 | 산업용로보트의최단시간속도제어방법 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1019920009361A KR100235191B1 (ko) | 1992-05-30 | 1992-05-30 | 산업용로보트의최단시간속도제어방법 |
Publications (2)
Publication Number | Publication Date |
---|---|
KR930023119A KR930023119A (ko) | 1993-12-18 |
KR100235191B1 true KR100235191B1 (ko) | 2000-04-01 |
Family
ID=19333926
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1019920009361A KR100235191B1 (ko) | 1992-05-30 | 1992-05-30 | 산업용로보트의최단시간속도제어방법 |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR100235191B1 (ko) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102451654B1 (ko) * | 2020-10-15 | 2022-10-07 | 주식회사 슈파스 | 뷰티 및 컬러 정보를 포함하는 트럼프 카드 및 이를 생성하기 위한 방법 |
-
1992
- 1992-05-30 KR KR1019920009361A patent/KR100235191B1/ko not_active IP Right Cessation
Also Published As
Publication number | Publication date |
---|---|
KR930023119A (ko) | 1993-12-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US4894596A (en) | Velocity control apparatus | |
US5073748A (en) | Method for limiting the rate-of-change of acceleration in numerical driving systems | |
JPH0384604A (ja) | 数値制御装置の送り速度制御方法 | |
US5004968A (en) | Method for acceleration and deceleration control of servomotors | |
US5070287A (en) | Method for a numerical positioning control system | |
EP0141860A1 (en) | Position-controlling apparatus | |
US4988934A (en) | Robot control apparatus | |
KR100235191B1 (ko) | 산업용로보트의최단시간속도제어방법 | |
CN102082545B (zh) | 马达速度控制器及其控制方法 | |
US4914363A (en) | Method for controlling the motion of a machine element | |
JPH02195409A (ja) | 数値制御装置の送り速度制御方法 | |
US5475602A (en) | Acceleration constant switching apparatus | |
JPH04142604A (ja) | サーボモータの制御方式 | |
US5550448A (en) | Method and apparatus for controlling the movement of a tool | |
JPH0561650B2 (ko) | ||
JPH06250717A (ja) | 数値制御装置の加減速制御方式 | |
JPH07194157A (ja) | サーボモータ制御装置 | |
WO1989001388A1 (en) | Axis switching device | |
JPH0115881B2 (ko) | ||
KR0157454B1 (ko) | 로봇의 속도제어 방법 | |
JP3232603B2 (ja) | デジタルサーボ制御装置 | |
JPH02137006A (ja) | 速度制御装置 | |
SU1045221A1 (ru) | Устройство дл позиционировани | |
JPH04260906A (ja) | モータの速度制御装置 | |
JPH068166A (ja) | 加減速制御装置 |
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: 20070830 Year of fee payment: 9 |
|
LAPS | Lapse due to unpaid annual fee |