KR101629836B1 - 제어 장치, 회전 속도 센서 및 고조파 설정점 신호를 갖는 제어 장치를 동작하기 위한 방법 - Google Patents

제어 장치, 회전 속도 센서 및 고조파 설정점 신호를 갖는 제어 장치를 동작하기 위한 방법 Download PDF

Info

Publication number
KR101629836B1
KR101629836B1 KR1020147014025A KR20147014025A KR101629836B1 KR 101629836 B1 KR101629836 B1 KR 101629836B1 KR 1020147014025 A KR1020147014025 A KR 1020147014025A KR 20147014025 A KR20147014025 A KR 20147014025A KR 101629836 B1 KR101629836 B1 KR 101629836B1
Authority
KR
South Korea
Prior art keywords
unit
controller
oscillator
harmonic
signal
Prior art date
Application number
KR1020147014025A
Other languages
English (en)
Other versions
KR20140081893A (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 노스롭 그루만 리테프 게엠베하
Publication of KR20140081893A publication Critical patent/KR20140081893A/ko
Application granted granted Critical
Publication of KR101629836B1 publication Critical patent/KR101629836B1/ko

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • G01C19/56Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
    • G01C19/5776Signal processing not specific to any of the devices covered by groups G01C19/5607 - G01C19/5719
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • G01C19/56Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • G01C19/56Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
    • G01C19/5719Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces using planar vibrating masses driven in a translation vibration along an axis
    • G01C19/5733Structural details or topology
    • G01C19/574Structural details or topology the devices having two sensing masses in anti-phase motion
    • G01C19/5747Structural details or topology the devices having two sensing masses in anti-phase motion each sensing mass being connected to a driving mass, e.g. driving frames
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D19/00Control of mechanical oscillations, e.g. of amplitude, of frequency, of phase
    • G05D19/02Control of mechanical oscillations, e.g. of amplitude, of frequency, of phase characterised by the use of electric means

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Signal Processing (AREA)
  • Automation & Control Theory (AREA)
  • Gyroscopes (AREA)
  • Measuring Volume Flow (AREA)
  • Control Of Eletrric Generators (AREA)

Abstract

제어 장치는 센서 유닛(170)을 포함하며, 센서 유닛(170)은 측정 신호를 출력하고, 측정 신호는 여기의 방향을 따라 발진기(190)의 편차를 반영한다. 제어기 메인 유닛(200)은 액츄에이터 유닛(180)이 고조파 공진 발진의 설정 진폭으로부터 발진기(190)의 편향의 편차에 대응하도록 측정 신호와 고조파 설정점 신호로부터 액츄에이터 유닛을 위한 제어 신호를 추론한다. 제어기 확장 유닛(600)은 비활성화된 액츄에이터 유닛(180)에서 발진기(190)의 잔여 발진의 실제-위상 및 실제-진폭을 추정하며 고조파 설정점 신호와 잔여 발진을 동기화시킨다. 발진기의 정의된 동작 상태에서 보다 빠르게 도착하도록 하기 위해, 잔여 발진에 포함된 잔여 에너지가 사용된다.

Description

제어 장치, 회전 속도 센서 및 고조파 설정점 신호를 갖는 제어 장치를 동작하기 위한 방법{CONTROL DEVICE, ROTATION RATE SENSOR AND METHOD FOR OPERATING A CONTROL DEVICE WITH HARMONIC SET POINT SIGNAL}
본 발명은 제어 유닛(control unit)에 관한 것으로, 특히 고조파 커맨드 변수(harmonic command variable) 또는 고조파 설정점 신호(harmonic set point signal)를 갖는 회전 속도 센서에 관한 것이다. 본 발명은 또한 고조파 커맨드 변수를 갖는 제어 장치를 동작하기 위한 방법에 관한 것이다.
종래의 제어 방법은 일정하거나 또는 단지 느리게 변하는 커맨드 변수들로 문제들을 제어하도록 맞추어지며, 여기서 방해(disturbance)로부터 영향을 받는 제어된 공정 변수의 값은 사전결정된 설정점에 가깝게 유지되거나, 또는 각각 변하는 설정점에 가능한 한 가깝게 갱신된다. 예를 들어 코리올리 힘(Coriolis force)의 분석을 위한 미소기계적 회전 속도 센서(micromechanical rotation rate sensor)로서 몇몇 어플리케이션은 자신의 공진 주파수 및, 제어 루프(control loop)에 의해 정의된 발진 진폭을 발진기의 여기에 제공한다. 이러한 공정에서, 제어기는 사전결정된 고조파 설정점 신호와 측정된 발진기 움직임 사이의 차이가 없어지도록 제어기는 제어기에 의해 발생 된 힘 신호(force signal)를 제어한다.
이러한 공정에서, 일반적으로 여기(excitation)의 방향을 따라 발진기의 움직임을 반영하는 측정 신호는 처음에 복조기(demodulator)에 공급된다. 복조기는 측정 신호와 각 주파수(angular frequency)(ωd)의 고조파 신호를 곱하며, 이는 발진기의 공진 각 주파수(ω0)에 대응한다. 제어 자체는 일정한 베이스밴드(baseband)에서 또는 공진 각 주파수로부터 독립적인 임의의 경우에서 설정점 신호에 의해 수행된다. 그 다음 제어기의 출력 신호는 각 주파수(ωm)를 갖는 고조파 신호에 대해 변조기에서 재-변조되며, 이는 발진기의 공진 주파수(ω0)에 대응한다. 그 다음 변조적(modulation product)이 사전결정된 설정 신호와 비교된다. 두 신호 간의 차는 최종적으로 액츄에이터(actuator)를 제어하며, 이는 제어기 신호에 기초하여 발진기가 사전결정된 설정 발진에 따라 발진하도록 발진기에 대해 힘을 수행한다. 제어가 베이스밴드에서 수행됨에 따라서, 저역 통과 필터(low pass filter)는, 특히 이중 공진 주파수에서, 주파수 변환적(frequency conversion product)을 여과할 수 있지만, 그러나, 이러한 공정에 의해 제어기의 폭(width)과 따라서 편향(deflection)의 변화에 대한 제어기의 반응 속도(reaction speed)가 제한된다.
출원일에 독일 특허출원 DE 102010055631.9는 아직 공개되지 않았으며 발진기의 공진 각 주파수(ω0)의 주파수 대역(frequency band)에서 고조파 설정점 신호를 갖는 제어가 기술된다.
어플리케이션의 많은 분야에서 발진기는 드라이브의 비활성화 후 감쇠 진폭(decaying amplitude)으로 발진한다. 발진기의 감쇠 위상(decay phase) 동안 활성화된 제어에서, 활성화 시간(activation time)은 감쇠 발진과 설정점 신호 간의 위상 및 진폭 차이에 의존한다.
본 발명의 목적은 고조파 커맨드 변수를 위한 제어 장치의 스위치-온 행위(switch-on behaviour)를 개선하기 위한 제어 개념이다. 목적은 독립항의 요지에 의해 해결된다. 게다가 실시예가 대응하는 종속항에 주어진다.
발명의 이어지는 실시예에서, 실시예의 장점 뿐만 아니라 실시예의 기능이 도면에 기초하여 기술될 것이다. 실시예의 요소는, 요소가 서로 배제하지 않는 한에 있어서는, 서로 조합될 것이다.
도 1은 발명의 실시예에 따른 제어 장치를 갖는 장치의 개략적인 블록도를 예시하며, 제어 장치는 고조파 설정점 신호에 기초하여 고조파 발진을 제어하기 위한 제어기 메인 유닛(controller main unit)과 고조파 설정점 신호를 동기화하기 위한 제어기 확장 유닛(controller extension unit)을 포함한다.
도 2a는 다른 실시예에 따른 도 1의 제어기 확장 유닛의 세부사항을 갖는 단순 블록도를 예시한다.
도 2b는 또 다른 실시예에 따른 도 2a의 제어기 확장 유닛의 다른 세부사항을 갖는 블록도를 예시한다.
도 3a는 실시예에 따른 제어 장치를 갖는 장치의 개략적인 블록도를 예시하며, 제어 장치는 고조파 설정점 신호를 위한 연속 PI 제어기(continuous PI controller)와 불감 시간 요소(dead time element)를 갖는 제어기 메인 유닛으로 지칭된다.
도 3b는 도 3a에 따른 PI 제어기의 전달 함수(transfer function)를 개략적으로 예시한다.
도 4a는 고조파 설정점 신호를 위한 이산 PI 제어기(discrete PI controller)와 불감 시간 요소를 갖는 제어기 메인 유닛을 지칭하는 실시예에 따른 제어 장치를 갖는 장치의 개략적인 블록도를 예시한다.
도 4b는 도 4a의 제어기 메인 유닛의 전달 함수를 개략적으로 예시한다.
도 5a는 실시예에 따른 제어 장치를 갖는 장치의 개략적인 블록도를 예시하며, 장치는 고조파 설정점 신호를 위한 이산 PI 제어기와 대역 통과와 유사하게 작동하는 제어기 확장을 갖는 제어기 메인 유닛을 지칭한다.
도 5b는 도 5a의 제어기 확장의 전달 함수를 개략적으로 예시한다.
도 6a는 발명의 또 다른 실시예에 따른 회전 속도 센서의 미소기계적 부분의 개략적인 평면도이다.
도 6b는 도 6a의 회전 속도 센서의 미소기계적 부분의 개략적인 단면도이다.
도 6c는 도 6a 및 도 6b에 따른 회전 속도 센서의 개략적인 블록도이다.
도 7은 발명의 또 다른 실시예에 따른 회전 속도 센서의 미소기계적 부분의 개략적인 평면도이다.
도 8은 제어 장치를 동작하기 위한 방법을 위해 단순화된 공정 흐름을 예시한다.
도 1에 도시된 바와 같이 장치(100)는 발진기(oscillator)(190) 및 제어기 메인 유닛(200)과 제어 확장 유닛(600)을 갖는 제어 장치를 포함한다. 발진기(190)는 질량(mass)이며, 질량은 여기의 방향을 따라 움직일 수 있게 매달려 있으며 그리고 공진 주파수(ω0)와 더불어 여기의 방향을 따라 발진할 수 있다. 고정 케이스에서 발진기(190)는 공진 각 주파수(ω0)와 함께 병진 또는 회전 발진을 수행한다. 실시예에 따라서 발진기(190)는 회전 속도 센서의 여기 유닛, 코리올리 유닛 또는 검출 유닛이다. 회전 속도 센서는 예를 들어 MEMS(microelectromechanical system : 미소전자기계적 시스템)로서 형성될 수 있다.
센서(170)는 발진기의 움직임을 포착하고 측정 신호를 출력하며, 이는 여기의 방향을 따라 발진기(190)의 전체 편향을 반영한다. 측정 신호는 제어기 메인 유닛(200)을 위한 제어기 입력 신호에 대응한다. 제어기 메인 유닛(200)은 제어기 입력 신호와 제어기 확장 유닛(600)으로부터 출력된 고조파 설정점 신호를 비교하며 신호 차(signal difference)에 기초하여 제어기 출력 신호를 발생하며, 제어기 출력 신호는 액츄에이터 유닛(actuator unit)(180)으로 출력된다. 제어기 메인 유닛(200)은 액츄에이터 유닛(180)이 사전결정된 고조파 설정점 신호와 발진기(190)의 측정된 움직임 간의 차이가 없어지도록 힘 신호를 발생하도록 제어기 출력 신호를 결정한다.
실시예에 따르면 제어기 확장 유닛(600)은 액츄에이터 유닛(180)이 활성화될 수 있는 액츄에이터 활성화 유닛(actuator activation unit)(695)을 포함한다. 도 1의 블록도에서 액츄에이터 활성화 유닛(695)은 액츄에이터 유닛(180)에 대한 제어기 출력 신호의 공급에 있어서 스위치로서 예시되며, 여기서 스위치는 제어기 확장 유닛(600)의 출력 신호에 의해 제어가능하다.
제어기 확장 유닛(600)은 제어 장치에 의해, 예를 들어 동작 전압(operation voltage)을 스위치 온 함으로써 활성화된다. 액츄에이터 유닛(180)은 처음에 비활성으로 머무른다. 이전의 히스토리에 따라서, 액츄에이터 유닛(18)이 비활성화되면 발진기(190)는 잔여 발진(residual oscillation)이 다루어지거나 잔여 발진을 수행한다. 제어기 확장 유닛(600)은 액츄에이터 유닛(180)이 측정 신호로부터 여전히 비활성화되는 동안 발진기(190)의 이와 같은 잔여 발진의 실제-위상 및 실제-진폭을 결정하며 실제 위상 및 실제 진폭에 적합한 동기화된 설정점 신호를 제어기 메인 유닛에 공급한다. 고조파 설정점 신호 또는 고조파 설정점 신호로부터 추론된 동기화된 제어 신호가 활용가능하게 되는 즉시, 발진기(190)의 잔여 발진의 진폭이 설정 진폭으로 위상 동기 증폭되며 그리고 이러한 공정에서 잔여 발진에 포함된 에너지가 사용되도록 제어기 확장 유닛(600)은 액츄에이터 활성화 유닛(695)을 통해 액츄에이터 유닛(180)을 활성화시킨다.
제어기 확장 유닛(600)은 매우 짧은 시간에 모든 고려가능한 초기 상태로부터 시작하여 자신의 설정된 진폭으로 발진기를 설정하며 발진기를 설정된 진폭으로 유지하도록 한다. 발진기(190)가 감쇠 시간 내에 임의의 시간에서 드라이브 또는 액추에이터 유닛(180)을 비활성화시킨 후 설정 진폭으로 발진되도록 한다면 잔여 발진이 특별히 일어난다.
실시예에 따르면 제어 장치(200, 600)와 발진기(190)는 내비게이션 기구(navigation instrument), 특히 가능한 한 짧은 시간 내 짧은 시간 전력 고장 후 방해받지 않는 동작 상태로 이동되어야 하는 항공기를 위한 내비게이션 기구의 회전 속도 센서로 구성된다. 제어기 확장 유닛(600)은 발진기(190)의 현재 감쇠하는 잔여 발진의 진폭과 위상을 추정한다.
실시예에 따르면 제어기 확장 유닛(600)은 진폭과 위상을 추정하기 위한 칼만 필터(Kalman filter)를 포함한다. 잔여 발진의 진폭과 위상으로부터 고조파 설정점 신호의 위상 및 진폭 정정 스위치-온을 위한 초기 진폭뿐만 아니라 초기 위상이 내부 신호 실행시간(internal signal runtime)의 고려 하에 추론된다. 짧은 시간동안 스위치-오프 후 재위임(recommissioning)의 주기가 감소되도록 본 잔여 발진이 사용된다. 본 잔여 발진의 진폭이 클 수록, 발진기가 설정된 진폭으로 다시 발진하도록 하기 위해 필요한 시간은 더 적다. 따라서, 특히 전력 공급의 짧은 고장 후 제어 장치(200, 600)를 포함하는 시스템의 재위임 시간(램프 업 시간(ramp up time))은 감소 된다.
도 1에 예시된 실시예에 따르면 제어기 확장 유닛(600)은 포착 유닛(capturing unit)(610)과 동기화 유닛(620)을 포함한다. 포착 유닛(610)은 측정 신호로부터 적어도 장치(100)의 활성화 위상에서, 예를 들어 동작 전압을 다시 스위치 온 한 후 발진기(190)의 잔여 발진의 실제 위상 및 실제 진폭을 결정한다. 추가 시스템 파라미터, 예를 들어, 신호 실행시간 및 신호 지연시간(retardation time) 뿐만 아니라 실제 위상 및 실제 진폭으로부터, 포착 유닛(610)은 동기화 정보를 결정하며, 이는 동기화 유닛(620)에 의해 발생된 고조파 설정점 신호의 위상 및 진폭을 표시한다. 동기화 유닛(620)은 동기화 정보를 수신하며 그리고 동기화 정보에 의해 결정된 고조파 설정점 신호를 제어기 메인 유닛(200)으로 전달한다. 예를 들어, 제어기 메인 유닛(200)은 동기화 유닛(620)으로부터 출력된 고조파 설정점 신호와 측정 신호로부터 차 신호(difference signal)를 형성하는 합산 유닛(summation unit)(221)을 포함한다.
실시예에 따르면 고조파 설정점 신호의 공진 각 주파수(ωr)는 발진기(190)의 공진 각 주파수(ω0)에 의해 결정되며, 여기서 이러한 주파수는 또한 실제 위상 및 실제 진폭을 위한 추정에 있어서 초기값으로서 통합된다. 다른 실시예에 따르면 제어기 확장 유닛(600)은 온도 포착 유닛(temperature capturing unit)을 포함하며, 여기서 포착 유닛(610)은 실제 위상 및 실제 진폭의 추정이 발진기(190)의 온도 정정 공진 각 주파수(temperature corrected resonance angular frequency)에 기초하도록 하며, 그리고 여기서 고조파 설정점 신호는 온도 정정 공진 각 주파수로 발진한다.
도 1에 예시된 실시예에 따르면 제어기 확장 유닛(600)은 주파수 스토리지 유닛(frequency storage unit)(630)을 포함하며, 주파수 스토리지 유닛(630)은 일시적인 간격에서 발진기(190)의 현재의 발진 주파수를 기술하는 주파수 정보를 저장한다. 실시예에 따르면 주파수 스토리지 유닛(630)은 비-휘발성 스토리지(non-volatile storage)에 주기적으로 현재의 공진 각 주파수를 주기적으로 저장한다. 예를 들어, 어플리케이션 전형적인 온도 변화가 이어질 수 있도록 갱신 주파수가 선택된다. 실시예에 따르면 갱신 주파수는 1Hz에서 100Hz 까지의 범위, 예를 들어 약 10Hz이다.
제어기 확장 유닛(600)은 발진기(190)의 잔여 발진의 실제 위상 및 실제 진폭을 추정하기 위한 주파수 정보를 검색하고/하거나 고조파 설정점 신호를 발생하기 위해, 예를 들어 설정점 신호를 발생하는 발진기의 제어를 위해 거기에 저장된 주파수 정보를 사용한다. 재위임을 위한 관련 시간 주기에서, 이것은 발진기(190)의 발진의 감쇠 시간내에 온도를 의미하며 따라서 발진기(190)의 공진 각 주파수는 비-휘발성 스토리지에서 진행중인 동작 동안 마지막 저장된 구동 주파수를 위한 값이 재시작 후 실제 공진 각 주파수 발진기(190)를 위한 충분히 양호한 근사치를 나타내며 그리고 제어를 위한 초기값으로서 사용될 수 있도록 거의 변하지 않는다. 예를 들어, 미소기계적 회전 속도 센서내 발진기는 10s의 범위에서 시상수(time constant)를 갖는다. 힘 전송을 비활성화한 후, 예를 들어 동작 전압의 손실 후, 발진기는 약 30s 후 여전히 설정 진폭의 약 5%로 발진한다.
실시예에 따르면 포착 유닛(610)의 시퀀스 제어는 제어기 확장 유닛(600)이 위상 및 진폭 동기 고조파 설정점 신호를 출력한다면 액츄에이터 유닛(180)만이 활성화되도록 액츄에이터 활성화 유닛(695)을 제어한다. 실시예에 따르면 액츄에이터 활성화 유닛(695)은 스위칭 장치, 예를 들어 디지털 스위치이며, 스위칭 장치는 위상 및 진폭 정정 고조파 설정점 신호가 제어기 메인 유닛(200)에 대해 활용가능한 경우에만 액츄에이터 유닛(180)에 제어기 메인 유닛(200)의 제어기 출력 신호를 공급한다.
다른 실시예에 따르면 포착 유닛(610)은 적어도 동기화 정보를 결정한 후 더 이상 필요없는 제어기 확장 유닛(600)의 이와 같은 부분적인 유닛을 비활성화시킨다.
도 2a는 포착 유닛(610)의 세부내용을 예시한다. 실시예에 따르면 포착 유닛(610)은 필터 유닛(612)을 포함한다. 예를 들어, 아날로그 측정 신호는 이러한 공정에서 샘플링 시간(T)으로 샘플되며 디지털 측정 신호로 변환된다. 필터링 유닛(612)은 측정 신호의 샘플링 값으로부터, 측정 신호에 포함된 측정 잡음의 변화에 대한 추정값으로 부터, 그리고 잔여 발진의 경우 변화를 위한 측정 신호 추정값의 일정한 진폭 오프셋(constant amplitude offset)을 위한 추정값으로부터 예를 들어 추정된 영점(zero point)을 추정한다. 실시예에 따르면 필터 유닛(612)은 이러한 공정에서 예를 들어 주파수 스토리지 유닛(630)으로부터 판독되는 주파수 정보를 사용한다. 제어 유닛(616)은 잔여 발진의 경우에 변화의 추정값으로부터 실제-위상 및 실제-진폭에 기초한 동기화 정보를 결정한다. 이러한 공정에서 제어 유닛(616)은 필터링으로 인한 지연, 요구된 계산 및 순간 발진 지연을 고려한다. 제어 유닛(616)은 이러한 방식으로 계산된 고조파 설정점 신호가 발진기(190)의 실제 발진을 갖는 위상에 존재하는 고조파 설정점 신호의 진폭과 시간(t0)을 위한 초기 위상(φ0)과 초기값(As)을 계산한다.
동기화 유닛(620)은 예를 들어 제어가능한 발진 회로(622)를 포함하며, 제어가능한 발진 회로(622)의 위상은 제어가능하다. 실시예에 따르면 또한 발진기의 주파수가 제어가능하다. 예를 들어, 발진기의 주파수는 발진기(190)의 고조파 공진 각 주파수의 온도-종속 변화가 이어질 수 있도록 온도-제어된다. 다른 실시예에 따르면 발진기 회로(622)의 공진 각 주파수(ωr)는 주파수 스토리지 유닛(630)으로의 최종 진입에 의해 결정된다. 최종 저장된 주파수에 관한 정보는 주파수 스토리지 유닛(630)으로부터 직접적으로 또는 제어 유닛(616)을 통해 발진기 회로(622)에 공급될 수 있다.
고조파 설정점 신호의 진폭은 발진기(190)의 발진의 추정된 실제-진폭에 대응하는 초기 진폭값(As)에 기초한 시간 함수(r(t))에 따라서 발진기(190)의 고조파 발진의 진폭의 설정값까지 램프 업 되도록 제어된다. 예를 들어 제어 유닛(616)은 이러한 공정에서 추정된 실제 진폭의 초기값 및 설정점 진폭의 종료 값(end value)을 갖는 램프 신호(ramp signal)를 출력하며, 시간 경과에서의 램프 신호의 변화 및/또는 램프 신호의 시상수가 실제 위상에 적합하다.
배율기 유닛(multiplcator unit)(626)은 진폭 신호(As·r(t))와 발진기 회로(622)의 출력 신호를 곱한다. 합산점(221)에서 고조파 설정점 신호와 측정 신호 간의 차가 형성된다. 실시예에 따르면 일단 그들의 결과가 제어 유닛(616)으로 전송되면 제어 유닛(616)은 필터 유닛(612)을 비활성화시킨다. 필터 유닛(612)의 비활성화는 예를 들어 전력 소모를 감소시킨다. 게다가 실현에 있어서 마이크로프로세서에서 추정을 위해 필요한 계산 용량은 장치의 정상적인 동작동안 필요한 계산 동작을 자유롭게 할 수 있다. 다른 실시예에 따르면, 제어 유닛(616)은 액츄에이터 유닛(180)이 시간(t0)에서 스위치 되도록 도 1의 액츄에이터 활성화 유닛(695)을 제어한다.
실시예에 따르면 제어기 확장 유닛(600)은 프리-스테이지 유닛(pre-stage unit)(640)을 포함한다. 프리-스테이지 유닛(pre-stage unit)(640)은 측정 신호로부터 잔여 발진의 진폭(A)이 최소 임계치(Axmin) 아래로 떨어지는지를 판단한다. 만일 그러하다면 발진기는 임의의 중요한 잔여 움직임을 더 이상 수행하지 않으며 그리고 발진기는 자신의 휴지기(resting state)로부터 문제없이 시작될 수 있다는 것이 가정될 것이다. 실시예에 따르면 그 다음 고조파 설정점 신호가 초기 진폭(AS=Axmin)으로 시작된다. 휴지기(state of rest)로부터 시작 동안의 위상은 임의적이며 고조파 설정점 신호의 주파수는 예를 들어 발진기(190)에 대한 온도 및 선형 온도 모델의 지식으로부터 결정될 수 있거나 또는 주파수 스토리지 유닛(630)으로부터 판독될 수 있다. 실시예에 따르면 프리-스테이지 유닛(pre-stage unit)(640)은 여러 발진 주기로부터 최대값(Amax) 및 최소값(Amin)을 결정하며 그리고 값(Amax 및 Amin)으로부터 식 1과 식 2에 따라서 전류 발진 진폭(A)과 전류 발진 오프셋(A0)을 위한 개략적인 값을 계산한다:
Figure 112014049148960-pct00001
예를 들어, 제어기 확장 유닛(600)은 디지털 회로, 예를 들어 주문형 반도체(application specific integrated circuit: ASIC), 디지털 신호 프로세서(digital signal processor: DSP) 또는 필드 프로그래머블 게이트 어레이(field programmable gate array: FPGA)로서 구현된다. 제어기 확장 유닛(600)과 제어기 메인 유닛(200)은 동일하거나 상이한 컴포넌트로 형성될 수 있다. 다른 실시예에 따르면 제어기 확장 유닛(600)과 제어기 메인 유닛(200)은 완전하거나 부분적으로 프로그램이며, 프로그램은 컴퓨터 또는 마이크로프로세서로부터 수행된다.
실시예에 따르면 필터 유닛(612)은 칼만-필터(Kalman-filter)이다. 진폭 및 위상을 위한 값의 추정은 발진기 여러 진폭의 감쇠 시상수에 비해서 빠르게 수행된다. 따라서 실시예에 따르면 발진기의 움직임(y0)은 비감쇠 고조파 발진(undamped harmonic oscillation)으로 가정된다:
Figure 112014049148960-pct00002
측정 신호(y*(t))는 실제 발진기 움직임(y0) 외에 불가피한 측정 잡음(w)과 상수 오프셋(A0)을 또한 포함한다.
Figure 112014049148960-pct00003
발진기 움직임(y0(t))은 식(5) 내지 식(10)과 더불어 미분 방정식 시스템의 해(solution)로서 고려된다:
Figure 112014049148960-pct00004
이러한 시스템의 상태의 설명은 다음과 같이 식(11)과 더불어 행렬 표현을 이용해 표시될 수 있다:
Figure 112014049148960-pct00005
계차 방정식 시스템(difference equation system)을 획득하기 위해, 상기 시스템은 측정 신호의 사용된 샘플링 T에 대하여 이산화된다. 이것은 라플라스 변환(Laplace transformation)에 의해 표현된다.
Figure 112014049148960-pct00006
Figure 112014049148960-pct00007
계차 방정식 시스템을 위한 요소는 다음과 같이 표현될 수 있다:
Figure 112014049148960-pct00008
계산 및 구현을 단순히 하기 위해, 다음과 같이 ω0M을 갖는 상태 변수(state variable)(x2')를 정상화하는 것이 바람직하다:
Figure 112014049148960-pct00009
새로운 상태 변수와 더불어
Figure 112014049148960-pct00010
이산화된 시스템의 상태의 설명은 다음과 같이 표시될 수 있다:
Figure 112014049148960-pct00011
측정 잡음(w)의 변화를 위해 부호(R)가 다음으로 사용된다.
실시예에 따른 잡음 측정값(y*)에 기초하여 칼만-필터는 실제 시스템 상태(x)의 추정값(
Figure 112014049148960-pct00012
)을 얻기 위해 사용된다. 칼만 필터는 다음 식의 세트로 기술될 수 있다:
Figure 112014049148960-pct00013
요소별로 고려함으로써 칼만 필터 방정식은 다음과 같이 식(30) 내지 식(42)으로 표시될 수 있다. 여기서 행렬 P *
Figure 112014049148960-pct00014
의 대칭이 사용되었다:
Figure 112014049148960-pct00015
Figure 112014049148960-pct00016
추정된 신호(
Figure 112014049148960-pct00017
)의 음(negative)의 값으로부터 양의 값(positive value)까지 영 교차(zero crossing)는 적절한 위상에서 진폭 제어의 설정 신호를 시작하기 위해 사용된다. 검출된 영 교차와 일치하도록 시간 제로(time zero)가 선택된다. 그 다음 추정된 신호는 sin(ω0M·T·k)에 비례한다.
진폭 제어의 설정점 신호는 초기 위상 0을 갖는 추정된 신호의 영 교차에서 정확히 시작해야 한다. 그러나 T의 임시 해상도를 갖는 샘플링 값만이 활용가능하기 때문에, 일반적으로 영 교차는 정확히 충족되지 않을 수 있다. 실시예에 따르면 이러한 이유 때문에 추가적으로 고려될 위상(
Figure 112014049148960-pct00018
)은 영 교차 이전의 샘플링 값(
Figure 112014049148960-pct00019
)과 식(43)에 따른 선형 보간에 의해 영 교차에 뒤 이은 샘플링 값(
Figure 112014049148960-pct00020
)으로부터 결정된다:
Figure 112014049148960-pct00021
이러한 위상은 단지 후속하는 사이클에서 효과적이 되며, 이는 추가적으로 고려되어야 할 지연을 초래한다. 더욱이, 실현에 따라 추가 지연이 신호 처리 동안(예를 들어, 측정값의 포착 동안) 고려되어야 한다. 다중 샘플링 시간에서 이들 추가 지연은 nosc인 것으로 가정된다. 그 다음 필요한 초기 위상(
Figure 112014049148960-pct00022
)은 식(44)을 따른다:
Figure 112014049148960-pct00023
도 2b는 제어 장치의 필터 유닛(612)으로서 칼만-필터의 세부내용을 예시한다.
(예를 들어, 3개의 회전 속도 센서로 구성된 관성 측정 유닛(inertial measurement unit: IMU)에서) 공동 전자장치(common electronic) 때문에 시스템이 여러 발진기로 구성되며 발진기의 구동이 함께 시작되어야 한다면 발진기의 영 교차는 필연적으로 동일한 샘플링 사이클 내에서 발생하지 않아야 한다. 이러한 이유 때문에 그들의 영 교차를 이미 가지고 있는 그들 발진기에 대한 시작 위상은 각각의 추가적인 샘플링 사이클 동안 ω0M·T 만큼 증가 된다. 이것은 최종 발진기가 자신의 영 교차를 가질 때까지 또한 수행된다.
예를 들어, 동기화 조건(측정된 발진기 신호의 영 교차)이 이들 센서 중 적어도 하나를 위해 검출되자마자, 이러한 센서의 구동은 상기-기술된 방법에 따라서 시작된다. 그 다음 나머지 센서의 스위치-온은 또한 그들의 개별적인 동기화 조건이 충족되자마자 수행될 수 있다. 구동에 대한 스위칭을 위한 시간은 이러한 공정에서 개별적으로 모든 센서를 위해 선택된다. 구동의 공통 스위치-온 시간만이 가능한 공통 전자장치를 갖는 다른 실시예에 따라서, 모든 센서를 위한 동기화 조건이 검출될 때까지 기다려진다. 샘플링 사이클당 동기화 조건이 한 차례 평가될 수 있으며, 각각의 센서에 대해, 이의 동기화 조건이 이미 획득되었기 때문에, 샘플링 시간에 대응하는 위상 ω0M·T 이 각각의 추가적인 샘플링 사이클을 위한 시작 위상에 추가된다.
도 3a에 예시된 실시예는 제어기 메인 유닛(200)이 장치(100) 내의 제어기 메인 유닛(200)의 아날로그 실시예에 기초하는 원리의 동작의 모드를 명확히 하기 위해 기술된다. 제어기 메인 유닛(200)은 적분 동작 계수(Ki)를 갖는 적분 전달 요소(222)와 증폭 인자(Kp)를 갖는 비례 전달 요소(224)를 구비하는 고조파 커맨드 변수 또는 고조파 설정점 신호를 위한 PI 제어기(225)를 포함한다. 고조파 커맨드 변수를 위한 PI 제어기(225)는 제어기 입력에서 일정한 진폭의 고조파 발진으로부터 제어기 출력에서 동일한 주파수 및 시간 비례 진폭을 갖는 고조파 발진을 발생한다.
도 3b는 PI-제어기(225)의 전달 함수(GR0(s))에 의해 시간 비례 진폭을 갖는 고조파 출력 신호(u(t))로 사인파 변조 계단 함수 신호(xd(t))의 변환을 예시한다. PI-제어기의 기술된 행위는 후속적으로 기술된 바와 같이 제어기 파라미터(Ki, Kp)의 치수화(dimensioning)를 요구한다. 식(45)은 xd(t)=σ(t)에 대해 제어기 출력 신호(u(t))와 제어기 입력 신호(xd(t)) 사이의 관계를 제공한다.
Figure 112014049148960-pct00024
제어기 출력 신호(u(t))와 제어기 입력 신호(xd(t))의 라플라스-변환(Laplace-transform)은 식(46a)과 식(46b)의 결과를 가져온다:
Figure 112014049148960-pct00025
따라서 고조파 설정점 신호를 위한 PI-제어기(225)의 전달 함수(GR0(s))는 식(47)의 결과를 가져온다:
Figure 112014049148960-pct00026
연속 PI-제어기(225)를 위한 특성으로는 일반화된 적분 성분으로부터 생기는 s=±jω0에서 켤레 복소수 극(conjugate complex pole)이다. 제어기 입력에서 주파수(ω0)의 고조파 발진과 함께, PI-제어기(225)는 제어기 출력에서 위상 시프트를 발생하지 않는다. 임의적인 위상(arbitrary phase)의 조절을 위해 제어기 메인 유닛(200)은 따라서 PI-제어기(225)에 직렬로 제어기 불감 시간(controller dead time)(TR)를 지닌 불감 시간 요소(226)을 추가적으로 포함한다. 따라서 제어기 메인 유닛(200)의 제어기 전달 함수(GR0(s))는 식(48)의 결과를 가져온다:
Figure 112014049148960-pct00027
제어기 파라미터(Ki, Kp)는 식(48)에 따른 제어기 전달 함수에서 제어기 영(controller zero)이 식(49)에 따른 시스템 전달 함수에서 켤레 복소수 시스템 극을 보상하도록 선택된다.
Figure 112014049148960-pct00028
제어기 파라미터(Ki, Kp)의 결정을 위해 식(48)과 식(49)의 계수를 동등하게 함으로써 식(50a)과 식(50b)의 결과는 다음과 같다:
Figure 112014049148960-pct00029
일 실시예에 따르면 발진기(190)의 댐핑(s0)과 공진 각 주파수(ω0)는 s0 ≪ω0이 충족되며 따라서 식(50b)은 매우 양호한 근사치로 충족되도록 선택된다. 식(50a)으로부터 식(50c)은 적분 동작 계수(KI) 대 증폭 인자(KP)의 비율을 위한 치수화 규칙에 따라서 결과는 다음과 같다:
Figure 112014049148960-pct00030
정정된 개 루프(open loop)의 전달 함수(Gk(s))는 시스템 전달 함수(GS(s))와 제어기 전달 함수(GR(s))의 곱의 결과이다. 켤레 복소수 시스템 극과 켤레 복소수 제어기 영(0)을 위한 표현이 식(50b), (50c)에 따른 적절한 치수화에 의해 상쇄되어 없어지기 때문에, 정정된 개 루프의 전달 함수(Gk(s))는 식(51)의 결과를 가져온다:
Figure 112014049148960-pct00031
종래의 PI-제어기와 더불어 피드백 제어에 의해 +90°에서 -90°로 위상 점프는 주파수 ω=0에서 정정된 개 루프의 위상 주파수 응답에서 발생한다. 대조적으로 고조파 커맨드 변수를 위해 설계된 PI-제어기(225)에서 180° 위상 점프는 주파수(ω0)에서 발생하지만, 그러나 180°위상 점프는 반드시 +90°과 -90° 사이일 필요는 없다. 따라서 일 실시예에 따르면 제어기 불감 시간(TR)은 따라서 180°위상 점프가 ω0에서 되도록 이면 정확히, 예를 들어 식(52a)에 따라 제어기 파라미터를 치수화함으로써 발생하도록 선택된다:
Figure 112014049148960-pct00032
위상 시프트가 90°보다 작은 ω0에서 단독으로 시스템 불감 시간(TS)에 의해 발생 된다면, 180°의 위상 비율이 인버팅 제어기(inverting controller)에 의해 또한 발생 될 수 있다. 이 경우에 ω0에서 제어기 불감 시간(TR)에 의해 발생된 위상과 시스템 불감 시간(TS)에 의해 각각 발생 된 위상은 단지 π/2에 더해져야 한다. 그 다음 제어기 불감 시간(TR)을 위한 치수화 규칙은 다음과 같다:
Figure 112014049148960-pct00033
정정된 개 루프의 주파수 응답으로부터 폐 루프의 안정도 특성은 나이퀴스트 판별법(Nyquist criterion)을 통해 추론될 수 있다. 정정된 개 루프는 범용 적분기 및 시스템 불감 시간(TS)과 제어기 불감 시간(TR)의 조합으로 이루어진다. 식(52a) 또는 식(52b)에 따른 제어기 불감 시간(TR)의 적절한 치수화에 의해 주파수(ω0)에서 위상 특성은 보다 낮은 주파수 ω<ω0에 대해 +90°와 보다 높은 주파수 ω>ω0에 대해 -90° 사이의 180°점프를 갖는다. 폐 루프의 전달 함수(GW(s))는 정정된 개 루프(Gk(s)) 중 하나로부터 생긴다:
Figure 112014049148960-pct00034
제어기 불감 시간(TR)이 식(52a)에 따라서 결정될 때 폐 루프는 정정된 개 루프의 중심지(locus)가 0≤ω<ω0에 대해 점 -1을 둘러싸지 않거나 포인트 -1을 통해 실행되지 않을 때 정확히 안정적이다.
대조적으로 제어기 불감 시간(TR)이 식(52b)에 따라서 결정되고 PI-제어기(225)가 180° 위상을 발생할 때 폐 루프는 네거티브 실수축(negative real axis)에서 정정된 개 루프의 중심지가 -1 보다 큰 값에서 시작할 때 정확히 안정적이다.
간격 0≤ω<ω0에서 절대값 특성은 이득 크로스오버 주파수에서 0dB 라인을 교차하며, 여기서 이득 크로스오버 주파수에서 ω0에 대한 주파수 거리는 폐루프의 대역폭을 결정한다. 증폭 인자(Kp)를 통해 절대값 주파수 응답이나 이득 크로스오버 주파수가 폐루프의 결과적인 대역폭이 조절가능하도록 종좌표(ordinate)를 따라서 이동될 수 있다. 일 실시예에 따르면 증폭 인자(Kp)는 대역폭이 안정성 기준(stability creteria)에 의해 주어진 허용치(limits) 내에서 최대가 되도록 선택된다.
요약하면, 제어기 메인 유닛(200)은 고조파 커맨드 변수를 위한 PI-제어기(225)를 포함하며, PI-제어기(225)는 고조파 설정점 신호를 공급받으며 증폭 인자(Kp)를 갖는 비례 전달 요소(224)와 적분 동작 계수(KI)를 갖는 적분 전달 요소(222)를 포함한다. 적분 동작 계수(KI)와 증폭 인자(Kp)는 s-평면에서 PI-제어기(225)의 제어기 전달 함수의 영과 시스템 전달 함수를 기술하는 발진기(190)의 켤레 복소수 극이 보상되도록 선택된다.
일 실시예에 따르면 여기의 방향의 편향에 대한 발진기(190)의 댐핑(s0)은 발진기(190)의 공진 각 주파수(ω0)보다 훨씬 작으며 sec-1에서 적분 동작 계수(KI) 대 증폭 인자(Kp)의 비율은 댐핑(s0)에 대략적으로 응답한다. 더욱이, 증폭 인자(Kp)는 결과적인 대역폭이 각각의 안정성 요구조건에 대해 가능한 한 높도록 선택될 수 있다. 그 다음 적분 동작 계수(KI)는 식(12c)에 따라서 댐핑(s0)과 증폭 인자(Kp)로부터 종속적으로 선택된다.
일 실시예에 따르면 액츄에이터(180)로부터 형성된 시스템, 발진기(190) 및 센서 유닛(170)은 시스템 불감 시간(TS)을 가지며 그리고 제어기 메인 유닛(200)은 PI-제어기(225)에 직렬로 작용하는 제어기 불감 시간(TR)을 갖는 불감 시간 요소(226)를 갖는다. 제어기 불감 시간(TR)은 발진기(190)의 공진 주파수(ω0)에 종속적으로 선택되며 시스템 불감 시간(TS)은 주파수(ω0)에서 정정된 개루프의 위상 주파수 응답이 보다 높은 주파수를 향해 +90°에서 -90°까지 위상 점프를 갖도록 선택된다.
본 실시예의 제1 변형에 따르면 고조파 커맨드 변수를 위한 PI-제어기는 부호를 뒤집지 않으며 제어기 불감 시간(TR)은 공진 각 주파수(ω0)의 곱 및 시스템 불감 시간(TS)과 제어기 불감 시간(TR)의 합이 결과적으로 3π/2를 갖도록 선택된다. 본 실시예의 다른 변형에 따르면 PI-제어기(225)는 부호를 반전시키며, 각각 약 180° 위상을 이동시키며, 그리고 공진 각 주파수(ω0)에서 제어기 불감 시간(TR)과 시스템 불감 시간(TS)에 의해 영향을 받는 위상은 공진 각 주파수(ω0)의 곱 및 시스템 불감 시간(TS)과 제어기 불감 시간(TR)의 합이 결과적으로 π/2를 갖도록 단지 π/2에 더해진다.
제어기 메인 유닛(200)이, 보다 높은 주파수 변환 곱의 댐핑을 위해 저역 통과 필터(low pass filter)를 요구하는, 베이스밴드 변환(baseband transformation)를 제공하지 않음에 따라서, 제어기 메인 유닛(200)은 상당히 보다 넓은 대역으로 형성될 수 있다. 제어기 메인 유닛(200)은 베이스밴드 변환를 제공하는 비교 제어기 보다 방해에 보다 빨리 반응한다.
도 4a 및 도 4b는 제어기 메인 유닛(200)이 증폭기 인자(Kp)를 갖는 이산 비례 전달 요소(324)와 적분 동작 계수(KI)를 갖는 이산 적분 전달 요소(322)와 함께 고조파 설정점 신호를 위한 이산 PI-제어기(325)를 갖는다. 실시예에 따르면 센서 유닛(170)에 의해 출력된 아날로그 측정 신호는 샘플링 유닛(321)에 의해 샘플링 시간(T)을 갖도록 샘플되며 이산 PI-제어기(325)를 위해 디지털 입력 신호로 변환된다. 다른 실시예에 따르면 센서 유닛은 디지털 측정 신호를 미리 출력한다.
액츄에이터(180), 발진기(190) 및 센서 유닛(170)을 포함하는 시스템이 시스템 불감 시간(TS)을 갖는 실시예에 따라서, 제어기 메인 유닛(200)은 제어기 불감 시간(TR)을 갖는 이산 PI-제어기(325)에 직렬로 정렬된 불감 시간 요소(326)를 포함한다. 다음으로 제어기 불감 시간(TR) 뿐만 아니라 시스템 불감 시간(TS)은 식(54a)과 식(54b)에 따라서 샘플링 시간(T)의 곱으로서 표현된다:
(54a), (54b) TS = βS·T 및 TR = βD·T.
이러한 공정에서 제어기 불감 시간(TR)은 정정된 개루프가 공진 각 주파수(ω0)에서 보다 높은 주파수를 향해 +90°에서 -90°까지 위상 점프를 갖도록 결정된다.
일 실시예에 따르면 적분 동작 계수(KI) 대 증폭 인자(KP)의 비율은 제어기 전달 함수의 제어기 영(zero)이 s-평면에서 시스템 전달 함수의 켤레 복소수 시스템 극을 보상하도록 조절된다. 다른 실시예에 따르면 제어기 파라미터는 등가 베이스밴드 시스템(equivalent baseband system)의 폐루프의 전달 함수가 이중 실 고유치(double real eigenvalue)를 갖도록 선택된다. 예를 들어 제어기 메인 유닛(200)은 디지털 회로, 예를 들어 ASIC(application specific integrated circuit), DSP(digital signal processor) 또는 FPGA(Field Programmable Gate Array)로서 또는 컴퓨터 또는 마이크로프로세서를 위한 프로그램으로서 구현된다.
도 4b는 도 4a에 따른 고조파 커맨드 변수를 위한 이산 PI-제어기(325)의 z-전달 함수(GR0(z))를 예시한다. 전달 함수(GR0(z))는 PI-제어기(325)가 계단 함수(σ(k))에 의해 변조된 고조파 발진을 포함하는 입력 신호(xd(k))로부터 식(55)에 의해 표현된 바와 같이 제어기 출력 신호(u(k))로서 시간 비례 진폭(time proportional amplitude)을 갖는 동일한 주파수의 고조파 발진을 발생하도록 결정된다:
(55) u(k) = (KP + KI·T·k)·sin(ω0·T·k)·σ(k)
입력 함수(xd(k))와 출력 함수(U(z))는 식 (56a) 및 식(56b)에 따라서 z-변환의 결과를 가져온다:
(56a)
Figure 112014049148960-pct00035
(56b)
Figure 112014049148960-pct00036
그 다음 고조파 커맨드 변수를 위한 이산 PI-제어기(325)의 전달 함수(GR0(z))는 식(56c)의 결과를 가져온다:
(56c)
Figure 112014049148960-pct00037
범용 적분 부분 때문에 이와 같은 이산 PI-제어기는
Figure 112014049148960-pct00038
에서 극을 가지며 입력에서 주파수(ω0)의 고조파 발진과 함께 출력에서 위상 이동을 발생하지 않는다. 그럼에도 불구하고 임의적인 위상을 조절할 수 있도록 하기 위해, 제어기 메인 유닛(200)은 일 실시예에 따라서 지연(βD)을 갖는 불감 시간 요소(326)를 구비한다. 그 다음 불감 시간 요소(326)와 이산 PI-제어기(325)를 갖는 제어기 메인 유닛(200)의 제어기 전달 함수(GR0(z))는 식(57)의 결과를 가져온다:
(57)
Figure 112014049148960-pct00039
따라서 식(49)에 따른 연속 제어 시스템의 모델이 이산화되어야 한다. 이러한 목적을 위해 식(49)에 따른 제어 시스템의 전달 함수(G(s))에서 시스템 불감 시간(TS)은 최초 표현에서 식(54a)에 따른 샘플링 시간(T)의 곱으로서 표현된다:
(58)
Figure 112014049148960-pct00040
일반적으로 전달 함수(G(s))를 갖는 연속 제어 시스템의 이산화된 모델의 계단 전달 함수(G(z))는 식(59)에 따라서 계산될 수 있다:
(59)
Figure 112014049148960-pct00041
식(59a) 내지 식(59(e)에 따라서 이어지는 축약
Figure 112014049148960-pct00042
과 함께, 발진기(190)를 위한 계단 전달 함수(G(z))는 식(60)에 따라서 식(58)과 식(59)의 결과를 가져온다:
(60)
Figure 112014049148960-pct00043
본 발명의 일 실시예에 따르면 제어기 불감 시간(TR)은 정정된 개루프의 위상 주파수 응답이 공진 각 주파수(ω0)에서 보다 높은 주파수를 향해 +90°으로부터 -90°까지 위상 점프를 갖도록 결정된다. 정정된 개루프를 위한 z-전달 함수는 식(57)에 따른 제어기 전달 함수(GR(z))와 식(58)에 따른 시스템 전달 함수(G(z))의 곱으로부터 식(51)과 유사한 결과가 된다:
(61)
Figure 112014049148960-pct00044
식(52a) 및 식(52b)에 유사하게 제어기 파라미터(βD)는 정정된 개루프(Gk(z))의 전달 함수가 공진 각 주파수(ω0)에서 +90°으로부터 -90°까지 위상 점프를 갖도록 선택된다:
(62a)
Figure 112014049148960-pct00045
식(52a)과 비교해 볼 때 발명자는 연속 제어기에 대하여 ½ω0T의 추가적인 부분을 발견했으며, 이것은. 추가적인 절반 샘플링 사이클의 이산화로 다시 추적될 수 있는, 지연을 표현한다. 시스템 불감 시간(βS·T)에 의해 발생 된 위상 시프트와 이산화(discretization)는, 각각, 공진 각 주파수(ω0)에서 90°보다 작으면, 연속 제어기의 경우에 있어서 180°의 위상 점프가 제어기에서 - 부호에 의해 발생 될 수 있기 때문에, 이산화에 의해 발생 된 위상, 제어기 불감 시간(βD·T) 그리고 시스템 불감 시간(βS·T)은 단지 π/2가 될 필요가 있다. 따라서, βD를 위한 치수화는 본 경우에 있어서 식(62b)의 결과를 가져온다:
(62b)
Figure 112014049148960-pct00046
식(62a)과 식(62b)은 정상적으로 βD에 대해 비-적분 값을 초래한다. 일반적으로, 제어기 파라미터(βD)는 식(63)에 따라서 적분 부분(nD)와 aD > 1인 나머지 1/aD를 갖는다:
(63)
Figure 112014049148960-pct00047
일 실시예에 따르면 적분 부분(nD)은 nD로 표시된 길이에 따라서 지연 체인(retardation chain)에 의해 근사될 수 있으며 샘플링 사이클의 분수(1/aD)은 식(64)에 따라 1차의 전대역 통과 필터(all-pass filter)에 의해 근사 될 수 있다:
(64)
Figure 112014049148960-pct00048
일 실시예에 따르면 전대역 통과 필터의 파라미터(αD)는 식(64)에 따른 정확한 전달 함수(
Figure 112014049148960-pct00049
)의 위상과 전대역 통과 근사치의 위상이 가능한 한 멀리 공진 각 주파수(ω0)에서 일치하도록 선택된다. 이들 조건으로부터 식(65)은 전대역 통과 필터의 파라미터(αD)를 위한 조건 방정식을 가져온다:
(65)
Figure 112014049148960-pct00050
일 실시예에 따르면 αD는 내포된 인터벌을 통해 식(66)에 따른 함수의 영(zero)이 결정되도록 결정된다.
(66)
Figure 112014049148960-pct00051
식(63)과 식(66)에 따라서 nD와 αD의 결정은 추가 제어기 파라미터(KP 및 KI)를 결정하는 방식으로부터 독립적이다.
도 4a에 따라서 이산 PI-제어기(325)의 치수화를 포함하는 제어기 유닛을 제조하기 위한 방법의 일 실시예에 따라서, 이산 PI-제어기(325)의 증폭 인자(KP)와 적분 동작 계수(KI)는 식(57)에 따른 제어기 전달 함수(GR(z))에서 제어기 영이 식(60)에 따른 제어기 전달 함수(G(z))의 켤레 복소수 시스템 극을 보상하도록 선택된다. z1에 대하여 식(57)과 식(60)의 동등 계수는 식(67)에 따른 치수화 규칙을 가져온다:
(67)
Figure 112014049148960-pct00052
z0에 대하여 동등 계수는 식(68)에 따른 치수화 규칙을 가져온다:
(68)
Figure 112014049148960-pct00053
일 실시예에 따르면 발진기(190)의 댐핑(s0)과 샘플링 시간(T)은 식(69a)과 식(69b)에 따라서 근사치가 충분히 정확하도록 s·T << 1이 유지되도록 선택된다:
(69a)
Figure 112014049148960-pct00054
(69b)
Figure 112014049148960-pct00055
식(69a) 및 식(69b)에 따른 근사치와 더불어 식(67) 및 식(68)에 따른 2개의 독립적인 치수화 규칙은 식(70)에 따라서 단일 치수화 규칙에 의해 근사화될 수 있다:
(70)
Figure 112014049148960-pct00056
, 각각
Figure 112014049148960-pct00057
일 실시예에 따르면 적분 동작 계수(KI) 대 증폭 인자(KP)의 비율은 발진기의 댐핑(s0)과 동일하거나 거의 동일하게 설정된다. 제어기 영에 의해 시스템 극의 보상을 포함하는 기술된 방법에 따라서 이산 PI-제어기(325)의 치수화는 폐 루프의 양호한 기준 작용을 유도한다.
도 5a 및 도 5b는 제어기 메인 유닛(200)이 제어기 확장(328)을 갖는 일 실시예를 지칭하며, 제어기 확장(328)은 도 4a에 따라서 PI-제어기(325) 및 불감 시간 요소(326)에 직렬로 정렬된다. 이어서 제어기 확장(328)의 구조는 베이스밴드를 위한 아날로그 제어기 확장으로부터 추론된다.
예를 들어 발진기(190)는 ω0에서 공진 각 주파수 이외에 공진 각 주파수(ω0)를 초과하거나 초과하지 않는 기계적인 구조 공진과 같은 추가 공진을 가질 수 있다. 제어기 확장(328)은 이들 추가 공진들이 보다 강하게 감쇄되도록 형성된다. 이것을 위해 원하는 대역폭을 넘어서는 킹크 주파수(kink frequency)에서 여분의 극을 갖는 1차의 지연 요소(PT1-요소)가 베이스밴드에서 종래의 PI-제어기에 더해질 것이다. 이러한 추가적인 제어기 극은 제어기가 더 이상 고주파수를 위한 비례 요소로서 작용하지 않지만, 제어기의 절대값 주파수가 20db/decade로 떨어지는 것에 영향을 준다. 베이스밴드에서 이와 같은 확장의 계단 응답(y(k))은 식(71)에 따른 입력 신호(u(k))로서 계단 함수(σ(k))를 야기한다:
(71)
Figure 112014049148960-pct00058
입력 신호(u(k))의 z 변환(u(z))은 계단 신호의 z 변환에 대응한다:
(72a)
Figure 112014049148960-pct00059
출력 신호(y(k))의 z 변환(Y(z))은 식(72b)의 결과를 가져온다:
(72b)
Figure 112014049148960-pct00060
따라서 베이스밴드에서 이와 같은 제어기 확장의 전달 함수(GREO(z))를 위한 식(47)에 유사하게
(73)
Figure 112014049148960-pct00061
의 결과를 가져온다.
일 실시예에 따르면 대역통과 대역에서 제어기 확장(328)은 이제 제어기 확장(328)이 동일한 주파수의 고조파 발진과 더불어 계단 함수에 의해 변조된 공진 각 주파수(ω0)의 고조파 발진의 입력에 응답하도록 베이스밴드에서 제어기 확장에 유사하게 구성되며, 여기서 베이스밴드 확장의 계단 응답은 도 5b의 우측에 예시된 바와 같이 엔벨로프(envelope)를 정의한다.
도 5b는 엔벨로프가 대역통과 대역에서 이산 제어기 확장의 전달 함수(GREO(z))에 따라서 계단 응답의 결과를 가져오는 부호 발진(sign oscillation)과 더불어 출력 신호 위에 부호 변조 계단 함수(u(k))의 변환을 예시한다. 전달 함수(GREO(z))와 더불어 대역통과 대역에서 제어기 확장(328)의 입력 신호는 식(74)의 결과를 가져온다:
(74)
Figure 112014049148960-pct00062
제어기 출력 신호(y(k))는 엔벨로프가 베이스밴드에서 PT1-제어기 확장의 계단 응답에 대응하는 고조파 발진이다:
(75)
Figure 112014049148960-pct00063
z-변환(U(z) 및 Y(z))은 식(76a)과 식(76b)의 결과를 가져온다:
(76a)
Figure 112014049148960-pct00064
(76b)
Figure 112014049148960-pct00065
대역통과 대역을 위한 제어기 확장(328)의 전달 함수(GRE(z))는 식(77)의 결과를 가져온다:
(77)
Figure 112014049148960-pct00066
전달 함수(GRE(z))를 갖는 제어기 확장(328)은 중간대역 주파수로서 공진 주파수(ω0)를 갖는 1차의 대역통과와 유사하게 이산 PI-제어기(325)에 직렬로 작용한다. 식(78)에 따라서 공진 각 주파수(ω0) 근처 좁은 영역내 공진 각 주파수(ω0)에서 정정된 개루프의 절대값과 위상은 변하지 않고 유지된다.
(78)
Figure 112014049148960-pct00067
이러한 영역에서 정정된 개 루프의 절대값 주파수 응답은 거의 영향을 받지않는 반면에, 이러한 영역 밖에서 가능한 원하지 않는 공진이 하락 될 수 있도록 절대값의 상당한 하락(drop)이 발생한다.
도 6a 내지 도 6c는 추가 실시예에 따른 미소기계적 회전 속도 센서(500)를 지칭한다. 회전 속도 센서(500)는 제1 스프링 요소(541)에서 매달리는 여기 유닛(590), 예를 들어, 여기 프레임을 포함한다. 제1 스프링 요소(541)는 여기 유닛(590)을 도 6b에 예시된 지지 기판(550)에 단단히 연결되는 부착 구조물(551)에 결합한다. 스프링 요소(541)는 단지 약하게 여기(501)의 방향을 따라 지지 기판(550)에 대하여 여기 유닛(590)의 편향을 감쇠시킨다. 제2 스프링 요소(542) 위에 검출 유닛(580)은 여기 유닛에 결합되며 그리고 주로 여기(501)의 방향에 직교인 검출 방향(502)을 따라 여기 유닛(590)에 대하여 움직일 수 있다. 여기(501)의 방향과 검출 방향(502)은 지지 기판(550)의 표면에 나란하게 구동한다. 제1 및 제 2 스프링 요소(541, 542)는 예를 들어 작은 교차 단면을 갖는 빔형 구조이며, 작은 교차 단면은 결합 될 구조의 각각의 사이에 형성된다.
일 실시예에 따르면 회전 속도 센서(500)는 제1 힘 전달 및 센서 유닛(561, 571), 예를 들어, 정전력 전달기와 센서를 포함하며, 이는 여기(501)의 방향을 따라 발진에 대해 여기 유닛(590)과 검출 유닛(580)으로부터 형성된 시스템을 여기시키며/시키거나 여기 유닛(590)의 대응하는 편향을 포착할 수 있다. 회전 속도 센서(500)는 제2 힘 전달 및 센서 유닛(562, 572), 예를 들어, 정전력 전달기와 센서를 포함하며, 이는 검출 유닛(580)에 대해 작용하며/하거나 자신의 편향을 포착할 수 있다. 일 실시예에 따르면 제2 힘 전달 및 센서 유닛(562, 572) 중 적어도 하나는 제2 힘 전달 및 센서 유닛(562, 572)이 방해에 의해 야기되거나 또는 측정 변수에 의해 야기된 폐 루프 시스템의 경우에 검출 유닛(580)의 편향에 대응하도록 제어된다.
회전 속도 센서(500)의 동작 동안 제1 힘 전달 및 센서 유닛(561, 571)은 예를 들어 여기(501)의 방향을 따라 발진에 대해 여기 유닛(590)을 여기시키며, 여기서 검출 유닛(580)은 여기 유닛(590)과 함께 대략 동일한 진폭과 위상으로 움직인다. 정렬이 기판 평면에 직교인 축 근처에서 회전될 때 코리올리 힘이 여기 유닛(590)과 검출 유닛(580)에 작용하며, 이는 검출 방향(502)으로 여기 유닛(590)에 대하여 검출 유닛(580)을 편향시킨다. 제2 힘 전달 및 센서 유닛(562, 572)은 편향 유닛(580)의 편향을 포착하며 따라서 기판 평면에 직교인 축 근처에서 회전 운동을 포착한다.
일 실시예에 따라서 힘 전달 및 센서 유닛(561, 572, 562, 572) 중 적어도 하나의 유닛은 액츄에이터 및 상기 기술된 장치(200) 중 하나의 의미 내에서 발진기로서 여기 유닛(590)이나 검출 유닛(580)으로서 작용한다.
예를 들어 회전 속도 센서(500)의 도 6c에 예시된 일 실시예에 따라서 제1 힘 전달 및 센서 유닛(561, 571)은 여기(501)의 방향을 따라 공진 각 주파수(ω0)와 더불어 발진에 대해 여기 유닛(590)을 여기시킨다. 그 다음 상기 논의에 따른 제어 루프에서 검출 방향(502)을 따라 검출 유닛(580)(x2-발진기)의 발진은 예를 들어 전술한 바와 같이 고조파 힘 신호에 대응할 수 있다.
x2-발진기의 편향은 공통 가동 전극 위 전하(charge)를 통해 포착될 수 있으며, 공통 가동 전극은 여기 유닛(590) 위에 형성된다. 전하는 부착 구조(551)를 통해 측정될 수 있다. 전하 증폭 유닛(521)은 측정된 신호를 증폭한다. 비록 전형적으로 복조 유닛이 측정된 신호를 제어기 유닛으로 공급되기 전에 예를 들어 공진 각 주파수(ω0)에 대응하는 주파수와 함께 측정된 신호를 변조하지만, 발명의 실시예는 상기 논의에 따라서 상기 논의된 의미 내에서 측정 신호로서 비-복조된 고조파 신호를 제어기 유닛(520)으로 공급하기 위해 제공된다.
발진에 효과적인 댐핑(s0)은 공진 각 주파수(ω0)보다 상당히 작다. 신호는 여기 프레임에 걸쳐서 각각 측정되었으며 여기 유닛(590)은 여기(501)의 방향을 따라 여기 유닛(590)의 움직임을 부분적으로 재생한다. 소스가 회전 속도 센서(500)의 바깥에 존재할 수 있는 방해, 또는, 폐 루프 시스템에서, 측정 변수는, 각각, 발진을 중첩하며 자신의 진폭을 변조한다. 제어기 유닛(520)은 변조된 고조파 신호로부터 제2 힘 전달 및 센서 유닛(562, 572)이 각각 방해 또는 측정 변수에 의해 영향을 받는 편향에 대응하는 것에 영향을 끼치는 제2 힘 전달 및 센서 유닛(562, 572)을 위한 제어 신호를 추론한다. 증폭 유닛(522)은 제2 힘 전달 및 센서 유닛(562, 572)의 전극을 위한 적절한 리셋 신호로 제어 신호를 변환한다. 제어기 유닛(520)은 상기 기술된 각각의 제어기 메인 유닛(200)과 제어기 확장 유닛(600) 중 하나를 포함한다.
도 7에 예시된 회전 속도 센서(505)는 여기 유닛(590)과 검출 유닛(580) 사이에 정렬된 코리올리 유닛(585)에 의해 도 6a에 예시된 회전 속도 센서(500)와 다르다. 코리올리 유닛(585)을 여기 유닛(590)에 결합하는 제2 스프링 요소(542)는 검출 방향(502)으로 여기 유닛(590)에 비례하여 코리올리 유닛(585)의 편향을 감안한다. 지지 기판(550)에 의해 부분적으로 연결될 수 있는 제3 스프링 요소(543)는 검출 유닛(580)이 검출 방향(502)을 따라 코리올리 유닛(585)의 움직임을 따를 수 있는 이와 같은 코리올리 유닛(585)에 검출 유닛(580)을 결합하지만, 여기(501)의 방향을 따라 움직임을 따를 수 없다. 검출 유닛(580)은 여기(501)의 방향에 대하여 고정되며 검출 방향(502)을 따라 움직일 수 있다.
다른 실시예에 따라서 제1 또는 제2 힘 전달 및 센서 유닛(561, 562, 571, 572) 중 적어도 하나의 유닛은 검출 유닛(580)이 액츄에이터 그리고 여기 유닛(590) 또는 검출 유닛(580)으로서 작용하거나 검출 유닛(580)뿐만 아니라 여기 유닛(590)이 상기 기술된 장치 중 하나에 따라서 발진기로서 작용하며, 이는 대역통과 제어기의 원리에 따라서 동작 된다. 이러한 공정에서 힘 전달 및 센서 유닛(561 및 571)은 x1-발진기를 위해 각각 힘 전달 및 센서 유닛으로서 작용하며 힘 전달 및 센서 유닛(562 및 572)은 x2-발진기를 위해 각각 힘 전달 및 센서 유닛으로서 작용한다.
다른 실시예에 따른 회전 속도 센서는 도 6a 또는 도 7에 예시된 바와 같이 정렬 중 2개의 정렬을 포함하며, 2개의 정렬은 여기 유닛이 서로에 대하여 고정 상태에서 반대되는 발진을 수행하도록 서로에 결합된다. 다른 실시예는 여기 유닛 중 모든 2개의 유닛이 고정 상태에서 반대되는 발진을 수행하도록 서로에 결합되는 도 6a 또는 도 7에 예시된 바와 같이 정렬 중 4개의 정렬을 갖는 회전 속도 센서에 관련된다.
추가 실시예는 도 1, 도 2a 및 도 2b에 예시된 바와 같이 제어기 메인 유닛(200)과 제어기 확장 유닛(600)의 조합을 갖는 회전 속도 센서 장치를 지칭한다. 제어기 메인 유닛(200)은 고조파 설정점 신호를 위해 적어도 하나의 PI-제어기(225, 325)를 포함하며, PI-제어기는 비례 전달 요소(224, 324)에 나란히 정렬된 비례 전달 요소(224, 324)와 적분 전달 요소(222, 322)를 가지며, 여기서 제어기 메인 유닛(200)의 제어기 유닛은 두 개의 전달 요소(222, 224, 322, 324)와 연결된다. 고조파 설정점 신호를 위한 PI-제어기(225, 325)의 전달 함수는 s-평면내 제어기 각 주파수(ωr)에서 또는 z-평면내
Figure 112014049148960-pct00068
에서 켤레 복소수 극을 가지며, 여기서 T는 PI-제어기(325)의 이산 입력 신호의 샘플링 시간이며 그리고 ωr은 0보다 크다.
이를 위하여 적분 전달 요소(222, 322)의 적분 동작 계수와 비례 전달 요소(224, 324)의 증폭 인자는, 제어기 입력에서 계단 함수에 의해 변조된 제어기 각 주파수(ωr)의 고조파 입력 신호와 더불어 승인시, 고조파 커맨드 변수를 위한 PI-제어기(225, 325)가 제어기 출력에서 상승 진폭을 갖는 제어기 각 주파수(ωr)의 고조파 발진을 발생하기에 적합하도록 선택된다.
고조파 설정점 신호를 위한 PI-제어기(225, 325)는 또한 고정적인 설정점 신호를 위한 종래의 PI-제어기로부터 파생된 제어기를 위해 취해질 수 있으며 각각 s-평면 또는 z-평면내 극의 위치만큼 고조파 설정점 신호와 다르다.
도 8은 고조파 커맨드 변수와 더불어 제어 장치를 동작하기 위한 방법을 지칭한다. 센서 유닛은 측정 신호를 발생하며, 측정 신호는 여기(802)의 방향을 따라 발진기의 편차를 나타낸다. 비활성화된 액츄에이터 유닛(804)에서 발진기의 잔여 발진의 실제 위상 및 실제-진폭의 추정(estimation)에 기초하여, 제어기 확장 유닛은 동등한 진폭을 갖는 위상 동기 고조파 설정점 신호를 발생한다. 제어기 메인 유닛은 액츄에이터 유닛이 고조파 발진으로부터 발진기의 편차에 대해 대응할 수 있도록 측정 신호와 동기 설정점 신호로부터 액츄에이터를 위한 동기화된 제어 신호를 발생한다. 동기화된 제어 신호에서 또는 동기화된 제어 신호를 제공한 후 액츄에이터 유닛이 활성화된다(806).

Claims (16)

  1. 여기의 방향을 따라 발진기(190)의 편향을 나타내는 측정 신호를 출력할 수 있는 센서 유닛(170),
    제어 신호에 의해 제어가능한 발진기(190)에 작용하는 액츄에이터 유닛(180)을 포함하는 제어 장치에 있어서,
    액츄에이터 유닛(180)이 발진기(190)의 고조파 공진 발진의 설정 진폭으로부터 발진기(190)의 편향의 편차에 대응하도록 측정 신호와 고조파 설정점 신호로부터 액츄에이터 유닛(180)을 위한 제어 신호를 추론하도록 구성되는 제어기 메인 유닛(200), 그리고
    액츄에이터 유닛(180)을 활성화한 후 발진기(190)의 잔여 발진의 진폭이 설정 진폭까지 위상-동기적으로 증폭되며 그리고 이러한 공정에서 잔여 발진에 포함된 에너지가 사용되도록 측정 신호로부터 비활성화된 액츄에이터 유닛(180)에서 발진기의 잔여 발진의 실제 위상 및 실제 진폭을 결정하고 실제 위상 및 실제 진폭에 따라 조정되는 고조파 설정점 신호를 제어기 메인 유닛(200)으로 출력하도록 구성되는 제어기 확장 유닛(600)
    을 특징으로 하는, 제어 장치.
  2. 제1항에 있어서,
    제어기 메인 유닛(200)은 고조파 설정점 신호를 위한 제어기 장치(225, 325)이며, 여기서 제어기 장치(225, 325)는 적어도 하나의 비례 전달 요소(224, 324)와 비례 전달 요소(224, 324)에 나란히 정렬된 하나의 적분 전달 요소(222, 324)를 포함하며 그리고 제어기 메인 유닛(200)의 제어기 입력은 두 개의 전달 요소(222, 224, 322, 324)와 연결되며, 그리고
    제어기 장치(225, 325)의 전달 함수는 s-평면내 제어기 각 주파수(ωr)에서 켤레 복소수 극 또는 z-평면내
    Figure 112014049148960-pct00069
    에서 극을 가지며, 여기서 T는 제어기 장치(225, 325)의 이산 입력 신호의 샘플링 시간이며 ωr은 0보다 큰 것을 특징으로 하는, 제어 장치.
  3. 제2항에 있어서,
    적분 전달 요소(222, 322)의 적분 동작 계수와 비례 전달 요소(224, 324)의 증폭 인자는 제어기 장치(225, 325)가, 제어기 입력에서 계단 함수에 의해 변조된 제어기 각 주파수(ωr)의 고조파 입력 신호의 고조파 입력 신호의 입력시, 제어기 출력에서 상승 진폭을 갖는 제어기 각 주파수(ωr)의 고조파 발진을 발생할 수 있도록 선택되는 것을 특징으로 하는, 제어 장치.
  4. 제3항에 있어서,
    적분 동작 계수 및 증폭 인자는 제어기 장치(225, 325)의 전달 함수의 영(zero)이 발진기(190)의 전달 함수의 극을 보상하도록 선택되는 것을 특징으로 하는, 제어 장치.
  5. 제1항에 있어서,
    제어기 확장 유닛(600)은 :
    액츄에이터 유닛(180)에 의해 발진기(190)의 잔여 발진의 진폭이 위상-동기적으로 증폭되며 그리고 잔여 발진에 포함된 에너지가 이용가능하도록 측정 신호로부터 발진기(190)의 잔여 발진의 실제 위상 및 실제 진폭을 결정하며 실제 위상 및 실제 진폭으로부터 고조파 설정점 신호를 위한 동기화 정보를 결정하도록 구성되는 포착 유닛(610); 그리고
    동기화 정보를 수신하며 그리고 동기화 정보에 기초하여 고조파 설정점 신호를 위한 위상 및 초기 진폭값을 결정하도록 구성된, 동기화 유닛(620)을 포함하는 것을 특징으로 하는, 제어 장치.
  6. 제5항에 있어서,
    포착 유닛(610)은 :
    측정 신호로부터, 전류 발진 주파수에 대한 추정값으로부터, 측정 신호에 포함된 측정 잡음의 변화에 대한 추정값으로부터, 그리고 측정 신호의 일정한 진폭 오프셋에 대한 추정값으로부터 잔여 발진의 시간 내 변화에 대한 추정값을 결정하도록 구성되는 필터 유닛(612); 그리고
    잔여 발진의 시간내 변화에 대한 추정값으로부터 실제 위상 및 실제 진폭을 기술하는 동기화 정보를 결정하고 동기화 정보를 출력하도록 구성되는 제어 유닛(616)을 포함하는 것을 특징으로 하는, 제어 장치.
  7. 제6항에 있어서,
    제어 유닛(616)은 동기화 정보의 출력 후 필터 유닛(612)을 비활성화시키도록 구성되는 것을 특징으로 하는, 제어 장치.
  8. 제6항에 있어서,
    제어 유닛(616)은 동기화 정보의 출력 후 액츄에이터 유닛(180)을 활성화시키도록 구성되는 것을 특징으로 하는, 제어 장치.
  9. 제6항에 있어서,
    제어기 확장 유닛(600)은 초기 진폭값에서 설정 진폭값까지 사전결정된 시간 주기 내에 설정점 발진의 진폭을 증가시키도록 구성되는 것을 특징으로 하는, 제어 장치.
  10. 제1항에 있어서,
    필터 유닛(612)은 칼만 필터(Kalman filter)인 것을 특징으로 하는, 제어 장치.
  11. 제1항에 있어서,
    제어기 확장 유닛(600)은 발진기(190)의 전류 발진 주파수를 기술하는 순간 인터벌 주파수 정보로 저장하도록 구성되는 주파수 스토리지 유닛(630)을 포함하며, 그리고
    제어기 확장 유닛(600)은 발진기(190)의 잔여 발진의 실제 위상 및 실제 진폭을 추정 및/또는 고조파 설정점 신호를 발생하기 위해 저장된 주파수 정보를 사용하도록 더 구성되는 것을 특징으로 하는, 제어 장치.
  12. 제1항에 있어서,
    제어 장치는 여기 유닛(590), 코리올리 유닛(585) 또는 검출 유닛(580)으로서 발진기를 형성하는 회전 속도 센서(500, 505)의 일부이며, 그리고 액츄에이터 유닛은 힘 전달기(561)이고,
    코리올리 유닛(585)은 코리올리 유닛(585)이 여기의 방향을 따라 여기 유닛(590)의 움직임을 따르며 그리고 코리올리 유닛(585)이 여기의 방향에 직교인 검출 방향으로 따라 추가적으로 움직일 수 있도록 여기 유닛(590)에 부착되며, 그리고
    검출 유닛(580)은 검출 유닛(580)이
    여기의 방향을 따라 여기 유닛(590)의 움직임을 따르며 검출 유닛(480)이 여기의 방향에 직교인 검출 방향을 따라 추가적으로 움직일 수 있거나, 또는
    여기의 방향에 직교인 검출 방향을 따라 코리올리 유닛(585)의 움직임을 따르며 여기의 방향을 따라 고정되는 여기 유닛(590) 또는 코리올리 유닛(585)에 이와 같이 부착되는 것을 특징으로 하는, 제어 장치.
  13. 고조파 공진 발진에 대해 여기의 방향으로 여기가능한 움직일 수 있게 지지된 발진기(190),
    여기의 방향을 따라 발진기(190)의 편차를 나타내는 측정 신호를 출력하기에 적합한 센서 유닛(170),
    제어 신호에 의해 제어가능한 발진기(190)에 작용하는 액츄에이터 유닛(180)을 포함하며,
    액츄에이터 유닛(180)이 공진 발진의 설정 진폭으로부터 발진기(190)의 편향의 편차에 대응하도록 측정 신호와 고조파 설정점 신호로부터 액츄에이터 유닛(180)을 위한 제어 신호를 추론하도록 구성된 제어기 메인 유닛(200), 그리고
    액츄에이터 유닛(180)을 활성화한 후 발진기(190)의 잔여 발진의 진폭이 설정 진폭까지 위상-동기적으로 증폭되며 그리고 이러한 공정에서 잔여 발진에 포함된 에너지가 사용되도록 측정 신호로부터 비활성화된 액츄에이터 유닛(180)에서 발진기의 잔여 발진의 실제 위상 및 실제 진폭을 결정하고 실제 위상 및 실제 진폭에 적합한 고조파 설정점 신호를 제어기 메인 유닛(200)으로 출력하도록 구성된 제어기 확장 유닛(600)
    을 포함하는, 회전 속도 센서.
  14. 제13항에 있어서,
    발진기는 여기의 방향을 따라 힘 전달기(561)에 의해 편향될 수 있으며 공진 각 주파수(ω0)를 갖는 발진할 수 있는 여기 유닛(590)인, 회전 속도 센서.
  15. 센서 유닛(170)에 의해 여기의 방향을 따라 발진기(190)의 편향을 나타내는 측정 신호를 발생하는 단계,
    비활성화된 액츄에이터 유닛(180)에서 발진기(190)의 잔여 발진의 실제 위상 및 실제 진폭의 추정에 기초하여 위상 및 진폭 동기 고조파 설정점 신호를 발생하는 단계,
    액츄에이터 유닛(180)이 고조파 발진으로부터 발진기(190)의 편차에 대응하도록 측정 신호 그리고 위상 및 진폭 동기 고조파 설정점 신호로부터 액츄에이터 유닛(180)을 위한 동기화된 제어 신호를 발생하는 단계, 그리고
    동기화된 제어 신호 제공시 또는 제공 후 액츄에이터 유닛(180)을 활성화시키는 단계
    를 포함하는, 고조파 커맨드 변수와 더불어 제어 장치를 동작하기 위한 방법.
  16. 제15항에 있어서,
    제어기 메인 유닛(200)은 고조파 설정점 신호를 위한 제어기 장치(225, 325)이며, 여기서 제어기 장치(225, 325)는 적어도 하나의 비례 전달 요소(224, 324)와 비례 전달 요소(224, 324)에 나란히 정렬된 적분 전달 요소(222, 324)를 포함하며 그리고 제어기 메인 유닛(200)의 제어기 입력은 두 개의 전달 요소(222, 224, 322, 324)와 연결되며, 그리고
    제어기 장치(225, 325)의 전달 함수는 s-평면내 제어기 각 주파수(ωr)에서 켤레 복소수 극 또는 z-평면내
    Figure 112014049148960-pct00070
    에서 극을 가지며, 여기서 T는 제어기 장치(225, 325)의 이산 입력 신호의 샘플링 시간이며 ωr은 0보다 큰 것을 특징으로 하는, 고조파 커맨드 변수와 더불어 제어 장치를 동작하기 위한 방법.
KR1020147014025A 2011-12-01 2012-10-15 제어 장치, 회전 속도 센서 및 고조파 설정점 신호를 갖는 제어 장치를 동작하기 위한 방법 KR101629836B1 (ko)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
DE102011119949.0 2011-12-01
DE102011119949A DE102011119949A1 (de) 2011-12-01 2011-12-01 Regelungsvorrichtung, Drehratensensor und Verfahren zum Betrieb einer Regelungsvorrichtung mit harmonischem Sollwertsignal
PCT/EP2012/004307 WO2013079139A2 (de) 2011-12-01 2012-10-15 Regelungsvorrichtung, drehratensensor und verfahren zum betrieb einer regelungsvorrichtung mit harmonischem sollwertsignal

Publications (2)

Publication Number Publication Date
KR20140081893A KR20140081893A (ko) 2014-07-01
KR101629836B1 true KR101629836B1 (ko) 2016-06-13

Family

ID=47115730

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020147014025A KR101629836B1 (ko) 2011-12-01 2012-10-15 제어 장치, 회전 속도 센서 및 고조파 설정점 신호를 갖는 제어 장치를 동작하기 위한 방법

Country Status (13)

Country Link
US (1) US9518824B2 (ko)
EP (1) EP2786096B1 (ko)
JP (1) JP5890533B2 (ko)
KR (1) KR101629836B1 (ko)
CN (1) CN103988051B (ko)
AU (1) AU2012344309B2 (ko)
BR (1) BR112014013062A2 (ko)
CA (1) CA2854091C (ko)
DE (1) DE102011119949A1 (ko)
IL (1) IL232589B (ko)
RU (1) RU2599281C2 (ko)
WO (1) WO2013079139A2 (ko)
ZA (1) ZA201403101B (ko)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102013217093A1 (de) * 2013-08-28 2015-03-05 Robert Bosch Gmbh Verfahren zum Anpassen der Parameter eines Reglers für mikromechanische Aktoren und Vorrichtungen
DE102013217105B4 (de) 2013-08-28 2023-03-16 Robert Bosch Gmbh Regler zur Ansteuerung eines mikromechanischen Aktors, Ansteuersystem zur Ansteuerung eines mikromechanischen Aktors, Mikrospiegelsystem und Verfahren zum Ansteuern eines mikromechanischen Aktors
DE102014003640A1 (de) 2014-03-14 2015-09-17 Northrop Grumman Litef Gmbh Verfahren zum optimieren der einschaltzeit eines corioliskreisels sowie dafür geeigneter corioliskreisel
DE102015003196B4 (de) * 2015-03-12 2022-12-01 Northrop Grumman Litef Gmbh Vorrichtung und Verfahren zur Restwertverarbeitung bei der Ansteuerung eines Sensors
US10991499B2 (en) * 2018-03-22 2021-04-27 Cirrus Logic, Inc. Drive waveform adjustments to compensate for transducer resonant frequency
KR102120410B1 (ko) * 2018-06-28 2020-06-09 주식회사 동운아나텍 액츄에이터 제어장치 및 방법
DE102019100507A1 (de) * 2019-01-10 2020-07-16 Northrop Grumman Litef Gmbh Verfahren zum Auslesen von Daten von Inertialsensoren
DE102019208569A1 (de) * 2019-06-13 2020-12-17 Robert Bosch Gmbh Verfahren zum Betreiben eines MEMS-Gyroskops
DE102020206003A1 (de) 2020-05-13 2021-11-18 Robert Bosch Gesellschaft mit beschränkter Haftung Verfahren zum Betreiben eines mikroelektromechanischen Gyroskops, Gyroskop
EP3960309A1 (de) * 2020-08-31 2022-03-02 Siemens Aktiengesellschaft Resonanzverfahren für ein schwingungssystem, einen umrichter, eine anregungseinheit und das schwingungssystem
CN111969901B (zh) * 2020-09-01 2022-02-01 南通大学 一种计及霍尔位置传感器故障的无刷直流电机容错控制方法
US20230314138A1 (en) * 2022-04-04 2023-10-05 Stmicroelectronics, Inc. Mems gyroscope start-up process and circuit
US11835339B1 (en) * 2022-04-05 2023-12-05 Hrl Laboratories, Llc Continuous online self-calibration for gyroscopes through modulation of damping axes

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005221845A (ja) 2004-02-06 2005-08-18 Hitachi Via Mechanics Ltd 移動体のサーボ制御装置及びレーザ加工装置

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0820258B2 (ja) * 1987-07-29 1996-03-04 日本電気ホームエレクトロニクス株式会社 振動ジャイロの駆動方法
WO1993015447A1 (de) * 1992-01-22 1993-08-05 Hurth Maschinen Und Werkzeuge Gmbh Regelungs-anordnung
JP3969824B2 (ja) * 1998-02-09 2007-09-05 マイクロストーン株式会社 角速度センサ
DE19845185B4 (de) 1998-10-01 2005-05-04 Eads Deutschland Gmbh Sensor mit Resonanzstruktur sowie Vorrichtung und Verfahren zum Selbsttest eines derartigen Sensors
RU2192662C1 (ru) * 2001-06-13 2002-11-10 Военный инженерно-космический университет им. А.Ф. Можайского Устройство для успокоения колебаний упругого элемента переменной жесткости
DE10240087C5 (de) * 2002-08-30 2011-12-01 Austriamicrosystems Ag Vibrationskreisel
CN100420592C (zh) 2003-02-21 2008-09-24 金泰克斯公司 自动汽车外部灯光控制系统
JP3812543B2 (ja) * 2003-03-28 2006-08-23 株式会社デンソー 角速度センサ装置及びその調整方法
CN100535945C (zh) 2004-04-20 2009-09-02 蓝福模具有限公司 用来监测和控制或调节机器的装置
US7190237B2 (en) * 2004-05-27 2007-03-13 Continental Automotive, Inc. Open-loop start-up method for a resonating device
JP4534714B2 (ja) * 2004-10-22 2010-09-01 株式会社デンソー チャージアンプ回路
CN100464036C (zh) * 2005-03-28 2009-02-25 广西柳工机械股份有限公司 用于液压挖掘机工作装置的轨迹控制系统及方法
US7411465B2 (en) 2005-07-15 2008-08-12 Watson Industries, Inc. AGC circuit for the reduction of harmonics in the drive signal
DE102005034702A1 (de) * 2005-07-26 2007-02-01 Robert Bosch Gmbh Verfahren und Schaltungsanordnung zur sicheren Inbetriebnahme eines Drehratensensors
DE102005043592A1 (de) * 2005-09-12 2007-03-15 Siemens Ag Verfahren zum Betrieb eines Vibrationskreisels und Sensoranordnung
DE102005043560A1 (de) * 2005-09-12 2007-03-15 Siemens Ag Verfahren zum Betrieb eines Vibrationskreisels und Sensoranordnung
ATE520960T1 (de) * 2007-09-18 2011-09-15 Atlantic Inertial Systems Ltd Verbesserungen in bezug auf winkelgeschwindigkeitssensoren
DE102008044000B4 (de) * 2008-11-24 2019-11-07 Robert Bosch Gmbh Verfahren zum Regeln einer angeregten Schwingung, Vorrichtung zum Regeln einer angeregten Schwingung
JP4436884B1 (ja) * 2009-02-06 2010-03-24 株式会社オーバル 信号処理方法、信号処理装置、およびコリオリ流量計
JP4436882B1 (ja) * 2009-02-06 2010-03-24 株式会社オーバル 信号処理方法、信号処理装置、およびコリオリ流量計
EP2336717B1 (en) * 2009-12-21 2012-09-19 STMicroelectronics Srl Microelectromechanical device having an oscillating mass, and method for controlling a microelectromechanical device having an oscillating mass
DE102010055631B4 (de) 2010-12-22 2017-12-14 Northrop Grumman Litef Gmbh Reglereinheit und Vorrichtung zur Rückstellung eines mit einer harmonischen Schwingung angeregten Schwingers, sowie Drehratensensor
US9448071B2 (en) * 2013-03-13 2016-09-20 Stmicroelectronics S.R.L. Microelectromechanical device having an oscillating mass and a forcing stage, and method of controlling a microelectromechanical device

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005221845A (ja) 2004-02-06 2005-08-18 Hitachi Via Mechanics Ltd 移動体のサーボ制御装置及びレーザ加工装置

Also Published As

Publication number Publication date
KR20140081893A (ko) 2014-07-01
RU2014119152A (ru) 2016-02-10
DE102011119949A1 (de) 2013-06-06
AU2012344309B2 (en) 2014-11-27
EP2786096A2 (de) 2014-10-08
ZA201403101B (en) 2016-01-27
US9518824B2 (en) 2016-12-13
CA2854091A1 (en) 2013-06-06
BR112014013062A2 (pt) 2017-06-13
RU2599281C2 (ru) 2016-10-10
EP2786096B1 (de) 2016-01-20
US20150211857A1 (en) 2015-07-30
JP2014533841A (ja) 2014-12-15
CN103988051B (zh) 2016-08-31
WO2013079139A2 (de) 2013-06-06
JP5890533B2 (ja) 2016-03-22
CN103988051A (zh) 2014-08-13
CA2854091C (en) 2016-12-13
AU2012344309A1 (en) 2014-06-12
IL232589B (en) 2018-03-29
IL232589A0 (en) 2014-06-30
WO2013079139A3 (de) 2013-07-25

Similar Documents

Publication Publication Date Title
KR101629836B1 (ko) 제어 장치, 회전 속도 센서 및 고조파 설정점 신호를 갖는 제어 장치를 동작하기 위한 방법
CN107636473B (zh) 从非线性的周期性信号中提取惯性信息
KR101576140B1 (ko) 고조파 발진에 의해 여기된 발진기를 재설정하기 위한 컨트롤러 유닛 및 디바이스 및 각속도 센서
US10309782B2 (en) Quality factor estimation for resonators
GB2539529A (en) System, apparatus, and method for resonator and coriolis axis control in vibratory gyroscopes
Cui et al. Transient response and stability of the AGC-PI closed-loop controlled MEMS vibratory gyroscopes
US20140191702A1 (en) Motor controlling device, motor controlling method and machinery system
CN108844531B (zh) 高q值微机电陀螺的快速起振控制方法及装置
JP2009503474A (ja) ヨーレートセンサの使用開始方法およびヨーレートセンサの使用開始のための回路装置
US9013241B2 (en) Circuit for measuring the resonant frequency of nanoresonators
KR101376840B1 (ko) 센서 자동이득제어 장치 및 방법, 그리고 센서 장치
JP5127767B2 (ja) 駆動制御装置
US20210333104A1 (en) Detector
KR102527109B1 (ko) 자이로스코프 루프 필터
CN111796509A (zh) 一种陀螺自稳定控制方法
WO2023037554A1 (ja) 振動型角速度センサ
JP2019152449A (ja) 振動装置
JPH09315397A (ja) 姿勢制御装置
WO2015060324A1 (ja) 角速度センサ
JP2018109521A (ja) 物理量検出装置及び物理量検出システム
Oboe et al. MEMS VIBRATIONAL GYROSCOPE

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: 20190529

Year of fee payment: 4