KR102085047B1 - 서보모터의 제어 시스템 - Google Patents
서보모터의 제어 시스템 Download PDFInfo
- Publication number
- KR102085047B1 KR102085047B1 KR1020190113795A KR20190113795A KR102085047B1 KR 102085047 B1 KR102085047 B1 KR 102085047B1 KR 1020190113795 A KR1020190113795 A KR 1020190113795A KR 20190113795 A KR20190113795 A KR 20190113795A KR 102085047 B1 KR102085047 B1 KR 102085047B1
- Authority
- KR
- South Korea
- Prior art keywords
- servomotor
- function
- control system
- disturbance
- control unit
- 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
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/0003—Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control
-
- 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
- Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
- Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10S388/00—Electricity: motor control systems
- Y10S388/923—Specific feedback condition or device
Abstract
본 발명은 전체 시스템의 안정도를 증가시키고 외란에 강인한 특성을 갖는 서보모터의 제어 시스템에 관한 것으로, 전체시스템의 안정도와 외란억제 성능을 높이는 피드백제어부와 목표속도에 대한 응답특성을 제어하는 피드포워드제어부를 결합한 형태를 갖는 서보모터의 제어 시스템을 제공함으로써 전체시스템을 안정화함과 동시에 외란을 효과적으로 억제할 수 있도록 구성된다.
Description
본 발명은 전체 시스템의 안정도를 증가시키고 외란에 강인한 특성을 갖는 서보모터의 제어 시스템에 관한 것이다.
서보모터의 종류는 AC 서보와 DC 서보로 크게 구분한다. 초기의 서보모터는 DC 서보모터를 사용하였으나, 정류자, brush, communicator 등으로 구성되어 있어 DC 모터의 단점인 brush 마찰에 의한 분진과 불꽃 방전현상 및 주기적인 교체로 인하여 그 사용량이 점점 줄어들게 되었다. 또한 모터 제어를 위한 전력소자의 개발 및 반도체 가격 하락으로 인하여 AC 서보모터가 대부분 사용되고 있다.
기존의 서보모터의 제어 시스템은 PI 제어기와 같이 전체시스템을 안정하게 하는 피드백제어부가 요구되었다. 하지만, 서보모터에서는 진동이나 부하토크의 변동 등으로 인해 발생하여 시스템의 응답특성을 나쁘게 하는 외란을 억제할 필요성이 있으며, 이를 위해서 추정된 외란을 전치보상하는 부하토크관측기를 결합하는 접근방식을 택하고 있다.
도 1은 종래기술에 따른 서보모터의 제어 시스템의 구성도이다.
도 1을 참조하면, 종래기술에 따른 서보모터의 제어 시스템은 PI제어기(11)와, 부하토크관측기(12)를 포함하고 있으며, 목표속도(ω*)에 실제의 모터속도(ω)가 감산되어 속도차이가 계산되고, 이는 PI제어기(11)에 입력되어 토크명령(ω*)을 발생시키고 토크명령(τ*)은 부하토크(τd)가 감산되어 서보모터(2)에 입력되는 하나의 제어루프와, 서보모터(2)의 출력속도(ω)를 미분하고 서보모터(2)의 관성능률(Jn )을 곱하는 단계(13)를 거쳐 상기 제어토크명령(ω*)에 감산하여 관측기필터(14)에 입력되고 관측기필터(14)의 출력토크신호(T0)는 다시 제어토크명령에 부가하는 다른 하나의 제어루프로 구성된다.
이러한 종래의 서보모터의 제어 시스템에서 부하토크관측기는 실제의 부하를 LPF(Low pass filter)에 부가하는 형태이므로 비교적 높은 주파수의 외란제거가 곤란하며, 외란제거성능을 높이기 위하여 관측기의 주파수대역을 높이면 노이즈에 의해 제어시스템이 불안정하게 되는 문제점이 있었다.
한편, 비선형제어이론을 적용한 비선형 적응 백스텝핑 속도 제어방법도 제안되었는데, 이 방법은 제어 성능은 비교적 우수하지만 제어기가 다소 복잡하다는 단점이 있었다.
따라서 본 발명은 상기 문제를 해결하기 위해 안출한 것으로서, 본 발명의 목적은 전체 시스템의 안정도를 증가시키고 외란에 강인한 특성을 갖는 서보모터의 제어 시스템을 제공하는 것이다.
본 발명의 다른 목적 및 장점들은 하기에 설명될 것이며, 본 발명의 실시예에 의해 알게 될 것이다. 또한, 본 발명의 목적 및 장점들은 청구범위에 나타낸 수단 및 조합에 의해 실현될 수 있다.
본 발명의 일측면에 따르면, 서보모터(20)를 제어하기 위한, 서보모터의 제어 시스템으로서, 서보모터(20)의 전달함수()는
... (1)
로 나타내고(여기서, J는 서보모터(20)와 부하의 총 관성모멘트, B는 점성마찰계수를 나타내고, s는 라플라스연산자)로서 복소변수임),
서보모터(20)의 회전속도()는
... (2)
로 나타내고(여기서, 는 서보모터(20)의 발생토크로서 제어입력에 해당되고, 는 서보모터(20)에 인가되는 외란토크를 나타SO며, 후단의 감산기에 의해 에서 가 감산됨)
시스템의 모델 파라미터 오차()와 출력오차()는 각각
... (3)
... (4)
... (5)
로 나타내고(여기서, 는 목표속도이고, 는 출력속도를 나타내고, Jn, Bn은 각각 총 관성모멘트(J)와 점성마찰계수(B)에 대한 공칭 값을 나타냄),
가산부(26)에 의해, 전체시스템의 안정도와 외란억제 성능을 높이는 피드백제어부(22)()와 목표속도()에 대한 응답특성을 제어하는 피드포워드제어부(24)()를 결합한 형태로서,
서보모터(20)의 발생토크는
... (6)
로 나타내고,
피드백제어부(22)()와 피드포워드제어부(24)()는
... (7)
... (8)
로 표현되고(여기서, 는 외란 억제필터함수임),
는
...(9)
의 형태를 갖도록 선택되며,
여기서,는 외란선택함수로서, 노치필터의 형태를 가지고,
인 경우, 이므로,
전술한 식들로부터, 내부상태를 나타내는 변수들(, , )은
...(10-1)
...(10-2)
...(10-3)
이고, 이때 함수 는 임의로 선택할 수 있는 안정한 자유함수이고, 서보모터의 전달함수 와 서보모터 모델 파라미터 는 최소 위상 함수이므로, 시스템 내부의 모든 전달함수들은 안정한 것을 특징으로 한다.
... (1)
로 나타내고(여기서, J는 서보모터(20)와 부하의 총 관성모멘트, B는 점성마찰계수를 나타내고, s는 라플라스연산자)로서 복소변수임),
서보모터(20)의 회전속도()는
... (2)
로 나타내고(여기서, 는 서보모터(20)의 발생토크로서 제어입력에 해당되고, 는 서보모터(20)에 인가되는 외란토크를 나타SO며, 후단의 감산기에 의해 에서 가 감산됨)
시스템의 모델 파라미터 오차()와 출력오차()는 각각
... (3)
... (4)
... (5)
로 나타내고(여기서, 는 목표속도이고, 는 출력속도를 나타내고, Jn, Bn은 각각 총 관성모멘트(J)와 점성마찰계수(B)에 대한 공칭 값을 나타냄),
가산부(26)에 의해, 전체시스템의 안정도와 외란억제 성능을 높이는 피드백제어부(22)()와 목표속도()에 대한 응답특성을 제어하는 피드포워드제어부(24)()를 결합한 형태로서,
서보모터(20)의 발생토크는
... (6)
로 나타내고,
피드백제어부(22)()와 피드포워드제어부(24)()는
... (7)
... (8)
로 표현되고(여기서, 는 외란 억제필터함수임),
는
...(9)
의 형태를 갖도록 선택되며,
여기서,는 외란선택함수로서, 노치필터의 형태를 가지고,
인 경우, 이므로,
전술한 식들로부터, 내부상태를 나타내는 변수들(, , )은
...(10-1)
...(10-2)
...(10-3)
이고, 이때 함수 는 임의로 선택할 수 있는 안정한 자유함수이고, 서보모터의 전달함수 와 서보모터 모델 파라미터 는 최소 위상 함수이므로, 시스템 내부의 모든 전달함수들은 안정한 것을 특징으로 한다.
삭제
삭제
본 발명에 의하면, 전체시스템의 안정도와 외란억제 성능을 높이는 피드백제어부와 목표속도에 대한 응답특성을 제어하는 피드포워드제어부를 결합한 형태를 갖는 서보모터의 제어 시스템을 제공함으로써 전체시스템을 안정화함과 동시에 외란을 효과적으로 억제할 수 있는 효과가 있다.
도 1은 종래기술에 따른 서보모터의 제어 시스템의 개략적인 구성도이고,
도 2는 본 발명에 따른 서보모터의 제어 시스템의 개략적인 구성도이며,
도 3은 본 발명에 따른 서보모터의 제어 시스템과 기존 서보모터의 제어 시스템 간의 속도 추적성능을 비교한 그래프이다.
도 2는 본 발명에 따른 서보모터의 제어 시스템의 개략적인 구성도이며,
도 3은 본 발명에 따른 서보모터의 제어 시스템과 기존 서보모터의 제어 시스템 간의 속도 추적성능을 비교한 그래프이다.
기타 실시예들의 구체적인 사항은 상세한 설명 및 도면에 포함되어 있다.
본 발명의 이점 및 특징, 그리고 그것들을 달성하는 방법은 첨부되는 도면과 함께 상세하게 후술되어 있는 실시예들을 참조하면 명확해질 것이다. 그러나 본 발명은 이하에서 개시되는 실시예에 한정되는 것이 아니라 서로 다른 다양한 형태로 구현될 수 있으며, 이하의 설명에서 어떤 부분이 다른 부분과 연결되어 있다고 할 때, 이는 직접적으로 연결되어 있는 경우뿐 아니라 그 중간에 다른 매체를 사이에 두고 연결되어 있는 경우도 포함한다. 또한, 도면에서 본 발명과 관계없는 부분은 본 발명의 설명을 명확하게 하기 위하여 생략하였으며, 명세서 전체를 통하여 유사한 부분에 대해서는 동일한 도면 부호를 붙였다.
이하, 첨부된 도면들을 참고하여 본 발명에 대해 설명하도록 한다.
도 2는 본 발명에 따른 서보모터의 제어 시스템의 개략적인 구성도이다.
도 2를 참조하면, 서보모터의 제어 시스템은 서보모터(20)와, 피드백제어부(22)와, 피드포워드제어부(24)와, 가산부(26)를 포함하여 구성될 수 있다.
여기서, J는 서보모터(20)와 부하의 총 관성모멘트, B는 점성마찰계수를 나타내고, s는 라플라스연산자)로서 복소변수이다.
또한, Jn, Bn은 각각 총 관성모멘트(J)와 점성마찰계수(B)에 대한 공칭 값을 나타낸다.
따라서, 이러한 외란을 없애기 위해서는 를 고역통과필터 형태로 선택해야 함을 알 수 있다. 또한 만약 외란이 어떤 특정한 주파수대역에만 존재한다면 노치필터 형태로 설계하고 노치필터의 중심주파수가 외란의 주파수와 일치하도록 하면 될 것이다.
이하에서는 본 발명에 따른 서보모터의 제어 시스템을 적용시, 시스템의 내부 안정도를 살펴보기로 한다. 다시 말해서, 서보모터에 대한 모델 파라미터 오차가 없는 경우, 즉 인 경우의 안정도를 살표보기로 한다.
함수 는 임의로 선택할 수 있는 안정한 자유함수이고, 서보모터의 전달함수 와 서보모터 모델 파라미터 는 최소 위상 함수이므로, 시스템 내부의 모든 전달함수들은 안정함을 알 수 있다.
도 3은 본 발명에 따른 서보모터의 제어 시스템과 기존 서보모터의 제어 시스템 간의 속도 추적성능을 비교한 그래프이다.
본 발명에 따른 서보모터의 제어 시스템의 속도 추적성능은 도 3a 및 도 3b와 같다. 여기서, 도 3a 는 목표속도 와 출력속도 를 나타내고, 도 3b는 속도추적오차(-)를 나타내며, 도 3b와 같이 본 발명에 따른 서보모터의 제어 시스템은 양호한 속도추적성능을 보여주고 있다.
종래기술에 따른 서보모터의 제어 시스템의 속도 추적성능은 도 3c 및 도 3d와 같다. 여기서, 도 3c 는 목표속도 와 출력속도 를 나타내고, 도 3d는 속도추적오차(-)를 나타내며, 도 3d와 같이 종래기술에 따른 서보모터의 제어 시스템은 ±5 (rad/sec)의 속도추적성능을 보여주고 있다.
이상과 같이, 본 발명에서는 전체시스템을 안정하게 하는 피드백제어부와 기준명령에 대한 응답특성을 제어하는 피드포워드제어부를 결합한 형태를 갖는 서보모터의 제어 시스템을 제공하고 있으며, 따라서 전체시스템을 안정화함과 동시에 외란을 효과적으로 억제할 수 있는 효과가 있다.
본 발명이 속하는 기술분야의 통상의 지식을 가진 자는 본 발명이 그 기술적 사상이나 필수적인 특징을 변경하지 않고서 다른 구체적인 형태로 실시될 수 있다는 것을 이해할 수 있을 것이다. 그러므로 이상에서 기술한 실시예은 모든 면에서 예시적인 것이며 한정적이 아닌 것으로 이해해야만 한다. 본 발명의 범위는 상기 상세한 설명보다는 후술하는 특허청구의 범위에 의하여 나타내어지며, 특허청구의 범위의 의미 및 범위 그리고 그 균등 개념으로부터 도출되는 모든 변경 또는 변형된 형태가 본 발명의 범위에 포함되는 것으로 해석되어야 한다.
20 : 서보모터
22 : 피드백제어부
24 : 피드포워드제어부
26 : 가산부
22 : 피드백제어부
24 : 피드포워드제어부
26 : 가산부
Claims (4)
- 서보모터(20)를 제어하기 위한, 서보모터의 제어 시스템으로서,
서보모터(20)의 전달함수()는
... (1)
로 나타내고(여기서, J는 서보모터(20)와 부하의 총 관성모멘트, B는 점성마찰계수를 나타내고, s는 라플라스연산자)로서 복소변수임),
서보모터(20)의 회전속도()는
... (2)
로 나타내고(여기서, 는 서보모터(20)의 발생토크로서 제어입력에 해당되고, 는 서보모터(20)에 인가되는 외란토크를 나타내며, 후단의 감산기에 의해 에서 가 감산됨)
시스템의 모델 파라미터 오차()와 출력오차()는 각각
... (3)
... (4)
... (5)
로 나타내고(여기서, 는 목표속도이고, 는 출력속도를 나타내고, Jn, Bn은 각각 총 관성모멘트(J)와 점성마찰계수(B)에 대한 공칭 값을 나타냄),
가산부(26)에 의해, 전체시스템의 안정도와 외란억제 성능을 높이는 피드백제어부(22)()와 목표속도()에 대한 응답특성을 제어하는 피드포워드제어부(24)()를 결합한 형태로서,
서보모터(20)의 발생토크는
... (6)
로 나타내고,
피드백제어부(22)()와 피드포워드제어부(24)()는
... (7)
... (8)
로 표현되고(여기서, 는 외란 억제필터함수임),
는
...(9)
의 형태를 갖도록 선택되며,
여기서,는 외란선택함수로서, 노치필터의 형태를 가지고,
인 경우, 이므로,
전술한 식들로부터, 내부상태를 나타내는 변수들(, , )은
...(10-1)
...(10-2)
...(10-3)
이고, 이때 함수 는 임의로 선택할 수 있는 안정한 자유함수이고, 서보모터의 전달함수 와 서보모터 모델 파라미터 는 최소 위상 함수이므로, 시스템 내부의 모든 전달함수들은 안정한 것을 특징으로 하는 서보모터의 제어 시스템. - 삭제
- 삭제
- 삭제
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020190113795A KR102085047B1 (ko) | 2019-09-16 | 2019-09-16 | 서보모터의 제어 시스템 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020190113795A KR102085047B1 (ko) | 2019-09-16 | 2019-09-16 | 서보모터의 제어 시스템 |
Publications (1)
Publication Number | Publication Date |
---|---|
KR102085047B1 true KR102085047B1 (ko) | 2020-03-05 |
Family
ID=69803880
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020190113795A KR102085047B1 (ko) | 2019-09-16 | 2019-09-16 | 서보모터의 제어 시스템 |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102085047B1 (ko) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113093551A (zh) * | 2021-04-08 | 2021-07-09 | 中国科学院光电技术研究所 | 一种非最小相位系统的双滤波器扰动观测器设计方法 |
CN113359485A (zh) * | 2021-07-27 | 2021-09-07 | 安徽工业大学 | 一种电液伺服系统输出反馈预设性能控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100218930B1 (ko) | 1996-12-20 | 1999-09-01 | 윤종용 | 서보모터의 속도제어방법 및 속도제어장치 |
JP2005215842A (ja) * | 2004-01-28 | 2005-08-11 | Yaskawa Electric Corp | サーボ制御装置 |
JP2006121876A (ja) * | 2004-10-25 | 2006-05-11 | Yaskawa Electric Corp | サーボモータ制御装置 |
JP2006254630A (ja) * | 2005-03-11 | 2006-09-21 | Yaskawa Electric Corp | モータ制御装置およびその制御方法 |
JP2008259271A (ja) * | 2007-04-02 | 2008-10-23 | Yaskawa Electric Corp | サーボ制御装置と定数自動調整方法 |
JP2009042985A (ja) * | 2007-08-08 | 2009-02-26 | Sumitomo Heavy Ind Ltd | モータ制御装置及びモータ制御方法 |
JP2015198531A (ja) * | 2014-04-02 | 2015-11-09 | カルソニックカンセイ株式会社 | 電動車両の駆動力制御装置 |
JP2017220971A (ja) * | 2016-06-03 | 2017-12-14 | 日産自動車株式会社 | 電動車両の制御方法、及び、制御装置 |
-
2019
- 2019-09-16 KR KR1020190113795A patent/KR102085047B1/ko active IP Right Grant
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100218930B1 (ko) | 1996-12-20 | 1999-09-01 | 윤종용 | 서보모터의 속도제어방법 및 속도제어장치 |
JP2005215842A (ja) * | 2004-01-28 | 2005-08-11 | Yaskawa Electric Corp | サーボ制御装置 |
JP2006121876A (ja) * | 2004-10-25 | 2006-05-11 | Yaskawa Electric Corp | サーボモータ制御装置 |
JP2006254630A (ja) * | 2005-03-11 | 2006-09-21 | Yaskawa Electric Corp | モータ制御装置およびその制御方法 |
JP2008259271A (ja) * | 2007-04-02 | 2008-10-23 | Yaskawa Electric Corp | サーボ制御装置と定数自動調整方法 |
JP2009042985A (ja) * | 2007-08-08 | 2009-02-26 | Sumitomo Heavy Ind Ltd | モータ制御装置及びモータ制御方法 |
JP2015198531A (ja) * | 2014-04-02 | 2015-11-09 | カルソニックカンセイ株式会社 | 電動車両の駆動力制御装置 |
JP6243279B2 (ja) * | 2014-04-02 | 2017-12-06 | カルソニックカンセイ株式会社 | 電動車両の駆動力制御装置 |
JP2017220971A (ja) * | 2016-06-03 | 2017-12-14 | 日産自動車株式会社 | 電動車両の制御方法、及び、制御装置 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113093551A (zh) * | 2021-04-08 | 2021-07-09 | 中国科学院光电技术研究所 | 一种非最小相位系统的双滤波器扰动观测器设计方法 |
CN113093551B (zh) * | 2021-04-08 | 2022-08-02 | 中国科学院光电技术研究所 | 一种非最小相位系统的双滤波器扰动观测器设计方法 |
CN113359485A (zh) * | 2021-07-27 | 2021-09-07 | 安徽工业大学 | 一种电液伺服系统输出反馈预设性能控制方法 |
CN113359485B (zh) * | 2021-07-27 | 2022-08-16 | 安徽工业大学 | 一种电液伺服系统输出反馈预设性能控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5120654B2 (ja) | サーボ制御装置 | |
KR101460463B1 (ko) | 모터 제어 장치 | |
KR102085047B1 (ko) | 서보모터의 제어 시스템 | |
JP3084928B2 (ja) | 電動機の位置制御装置 | |
JP5273575B2 (ja) | 電動機制御装置 | |
US9285782B2 (en) | Motor control device | |
TW201440415A (zh) | 馬達控制裝置 | |
JP5652678B2 (ja) | 電動機制御装置 | |
EP2434356B1 (en) | Integrated upsampler and filtering for multi-rate control of an electro-mechanical actuator | |
JPWO2008075558A1 (ja) | 位置制御装置 | |
JP4992909B2 (ja) | サーボ制御装置とその制御方法 | |
US6212540B1 (en) | Filter circuit | |
JP7039176B2 (ja) | 遅れ補償器のフィルタの設計方法、及びそれを用いたフィードバック制御方法、モータ制御装置 | |
JP6930868B2 (ja) | サーボ制御装置、サーボ制御方法及びシステム | |
JP5413036B2 (ja) | モータ制御装置及びモータ制御システム | |
JP2008097334A (ja) | サーボ制御装置とその制御方法 | |
KR20140126851A (ko) | 전류 제한 장치가 있는 서보 제어기의 무튜닝 비선형 제어 방법 | |
JP2018116600A (ja) | モータ制御装置 | |
WO2014002435A1 (ja) | 馬力制限装置及び馬力制限方法 | |
JP2004064949A (ja) | 超音波モータの位置制御方式 | |
JPH0635506A (ja) | 可変構造制御方法 | |
JPH086603A (ja) | サーボ系の調整方法及びそのサーボ制御装置 | |
US20030195643A1 (en) | Method and apparatus for acceleration limiting a position command for motion control | |
KR20210103164A (ko) | 전동기 위치제어장치 | |
JP5361507B2 (ja) | 保護機能を備えた電動機制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AMND | Amendment | ||
E601 | Decision to refuse application | ||
X091 | Application refused [patent] | ||
AMND | Amendment | ||
X701 | Decision to grant (after re-examination) | ||
GRNT | Written decision to grant |