KR101555774B1 - 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법 - Google Patents

가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법 Download PDF

Info

Publication number
KR101555774B1
KR101555774B1 KR1020140014713A KR20140014713A KR101555774B1 KR 101555774 B1 KR101555774 B1 KR 101555774B1 KR 1020140014713 A KR1020140014713 A KR 1020140014713A KR 20140014713 A KR20140014713 A KR 20140014713A KR 101555774 B1 KR101555774 B1 KR 101555774B1
Authority
KR
South Korea
Prior art keywords
acceleration
impulse
displacement
input
flexible system
Prior art date
Application number
KR1020140014713A
Other languages
English (en)
Other versions
KR20150093996A (ko
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 조선대학교산학협력단
Priority to KR1020140014713A priority Critical patent/KR101555774B1/ko
Publication of KR20150093996A publication Critical patent/KR20150093996A/ko
Application granted granted Critical
Publication of KR101555774B1 publication Critical patent/KR101555774B1/ko

Links

Images

Classifications

    • GPHYSICS
    • G16INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
    • G16ZINFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS, NOT OTHERWISE PROVIDED FOR
    • G16Z99/00Subject matter not provided for in other main groups of this subclass
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions

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)
  • Injection Moulding Of Plastics Or The Like (AREA)

Abstract

본 발명은 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법에 관한 것으로서, 유연시스템의 운동에서 기존의 linear 기반의 입력성형 방법을 활용할 때 도면 6 과같이 가속도제한 구동기를 거치면서 명령이 ramp형태로 왜곡 되는 현상이 나타나며 이에 따라 시스템의 잔류 및 과도변위의 저감성능이 감소한다. 이와 같은 문제 해결을 위해 Benchmark System의 운동방정식을 이용하여 페이저(phasor) 벡터의 형태로 나타낸 잔류변위에 대한 변위 벡터를 이용한 펄스 시점(tp)에 따른 각각의 임펄스 A1과 A2 및 A3에 대한 벡터
Figure 112014012621843-pat00106
,
Figure 112014012621843-pat00107
,
Figure 112014012621843-pat00108
를 구하고, 상기 세 벡터를 이용하여 상기 유연시스템의 운동 중의 잔류 진동 감소를 위한 임펄스의 시간 t2와 t3를 다음과 같은 식으로 계산하며, 상기와 같은 방법으로 유연시스템의 운동 후의 잔류 진동 감소를 위한 임펄스의 시간 t5와 t6를 구하여, 상기 임펄스 시간 t2, t3, t5 및 t6를 활용하여 가속도 제한 형태의 속도 명령인 ramped step과의 convolution을 통해 새로 성형된 명령을 입력 커맨드로 활용하여가속도 및 과도변위가 제한된 상기 유연시스템의 운동을 위한 잔류 진동을 감소하도록 한 것이다.

Description

가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법{Method of high speed input shaped control with flexible system limited acceleration and excess deplacement}
본 발명은 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법에 관한 것으로서, 상세히는 구동기 드라이브로 인한 가속도제한을 갖는 유연시스템의 경우 기존의 linear 기반의 입력성형제어 방법을 활용할 때 도면 6 과같이 가속도제한 구동기를 거치면서 명령이 ramp형태로 왜곡되는 현상이 나타나며 이에 따라 시스템의 잔류 및 과도변위의 저감성능이 감소한다. 이와 같은 문제 해결을 위해 상기 유연시스템의 운동에 따른 벡터를 이용하여 잔류변위의 감소를 위한 임펄스 시간을 계산하고, 이를 상기 유연시스템의 운동을 위한 입력 커맨드에 활용하도록 한 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형제어 방법에 관한 것이다.
우주구조물 또는 스페이스 셔틀과 같은 유연시스템이 운동을 할 때 구조물의 양쪽 끝단에서는 운동 후 잔류변위와 더불어 운동 중에는 큰 과도변위가 발생된다. 특히 과도변위는 위치제어와 장비의 수명 감소 등에 영향을 주고 있다. 이러한 잔류변위 및 과도변위를 해결하기 위한 방법 중 입력성형기술은 큰 시스템 변화 없이 활용할 수 있는 효과적인 방법 중에 하나이다. 하지만 상기 유연시스템은 구동기 드라이브에 의해 최대 가속도가 고정되어 있기 때문에 ramp형태의 속도 프로파일을 가지게 되어 linear system에 기반한 square 형태의 속도 프로파일을 이용한 입력성형방법의 경우 속도 프로파일 형태의 차이로 인하여 잔류변위가 발생하고 정밀한 제어가 어려워지기 때문에 입력 성형시에 시스템의 따른 제약 조건과 가속도 제한을 고려한 입력성형방법이 요구된다.
이러한 요구에 의해 유연시스템의 과도변위를 줄이기 위한 입력성형방법에 대한 연구들이 진행되어 왔다. Singhose, Seering 및 Banerjee는 우주 유연구조물의 slew시에 발생되는 transient deflection의 저감과 연료 효율성을 discrete time에서 최적화하는 방법을 이용하여 입력성형기를 제시하였다. 하지만 가속도 제한을 고려한 방법은 아니기 때문에 과도변위와 잔류변위 저감 성능이 감소한다. Robertson과 Singhose는 deflection 벡터 다이어그램을 이용하여 closed form 형태로 나타내었다. 여기서는 deflection의 저감을 벡터 다이어그램을 이용한 방법으로 제시하였지만 이 역시도 가속도 제한은 고려되지 않았다. Singhose, Banerjee와 seering의 robustness, deflecting limiting, 연료 효율성 세 가지를 고려한 방법 등이 있었지만 모두 최적화 방법으로 제시되었다. 하지만 최적화이기 때문에 실제 산업 현장에서 사용하기에는 제약이 있으며 가속도 제한시에 성능 감소가 일어난다. Robertson과 Singhose는 임펄스의 크기 조정을 통한 closed-form 형태의 deflection limiting 방법을 제시하였다. 이 방법은 간단한 방법으로 과도변위를 저감할 수 있는 방법이긴 하지만 가속도 제한 시스템에서는 성능 감소가 일어난다. 이후, Sung과 Singhose가 deflection limiting과 velocity limiting을 고려한 closed form 형태의 deflection-velocity-limiting(DVL)을 개발하였다. 이 방법 역시 linear system 기반의 솔루션이다. 그 밖에 다른 관련 입력성형 기술 역시 linear system theory를 기반으로 하고 있어 가속도가 제한된 시스템에 활용되기에는 어렵고 잔류변위 저감 성능이 떨어진다.
비선형 유연시스템의 잔류변위 저감에 활용하기 위한 연구가 초기단계에 있다. Sorenson은 saturation, backlash, rate limiting, dead zone의 비선형성으로 인한 성형기에 성능감소에 대하여 convolution 방법을 이용한 성형기의 성능분석 방법을 제시하였다.
구동기와 관련한 비선형성 연구들이 제안되었다. Lawrence는 선형 입력성형제어기에 비선형 구동기의 영향으로 발생되는 가속도 및 감속도에 의한 시간지연을 고려하여 잔류변위저감 성능을 개선한 on-off 형태의 비선형 입력성형제어기를 개발하였다. 이 경우 1st-order형태의 구동기의 비선형을 고려하였으며 산업현장의 비선형 구동기의 동적특성을 고려한 입력성형제어기 설계에 필요한 정확한 변수가 필요하다. Danielson은 구동기의 가속도 제한을 고려하여 최적화 방법을 연구하였다. 하지만 또한 on-off 시스템은 고려하지 않았으며 최적화 방법이기 때문에 계산 과정이 필요하므로 실제 산업 현장에 적용하기에는 다소 어려움이 있다. 그 밖에 다른 비선형을 고려한 입력성형 관련 기술 역시 linear system 이론을 기반으로 하고 있어 가속도가 제한된 시스템에 활용되기에는 어렵고 잔류변위 저감 성능이 떨어진다.
현재 가속도 제한을 고려하면서 on-off형태의 솔루션은 아직까지 한 번도 다루어지지 않았다.
한국 등록특허공보 제10-0919890호
본 발명은 상기한 바와 같은 제반 문제점을 개선하기 위해 안출된 것으로서, 그 목적은 구동기의 동특성 중 가속도 제한을 고려하여 유연시스템의 과도변위 고속이동 입력성형 제어방법을 제시한 것으로, 2mass-spring system을 통한 응답식을 통해 phasor 형태의 벡터로 계산하여 나타내고, 이렇게 계산된 phasor vector를 vector diagram approach을 활용하여, 상기 유연시스템의 임펄스 크기와 시간을 구하여 가속도제한으로 인한 ramped step과 convolution을 통해 얻어진 입력 커맨드를 유연시스템에 적용하도록 한 Acceleration High-speed Limits Zero Vibration(AHDLZV) 입력성형기의 입력성형 제어방법을 제공함에 있다.
다른 목적은 MATLAB®을 이용한 numerical simulation을 통해 입력성형기들의 과도변위와 잔류변위 및 강건성의 성능평가를 하고, 입력성형기들을 mini-bridge crane을 통한 감도, 잔류변위 실험 결과를 통해 성능 검증을 하도록 한 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법을 제공함에 있다.
상기한 바와 같은 목적을 달성하기 위해 본 발명의 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법은, 유연시스템의 운동에서 Benchmark System의 운동방정식을 이용하여 페이저(phasor) 벡터의 형태로 나타낸 잔류변위에 대한 변위 벡터를 이용한 펄스 시점(tp)에 따른 각각의 임펄스 A1과 A2 및 A3에 대한 벡터
Figure 112014012621843-pat00001
,
Figure 112014012621843-pat00002
,
Figure 112014012621843-pat00003
를 구하고, 상기 세 벡터를 이용하여 상기 유연시스템의 운동 중의 잔류 진동 감소를 위한 임펄스의 시간 t2와 t3를 다음과 같은 수학식으로 계산하며, 상기와 같은 방법으로 유연시스템의 운동 후의 잔류 진동 감소를 위한 임펄스의 시간 t5와 t6를 다음과 같은 수학식으로 구하여,
Figure 112014012621843-pat00004
Figure 112014012621843-pat00005
Figure 112014012621843-pat00006
,
Figure 112014012621843-pat00007
,
Figure 112014012621843-pat00008
Figure 112014012621843-pat00009
Figure 112014012621843-pat00010
Figure 112014012621843-pat00011
상기 t2, t3, t5 및 t6를 가속도 및 과도변위가 제한된 상기 유연시스템의 운동을 위한 입력 커맨드에 활용하여 잔류 진동을 감소하도록 한 것을 특징으로 하고 있다.
또 상기 벡터
Figure 112014012621843-pat00012
,
Figure 112014012621843-pat00013
, 는 임펄스로 인한 pendulum에 정상상태 응답에 대한 변위의 크기와 위상각을 나타내는 다음의 벡터,
Figure 112014012621843-pat00015
를 통해 구하는 것이 바람직하다.
또 상기 벡터
Figure 112014012621843-pat00016
를 통해 구해진 벡터
Figure 112014012621843-pat00017
,
Figure 112014012621843-pat00018
,
Figure 112014012621843-pat00019
의 크기와 위상각은,
Figure 112014012621843-pat00020
Figure 112014012621843-pat00021
Figure 112014012621843-pat00022
인 것이 바람직하다.
또 상기 t2, t3의 식에서 cos-1 항은 -1과 1 사이인 것이 바람직하다.
또 다음의 수학식,
Figure 112014012621843-pat00023
에 의해 임펄스의 간격이 원하는 속도에서 가속도(속도 감소시에는 감속도)로 나눈 값보다 크도록 하며, 상기 t2, t3, t5 및 t6를 나타내는 ti는 항상 실수 값을 가지도록 하는 것이 바람직하다.
본 발명의 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법에 의하면, 입력성형제어기의 성능 평가를 위해 설계 변수에 대한 잔류변위의 크기와 과도변위, modeling error에 대한 감도를 기존의 입력성형기와 비교하였을 때 성능 향상을 보였으며, 감도 곡선(sensitivity curve) 역시 보다 modeling error에 강건함을 보여주는 효과가 있다.
이로 인해 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기는 잔류진도의 감소가 향상되는 효과가 있다.
도 1은 Benchmark System의 개념도
도 2는 입력성형기의 속도의 분리 개념도
도 3은 tp에서 HDLZV 입력성형기의 잔류변위 그래프
도 4는 HDLZV Short 커맨드의 convolution process
도 5는 HDLZV Long 커맨드의 convolution process
도 6은 HDLZV 입력성형기의 왜곡된 커맨드로 인한 시스템 응답
도 7은 본 발명에 따른 AHDLZV 입력성형기의 속도의 분리 개념도
도 8은 본 발명에 따른 AHDLZV 입력성형기의 벡터 다이어그램
도 9는 성형된 가속제한 커맨드 그래프
도 10은 κa와 κd에서 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 잔류변위의 컴퓨터 시뮬레이션을 나타내는 도면
도 11은 κa와 tp에서 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 잔류변위의 컴퓨터 시뮬레이션을 나타내는 도면
도 12는 κa와 κd에서 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 감도의 컴퓨터 시뮬레이션을 나타내는 도면
도 13은 κa와 κd에서 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 Transient Deflection의 컴퓨터 시뮬레이션을 나타내는 도면
도 14는 κa/κam에서 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 감도를 나타내는 그래프
도 15는 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 시험대를 위한 Mini-Bridge Crane
도 16은 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기에 의한 속도 에러의 실험그래프
도 17은 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 속도 커맨드를 나타내는 그래프
도 18은 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 Deflection Response를 나타내는 그래프
도 19는 L/Lm에서 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 감도를 나타내는 그래프
도 20은 tp에서 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 잔류변위를 나타내는 그래프
도 21은 κa/κam에서 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 감도를 나타내는 그래프
도 22는 κa에서 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 Transient Deflection을 나타내는 그래프
이하, 본 발명에 따른 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법의 바람직한 실시예를 첨부한 도면을 참조로 하여 상세히 설명한다. 본 발명은 이하에서 개시되는 실시예에 한정되는 것이 아니라 서로 다른 다양한 형태로 구현될 수 있으며, 단지 본 실시예는 본 발명의 개시가 완전하도록 하며 통상의 지식을 가진 자에게 발명의 범주를 완전하게 알려주기 위하여 제공되는 것이다.
본 발명에 따른 AHDLZV의 입력성형 제어방법에 있어 기본적인 Benchmark System의 운동방정식을 이용하여 정상상태 응답을 구하고, 이 응답을 phasor vector의 형태로 나타내어 잔류변위에 대한 변위벡터를 나타낸다. 이 벡터는 본 발명에 따른 AHDLZV의 입력성형 제어방법의 입력성형 설계시에 사용된다.
도 1에 도시한 일반적인 Benchmark System의 운동방정식은 다음의 수학식 1 및 수학식 2와 같다.
Figure 112014012621843-pat00024
Figure 112014012621843-pat00025
위의 시스템 응답을 구하기 위해 라플라스 변환하여
Figure 112014012621843-pat00026
에 대하여 위의 두 식을 정리하여
Figure 112014012621843-pat00027
로 치환하여주면 다음 수학식 3과 같다.
Figure 112014012621843-pat00028
여기서 가속도 입력
Figure 112014012621843-pat00029
는 속도 입력
Figure 112014012621843-pat00030
로 나타나며 라플라스 변환시
Figure 112014012621843-pat00031
로 치환된다.
응답 Y(s)는 다음의 수학식 4 및 5와 같이 시스템입력 C(s)와 sine input으로 표현된다.
Figure 112014012621843-pat00032
Figure 112014012621843-pat00033
이를 이용하여 steady state response 으로 나타내면 다음의 수학식 6으로 나타낼 수 있다.
Figure 112014012621843-pat00034
여기서
Figure 112014012621843-pat00035
Figure 112014012621843-pat00036
만의 함수가 아니고 Ai ti등 여러 변수의 함수지만 간략화 해서
Figure 112014012621843-pat00037
로 표시한다.
벡터의 amplitude 와 phase로 나타내면, 다음의 수학식 7로 나타난다.
Figure 112014012621843-pat00038
도 2 (a)의 실제 속도명령어를 임펄스 시간에 따라 개별적으로 나누면 도 2의 (b)와 같다. 따라서 실제 속도명령어를 임펄스 시간에 따라 개별적으로 나누면 전체 속도명령어에 대한 함수는 다음의 수학식 8과 같이 나타낼 수 있다.
Figure 112014012621843-pat00039
여기서
Figure 112014012621843-pat00040
는 shaped 입력을 도 4의 2번째 그림과 같이 나누었을 때의 각 부분의 속도의 함수를 의미한다.
가속도 제한 형태인 ramp함수의 전달 함수는 다음의 수학식 9와 같이 나타낼 수 있다.
Figure 112014012621843-pat00041
여기서 κi는 감속도 또는 감속도로 양의 임펄스일 때는 κa, 음의 임펄스일 때는 κd이다.
수학식 7과 9를 이용하여 Laplace transform한 후 벡터의 amplitude와 phase로 나타내면 다음의 수학식 10과 같다.
Figure 112014012621843-pat00042
이 벡터는 임펄스로 인한 pendulum에 정상상태 응답에 대한 변위의 크기와 위상각을 나타낸다. 다음의 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형 기의 개발시에 상기의 수학식 10을 이용하여 vector diagram approach를 이용하여 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기를 제시한다.
다음은 본 발명의 가속도 제한 및 과도변위 저감 입력성형 제어방법에 따른 입력성형기의 개발에서 가속도 제한을 고려한 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기에 대해 설명한다.
입력성형기의 명령은 일반적으로 임펄스 시퀀스와 step입력의 convolution을 통해 생성된다. 하지만 이 명령은 pulse duration(tp)에 따라 short과 long 그리고 interference 커맨드 세 가지로 분류된다. 따라서 세 가지의 커맨드를 구분하고 HDLZV 형태의 입력성형기를 개발한다.
도 3은 tp에 따라 입력성형기 HDLZV의 잔류변위를 나타내었다. 도시한 바와 같이 그래프 상에서 3가지의 구간으로 구분된다. 먼저 I구간은 short 커맨드 구간으로 실제 잔류변위가 발생하지 않고 있다. II 구간은 Interference 커맨드 구간으로 커맨드가 잔류변위가 크게 발생되고 있다. III 구간은 약간의 변위가 발생되고 있으며 다른 구간과 달리 tp에 따라 주기적인 특성을 보인다는 것이 특징이다.
도 4는 HDLZV의 short 커맨드를 나타내고 있다. 상기 HDLZV short 커맨드는 펄스입력과 임펄스 시퀀스의 convolution을 통해 생성되며 세 개의 펄스 형태로 구성된다. 이와 같은 short 커맨드가 사용되기 위해서는 tp가 다음과 같은 수학식 11 조건을 만족해야한다.
Figure 112014012621843-pat00043
상기 HDLZV interference 커맨드는 tp가 short 커맨드와 long 커맨드 사이에 위치할 경우 발생된다. HDLZV interference 커맨드는 커맨드가 정상상태에 도달하지 않기 때문에 실제 약간의 잔류 변위가 발생된다.
도 5는 HDLZV의 long 커맨드를 나타내고 있다. HDLZV long 커맨드는 ramp up과 ramp down에 따라 각기 다른 펄스입력과 임펄스 시퀀스의 convolution을 통해 생성된다. 이와 같은 long 커맨드가 사용되기 위해서는 tp가 다음과 같은 수학식 12의 조건을 만족해야한다.
Figure 112014012621843-pat00044
본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기의 개발에 있어, 기존의 MUMZV 성형기는 A3에서의 속도가 낮아 원하는 위치까지의 이동시에 시간이 많이 걸린다는 단점이 있다. 이에 따라 A1, A2의 값이 A3보다 낮고 A3가 1인 HDLZV 입력성형ㄹ기를 가속도를 포함하여 본 발명의 입력성형 제어방법에 따른 AHDLZV 입력성형기를 개발한다. 도 6은 기존의 임펄스와 step 명령의 convolution으로 생성된 HDLZV 입력명령이 가속도 제한 구동기를 거치면서 명령어에 왜곡이 발생되어 입력이 ramp 형태로 변하게 되어 시스템응답에서 잔류변위가 발생하는 것을 보여준다. 앞서 계산된 시스템의 잔류변위에 대한 phasor 벡터를 이용하여, 가속도 및 과도제한을 고려한 입력성형제어방법, 즉, 임펄스크기에 따른 시간을 결정한다. 여기서 우리는 t1을 0, A1, A2와 A3를 각각 A1, -A1과 1로 가정한다. 여기서 A1과 A2는 크기는 같고 방향이 다른 임펄스 이다.
도 7 (a)의 실제 속도명령어를 임펄스 시간에 따라 개별적으로 나누면 도 7 (b)와 같다. 따라서 상기의 수학식 10을 이용하여 각각의 임펄스 A1과 A2에 대한 벡터
Figure 112014012621843-pat00045
,
Figure 112014012621843-pat00046
,
Figure 112014012621843-pat00047
는 다음과 같은 수학식 13 내지 15로 표현된다.
Figure 112014012621843-pat00048
Figure 112014012621843-pat00049
Figure 112014012621843-pat00050
위의 두 벡터
Figure 112014012621843-pat00051
,
Figure 112014012621843-pat00052
,
Figure 112014012621843-pat00053
의 크기와 위상각을 정리하면 다음과 같은 수학식 16 내지 18이 된다.
Figure 112014012621843-pat00054
Figure 112014012621843-pat00055
Figure 112014012621843-pat00056
위의 세 벡터를 이용하여 임펄스의 시간 t2와 t3를 계산하기 위하여 도 8의 vector diagram approach를 활용하여 본 발명에 따른 AHDLZV 입력성형기의 임펄스의 시간을 결정할 수 있다.
Figure 112014012621843-pat00057
Figure 112014012621843-pat00058
같다. 여기에 코사인 법칙을 이용하여 다음의 수학식 19와 20을 얻는다.
Figure 112014012621843-pat00059
Figure 112014012621843-pat00060
Figure 112014012621843-pat00061
,
Figure 112014012621843-pat00062
,
Figure 112014012621843-pat00063
상기의 수학식 19와 20에서 cos-1 항목은 반드시 -1과 1 사이에 있어야 한다. 그래야만 cos-1 항목이 실수로 계산이 되어 유연시스템의 운동 중의 잔류변위를 감소하기 위한 임펄스 시간
Figure 112014012621843-pat00064
,
Figure 112014012621843-pat00065
를 얻을 수 있다.
본 발명에 따른 AHDLZV 입력성형기를 활용한 유연시스템의 stop motion을 갖춘 AHDLZV 입력성형기의 나머지 switching times, 즉 상기 유연시스템의 운동 후의 잔류변위를 감소하기 위한 임펄스 시간은 start motion의 과정과 같은 방법으로 계산 하면 된다. 계산된 t5와 t6는 다음의 수학식 21 및 22로 얻어진다.
Figure 112014012621843-pat00066
Figure 112014012621843-pat00067
Figure 112014012621843-pat00068
유연시스템의 stop motion의 시작 시간은 tp에 의해 결정되며 따라서 구동기 드라이브를 고려한 zero 잔류변위 솔루션인 본 발명에 따른 AHDLZV 입력성형기의 전체 시퀀스는 상기의 수학식 19, 20, 21 및 22로 표시된다.
본 발명에 따른 AHDLZV 입력성형기의 경우 ti가 항상 실수값을 가져야 한다. 또한 다음의 수학식 23에서와 같이 임펄스의 간격이 원하는 속도에서 가속도(속도 감소시에는 감속도)로 나눈 값보다 커야 된다. 그 이유는 이 조건을 만족하지 못할 경우 속도프로파일이 원하는 속도까지 도달하지 못하여 커맨드가 정상상태에 도달하지 못한다.
Figure 112014012621843-pat00069
만약 상기의 수학식 23을 만족하지 못할 때는 입력성형기의 잔류변위 저감 성능의 감소를 가져온다.
다음은 본 발명에 따른 AHDLZV 입력성형기의 과도변위 제약조건에 대해 설명한다.
도 9의 성형된 AHDLZV의 속도입력을 이용하여 deflection의 최대값을 계산한다.
따라서 deflection의 식을 일반화하여 summation 형태로 나타내면 다음의 수학식 24와 같다.
Figure 112014012621843-pat00070
여기서 κi는 Ai가 양수일 때는 κa, 음수일 때는 κd이다.
위의 수식으로부터 성형된 커맨드가 가질 수 있는 최대의 deflection 값은 다음의 수학식 25와 같다.
Figure 112014012621843-pat00071
과도 변위 제한을 위해 "임의의 원하는 deflection 값인 Dd값보다 Dshapmax값이 작거나 같다"는 조건식을 도출하면 다음과 같은 수학식 26이 된다.
Figure 112014012621843-pat00072
좌변과 우변을 unshap의 최대 deflection 값으로 나누어 deflection의 비율로 나타내면 다음의 수학식 27과 같다.
Figure 112014012621843-pat00073
여기서 κi는 Ai가 양수일 때는 κa, 음수일 때는 κd이다.
위의 식을 이용하여 A1 대한 값을 시스템 변수들을 대입하고 MATLAB의 fsolve를 이용하여 계산하는 것으로 사용하였다.
다음의 본 발명에 따른 가속도 제한 및 과도변위 저감 입력성형제어기의 평가에 대해 설명한다.
MATLAB®을 이용하여 앞에서 개발한 각각의 입력성형기에 대하여 numerical simulation을 진행 한다. 기존의 HDLZV와 본 발명에 따른 AHDLZV 입력성형기의 성능비교를 한다. 시뮬레이션의 기본적인 변수들의 값은 다음의 표 1과 같이 설정 하였다.
본 발명에 따른 AHDLZV 입력성형기의 시스템 매개변수
변수 m1 m2 k κa κd Vd tp
1kg 1kg 1N/m 1m/sec2 1.6m/sec2 0.2m/sec 3.5sec
위의 설정된 값은 κa와 κd의 경우 값이 같을 경우 linear 솔루션과 같은 결과를 가지게 되므로 가속도와 감속도의 값을 서로 다른 값으로 설정하였고, 일반적으로 가속도보다 감속도가 크기 때문에 κd를 κa보다 작게 나타내었으며, 유연시스템의 실제 모터의 가속도와 감속도는 최대 속도의 2배 이상의 값을 가진다. 이 값을 이용한 simulation은 κa, κd, 그리고 tp에 대하여 잔류변위 저감 성능과 설계변수 κa와 κd에 대한 강건성을 기존의 linear 기반의 입력성형기와 비교하였다.
다음은 본 발명에 따른 AHDLZV 입력성형기를 분석하도록 한다.
MATLAB® 이용하여 상기에서 개발한 본 발명에 따른 AHDLZV 입력성형기의 simulation을 진행한다. 시뮬레이션에 사용된 변수 값은 상기의 표 1과 같이 κa=1m/s2, κd=1.6m/s2,
Figure 112014012621843-pat00074
=3.5sec 그리고
Figure 112014012621843-pat00075
=0.2m/s로 설정하였으며 실험에 따라 tp, κa 그리고 κd를 변경하면서 실험을 진행 하였다.
도 10은 κa와 κd에 대하여 기존의 HDLZV와 본 발명에 따른 AHDLZV 입력성형기의 잔류변위의 저감 성능을 비교한 그림이다. 변수 설정은 표 1과 동일하며 κa와 κd의 범위를 0.8∼3의 영역에서 진행하였다. 본 발명에 따른 AHDLZV 입력성형기의 경우 전체적인 영역에서의 잔류변위가 0이지만, 기존의 HDLZV 입력성형기의 경우 잔류변위가 그래프 상에서 0∼6cm 정도 발생한다. 하지만 본 발명에 따른 AHDLZV 입력성형기의 경우 zero 변위를 보이고 있다.
도 11은 κa와 tp에 대하여 기존의 HDLZV와 본 발명에 따른 AHDLZV 입력성형기의 잔류변위의 크기를 나타내고 있다. 변수 설정은 상기의 표 1과 동일하며 κa 범위를 0.1∼3, tp의 범위를 2∼15(sec)로 설정하여 진행하였다. 본 발명에 따른 AHDLZV 입력성형기의 경우 전체적인 영역에서의 잔류 변위가 0이지만, 기존의 HDLZV 입력성형기의 경우 잔류변위가 그래프 상에서 약 0∼11cm정도 발생한다. tp에 따라 기존의 HDLZV 입력성형기의 변위가 주기적으로 반복되고 있다. 이는 stop motion의 시작 지점의 초기 변위값이 0이 아니므로 tp값에 따라 잔류변위의 크기가 주기적인 특성을 보인다.
도 12는 κa와 κd에 대하여 기존의 HDLZV와 본 발명에 따른 AHDLZV 입력성형기의 강건성을 나타내고 있다. 변수 설정은 상기의 표 1과 동일하며 κam을 1, κdm을 1.6로 설정하고 진행하였다. 본 발명에 따른 AHDLZV 입력성형기의 경우 전체적인 영역에서의 잔류 변위가 기존의 HDLZV 입력성형기보다 낮게 나타나고 있다. 또한 κaam κddm의 값이 1일 때 잔류 변위의 크기가 0으로 낮게 나타나고 있다.
Simulation을 통해 잔류변위의 크기와 각각의 변수들의 강건성을 평가한 결과 본 발명에 따른 AHDLZV 입력성형기의 경우 기존의 HDLZV 입력성형기와 비교하여 잔류변위가 줄어들었으며 각 설계 변수에 대한 강건성 역시 증가함을 보인다.
도 13은 κa와 κd에 대하여 본 발명에 따른 AHDLZV 입력성형기의 과도변위를 나타내고 있다. 변수 설정은 상기의 표 1과 동일하게 설정하였다. 본 발명에 따른 AHDLZV 입력성형기의 경우 전체적인 영역에서의 과도변위의 크기가 Dlim값에 의해 제어되고 있다. unshape의 과도변위의 80%를 제한했을 경우 80%보다 낮은 과도변위를 보이며 60% 제한일 경우 역시 60% 이하로 제어가 되고 있다. 이는 본 발명에 따른 AHDLZV 입력성형기가 과도변위 저감을 제어하고 있음을 보여준다.
도 14는 줄 길이 κa에 대하여 본 발명에 따른 AHDLZV의 가속도의 경사의 각도에 따라 unshape일 때의 잔류변위의 백분율을 나타낸 것이다. 허용 잔류변위를 5%로 가정했을 때 기울기 45°(κa=1m/sec2)을 기준으로 κa/κam의 값이 0.68∼1.84의 값을 가질 때 5%의 잔류변위가 발생하였으며, 이것을 기울기로 환산하면 34.2°∼61.4°의 기울기 범위 안에서 입력성형기를 작동할 경우 잔류 변위의 5% 이내의 값을 얻을 수 있다.
다음은 본 발명에 따른 가속도 제한 및 과도변위 저감의 입력성형기를 검증해보도록 한다.
먼저 실험장치 설정함에 있어 본 발명의 입력성형 제어방법에 따른 입력성형기의 과도변위 제한 및 잔류변위 저감 성능을 실험적으로 검증하기 위해 도 15의 실험장치를 사용하였다. 도 15에 도시한 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로 모터 세팅을 하여 생성된 프로파일을 잘 추적할 수 있도록 하였다. 도 16은 실제 ideal solution으로 가속도 제한 속도 프로파일을 입력한 후 입력한 속도 프로파일과 실제 모터의 속도값을 비교하였다. 실제 나타난 error plot의 경우와 같이 최대 ±2cm/sec2의 오차는 있으나 명령된 속도 프로파일을 허용범위 안에서 추적하고 있다. intelligent vision sensor를 통해 payload 변위측정을 하였고, MATLAB® software을 통해 측정된 변위를 분석하였다. 실험은 다음의 표 2 설정하였으며 start-stop motion을 통해 케이블 길이 또는 tp을 바꿔가며 잔류변위를 검증하였다.
실험을 위한 시스템 매개변수
변수 L κa κd Vd tp
0.8m 1m/sec2 1.6m/sec2 0.2m/sec 3.5sec
실험결과는 다음과 같다.
ramp 형태의 속도 프로파일을 생성하여 mini-bridge crane을 활용해 실험을 진행하였다. 진행시의 변수 값은 상기의 표 2와 동일하게 κa=1m/s2, κd=1.6m/s2,
Figure 112014012621843-pat00076
=3.5sec, L=0.8m 그리고
Figure 112014012621843-pat00077
=0.2m/s로 설정하였으며 실험에 따라 L, tp 그리고 κa를 변경하면서 실험을 진행하였다.
도 17은 실험에 사용된 속도 프로 파일을 나타내고 있다. 실제적으로 커맨드의 임펄스의 크기는 같지만 시간의 차이만 나타난다. 실제 모터의 속도를 나타내기 때문에 이론적인 속도와 비교하여 약간의 오차가 있지만 이론적인 속도의 ㅁ 2cm/sec2 이내이다.
도 18은 실험을 통해 얻은 Deflection Response를 나타내고 있다. 과도변위의 크기 변화는 거의 차이는 없으나 잔류변위의 경우 기존의 HDLZV 입력성형기는 약 3cm 정도의 크기를 보이고 본 발명에 따른 AHDLZV 입력성형기보다 작은 변위가 발생하고 있다.
도 19는 줄 길이 L에 대한 Modeling error에 대한 감도 곡선이다. 실험변수 값은 κa=0.8m/s2, κd=1.6m/s2,
Figure 112014012621843-pat00078
=3.5sec, L=0.8m 그리고
Figure 112014012621843-pat00079
=0.2m/s로 설정하였다. L/Lm이 1일 때 기존의 HDLZV 입력성형기의 경우 잔류변위가 발생하고 있다. 하지만 본 발명에 따른 AHDLZV 입력성형기의 경우 잔류변위를 0으로 만들고 있다. 이는 본 발명의 AHDLZV 입력성형기가 보다 강건하다는 것을 나타낸다.
도 20은 pulse duration tp에 대한 잔류변위를 나타낸다. 실험변수 값은 κa=0.8m/s2, κd=1.6m/s2, L=0.8m 그리고
Figure 112014012621843-pat00080
=0.2m/s로 설정하였다. 기존의 HDLZV 입력성형기의 경우 변위가 발생 되고 있으며 본 발명에 따른 AHDLZV 입력성형기의 경우 잔류변위를 0으로 나타내고 있다. 또한 ideal solution의 경우 잔류변위가 발생하기 때문에 변위가 주기적인 특성을 보이고 있다.
도 21은 가속도 제한의 중요 변수중 하나인 κa에 대한 modeling error에 대하여 강건성을 나타낸 것이다. 실험변수 값은 κa=0.8m/s2, κd=1.6m/s2,
Figure 112014012621843-pat00081
=3.5sec, L=0.8m 그리고
Figure 112014012621843-pat00082
=0.2m/s로 설정하였다. 기존의 HDLZV 입력성형기의 경우 잔류 변위를 저감하지 못하고 있으며 본 발명에 따른 AHDLZV 입력성형기의 경우는 κaam이 1인 경우 잔류 변위가 0임을 보이고 있다.
도 22는 본 발명에 따른 AHDLZV와 기존의 HDLZV 입력성형기의 κa에 대한 과도변위 저감 성능을 나타내고 있다. ideal shaper의 경우 Dlim의 값에 따라 과도변위 자체가 저감이 되어 보이지만 입력성형기의 본 목적중 하나인 잔류변위를 없애지 못하는 것을 앞부분에서의 실험과 시뮬레이션을 통해 나타내었으며, Dlim 값에 따른 속도입력의 크기가 변하기 때문에 그래프만을 볼 때 과도변위가 저감되어 보인다. 기존의 HDLZV 입력성형기의 경우 κa가 약 1∼1.4 사이일 때의 그래프를 보면 과도변위가 계속 증가하고 있다. 즉 제대로 제어가 이루어지지 않고 있음을 이야기 하고 있다.
이상과 같이 본 발명에 따른 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법에 대해서 예시한 도면을 참조로 하여 설명하였으나, 본 명세서에 개시된 실시예와 도면에 의해 본 발명이 한정되는 것은 아니며, 본 발명의 기술사상의 범위 내에서 당업자에 의해 다양한 변형이 이루어질 수 있음은 물론이다.

Claims (6)

  1. 유연시스템의 운동에서 Benchmark System의 운동방정식을 이용하여 페이저(phasor) 벡터의 형태로 나타낸 잔류변위에 대한 변위 벡터를 이용한 펄스 시점(tp)에 따른 각각의 임펄스 A1과 A2 및 A3에 대한 벡터
    Figure 112015056791378-pat00083
    ,
    Figure 112015056791378-pat00084
    ,
    Figure 112015056791378-pat00085
    를 구하고,
    상기 세 벡터를 이용하여 상기 유연시스템의 운동 중의 잔류 진동 감소를 위한 임펄스의 시간 t2와 t3를 다음과 같은 수학식으로 계산하며, 상기와 같은 방법으로 유연시스템의 운동 후의 잔류 진동 감소를 위한 임펄스의 시간 t5와 t6를 다음과 같은 수학식으로 구하여,
    Figure 112015056791378-pat00086

    Figure 112015056791378-pat00087

    Figure 112015056791378-pat00088
    ,
    Figure 112015056791378-pat00089
    ,
    Figure 112015056791378-pat00090

    Figure 112015056791378-pat00091
    Figure 112015056791378-pat00092

    Figure 112015056791378-pat00093

    [상기 수학식에서,
    ωn : 유연시스템의 고유주파수
    Vd : 구동기의 최대속도
    kd : 속도함수를 정의하는 감가속도(ramp down에서는 음의 기울기임)
    ki : 속도함수를 정의하기 위해 표시한 변수명으로 가속도 혹은 감가속도가 됨
    A1 : 도 5에서 임펄스의 크기
    kα : 속도함수를 정의하는 가속도(ramp up에서는 양의 기울기임)]
    상기 t2, t3, t5 및 t6를 가속도 및 과도변위가 제한된 상기 유연시스템의 운동을 위한 입력 커맨드에 활용하여 잔류 진동을 감소하도록 한 것을 특징으로 하는 가속도 및 과도변위가 제한된 유연시스템에 대한 고속 입력성형 제어방법.
  2. 제1항에 있어서,
    상기 벡터
    Figure 112015056791378-pat00094
    ,
    Figure 112015056791378-pat00095
    ,
    Figure 112015056791378-pat00096
    는 임펄스로 인한 pendulum에 정상상태 응답에 대한 변위의 크기와 위상각을 나타내는 다음의 벡터,
    Figure 112015056791378-pat00097

    [상기 수학식에서,
    ωn : 유연시스템의 고유주파수
    Vd : 구동기의 최대속도
    ki : 속도함수를 정의하기 위해 표시한 변수명으로 가속도 혹은 감가속도가 됨
    Ai : 속도함수를 결정하기 위한 임펄스 sequence에서 개별 임펄스의 크기(최대 1임)
    mi : 도 1에서 첫 번째 질량]
    를 통해 구하는 것을 특징으로 하는 가속도 및 과도변위가 제한된 유연시스템에 대한 고속 입력성형 제어방법.
  3. 제2항에 있어서,
    상기 벡터
    Figure 112015056791378-pat00098
    를 통해 구해진 벡터
    Figure 112015056791378-pat00099
    ,
    Figure 112015056791378-pat00100
    ,
    Figure 112015056791378-pat00101
    의 크기와 위상각은,
    Figure 112015056791378-pat00102

    Figure 112015056791378-pat00103

    Figure 112015056791378-pat00104

    [상기 수학식에서,
    ωn : 유연시스템의 고유주파수
    Vd : 구동기의 최대속도
    kd : 속도함수를 정의하는 감가속도(ramp down에서는 음의 기울기임)
    A1 : 도 5에서 임펄스의 크기
    kα : 속도함수를 정의하는 가속도(ramp up에서는 양의 기울기임)]
    인 것을 특징으로 하는 가속도 및 과도변위가 제한된 유연시스템에 대한 고속 입력성형 제어방법.
  4. 제1항 내지 제3항 중 어느 한 항에 있어서,
    상기 t2, t3의 식에서 cos-1 항은 -1과 1 사이인 것을 특징으로 하는 가속도 및 과도변위가 제한된 유연시스템에 대한 고속 입력성형 제어방법.
  5. 제1항 내지 제3항 중 어느 한 항에 있어서,
    다음의 수학식,
    Figure 112015056791378-pat00105

    [상기 수학식에서,
    Vd : 구동기의 최대속도
    kd : 속도함수를 정의하는 감가속도(ramp down에서는 음의 기울기임)
    ki : 속도함수를 정의하기 위해 표시한 변수명으로 가속도 혹은 감가속도가 됨
    Ai : 속도함수를 결정하기 위한 임펄스 sequence에서 개별 임펄스의 크기(최대 1임)
    kα : 속도함수를 정의하는 가속도(ramp up에서는 양의 기울기임)]
    에 의해 임펄스의 간격이 원하는 속도에서 가속도(속도 감소시에는 감속도)로 나눈 값보다 크도록 한 것을 특징으로 하는 가속도 및 과도변위가 제한된 유연시스템에 대한 고속 입력성형 제어방법.
  6. 제1항에 있어서,
    상기 t2, t3, t5 및 t6를 나타내는 ti는 항상 실수 값을 가지도록 한 것을 특징으로 하는 가속도 및 과도변위가 제한된 유연시스템에 대한 고속 입력성형 제어방법.
KR1020140014713A 2014-02-10 2014-02-10 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법 KR101555774B1 (ko)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020140014713A KR101555774B1 (ko) 2014-02-10 2014-02-10 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020140014713A KR101555774B1 (ko) 2014-02-10 2014-02-10 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법

Publications (2)

Publication Number Publication Date
KR20150093996A KR20150093996A (ko) 2015-08-19
KR101555774B1 true KR101555774B1 (ko) 2015-09-30

Family

ID=54057574

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020140014713A KR101555774B1 (ko) 2014-02-10 2014-02-10 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법

Country Status (1)

Country Link
KR (1) KR101555774B1 (ko)

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
논문1(2009.11)

Also Published As

Publication number Publication date
KR20150093996A (ko) 2015-08-19

Similar Documents

Publication Publication Date Title
CN101927495B (zh) 一种冗余度机械臂重复运动规划方法
JP5328798B2 (ja) 運動制御システムにおいて終了条件を満たす方法およびシステム
CN101362511A (zh) 基于四个定位器的飞机部件位姿调整协同控制方法
CN101986564A (zh) 基于Backlash算子和神经网络的自适应滤波器
KR102275302B1 (ko) 입력 포화를 가지는 불확실한 전기 구동 로봇 시스템에 대해 pso를 이용한 rbfnn 기반 분산 적응 추종 시스템
WO2017094424A1 (ja) 制御装置
KR101555774B1 (ko) 가속도 및 과도변위 제한된 유연시스템에 대한 고속 입력성형 제어방법
KR101553764B1 (ko) 가속도 제한된 유연시스템에 대한 강건 입력성형 제어방법
Sorensen et al. Finite-state input shaping
KR101575946B1 (ko) 가속도 제한된 유연시스템에 대한 허용 잔류변위를 활용한 강건 입력성형 제어방법
Wang et al. Jerk-optimal trajectory planning for stewart platform in joint space
CN115179328A (zh) 机器人末端工具残余振动抑制方法
KR101432432B1 (ko) 가속도가 제한된 유연시스템의 과도변위 제한 및 잔류진동 저감을 위한 입력성형 제어기 및 이에 의한 과도변위 제한 및 잔류진동 저감방법
CN110337617B (zh) 控制系统
Ishak et al. Tracking control for electro-hydraulic actuator using ZPETC
Robertson et al. Computational framework for digital input shapers using linear optimisation
Mohammed et al. The effectiveness of kinematic constraints on the accuracy of trajectory profile of human walking using PSPB technique
Ishak et al. Non-minimum phase model of vertical position electro-hydraulic cylinder for trajectory zpetc
Inel et al. Adaptive sliding mode control of a novel cable driven robot model
Adnan et al. Real-time control of non-minimum phase electro-hydraulic system using trajectory-adaptive ZPETC
Ooten et al. Command generation with sliding mode control for flexible systems
Lee et al. Bumpless transfer synthesis in the MIMO systems with a large online/offline controller mismatch using the state/output feedback topology
Zheng et al. Adaptive iterative learning control for systems with non-smooth nonlinearities
KR101432431B1 (ko) 가속도가 제한된 유연시스템의 on-off 입력성형 제어기 및 이에 의한 잔류진동 저감방법
Kongthon Tracking of High-speed, Non-smooth and Microscale-amplitude Wave Trajectories

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