KR900007107B1 - 속도 제어 방식 - Google Patents
속도 제어 방식 Download PDFInfo
- Publication number
- KR900007107B1 KR900007107B1 KR1019870700648A KR870700648A KR900007107B1 KR 900007107 B1 KR900007107 B1 KR 900007107B1 KR 1019870700648 A KR1019870700648 A KR 1019870700648A KR 870700648 A KR870700648 A KR 870700648A KR 900007107 B1 KR900007107 B1 KR 900007107B1
- Authority
- KR
- South Korea
- Prior art keywords
- speed
- control system
- motor
- mechanical load
- load
- Prior art date
Links
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
-
- 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
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/32—Automatic controllers electric with inputs from more than one sensing element; with outputs to more than one correcting element
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/16—Controlling the angular speed of one shaft
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
- Control Of Velocity Or Acceleration (AREA)
- Numerical Control (AREA)
Abstract
내용 없음.
Description
[발명의 명칭]
속도 제어 방식
[도면의 간단한 설명]
제1도는 본 발명의 한 실시예를 나타내는 블록신도.
제2도는 기계부하의 선단속들 귀환해서 제어할때의 서브 제어계의 한 예를 나타내는 블록신도.
제3도는 업저버에 의해서 속도를 추정하는 원리를 설명하는 블록도.
[발명의 상세한 설명]
(기술분야)
본 발명은 서브모터의 속도 제어방식, 특히 저 강성의 부하를 구동하는데 적합한 서보모터의 속도 제어방식에 관한 것이다.
(배경기술)
산업용 로봇은, 복수의 아암을 연결하므로서 높은 자유도를 부여하여, 다양한 작업에 대응하도록 하고 있으나, 연결된 아암은 긴 외팔보(cantilever)상태을 이루기 매문에, 그리고 또, 서보모터와의 사이의 동력전달 기구의 특성에 의해서, 강성이 저하되는 것은 불가피하다. 그리고 이와 같은 저 강성의 기계부하임에도 불구하고, 산업용 로봇에서는 그 작업능력을 높이기 위해서 동작속도, 동작범위를 넓히고, 또한 고정도의 위치 결정도 요구되고 있다.
이와 같은 종래의 저 강성 기계부하, 예를 들면 로봇의 아암 등을 제어할때에 DC모터를 사용한 속도제어계를 이상적으로 제어하기 위해서는, 제2도의 블록선도로 표시되는 속도 제어 시스템이 고려되고 있다. 그림에 있어서, K1은 적분정수, K2,K3,K4는 비례정수, Kt는 전력증폭기 정수, Jm은 로우터이너셔, JL은 부하관성이너셔. K는 로우터와 부하결합의 스프링 정수이다. 이 경우 입력신호 Vr와 출력신호 예를 들면, 로봇핸드의 선단속도 V1과의 비(전달 함수)를, 속도 제어용의 적분기로의 피드백 신흐를 V1에 의거해서 연산하기 위해서는,
로서 표시되는 식을 이용하고 있다.
즉, (1)식과 같이 결정된 연산식에 의하면, 분모의 다항식에 있어시의 1차 미분 S(md/dt), 2차 미분S2, 3차 미분 S3의 각항 계수가, 비례정수 K2,K3,K4만의 적의 꼴로되어 있으므로, 이를 계수를 자유롭게 변경시켜 속도제어계를 안정되게 유지하는 것은 용이하다. 그리고, 직류항에 있어서도, 이들 비례정수 K2,K3,K4와는 독립적으로 적분정수 K1만을 자유롭게 바꾸어서, 즉응성을 향상시켜 위치 제어계에 대한 외관에 적절하게 대응할 수가 있다.
그러나, 실제상으로는, 기계추진계의 변위나 핸드선단에서의 속도 신호 찾아낼 때에, 추정기등을 사용하나, 여기에는 다소의 오차가 포함되므로 정확한 피드백 신호를 얻는 것은 곤란하다. 따라서, 종래에는 통상, 모터속도 Vm을 적분기에 피드백하고 있다. 이 경우에는 모터속도 Vm과, 핸드 선단의 속도 V1과의 관계는 스프링 정수 K에 의하여,
로 포현되므로, 전달함수는
로 표시된다.
이 때문에, 2차 미분 S2의 계수에는 비례정수 K4와 척분정수 K1의 두개의 계수가 포함되므로서, 저 강성의 기계부하를 안정되게 조정하는 것이 관난하게 된다는 문제가 있었다.
즉, 위치 제어계의 시정수는 1차 미분의 항과 직류항의 계수와의 비로서 결정되며,
로 표시된다. 따라서, 적분정수 K1의 값을 K2+K3에 대해서 적절한 값으로 선정하므로서, 속도 제어계에서는 정확한 동작을 시킬 수가 있으나, 2차 미분의 항의 계수에 비례정수 K4도 포함되어 있으므로, K1의값을 K2+K3와의 관계로 선정할때 위치 제어계에서의 밸런스를 얻을수가 없어, 안정성이 손상된다는 문제가 있었다.
(발명의 개시)
본 발명은 이와 같은 종래 기술의 문제점을 해소하고, 근사적인 모터로서 출력되는 기계부하로부터의 속도신호를 모터속도와 함꼐 속도 제어용의 적분기에 피드백하므로서, 속도 제어계에서의 즉응성을 손상시킴이 없어, 안정왼 위치 제어까지도 가능하게 하는 속도 제어방식을 제공함을 목적으로 하는 것이다.
본 발명에 의하면, 서보제어계를 지령속도와 피드백된 기계부하와의 속도신호에 의하여 제어하는 속도제어방식에 있어서, 저 강성의 가계부하를 구동하는 서보모터와, 상기 서보모터의 속도를 검출하는 수단과, 상기 기계부하의 속도신호를 형성하는 수단과, 상기 서보모터의 속도신호가 피드백되는 제1의 적분수단과, 상기 기계부하의 속도신호가 피드백되는 제2의 적분수단과, 이들 제1, 제2의 적분수단으로부터 서보계의전달함수를 결정하는 수단 등을 가지는 것을 특징으로하는 속도제어방식이 제공된다.
본 발명에 의하면, 서보모터 및 기계부하의 속도를 각각 서보제어계에 설치한 별개의 적분기에 피드백하고 있으므로, 안정된 서보제어가 가능하다.
(발명의 최량 실시 형태)
이하, 도면에 의하여 본 발명의 한 실시예에 대한 설명을 한다.
제1도는 본 발명에 의한 속도 제어계의 블록도이다. 본 발명은 서보제어계에 모터속도 Vm을 피드백하는 적분기 A와 기계부하 선단속도 V1을 피드백하는 적분기 B를 별개로 설치하였음을 특징으로 한다. 도면에 있어서, Kl을 모터속도에 대한 적분정수 K5를 기계부하속도에 대한 적분정수로 한다면, 모터속도와 기계속도의 두개의 신호에 관해서 확대했을때의 전달 함수는 다음과 같이 표시된다.
다음에, 기계부하 속도에 관해서 확대한 경우의 전달 함수는, Km을 부하속도에 대한 적분정수로 하면,
로서 표시된다.
따라서, (3),(4)식을 비교하면 1차 미분, 3차 미분의 계수는 같기 때문이 2차 미분의 항 이외의 계수를 일치시키는데는,
로 되도록 적분정수 Kl,K5를 정하면 되게된다. 즉, 이때에 제어계의 밸런스가 얻어진다.
여기서 부하속도에 대한 확대형에 대하여 분모가 버터워드패턴에 일하도록 각계를 선정하는 것으로 한다. 버터워드패턴은
으로 나타낼 수 있으나 2차 미분의 항의 계수는 비례정수 K4에 따라서 자유로히 변경할 수 있으므로 1차미분, 3차 미부, 4차 미분의 각항의 계수에 대해서는,
이 성립된다. 이때 모터 속도와 부하속도의 2개의 출력에 대한 확대형의 전달함수의 2차 미분의 계수는 다음과 같이 된다.
여기서 (9)식으로부터 (1/Km·kt)·(Jm·J1/K)=0.0304이기 때문에
로 된다. 지금
로 하면,
로 가정하여
로 되므로
로하면
G2={0.03α+(K1/Km)(2/α)}δ2
이 얻어진다.
예컨대 δ=5.3×10-3, Wn=2π×8로 하면 버터워드의 계수 BW2는,
이 도출된다.
또한 기계선단의 속도는 모터의 출력 토오크 및 모터의 위치로부터 업저버에 의해 추정한 값을 사용할 수도 있다. 이 입저버에 의한 속도 추정에 대해서는 본 발명의 출원인에 의해 일본국 특개소 60-200788호 공보에 제안되고 있다. 이하, 업저버에 의한 속도 추정에 대하여 제3도에 블록도에 의해 설명한다. 도면에 있어서 참고부호 1,2,3은 연산기, 참고부호 4는 추정기, 참고부호 5는 모터, 참고분호 6은 I-P콘롤로러, θ는 모터의 위치,
의 차가 연산기(1)로부터 출력된다. 이 출력신호는 적분되어 연산기(2)에 출력된다. 한편 후술하는 속도 추정치 V에 퍼이드 백게인 K2를 승한 것이 연산기(2)에 입력되고, 그들의 입력신호간의 차가 토오크 지령 U로서 출력되고, 모터(5)가 제어된다. 그리하여 모터의 속도는 V로서 출력되고, 로우터리 인코우더에 의해서 위치 θ가 검출된다. 여기서 위치 θ의 정보에는 연산기(3)에 있아서 부하 토오크(쿨롬 마찰)을 나타내는 전류 IL이 가해진 결과가 포함된다.
추정기 즉, 업저버(4)를 사용하여 속도 추정치를 얻을 경우에는 정상적인 추정오차가 생기는 원인으로 되는 부하토오크를 동시에 추정한다. 즉, 추정기(4)에는 모터 전류 I와 부하 토오크를 나타내는 IL을 고려한 위치정보 θ를 입력하고 속도 추정치 V를 출력한다.
이점에 대하여 더욱 상세히 설명하면, 상기 모터전류 I, 속도 V, 위치 θ, 부하토오크에 의한 전류 IL로서 동일 차원 업저버를 구성하면 다음과 같이 된다.
실제로 검출하고, 추정기, 즉, 업저버(4)에 입력하는 모터전류 I와 위치 θ이며, 디지탈 처리하기 위한 동일 차원 업저버는
여기서 T는 샘플링 주기,λ1,λ2,λ3는 업저버의 게인이며, 추정치가 진짜값으로 수속하기 위한 시간에 반비례한다.
그래서 이것을 마이크로 프로세서로 처리하기 위하여 상기한 업저버를 하기의 알고리즘으로 실현한다.
이와 같이 하여, 업저버에 의해 속도가 추정되기 때문에 제1도에 표시한 바와 같은 본 발명의 제어계에 있어서도 기계속도가 업저버에 의해 추정할 수 있는 것은 명백하다.
또한 본 발명을, 1실시예에 따라 설명하였으나, 본 발명은 상기한 실시예 한정되는 것은 아니고 본 발명의 주지의 범위에서 여러가지의 변형이 가능하고 이것들을 본 발명의 범위에서 배제하는 것은 아니다.
(산업상의 이용 가능성)
이상과 같이 본 발명에 의하면 로봇 핸드 등의 저 강성의 기계부하를 제어하는 제어게에 있어서 모터의속도 및 기계 선단의 속도를 서보제어계의 각각 별개의 적분기에 피이드백하여 속도제어를 행하므로 속응성, 안정성에 뛰어나고 특히 저 강성의 부하를 구동하는 서보모터의 속도 제어계에 사용하는 것이 바람직하다.
Claims (2)
- 서보 제어계를 지령속도와 피이드 백된 기계 부하의 속도 신호에 의해 제어하는 속도제어방식에 있어서, 저강성의 기계 부하를 구동하는 서보모터, 상기 서보모터의 속도를 검출하는 수단, 상기 기계부하의 속도 신호를 형성하는 수단, 상기 서보모터의 속도신호가 피이드 백되는 제1의 적분수단, 상기 기계부하의 속도신호가 피이드 백되는 제2의 적분 수단, 이들 제1, 제2의 적분수단으로부터 서보계의 전달 함수를 결정하는 수단을 포함함을 특징으로 하는 속도 제어방식.
- 제1항에 있어서, 상기 기계 부하의 속도는 상기 서보모터의 출력 토오크와 상기 서보모터의 위치 신호로부터 업 저버에 의해 추정한 값인 것을 특징으로 하는 속도 제어방식.
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP60266616A JPS62126883A (ja) | 1985-11-27 | 1985-11-27 | 速度制御方式 |
JP266616 | 1985-11-27 | ||
PCT/JP1986/000601 WO1987003432A1 (en) | 1985-11-27 | 1986-11-26 | Speed control system |
Publications (2)
Publication Number | Publication Date |
---|---|
KR880701039A KR880701039A (ko) | 1988-04-22 |
KR900007107B1 true KR900007107B1 (ko) | 1990-09-28 |
Family
ID=17433285
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1019870700648A KR900007107B1 (ko) | 1985-11-27 | 1986-11-26 | 속도 제어 방식 |
Country Status (6)
Country | Link |
---|---|
US (1) | US4816734A (ko) |
EP (1) | EP0247206B1 (ko) |
JP (1) | JPS62126883A (ko) |
KR (1) | KR900007107B1 (ko) |
DE (1) | DE3683642D1 (ko) |
WO (1) | WO1987003432A1 (ko) |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63273115A (ja) * | 1987-04-30 | 1988-11-10 | Fanuc Ltd | サ−ボ制御回路 |
JPS63274385A (ja) * | 1987-04-30 | 1988-11-11 | Fanuc Ltd | サ−ボモ−タの速度制御装置 |
JPS6464577A (en) * | 1987-08-31 | 1989-03-10 | Fanuc Ltd | Servomotor controller |
JPH01137305A (ja) * | 1987-11-25 | 1989-05-30 | Mitsubishi Electric Corp | フィードバック制御装置 |
JPH01186182A (ja) * | 1988-01-19 | 1989-07-25 | Fanuc Ltd | サーボモータの制御装置 |
JPH01194881A (ja) * | 1988-01-26 | 1989-08-04 | Sony Corp | 記録再生装置 |
JPH07120216B2 (ja) * | 1988-10-21 | 1995-12-20 | 新技術事業団 | 位置制御方法 |
US4893068A (en) * | 1988-11-15 | 1990-01-09 | Hughes Aircraft Company | Digital servo employing switch mode lead/lag integrator |
US4914726A (en) * | 1989-01-17 | 1990-04-03 | Tektronix, Inc. | Mass velocity controller |
US5036266A (en) * | 1989-01-17 | 1991-07-30 | Tektronix, Inc. | Mass velocity controller |
JPH02221702A (ja) * | 1989-02-22 | 1990-09-04 | Nireco Corp | 電気油圧サーボ装置 |
US4912386A (en) * | 1989-03-21 | 1990-03-27 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Balanced bridge feedback control system |
JPH02297602A (ja) * | 1989-05-12 | 1990-12-10 | Fanuc Ltd | 非線形項補償を含むスライディングモード制御方式 |
JPH0349588A (ja) * | 1989-07-14 | 1991-03-04 | Omron Corp | 離散時間型acモータ制御装置 |
US4985668A (en) * | 1989-09-19 | 1991-01-15 | Kabushiki Kaisha Kobe Seiko Sho | Robot controller |
US5371449A (en) * | 1991-03-20 | 1994-12-06 | Hitachi, Ltd. | Servo control method for a servo system |
JPH07104856A (ja) * | 1993-10-01 | 1995-04-21 | Fanuc Ltd | 振動制御方法 |
DE4335239C1 (de) * | 1993-10-15 | 1994-12-01 | Vdo Schindling | Verfahren zum Positionieren eines Stellglieds |
JP3166446B2 (ja) * | 1993-10-26 | 2001-05-14 | 株式会社明電舎 | 速度推定オブザーバ |
US5424962A (en) * | 1993-12-29 | 1995-06-13 | Comsat | Method and system for projecting steady state conditions of a product from transient monotonic or cyclic data |
JP3611147B2 (ja) * | 1996-02-20 | 2005-01-19 | 株式会社安川電機 | 多軸ロボットの制御装置 |
JP4014162B2 (ja) * | 2003-08-06 | 2007-11-28 | ヤマザキマザック株式会社 | 工作機械の位置制御装置及び工作機械の位置制御方法 |
US7904182B2 (en) * | 2005-06-08 | 2011-03-08 | Brooks Automation, Inc. | Scalable motion control system |
JP6568147B2 (ja) * | 2017-06-06 | 2019-08-28 | ファナック株式会社 | サーボモータ制御装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4502109A (en) * | 1982-09-14 | 1985-02-26 | Vickers, Incorporated | Apparatus for estimating plural system variables based upon a single measured system variable and a mathematical system model |
JPS59206902A (ja) * | 1983-05-11 | 1984-11-22 | Hitachi Ltd | 電気サ−ボ装置 |
JPS60200788A (ja) * | 1984-03-22 | 1985-10-11 | Fanuc Ltd | 速度制御方式 |
JPS61116986A (ja) * | 1984-11-09 | 1986-06-04 | Fanuc Ltd | 速度制御装置 |
US4680581A (en) * | 1985-03-28 | 1987-07-14 | Honeywell Inc. | Local area network special function frames |
-
1985
- 1985-11-27 JP JP60266616A patent/JPS62126883A/ja active Pending
-
1986
- 1986-11-26 EP EP86906946A patent/EP0247206B1/en not_active Expired - Lifetime
- 1986-11-26 DE DE8686906946T patent/DE3683642D1/de not_active Expired - Lifetime
- 1986-11-26 KR KR1019870700648A patent/KR900007107B1/ko not_active IP Right Cessation
- 1986-11-26 WO PCT/JP1986/000601 patent/WO1987003432A1/ja active IP Right Grant
- 1986-11-26 US US07/082,633 patent/US4816734A/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
EP0247206A1 (en) | 1987-12-02 |
EP0247206A4 (en) | 1988-05-03 |
DE3683642D1 (de) | 1992-03-05 |
US4816734A (en) | 1989-03-28 |
WO1987003432A1 (en) | 1987-06-04 |
KR880701039A (ko) | 1988-04-22 |
EP0247206B1 (en) | 1992-01-22 |
JPS62126883A (ja) | 1987-06-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR900007107B1 (ko) | 속도 제어 방식 | |
US4904152A (en) | Industrial robot | |
US4680518A (en) | Servomotor velocity control method | |
JP3506157B2 (ja) | 電動機の位置制御装置 | |
JP2573120B2 (ja) | 同期形交流サーボモータの速度制御方法及び制御装置 | |
US5357424A (en) | Dynamic model parameter identification system | |
JP4014162B2 (ja) | 工作機械の位置制御装置及び工作機械の位置制御方法 | |
EP0464649B1 (en) | Control device for robot in inertial coordinate system | |
US5742144A (en) | Backlash compensation method for semi-closed-loop type servo control | |
JP2906256B2 (ja) | サーボ制御装置 | |
JP4134369B2 (ja) | ロボットの制御装置 | |
JP2580502B2 (ja) | 減速機付モ−タの力・トルク制御方法 | |
JP3374592B2 (ja) | ロボットの制御パラメータ推定方法 | |
JP2906255B2 (ja) | サーボ制御装置 | |
JP3308656B2 (ja) | サーボモータの制御方法 | |
JP2718688B2 (ja) | 多自由度作業機械の位置と力の制御装置 | |
JP2628846B2 (ja) | 産業用ロボットの制御方法およびその装置 | |
JPH0623932B2 (ja) | サ−ボ制御方法 | |
JP2650889B2 (ja) | 関節形ロボットの教示方法 | |
JP2718687B2 (ja) | 多自由度作業機械の位置と力の制御装置 | |
JPS62233081A (ja) | モ−タの速度制御方式 | |
SU1406565A1 (ru) | След щий электропривод с переменным моментом инерции | |
KR200172908Y1 (ko) | 산업용 다관절 로봇 제어장치 | |
JPS62126403A (ja) | 速度制御方式 | |
JP2502312B2 (ja) | ロボットにおける指令値演算方法および物体の位置制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
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: 19930920 Year of fee payment: 4 |
|
LAPS | Lapse due to unpaid annual fee |