KR101553764B1 - 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법 - Google Patents
가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법 Download PDFInfo
- Publication number
- KR101553764B1 KR101553764B1 KR1020140014715A KR20140014715A KR101553764B1 KR 101553764 B1 KR101553764 B1 KR 101553764B1 KR 1020140014715 A KR1020140014715 A KR 1020140014715A KR 20140014715 A KR20140014715 A KR 20140014715A KR 101553764 B1 KR101553764 B1 KR 101553764B1
- Authority
- KR
- South Korea
- Prior art keywords
- input
- acceleration
- impulse
- vector
- molding machine
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16Z—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS, NOT OTHERWISE PROVIDED FOR
- G16Z99/00—Subject matter not provided for in other main groups of this subclass
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Databases & Information Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Feedback Control In General (AREA)
Abstract
본 발명은 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법에 관한 것으로서, 기존의 linear 기반의 입력성형 방법을 활용할 때 도면 6 과같이 가속도제한 구동기를 거치면서 명령이 ramp형태로 왜곡되는 현상이 나타나며 이에 따라 시스템의 잔류변위저감 성능 및 강건성이 감소한다. 이와 같은 문제 해결을 위해 유연시스템의 운동에서 Pendulum System의 전달함수를 이용하여 페이저(phasor) 벡터의 형태로 나타낸 잔류변위에 대한 변위 벡터를 이용한 펄스 시점(tp)에 따른 각각의 임펄스 A1과 A2 및 A3에 대한 벡터 , , 를 구하고, 상기 세 벡터를 이용하여 상기 유연시스템의 운동 중의 잔류 진동 감소를 위한 임펄스의 시간 t2와 t3를 다음과 같은 식으로 계산하며, 상기와 같은 방법으로 유연시스템의 운동 후의 잔류 진동 감소를 위한 임펄스의 시간 t5와 t6를 다음과 같은 수학식으로 구하여, 상기 상기 임펄스 시간 t2, t3, t5 및 t6를 활용하여 가속도 제한 형태의 속도 명령인 ramped step과의 convolution을 통해 새로 성형된 명령을 입력 명령(command)으로 활용하여 가속도가 제한된 상기 유연시스템의 운동을 위한 잔류 진동을 감소하도록 한 것이다.
Description
본 발명은 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법에 관한 것으로서, 상세히는 기존의 linear 기반의 입력성형제어 방법을 활용할 때 도면 6 과같이 가속도제한 구동기를 거치면서 명령이 ramp형태로 왜곡되는 현상이 나타나며 이에 따라 시스템의 잔류변위의 저감성능이 감소한다. 이와 같은 문제 해결을 위해 상기 유연시스템의 운동에 따른 벡터를 이용하여 잔류변위의 감소를 위한 임펄스 시간을 계산하고, 이를 상기 유연시스템의 운동을 위한 입력 명령(command)에 활용하도록 한 가속도 제한된 유연시스템에 대한 강건 입력성형제어 방법에 관한 것이다.
산업 현장에서 이동과 위치에 관한 제어는 작업 효율을 높일 수 있고 안전성을 확보할 수 있어 상당히 중요하다. 이러한 측면에서 입력성형방법은 이동과 이동이 끝난 직후의 변위를 저감하기에 매우 효과적인 방법이다. 하지만 산업현장의 경우 외부적인 요소들로 인하여 시스템의 변수 추정에 어려움이 있으며 이에 따라 잔류변위 저감의 성능 감소가 일어난다. 또한 구동모터는 대부분 모터 드라이브나 모터 자체의 성능으로 인하여 최대 가속도가 제한되어 있는 경우가 많다. 따라서 이동시에 최대 가속도나 모터 드라이브의 세팅으로 인한 제한된 가속도는 ramp형태의 속도 프로파일을 보이기 때문에 기존의 이론적인 square 형태의 속도 프로파일을 이용한 입력성형방법의 경우 잔류변위가 발생하고, 또한 정밀한 제어가 어려워지기 때문에 실제 산업 현장에서는 입력 성형시에 구동기의 가속도 제한을 고려함과 동시에 강건한 입력성형방법이 요구된다.
산업 현장의 입력 성형방법들은 설계변수에 대하여 강건성을 요구하게 되었으며 그에 관한 연구들이 진행되어 왔다. 고유 주파수의 오차에 대한 강건성을 위하여 Singer는 기존의 임펄스 두 개를 이용한 Zero Vibration(ZV) 입력성형기의 고유 주파수를 미분한 식을 이용한 임펄스 3개 형태의 Zero Vibration Derivate(ZVD) 입력성형기를 개발 하였다. 하지만 이 솔루션의 경우 역시 linear system 이론을 기반으로 하고 있어 실제의 산업현장에서는 성능 감소가 일어난다.
시스템의 비선형성 역시 산업현장의 잔류변위 감소 성능 향상 및 정확도 향상을 위해 몇몇의 연구가에 의해 연구되고 있다. Sorenson은 saturation, backlash, rate limiting, dead zone의 비선형성으로 인한 입력성형기의 성능감소에 대하여 convolution 방법을 이용한 입력성형기의 성능분석방법을 제시하였다. Kinceler와 Meckl는 비선형시스템(예, robot manipulator)의 point-to-point motion을 위해 inverse dynamics 및 open-loop optimal formulation을 통해 time-varying 고유 주파수에 대한 입력 명령(command)을 생성하는 방법을 개발하고, 에너지 소비 및 computational burden을 평가하였으며, 매개변수 불확정성에 대한 제어성능 저감으로 매개변수 평가의 필요성을 언급하였다.
Gorinevsky와 Vukovich는 nonlinear dynamics으로 표시되는 회전 우주 유연구조물의 잔류변위를 저감하기 위해 collocated feedback controller와 feedforward control 방법을 동시에 활용하는 제어방법을 제시하였다. 여기서, feedforward control command는 spline 함수를 활용한 iterative optimization 방법으로 입력 명령(command)을 설계하였다. Danielson은 nonlinear dynamics를 kinematic formulation을 통하여 구한 linearized system에 대해 기존의 입력성형 방법들을 평가하였다.
구동기와 관련한 성능저하에 관한 연구들을 제안한 Lawrence는 선형 입력성형제어기에 비선형 구동기의 영향으로 발생되는 가속도 및 감속도에 의한 시간지연을 고려하여 잔류변위 저감 성능을 개선한 비선형 입력성형제어기를개발 하였다. 산업 현장의 비선형 구동기의 동적특성을 고려한 입력성형제어기 설계에 필요한 정확한 변수가 필요하다. Danielson은 구동기의 가속도 제한을 고려하여 최적화 방법을 제시하였다. 하지만 최적화 방법은 실제 시스템에 적용하는데 계산시간이 많이 걸리기 때문에 실제 적용에는 다소 어려움이 있다.
가속도 제한은 실제 산업현장의 구동기는 드라이브에 의해 가속도 및 감속도의 제한을 두고 있으며 일반적인 구동기의 동특성을 가장 간단히 근사화한 형태이다.
본 발명은 상기한 바와 같은 제반 문제점을 개선하기 위해 안출된 것으로서, 그 목적은 구동기의 동특성 중 가속도 제한을 고려하여 유연시스템의 정확한 입력성형 제어방법을 제시한 것으로, Pendulum system을 통한 응답식을 통해 phasor 형태의 벡터로 계산하여 나타내고, 이렇게 계산된 phasor vector를 vector diagram approach을 활용하여, 유연시스템의 임펄스 크기와 시간을 구하여 가속도제한으로 인한 ramped step과 convolution을 통해 얻어진 입력 명령(command)을 유연시스템에 적용하도록 한 Acceleration Limits Zero Vibration Derivate(ALZVD) 입력성형기의 입력성형 제어방법을 제공함에 있다.
다른 목적은 numerical simulation을 통해 입력성형기의 잔류변위와 강건성의 성능평가를 하고, 입력성형기들을 mini-bridge crane을 통한 감도, 잔류변위 실험 결과를 통해 성능 검증을 하도록 한 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법을 제공함에 있다.
상기한 바와 같은 목적을 달성하기 위해 본 발명의 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법은, 유연시스템의 운동에서 Pendulum System의 전달함수를 이용하여 페이저(phasor) 벡터의 형태로 나타낸 잔류변위에 대한 변위 벡터를 이용한 펄스 시점(tp)에 따른 각각의 임펄스 A1과 A2 및 A3에 대한 벡터 , , 를 구하고, 상기 세 벡터를 이용하여 상기 유연시스템의 운동 중의 잔류 진동 감소를 위한 임펄스의 시간 t2와 t3를 다음과 같은 수학식으로 계산하며, 상기와 같은 방법으로 유연시스템의 운동 후의 잔류 진동 감소를 위한 임펄스의 시간 t5와 t6를 다음과 같은 수학식으로 구하여,
상기 t2, t3, t5 및 t6를 가속도가 제한된 상기 유연시스템의 운동을 위한 입력 명령(command)에 활용하여 잔류 진동을 감소하도록 한 것을 특징으로 하고 있다.
를 통해 구하는 것이 바람직하다.
인 것이 바람직하다.
또 상기 t2, t3, t5 및 t6를 나타내는 ti가 항상 실수값을 가지도록 상기 t3, t6의 식에서 cos-1 항은 -1과 1 사이의 값을 가지도록 하는 것이 바람직하다.
또 다음의 수학식,
에 의해 임펄스의 간격이 원하는 속도에서 가속도(속도 감소시에는 감속도)로 나눈 값보다 크도록 하는 것이 바람직하다.
본 발명의 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법에 의하면, 입력성형제어기의 성능 평가를 위해 설계변수에 대한 잔류변위의 크기와 modeling error에 대한 감도를 기존의 linear 기반의 입력성형기와 비교하였을 때 성능 향상을 보였으며, 감도 곡선(sensitivity curve) 역시 기존의 입력성형기보다 modeling error에 강건함을 보여주는 효과가 있다.
이로 인해 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기는 잔류진도의 감소가 향상되는 효과가 있다.
도 1은 Flexible System 중의 하나인 Pendulum System의 개념도
도 2는 ZV 입력성형기의 속도의 분리 개념도
도 3은 tp에서 ZVD 입력성형기의 잔류변위 그래프
도 4는 ZVD Short 명령(command)의 convolution process
도 5는 ZVD Long 명령(command)의 convolution process
도 6은 ZVD 입력성형기의 왜곡된 명령(command)으로 인한 시스템 응답
도 7은 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 속도의 분리 개념도
도 8은 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 벡터 다이어그램
도 9는 κa와 κd에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 잔류변위의 컴퓨터 시뮬레이션을 나타내는 도면
도 10은 κa와 tp에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 잔류변위의 컴퓨터 시뮬레이션을 나타내는 도면
도 11은 κa와 κd에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 감도의 컴퓨터 시뮬레이션을 나타내는 도면
도 12는 κa와 L에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 감도의 컴퓨터 시뮬레이션을 나타내는 도면
도 13은 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 시험대를 위한 Mini-Bridge Crane
도 14는 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기에 의한 속도 에러의 실험그래프
도 15는 기존의 ZVD와 본 발명에 따른 ALZVD 입력성형기의 속도 명령(command)을 나타내는 그래프
도 16은 기존의 ZVD와 본 발명에 따른 ALZVD 입력성형기의 Deflection Response를 나타내는 그래프
도 17은 L/Lm에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 감도를 나타내는 그래프
도 18은 tp에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 잔류변위를 나타내는 그래프
도 19는 κa/κam에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 감도를 나타내는 그래프
도 2는 ZV 입력성형기의 속도의 분리 개념도
도 3은 tp에서 ZVD 입력성형기의 잔류변위 그래프
도 4는 ZVD Short 명령(command)의 convolution process
도 5는 ZVD Long 명령(command)의 convolution process
도 6은 ZVD 입력성형기의 왜곡된 명령(command)으로 인한 시스템 응답
도 7은 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 속도의 분리 개념도
도 8은 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 벡터 다이어그램
도 9는 κa와 κd에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 잔류변위의 컴퓨터 시뮬레이션을 나타내는 도면
도 10은 κa와 tp에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 잔류변위의 컴퓨터 시뮬레이션을 나타내는 도면
도 11은 κa와 κd에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 감도의 컴퓨터 시뮬레이션을 나타내는 도면
도 12는 κa와 L에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 감도의 컴퓨터 시뮬레이션을 나타내는 도면
도 13은 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 시험대를 위한 Mini-Bridge Crane
도 14는 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기에 의한 속도 에러의 실험그래프
도 15는 기존의 ZVD와 본 발명에 따른 ALZVD 입력성형기의 속도 명령(command)을 나타내는 그래프
도 16은 기존의 ZVD와 본 발명에 따른 ALZVD 입력성형기의 Deflection Response를 나타내는 그래프
도 17은 L/Lm에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 감도를 나타내는 그래프
도 18은 tp에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 잔류변위를 나타내는 그래프
도 19는 κa/κam에서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 감도를 나타내는 그래프
이하, 본 발명에 따른 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법의 바람직한 실시예를 첨부한 도면을 참조로 하여 상세히 설명한다. 본 발명은 이하에서 개시되는 실시예에 한정되는 것이 아니라 서로 다른 다양한 형태로 구현될 수 있으며, 단지 본 실시예는 본 발명의 개시가 완전하도록 하며 통상의 지식을 가진 자에게 발명의 범주를 완전하게 알려주기 위하여 제공되는 것이다.
본 발명에 따른 ALZVD의 입력성형 제어방법에 있어 기본적인 Flexible System 중 하나인 Pendulum System의 전달함수를 이용하여 정상상태 응답을 구하고, 응답을 phasor vector의 형태로 나타내어 잔류변위에 대한 변위 벡터를 나타낸다. 변위벡터는 본 발명의 입력성형 제어방법 따른 입력성형제어기의 설계시에 사용된다.
도 1과 같은 일반적인 pendulum의 모델에 대한 식을 Lagrange equation을 이용하여 계산하면 다음의 수학식 1과 같다.
응답 θ(s)는 다음의 수학식 4와 같이 시스템 입력 C(s)와 sine input으로 변형된 식으로 나타낸다.
상기 수학식 4를 steady state response으로 나타내면 다음의 수학식 5로 나타낼 수 있다.
벡터의 amplitude 와 phase로 나타내면, 수학식 6으로 나타난다.
도 2 (a)의 실제 속도 명령어를 임펄스 시간에 따라 개별적으로 나누면 도 2 (b)와 같다. 따라서 전체 속도명령어에 대한 함수는 다음의 수학식 7과 같이 나타낼 수 있다.
가속도 제한으로 인한 구동기 함수를 ramp함수로 표시하여 다음의 수학식 8과 같이 나타낼 수 있다.
여기서 κi는 감속도 또는 감속도로 양의 임펄스일 때는 κa, 음의 임펄스일 때는 κd이다, Vd는 요구되는 속도값이다.
상기의 수학식 6과 수학식 8을 이용하여 Laplace transform한 후 벡터의 amplitude와 phase로 나타내면 다음의 수학식 9와 같다.
이 벡터는 임펄스로 인한 pendulum에 정상상태 응답에 대한 변위의 크기와 위상각을 나타낸다. 다음의 본 발명의 입력성형 제어방법에 따른 입력성형제어기 개발시에 상기의 수학식 9를 이용한 vector diagram approach를 이용하여 ALZVD(Acceleration Limits Zero Vibration Derivate) 입력성형기를 제시한다.
다음은 본 발명에 따른 가속도 제한 입력성형 제어방법에 따른 입력성형기에 대해 설명하도록 한다.
기존의 ZVD(Zero Vibration Derivate) 입력성형기의 가속도 제한의 경우 성능 향상을 위해 상기에서 계산된 가속도제한의 phasor vector를 vector diagram approach를 이용하여 exact shapers를 계산한다.
기존의 가속도 제한을 고려한 ZVD 입력성형기에 있어, 입력성형기의 명령은 일반적으로 임펄스 시퀀스와 step입력의 convolution을 통해 생성된다. 하지만 이 명령은 pulse duration(tp)에 따라 short과 long 그리고 interference 명령(command) 세 가지로 분류된다. 따라서 세 가지의 명령(command)을 구분하고 ZVD 형태의 입력성형기를 개발한다.
도 3 은 tp에 따라 ZVD의 잔류변위를 나타내었다. 도 3에 도시한 바와 같이 그래프 상에서 3가지의 구간으로 구분된다. 먼저 I 구간은 short 명령(command) 구간으로 실제 잔류변위가 발생하지 않고 있다. II 구간은 Interference 명령(command) 구간으로 명령(command)이 잔류변위를 크게 발생하고 있다. III 구간은 약간의 변위가 발생되고 있으며 다른 구간과 달리 tp에 따라 주기적인 특성을 보인다는 것이 특징이다.
도 4는 ZVD의 short 명령(command)을 나타내고 있다. ZVD short 명령(command)은 펄스입력과 임펄스 시퀀스의 convolution을 통해 생성되며 세 개의 펄스 형태로 구성된다. 이와 같은 short 명령(command)이 사용되기 위해서는 다음의 수학식 10에서 tp가 다음과 같은 조건을 만족해야한다.
ZVD interference 명령(command)은 tp가 short 커맨드와 long 명령(command) 사이에 위치할 경우 발생된다. 따라서 ZVD interference 명령(command)이 사용되기 위해서는 다음의 수학식 11 및 24에서 tp가 다음과 같은 조건을 만족해야한다.
ZVD interference 명령(command)은 명령(command)이 정상상태에 도달하지 않기 때문에 실제 약간의 잔류 변위를 발생시킨다.
도 5는 ZVD의 long 명령(command)을 나타내고 있다. ZVD long 명령(command)은 ramp up과 ramp down에 따라 각기 다른 펄스입력과 임펄스 시퀀스의 convolution을 통해 생성된다. 이와 같은 long 명령(command)이 사용되기 위해서는 다음의 수학식 12에서 tp가 다음과 같은 조건을 만족해야한다.
다음은 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기에 대해서 설명한다.
기존의 ZVD 입력성형기를 가속도 제한이 고려된 solution으로 제시한다. 도 6은 기존의 linear 기반의 ZVD 입력성형기를 활용할 때 가속도제한 구동기를 거치면서 명령이 ramp형태로 왜곡 되는 현상이 나타나며 이에 따라 시스템의 잔류변위가 발생하고 있음을 보여준다.
본 발명에서는 가속도제한 및 강건성을 고려한 입력성형제어방법, 즉, 임펄스 크기에 따른 시간을 결정한다. t1을 0, 그리고 ZVD 입력성형기와 같은 임펄스 크기를 갖도록 A1과 A3를 0.25, A2를 0.5 로 정한다. 도 7 (a)의 실제 속도 명령어를 임펄스 시간에 따라 개별적으로 나누면 도 7 (b)와 같다. 따라서 상기의 수학식 9를 이용하여 각각의 임펄스에 대한 phasor 벡터 , , 는 다음의 수학식 13 내지 15와 같이 표현된다.
상기의 세 벡터를 이용하여 도 8과 같이 나타내고 임펄스의 시간 t2와 t3를 계산하기 위하여 vector diagram approach에서 코사인 법칙을 활용하여 다음의 수학식 19 및 20에 의해 임펄스의 시간을 결정한다.
유연시스템의 stop motion의 시작 시간은 tp에 의해 결정되며 κa대신 κd를 이용하여 계산하면 된다. 따라서 stop motion의 임펄스의 시간은 다음의 수학식 21 및 22로 얻어진다.
본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 경우 ti가 항상 실수값을 가져야 한다. 따라서 cos-1 항의 괄호가 -1∼1 사이의 값을 가져야 한다. 또한 다음의 수학식 23에서와 같이 임펄스의 간격이 원하는 속도에서 가속도(속도 감소시에는 감속도)로 나눈 값보다 커야 된다. 그 이유는 이 조건을 만족하지 못할 경우 속도 프로파일이 원하는 속도까지 도달하지 못하여 명령(command)이 정상상태에 도달하지 못한다.
본 발명의 가속도 제한 입력성형 제어방법에 따른 입력성형기의 평가는 다음과 같이 이루어진다.
MATLAB®을 이용하여 앞에서 개발한 각각의 입력성형기에 대하여 numerical simulation을 진행한다. 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 시뮬레이션을 통해 기존의 ZVD 입력성형기의 성능 비교를 한다. 시뮬레이션의 기본적인 변수들의 값은 다음과 같은 표 1로 설정하였다.
변수 | L | κa | κd | Vd | tp |
값 | 0.8m | 0.5m/sec2 | 1m/sec2 | 0.2m/sec | 3.5sec |
상기의 설정된 값은 κa와 κd의 값이 같을 경우 linear 솔루션과 같은 결과를 가지게 되므로 가속도와 감속도의 값을 서로 다른 값으로 설정하였고, 일반적으로 가속도보다 감속도가 크기 때문에 κd를 κa보다 작게 나타내었으며, 실제 모터의 가속도와 감속도는 최대 속도의 2배 이상의 값을 가진다. 이 값을 이용한 simulation은 κa, κd, tp에 대하여 잔류변위 저감 성능과 설계변수 κa, κd, L에 대한 강건성을 기존의 linear 기반의 입력성형기와 비교하였다.
본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기를 분석하면 다음과 같다.
본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기의 numerical simulation을 진행한다. 시뮬레이션에 사용된 변수 값은 상기의 표 1과 같이 κa=0.5m/s2, κd=1m/s2, =3.5sec, L=0.8m, =0.2m/s로 설정하였으며 실험에 따라 L, tp, κa를 변경하면서 평가를 하였다.
도 9는 κa와 κd에 대하여 본 발명의 ALZVD와 기존의 ZVD 입력성형기의 잔류 변위의 저감 성능을 비교한 그림이다. 변수 설정은 표 1과 동일하며 κa와 κd의 범위를 0.3∼5 m/sec2의 영역에서 진행하였다. 본 발명의 ALZVD 입력성형기의 경우 전체적인 영역에서의 잔류 변위가 0이지만 기존의 ZVD 입력성형기의 경우 잔류변위가 그래프 상에서 0에서 0.73cm정도로 발생한다. κa와 κd가 같은 값을 가질 경우 기존의 ZVD 입력성형기의 잔류변위가 없어지고 있다. 이는 κa와 κd가 같을 경우 기존의 ZVD와 본 발명의 ALZVD 입력성형기의 임펄스의 시간이 동일한 값을 갖게 되어 잔류변위가 발생하지 않는다. 또한 기존의 ZVD 입력성형기의 경우 κa와 κd의 값이 커질수록 잔류변위가 줄어드는 현상을 보인다. 이는 κa와 κd의 값이 커질수록 linear 구동기와 유사한 구동을 하기 때문에 그 오차가 줄어 잔류변위 자체도 줄어들게 된다.
도 10은 κa와 tp에 대하여 본 발명의 ALZVD와 기존의 ZVD 입력성형기의 잔류 변위 나타내고 있다. 변수 설정은 표 1과 동일하며 κa 범위를 0.3∼5, tp의 범위를 2∼5(sec)로 설정하여 진행하였다. 본 발명의 ALZVD 입력성형기의 경우 전체적인 영역에서의 잔류 변위가 0이지만 기존의 ZVD 입력성형기의 경우 잔류변위가 그래프 상에서 약 0.2∼1cm정도로 발생한다. tp에 따라 기존의 ZVD 입력성형기의 변위가 주기적으로 반복되고 있다. 이는 유연시스템의 stop motion의 시작 지점의 초기 변위값이 0이 아니므로 tp값에 따라 잔류변위의 크기가 주기적인 특성을 보인다.
도 11은 κa와 κd에 대하여 본 발명의 ALZVD와 기존의 ZVD 입력성형기의 강건성을 나타내고 있다. 변수 설정은 상기의 표 1과 동일하며 κam을 0.5, κdm을 1로 설정하고 진행하였다. 본 발명의 ALZVD 입력성형기의 경우 전체적인 영역에서의 잔류 변위가 약 0.2 이하로 기존의 ZVD 입력성형기보다 낮게 나타나고 있다. 또한 κa/κam와 κd/κdm의 값이 1일 때 잔류 변위의 크기가 0으로 낮게 나타나고 있다. κdm의 경우 κam보다 값의 크기가 1로 κa 보다 크기 때문에 보다 linear 형태에 가까워 잔류변위에 작은 영향을 미치고 있다.
도 12는 κa와 줄 길이 L에 대하여 본 발명의 ALZVD와 기존의 ZVD 입력성형기의 강건성을 나타내고 있다. 변수 설정은 상기의 표 1과 동일하며 κam을 0.5, L을 0.8로 설정하고 진행하였다. 본 발명의 ALZVD 입력성형기의 경우 전체적인 영역에서의 잔류 변위가 기존의 ZVD 입력성형기보다 낮게 나타나고 있다. 또한 κa/κam와 κd/κdm의 값이 1일 때 잔류 변위의 크기가 0으로 낮게 나타나고 있다. 이는 가속도 제한 구동기의 경우 본 발명의 ALZVD 입력성형기가 보다 강건함을 나타낸다.
Simulation을 통해 잔류변위의 크기와 각각의 변수들의 강건성을 평가한 결과 기존의 이상적인 입력성형기와 비교하여 본 발명의 입력성형 제어방법에 따른 입력성형기의 잔류변위가 줄어들고 제어가 가능해졌으며 강건성 역시 증가함을 보인다. 따라서 본 발명의 입력성형 제어방법에 따른 ALZVD 입력성형기가 기존의 ZVD 입력성형기보다 가속도 제한의 경우에 성능이 향상되었다.
본 발명의 가속도 제한된 입력성형 제어방법에 따른 입력성형기를 다음과 같이 실험장치를 통해 검증하도록 한다.
본 발명의 입력성형 제어방법에 따라 개발된 입력성형제어기들의 잔류변위 저감 성능을 실험적으로 검증하기 위해 도 13의 실험 장치를 사용하였다. mini-bridge crane은 Siemens PLC(programmable logic controller)로 구성되어 있고, 이론 검증을 위해 시스템 구동을 위한 pendant와 실험 data를 입출력할 수 있게 프로그램을 개발하였다. 실험장치의 구동에는 절대 엔코더를 사용하는 3개의 servo motor를 사용하였고 payload의 흔들림을 측정하기 위해 Siemens VS720x 계열의 intelligent vision sensor를 사용하였다.
가속도 제한이 고려된 속도 프로파일을 upload를 통해 실험하였으며, upload 하는 속도 프로파일은 ramp 함수를 이용하여 만들고, 이를 motion control할 수 있는 실험장치의 모터 드라이버의 세팅을 모터의 가속도와 감속도를 실험장치의 최대값인 3.6e+008rad/sec로 모터 세팅을 하여 생성된 프로파일을 잘 추적할 수 있도록 하였다.
도 14는 실제 ZVD 입력성형기를 이용하여 가속도 제한 속도 프로파일을 입력한 후 입력한 속도 프로파일과 실제 모터의 속도값을 비교하였다. 실제 나타난 error plot의 경우와 같이 최대 ±2cm/sec2의 오차는 있으나 명령된 속도 프로파일을 허용범위 안에서 추적하고 있다. intelligent vision sensor를 통해 payload 변위측정을 하였고, MATLAB® software를 통해 측정된 변위를 분석했다. 실험은 κa=0.5m/sec2, κd=1m/sec2, =3.5sec, L=0.8m, =0.2m/s로 설정하였으며 start-stop motion을 통해 케이블 길이 또는 tp을 바꿔가며 잔류변위를 검증하였다.
실험 결과는 다음과 같다.
ramp 형태의 속도 프로파일을 생성하여 mini-bridge crane을 활용해 실험을 진행하였다. 진행시의 변수값은 시뮬레이션과 동일하게 κa=0.5m/s2, κd=1m/s2, =3.5sec, L=0.8m, =0.2m/s로 설정하였으며 실험에 따라 L, tp, κa를 변경하면서 실험을 진행하였다.
도 15는 실험에 사용된 속도 프로 파일을 나타내고 있다. 실제적으로 명령(command)의 임펄스의 크기는 같지만 시간의 차이만 나타난다. 실제 모터의 속도를 나타내기 때문에 이론적인 속도와 비교하여 약간의 오차가 있지만 이론적인 속도의 ±2cm/sec2 이내이다.
도 16은 실험을 통해 얻은 Deflection Response를 나타내고 있다. 잔류변위가 약간 발생하는 이유는 이론적으로는 잔류변위가 0의 값을 가지지만 실제 시스템에서의 경우는 외란이나 속도 프로파일의 이론적이 형태로 구동하기는 힘들기 때문이다. 과도 변위의 크기 변화는 거의 차이가 없으나 70%의 잔류변위의 저감의 성능 향상을 보이고 있음을 알 수 있다.
도 17은 줄 길이 L에 대한 Modeling error에 대한 감도 곡선이다. 실험변수 값은 κa=0.5m/s2, κd=1m/s2, =3.5sec, L=0.8m, =0.2m/s로 설정하였다. 기존의 ZVD 입력성형기는 잔류변위가 발생하고 있다. 하지만 본 발명의 ALZVD 입력성형기의 경우 잔류변위가 0으로 기존의 ZVD 입력성형기보다 강건함을 알 수 있다.
도 18은 tp에 대한 잔류변위를 나타낸다. 실험변수 값은 κa=0.5m/s2, κd=1m/s2, L=0.8m, =0.2m/s로 설정하였다. 기존의 ZVD 입력성형기 역시 잔류변위가 발생하고 있다. 본 발명의 ALZVD 입력성형기는 잔류변위가 0.5cm 이하로 거의 발생하지 않아 기존의 ZVD 입력성형기보다 높은 성능을 보이고 있다.
도 19는 가속도 제한의 중요 변수중 하나인 κa에 대하여 modeling error에 대한 강건성을 나타낸 것이다. 실험변수 값은 κa=0.5m/s2, κd=1m/s2, =3.5sec, L=0.8m, =0.2m/s로 설정하였다. 기존의 ZVD 입력성형기의 경우 잔류변위를 저감 하지 못하고 있으며 본 발명의 ALZVD 입력성형기의 경우는 κa/κam이 1인 경우 잔류 변위가 0임을 보이고 있다. 따라서 본 발명의 ALZVD 입력성형기 이상적인 입력성형기보다 κa 대해서 강건하다.
이상과 같이 본 발명에 따른 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법에 대해서 예시한 도면을 참조로 하여 설명하였으나, 본 명세서에 개시된 실시예와 도면에 의해 본 발명이 한정되는 것은 아니며, 본 발명의 기술사상의 범위 내에서 당업자에 의해 다양한 변형이 이루어질 수 있음은 물론이다.
Claims (5)
- 유연시스템의 운동에서 Pendulum System의 전달함수를 이용하여 페이저(phasor) 벡터의 형태로 나타낸 잔류변위에 대한 변위 벡터를 이용한 펄스 시점(tp)에 따른 각각의 임펄스 A1과 A2 및 A3에 대한 벡터 , , 를 구하고,
상기 세 벡터를 이용하여 상기 유연시스템의 운동 중의 잔류 진동 감소를 위한 임펄스의 시간 t2와 t3를 다음과 같은 수학식으로 계산하며, 상기와 같은 방법으로 유연시스템의 운동 후의 잔류 진동 감소를 위한 임펄스의 시간 t5와 t6를 다음과 같은 수학식으로 구하여,
상기 t2, t3, t5 및 t6를 가속도가 제한된 상기 유연시스템의 운동을 위한 입력 명령(command)에 활용하여 잔류 진동을 감소하도록 한 것을 특징으로 하는 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법. - 제1항 내지 제3항 중 어느 한 항에 있어서,
상기 t2, t3, t5 및 t6를 나타내는 ti가 항상 실수값을 가지도록 상기 t3, t6의 식에서 cos-1 항은 -1과 1 사이의 값을 가지도록 한 것을 특징으로 하는 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020140014715A KR101553764B1 (ko) | 2014-02-10 | 2014-02-10 | 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020140014715A KR101553764B1 (ko) | 2014-02-10 | 2014-02-10 | 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법 |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20150093997A KR20150093997A (ko) | 2015-08-19 |
KR101553764B1 true KR101553764B1 (ko) | 2015-09-16 |
Family
ID=54057575
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020140014715A KR101553764B1 (ko) | 2014-02-10 | 2014-02-10 | 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법 |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR101553764B1 (ko) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102129874B1 (ko) * | 2018-07-13 | 2020-07-03 | 조선대학교산학협력단 | 램프형 구동기에 대한 선형기반의 입력성형기 |
KR102132689B1 (ko) * | 2019-01-31 | 2020-07-10 | 조선대학교산학협력단 | 1차형 구동기에 대한 선형기반의 강건 입력성형기 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000079583A (ja) | 1998-08-31 | 2000-03-21 | Tietech Co Ltd | アームの残留振動抑制方法 |
-
2014
- 2014-02-10 KR KR1020140014715A patent/KR101553764B1/ko active IP Right Grant
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000079583A (ja) | 1998-08-31 | 2000-03-21 | Tietech Co Ltd | アームの残留振動抑制方法 |
Non-Patent Citations (1)
Title |
---|
김득현 외 2인, '비선형 구동기의 변수추정을 통한 학습입력성형제어기', 대한기계학회논문집A 제35권 제11호 통권 제314호, 2011.11, pp.1423-1428 |
Also Published As
Publication number | Publication date |
---|---|
KR20150093997A (ko) | 2015-08-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101927495B (zh) | 一种冗余度机械臂重复运动规划方法 | |
JP6126152B2 (ja) | 曲線部を有する軌道を生成するロボットの軌道生成装置 | |
CN105700530A (zh) | 一种机器人关节空间传送带跟随运动的轨迹规划方法 | |
CN110480659B (zh) | 一种机器人操纵柔性工件运动时的振动控制装置及方法 | |
Akyüz et al. | Cascade fuzzy logic control of a single-link flexible-joint manipulator | |
CN105538327A (zh) | 一种基于突加度的冗余度机械臂重复运动规划方法 | |
KR102275302B1 (ko) | 입력 포화를 가지는 불확실한 전기 구동 로봇 시스템에 대해 pso를 이용한 rbfnn 기반 분산 적응 추종 시스템 | |
JP2006215807A (ja) | ロボット制御装置および制御方法 | |
KR101553764B1 (ko) | 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법 | |
Sancak et al. | Position control of a fully constrained planar cable-driven parallel robot with unknown or partially known dynamics | |
Veciana et al. | Minimizing residual vibrations for non-zero initial states: Application to an emergency stop of a crane | |
KR101575946B1 (ko) | 가속도 제한된 유연시스템에 대한 허용 잔류변위를 활용한 강건 입력성형 제어방법 | |
Suvilath et al. | IMC-based PID controllers design for a two-links SCARA robot | |
Amthor et al. | Asymmetric motion profile planning for nanopositioning and nanomeasuring machines | |
JP2018532608A (ja) | 位置および/または姿勢の離散手動入力の制御システムを備えるロボット | |
Ishak et al. | Real-time application of self-tuning PID in electro-hydraulic actuator | |
Ye et al. | Design and simulation of closed loop control system for large precision machining | |
KR101555774B1 (ko) | 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법 | |
Yovchev | Finding the optimal parameters for robotic manipulator applications of the bounded error algorithm for iterative learning control | |
KR101432432B1 (ko) | 가속도가 제한된 유연시스템의 과도변위 제한 및 잔류진동 저감을 위한 입력성형 제어기 및 이에 의한 과도변위 제한 및 잔류진동 저감방법 | |
KR101432431B1 (ko) | 가속도가 제한된 유연시스템의 on-off 입력성형 제어기 및 이에 의한 잔류진동 저감방법 | |
Inel et al. | Adaptive sliding mode control of a novel cable driven robot model | |
Hamad | Modelling and feed-forward control of robot arms with flexible joints and flexible links | |
Flash et al. | Communication: Discrete trajectory planning | |
Weng et al. | Design and Implementation of the SCARA Robot Arm |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant | ||
FPAY | Annual fee payment |
Payment date: 20190819 Year of fee payment: 5 |