WO2017138759A1 - 기울기센서를 이용한 자이로센서의 캘리브레이션 방법 - Google Patents

기울기센서를 이용한 자이로센서의 캘리브레이션 방법 Download PDF

Info

Publication number
WO2017138759A1
WO2017138759A1 PCT/KR2017/001457 KR2017001457W WO2017138759A1 WO 2017138759 A1 WO2017138759 A1 WO 2017138759A1 KR 2017001457 W KR2017001457 W KR 2017001457W WO 2017138759 A1 WO2017138759 A1 WO 2017138759A1
Authority
WO
WIPO (PCT)
Prior art keywords
sensor
gyro sensor
gyro
calibration
tilt
Prior art date
Application number
PCT/KR2017/001457
Other languages
English (en)
French (fr)
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 CN201780022908.4A priority Critical patent/CN109073408A/zh
Priority to US16/076,966 priority patent/US10900806B2/en
Publication of WO2017138759A1 publication Critical patent/WO2017138759A1/ko

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
    • G01P15/14—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration by making use of gyroscopes
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • G01C19/56—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
    • G01C19/5719—Turn-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/5726—Signal processing
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
    • G01P21/02—Testing or calibrating of apparatus or devices covered by the preceding groups of speedometers

Definitions

  • the present invention relates to a calibration method of a gyro sensor for sensing the acceleration in the three-axis direction to perform posture control of a device such as an antenna, and more particularly, to a tilt sensor for measuring the tilt with respect to gravity during calibration of the gyro sensor.
  • the present invention relates to a calibration method of a gyro sensor using a tilt sensor which greatly improves calibration accuracy by interlocking.
  • the mobile satellite tracking antenna system mounted on a vehicle or a ship is controlled so that the antenna unit always faces the satellite through attitude control using a sensor due to the high gain of the antenna.
  • the sensors mounted in the mobile satellite tracking antenna system are a plurality of gyro sensors and tilt sensors, and the driving unit detects the movement in each direction of how much the antenna is inclined with respect to the three axis directions. It is possible to control the attitude of the antenna unit. In this case, additional information may be obtained by adding a geomagnetic sensor or an altitude sensor.
  • the related technology has been disclosed in Korea Patent Publication No. 2010-0005346.
  • the prior art relates to an antenna stabilization device that enables the antenna to maintain the orientation to the satellite and accurately track the satellite by using a tilt sensor (tilt sensor) for detecting a tilt and a gyro sensor for performing wind pressure attitude control. .
  • the above-described prior art does not disclose the calibration of the sensor.
  • the tilt sensor does not have any problem because there is almost no error rate even if it is not calibrated separately, but the gyro sensor has a characteristic that the output value varies slightly depending on the external environment such as temperature and humidity of the surroundings. .
  • the present invention has been made to solve the above problems, an object of the present invention by performing the calibration of the gyro sensor in conjunction with the inclination sensor to perform the calibration of the gyro sensor with almost no error even when fine movement occurs during calibration To provide a way to do this.
  • X-axis, Y-axis, Z-axis direction based on the sensor board is provided on the sensor board by using an inclination sensor provided on the sensor board attached to the object of the present invention to detect the inclination to gravity
  • Method for calibrating three gyro sensors for sensing the angular velocity for each of the steps a) (S100) is the power is applied to the drive unit for driving the object; B) the sensor board is maintained in a horizontal state with respect to the ground by the inclination sensor (S200); Determining whether the object is in motion (S300); And d) in the case of movement (S300-Y), step c) in which the gyro sensor is calibrated to reflect the output value of the tilt sensor (S410).
  • the step d) is a first gyro sensor and a Y-axis direction for detecting rotation in the X-axis direction using the tilt data received from the tilt sensor.
  • step c) when there is a change in the gyro sensor output value for a predetermined time, it may be determined that there is motion, and when the output value is constant, it may be determined that there is no motion.
  • step d) may include a step of setting each of the gyro sensor output values received in step c) to zero (S420). .
  • the present invention performs the calibration of the gyro sensor in conjunction with the inclination sensor, in particular, the gyro sensor for detecting the rotation in the Z-axis direction by mounting the sensor board equipped with the sensor also has the advantage of performing the calibration in conjunction with the inclination sensor have.
  • FIG. 1 is a schematic configuration diagram of an apparatus for performing calibration of a gyro sensor according to an embodiment of the present invention.
  • FIG. 2 is a flow chart of a calibration method of a gyro sensor according to an embodiment of the present invention.
  • 3 and 4 is an example showing the rotation and the direction of the sensor board according to an embodiment of the present invention.
  • FIG. 1 is a schematic configuration diagram of a device 100 for performing calibration of a gyro sensor 110 according to an embodiment of the present invention
  • Figure 2 is a calibration of the gyro sensor 110 according to an embodiment of the present invention
  • 3 and 4 are examples showing the rotation and direction of the sensor board 10 according to an embodiment of the present invention.
  • a sensor board 10 including various sensors is attached to the target object to detect a movement of the target object and simultaneously detect a movement of the target object and output a signal corresponding to the detected movement. To control the posture of the object.
  • the object may be an antenna unit of a mobile satellite tracking antenna system which is always controlled to face the satellite direction.
  • the antenna unit In order to maximize the gain of the antenna, even if there is an external movement, the antenna unit must always be controlled to face the satellite, so that a sensor board including various sensors is provided at a predetermined position of the antenna unit to control the attitude of the antenna unit.
  • the first gyro detects the angular velocity (rotation) for each direction.
  • the sensor 111, the second gyro sensor 112, and the third gyro sensor 113 are provided.
  • the X-axis, Y-axis, Z-axis direction in the present specification means three axes set based on the sensor board 10, and also set the plane on which the sensor board 10 is disposed as a reference plane.
  • the first gyro sensor 111 is disposed parallel to the Y axis direction of the sensor board 10 and perpendicular to the reference plane, and detects the angular velocity (rotation) based on the X axis direction.
  • the second gyro sensor 112 is disposed parallel to the X-axis direction of the sensor board 10 and perpendicular to the reference plane, and detects the angular velocity based on the Y-axis direction.
  • the third gyro sensor 113 is disposed horizontally on the reference plane.
  • on the sensor board 10 includes a tilt sensor 120 for detecting the inclination to gravity.
  • the controller 130 receives the signals output from the sensors, the controller 130 applies a signal to the target object driver based on the received signal in order to control the posture of the target object.
  • the controller 130 is also connected to the motor 140 for controlling the posture of the sensor board 10, a detailed description thereof will be described later.
  • the present invention relates to a method for calibrating a sensor, in particular, a gyro sensor 110 for attitude control of an object, by using an inclination sensor 120 when calibrating a gyro sensor, even when an external movement occurs during calibration. It is about a calibration method.
  • Calibration means calibrating the zero point of the sensor.
  • a gyro sensor is a sensor that outputs a voltage in the range of 0 to 5V depending on the degree of rotation.
  • the output voltage is recognized by the controller 130 as a number from 0 to 1024 through A-D conversion.
  • the output value of the gyro sensor is 512, which is the middle value, it is judged that there is no motion, and the 512 value is set to zero.
  • a value of 512 should be received. However, even if there is no movement due to the influence of the surrounding environment (temperature, humidity, etc.), the value of 512 is not output and the value is 505 This output may be set to zero.
  • the gyro sensor 110 is preferably initially calibrated to compensate for errors caused by the external environment.
  • a method of calibrating a gyro sensor according to an embodiment of the present invention will be described step by step.
  • the sensors when power is applied to the driving unit for driving the object (S100), the sensors output the measured value. At this time, the sensor board 10 is maintained in a horizontal state with respect to the ground by the inclination sensor 120 (S200). Since the inclination sensor 120 outputs an almost accurate value without calibration as described above, the controller 130 determines the inclination of the sensor board 10 by using the value received from the inclination sensor 120. To keep it horizontal.
  • the controller 130 determines whether or not the object moves. At this time, the movement of the object is determined by the output value of each gyro sensor 110, and if there is a change in the output value of the at least one gyro sensor 110 for a predetermined time, it is determined that there is a movement, if the output value is constant, the movement Will be judged.
  • each of the received output values is set to zero (S420).
  • the calibration of the gyro sensor 110 is performed by reflecting the output value of the tilt sensor 120 (S410). This process can be done in three steps as shown.
  • the first gyro sensor 111 that detects rotation about the X-axis direction and the second gyro that senses rotation about the Y-axis direction using the output value (degree of inclination with respect to the gravity direction) received from the tilt sensor 120.
  • the zero point of the sensor 112 may be set (S411).
  • each of the first gyro sensors 111 corresponding to the measured values may be used.
  • Zero setting of the second gyro sensor 112 is possible.
  • the calibration (S411) of the first gyro sensor 111 and the second gyro sensor 112 may be automatically performed in the previous step of determining whether the movement. to be.
  • the tilt with respect to the Z-axis direction is out of the sensing area of the tilt sensor 120, and the third gyroscope 113 cannot be calibrated at this stage.
  • the control unit 130 applies a signal to the motor 140, the sensor board 10
  • the step S412 of changing from a horizontal state to a vertical state is performed. That is, the sensor board 10 is rotated 90 degrees as shown in FIG. 4 in the state shown in FIG. 3.
  • the inclination sensor 120 is a sensor for detecting the inclination of the gravity direction, as shown in Figure 4 when the sensor board 10 is in a vertical state, the inclination sensor 120 can measure the inclination with respect to the Z axis. .
  • the controller 130 may finally set the zero point of the third gyro sensor 113 that detects rotation in the Z-axis direction by using the measured value received from the tilt sensor 120.
  • the sensor board 10 in the state where the sensor board 10 is horizontal with respect to the ground, accurate calibration was not possible due to the inability to interlock with the inclination sensor 120.
  • the sensor board 10 is erected vertically and then interlocked with the inclination sensor 120.
  • the third gyro sensor 113 can also be calibrated.
  • the controller 130 controls the posture of the target object to move the object in response to external movement even when the sensor board 10 is changed to a vertical state for calibration of the third gyro sensor 113. . Therefore, even if there is an external movement, it is possible to effectively perform calibration of the third gyro sensor 113.
  • the present invention performs the calibration of the gyro sensor 110 by interlocking with the tilt sensor 120 through a series of steps as described above, in particular, the sensor board (10) equipped with a sensor to raise the rotation in the Z-axis direction
  • the detecting gyro sensor 113 may also be calibrated in conjunction with the tilt sensor 120.
  • control unit 130 control unit

Abstract

본 발명은 3축 방향에 대한 가속도를 감지하여 안테나와 같은 장치의 자세 제어를 수행하는 자이로센서의 캘리브레이션 방법에 관한 것으로, 기울기센서와 연동하여 자이로센서의 캘리브레이션을 수행하며, 특히 센서가 구비된 센서보드를 세워 Z축 방향에 대한 회전을 감지하는 자이로센서도 기울기센서와 연동하여 캘리브레이션이 가능해지는 자이로센서의 캘리브레이션 방법에 관한 것이다.

Description

기울기센서를 이용한 자이로센서의 캘리브레이션 방법
본 발명은 3축 방향에 대한 가속도를 감지하여 안테나와 같은 장치의 자세 제어를 수행하는 자이로센서의 캘리브레이션 방법에 관한 것으로, 더욱 상세하게는 자이로센서의 캘리브레이션 시 중력에 대한 기울기를 측정하는 기울기센서와 연동함으로써 캘리브레이션 정확도를 매우 향상시킨 기울기센서를 이용한 자이로센서의 캘리브레이션 방법에 관한 것이다.
차량 또는 선박 등에 장착되는 이동형 위성 추적 안테나 시스템은 안테나의 높은 이득으로 인하여 센서를 이용한 자세 제어를 통해 안테나부가 항상 위성 방향을 향하도록 제어된다.
구체적으로, 이동형 위성 추적 안테나 시스템에 탑재되는 센서는 복수개의 자이로센서(gyro sensor)와 기울기센서(tilt sensor)로, 안테나부가 3축 방향에 대해 각각 얼마나 기울어졌는지 각 방향에 대한 움직임을 감지하여 구동부로 하여금 안테나부의 자세 제어를 할 수 있도록 한다. 이때, 추가적으로 지자기 센서나 고도 센서를 추가하여 부가적인 정보를 얻기도 한다.
이와 관련된 기술이 국내공개특허 제 2010-0005346호가 개시된 바 있다. 상기 종래 기술은 기울기를 감지하는 기울기센서(틸트센서)와 풍압 자세 제어를 수행하는 자이로센서를 이용함으로써, 안테나가 위성에 대한 지향을 유지하고 위성을 정확하게 추적할 수 있도록 하는 안테나 안정화 장치에 관한 것이다.
그러나, 상기 종래 기술에는 센서의 영점조정(Calibration)에 대한 내용은 개시되어 있지 않다. 기울기센서의 경우 따로 캘리브레이션을 하지 않아도 오차율이 거의 없어 문제가 없지만, 자이로센서의 경우 주변의 온도, 습도 등 외부 환경에 따라 출력되는 값이 미세하게 달라지는 특성이 있어, 사용 전에 캘리브레이션 작업이 필요로 된다.
자이로센서를 캘리브레이션 하기 위해서는 외부 움직임이 없는 상태여야만 한다. 따라서, 종래의 이동형 위성 추적 안테나의 경우 캘리브레이션 시 움직임이 발생하면 메모리에서 초기 디폴트(default)값을 불러오는 방법을 적용하고 있다. 이러한 방법은 외부 환경 변화가 반영되지 못하기 때문에 자이로센서의 출력값에 오차가 발생될 수밖에 없는 문제가 있다.
이와 같이, 캘리브레이션이 잘 되지 않았을 경우 이와 연동되어 작동하는 이동형 위성 추적 안테나 시스템의 추적 정확도가 급격히 저하되는 문제점이 있다.
본 발명은 상기한 문제점을 해결하기 위하여 안출된 것으로, 본 발명의 목적은 기울기센서와 연동하여 자이로센서의 캘리브레이션을 수행함으로써 캘리브레이션 중 미세한 움직임이 발생하는 경우에도 오차가 거의 없이 자이로센서의 캘리브레이션을 수행할 수 있는 방법을 제공하는 것이다.
본 발명의 대상물체에 부착 설치되는 센서보드 상에 구비되어 중력에 대해 기울어짐을 감지하는 기울기센서를 이용하여, 상기 센서보드 상에 구비되어 상기 센서보드를 기준으로 X축, Y축, Z축 방향에 대한 각속도를 각각 감지하는 3개의 자이로센서를 캘리브레이션 하는 방법은 상기 대상물체를 구동하는 구동부에 전원이 인가되는 a)단계(S100); 상기 기울기센서에 의해 상기 센서보드가 지면에 대해 수평인 상태로 유지되는 b)단계(S200); 상기 대상물체의 움직임 여부가 판단되는 단계(S300); 및 d) 움직임이 있는 경우(S300-Y), 상기 기울기센서의 출력값을 반영하여 상기 자이로센서가 캘리브레이션 되는 c)단계(S410);를 포함하여 이루어질 수 있다.
또, 상기 대상물체에 움직임이 있는 경우(S300-Y), 상기 d)단계는 상기 기울기센서로부터 수신된 기울기 데이터를 이용하여 X축 방향에 대한 회전을 감지하는 제 1자이로센서와 Y축 방향에 대한 회전을 감지하는 제 2자이로센서의 영점이 설정되는 d-1)단계(S411); 수평 상태의 상기 센서보드를 세워 수직 상태로 변경하는 d-2)단계(S412); 및 상기 기울기센서로부터 수신된 기울기 데이터를 이용하여 Z축 방향에 대한 회전을 감지하는 제 3자이로센서의 영점이 설정되는 d-3)단계(S413);를 포함하여 이루어질 수 있다.
또한, 상기 c)단계에서 일정 시간 동안 상기 자이로센서 출력값에 변동이 있는 경우 움직임이 있다고 판단되며, 출력값이 일정한 경우 움직임이 없다고 판단될 수 있다.
마지막으로, 상기 대상물체에 움직임이 없는 경우(S30-N) 상기 d)단계는, 상기 c)단계에서 수신된 각각의 자이로센서 출력값이 영점으로 설정되는 단계(S420);를 포함하여 이루어질 수 있다.
본 발명은 기울기센서와 연동하여 자이로센서의 캘리브레이션을 수행하며, 특히 센서가 구비된 센서보드를 세워 Z축 방향에 대한 회전을 감지하는 자이로센서도 기울기센서와 연동하여 캘리브레이션을 수행할 수 있는 장점이 있다.
따라서, 외무 움직임이 있는 경우에도 정확하게 자이로센서의 캘리브레이션이 가능함에 따라 외부 환경 변화에 따른 오차가 거의 없어, 위성 추적 안테나 시스템에 적용할 경우 추적 정확도가 매우 우수해지는 효과가 있다.
도 1은 본 발명의 일실시예에 따른 자이로센서의 캘리브레이션을 수행하기 위한 장치의 개략 구성도.
도 2는 본 발명의 일실시예에 따른 자이로센서의 캘리브레이션 방법의 순서도.
도 3 및 4는 본 발명의 일실시예에 따른 센서보드의 회전 및 방향을 도시한 일예.
이하, 본 발명의 기술적 사상을 첨부된 도면을 사용하여 더욱 구체적으로 설명한다.
첨부된 도면은 본 발명의 기술적 사상을 더욱 구체적으로 설명하기 위하여 도시한 일예에 불과하므로 본 발명의 기술적 사상이 첨부된 도면의 형태에 한정되는 것은 아니다.
도 1은 본 발명의 일실시예에 따른 자이로센서(110)의 캘리브레이션을 수행하기 위한 장치(100)의 개략 구성도이며, 도 2는 본 발명의 일실시예에 따른 자이로센서(110)의 캘리브레이션 방법의 순서도이고, 도 3 및 4는 본 발명의 일실시예에 따른 센서보드(10)의 회전 및 방향을 도시한 예이다.
먼저 도 1을 참조하여 캘리브레이션을 위한 장치(100)의 구성을 간단히 설명한 이후, 본 발명의 자이로센서 캘리브레이션 방법을 단계적으로 설명한다.
먼저, 대상물체의 자세를 제어하기 위해서는 여러 센서들을 포함하여 구성되는 센서보드(10)가 대상물체에 부착 설치되어, 대상물체의 움직임을 감지함과 동시에 감지된 움직임에 대응되는 신호를 대상물체 구동부로 전달하여 대상물체의 자세를 제어한다.
구체적인 예로, 상기 대상물체는 항상 위성 방향을 향하도록 제어되는 이동형 위성 추적 안테나 시스템의 안테나부일 수 있다. 안테나의 이득을 최대로 하기 위해서는 외부의 움직임이 있더라도 항상 안테나부가 위성을 향하도록 제어되어야만 하므로, 각종 센서들이 포함된 센서보드가 안테나부의 일정 위치에 구비되어 안테나부의 자세를 제어하는 것이다.
도 3에 도시된 바와 같이 센서보드(10) 상에는 센서보드(10)를 기준으로 X축, Y축, Z축 방향을 설정하였을 때, 각 방향에 대한 각속도(회전)를 각각 감지하는 제 1자이로센서(111), 제 2자이로센서(112), 제 3자이로센서(113)가 구비된다. 이때, 본 명세서 상에서 X축, Y축, Z축 방향은 센서보드(10)를 기준으로 설정한 3축을 의미하며, 또한 센서보드(10)가 배치된 평면을 기준면으로 설정한다.
구체적으로, 제 1자이로센서(111)는 센서보드(10)의 Y축 방향과 평행하고 상기 기준면에 대해 수직하게 배치되며, X축 방향을 기준으로 각속도(회전)를 감지한다. 또한, 제 2자이로센서(112)는 센서보드(10)의 X축 방향과 평행하고 상기 기준면에 대해 수직하게 배치되며, Y축 방향을 기준으로 각속도를 감지한다. 마지막으로, 제 3자이로센서(113)는 기준면 상에 수평하게 배치된다. 또한, 상기 3개의 자이로센서(110)와 더불어 센서보드(10) 상에는 중력에 대한 기울어짐을 감지하는 기울기센서(120)가 포함된다.
본 발명에서는 센서들로부터 출력되는 신호를 제어부(130)가 수신하며, 제어부(130)는 대상물체의 자세를 제어하기 위해 상기 수신된 신호를 바탕으로 대상물체 구동부로 신호를 인가하게 된다. 또한, 제어부(130)는 센서보드(10)의 자세를 제어하는 모터(140)와도 연결되며, 이에 대한 상세한 설명은 후술한다.
본 발명은 대상 물체의 자세 제어를 위한 센서, 특히 자이로센서(110)의 캘리브레이션 방법에 관한 것으로, 자이로센서 캘리브레이션 시 기울기센서(120)를 이용함으로써 캘리브레이션 도중 외부의 움직임이 발생하여도 오차가 거의 없는 캘리브레이션 방법에 대한 것이다.
캘리브레이션이란 센서의 영점을 보정하는 것을 의미하는 것으로, 일반적으로 자이로센서는 회전 정도에 따라 0 ~ 5V 범위의 전압이 출력되는 센서이다. 출력 전압은 A-D 변환을 통해 제어부(130)에서는 0 ~ 1024의 숫자로 인식하게 된다. 자이로센서의 출력값이 중간값인 512일 때 움직임이 없다고 판단하며, 512값을 영점으로 설정한다.
이상적으로는 센서(110)에 전원이 인가되었을 때 움직임이 없다면 512값이 수신되어야 하나, 주변 환경(온도, 습도 등)의 영향에 따라 움직임이 없더라도, 512값이 출력되지 않고 예를 들어 505 값이 출력되어 영점으로 설정될 수도 있는 것이다.
이와 같이, 외부 환경에 의한 오차를 보상하기 위해 자이로센서(110)는 초기 캘리브레이션되는 것이 바람직하며, 이하 본 발명의 일실시예에 따른 자이로센서의 캘리브레이션 방법을 단계적으로 설명한다.
도 2에 도시된 것처럼, 대상물체를 구동하는 구동부에 전원이 인가되면(S100), 센서들은 측정값을 출력하게 된다. 이때, 기울기센서(120)에 의해 센서보드(10)가 지면에 대해 수평인 상태로 유지된다(S200). 기울기센서(120)는 상술한 것처럼 캘리브레이션 없이도 거의 정확한 값을 출력하므로, 제어부(130)가 기울기센서(120)로부터 수신된 값을 이용하여 지면에 대해 기울어진 정도를 파악하여 센서보드(10)를 수평 상태로 유지시키는 것이다.
이후, 제어부(130)는 대상물체의 움직임 여부를 판단한다(S300). 이때, 대상물체의 움직임 여부는 각 자이로센서(110) 출력값에 의해 결정되는 것으로, 일정 시간 동안 적어도 하나의 자이로센서(110) 출력값에 변동이 있는 경우 움직임이 있다고 판단하며, 출력값이 일정한 경우 움직임이 없다고 판단하게 된다.
만약, 대상물체에 움직임이 없는 경우(S300-N), 기수신된 자이로센서(110)의 출력값이 일정한 것이므로 수신된 각각의 출력값을 영점으로 설정한다(S420).
그러나, 대상물체에 움직임이 있는 경우에는(S300-Y), 기울기센서(120)의 출력값을 반영하여 자이로센서(110)의 캘리브레이션을 수행한다(S410). 이 과정은 도시된 바와 같이 3단계로 이루어질 수 있다.
먼저 기울기센서(120)로부터 수신된 출력값(중력 방향에 대한 기울기 정도)을 이용하여 X축 방향에 대한 회전을 감지하는 제 1자이로센서(111)와 Y축 방향에 대한 회전을 감지하는 제 2자이로센서(112)의 영점이 설정될 수 있다(S411).
즉, 도 3과 같이 센서보드(10)가 위치하는 경우, 기울기센서(120)는 X축 방향 및 Y축 방향에 대한 기울기 측정이 가능하므로, 각각 측정값에 대응되는 제 1자이로센서(111)와 제 2자이로센서(112)의 영점 설정이 가능하다.
한편, 센서보드(10)는 수평 상태로 유지되고 있는 것이므로, 제 1자이로센서(111) 및 제 2자이로센서(112)의 캘리브레이션(S411)은 움직임 여부 판단 이전 단계에서 자동 수행될 수도 있음은 물론이다.
그러나, Z축 방향에 대한 기울기는 기울기센서(120)의 감지 영역 밖으로, 제 3자이로센서(113)는 이 단계에서 캘리브레이션이 불가능하다.
본 발명에서는 상기한 문제를 해결하기 위하여, 제 1자이로센서(111)와 제 2자이로센서(112) 캘리브레이션을 수행한 이후, 제어부(130)가 모터(140)에 신호를 인가하여 센서보드(10)를 세워 수평 상태에서 수직 상태로 변경하는 단계(S412)가 수행된다. 즉, 센서보드(10)가 도 3에 도시된 상태에서 도 4에 도시된 바와 같이 90도 회전되는 것이다.
이때, 본 발명에서 X축, Y축, Z축은 센서보드(10)를 기준으로 설정한 것이므로, 도 4와 같이 배치된다.
한편, 기울기센서(120)는 중력 방향에 대한 기울어짐을 감지하는 센서이므로, 도 4와 같이 센서보드(10)가 수직상태가 되면 기울기센서(120)는 Z축에 대한 기울기를 측정할 수 있게 된다.
따라서, 마지막으로 제어부(130)는 기울기센서(120)로부터 수신된 측정값을 이용하여, Z축 방향에 대한 회전을 감지하는 제 3자이로센서(113)의 영점을 설정할 수 있게 된다.
즉, 센서보드(10)가 지면에 대해 수평인 상태에서는 기울기센서(120)와 연동하지 못하여 정확한 캘리브레이션이 불가능하였지만, 센서보드(10)를 수직으로 세운 후 기울기센서(120)와 연동함으로써, 제 1 자이로센서(111) 및 제 2자이로센서(112)와 더불어 제 3자이로센서(113)도 캘리브레이션이 가능해진다.
이때, 제어부(130)는 제 3자이로센서(113)의 캘리브레이션을 위해 센서보드(10)를 수직 상태로 변경하는 과정에서도 대상물체의 자세를 제어하여 외부 움직임에 대응하여 대상물체가 움직이도록 제어한다. 따라서, 외부 움직임이 있더라도 효과적으로 제 3자이로센서(113)의 캘리브레이션을 수행할 수 있게 된다.
종래에는 외부 움직임이 있는 경우 자이로센서의 캘리브레이션을 수행하지 못하여, 기저장된 default값을 영점으로 설정함에 따라 대상물체의 정확한 자세 제어가 불가능하였다.
본 발명은 상술한 바와 같은 일련의 단계들을 통해 기울기센서(120)와 연동하여 자이로센서(110)의 캘리브레이션을 수행하며, 특히 센서가 구비된 센서보드(10)를 세워 Z축 방향에 대한 회전을 감지하는 자이로센서(113)도 기울기센서(120)와 연동하여 캘리브레이션을 수행할 수 있게 된다.
따라서, 외무 움직임이 있는 경우에도 정확하게 자이로센서의 캘리브레이션이 가능함에 따라 외부 환경 변화에 따른 오차가 거의 없어, 위성 추적 안테나 시스템에 적용할 경우 추적 정확도가 매우 우수해지는 효과가 있다.
본 발명은 상기한 실시예에 한정되지 아니하며, 적용범위가 다양함은 물론이고, 청구범위에서 청구하는 본 발명의 요지를 벗어남이 없이 다양한 변형 실시가 가능한 것은 물론이다.
(부호의 설명)
10 : 센서보드
100 : 캘리브레이션 장치
110 : 자이로센서
120 : 기울기센서
130 : 제어부
140 : 모터

Claims (4)

  1. 대상물체에 부착 설치되는 센서보드 상에 구비되어 중력에 대해 기울어짐을 감지하는 기울기센서를 이용하여, 상기 센서보드 상에 구비되어 상기 센서보드를 기준으로 X축, Y축, Z축 방향에 대한 각속도를 각각 감지하는 3개의 자이로센서를 캘리브레이션 하는 방법에 있어서,
    a) 상기 대상물체를 구동하는 구동부에 전원이 인가되는 단계(S100);
    b) 상기 기울기센서에 의해 상기 센서보드가 지면에 대해 수평인 상태로 유지되는 단계(S200);
    c) 상기 대상물체의 움직임 여부가 판단되는 단계(S300); 및
    d) 움직임이 있는 경우(S300-Y), 상기 기울기센서의 출력값을 반영하여 상기 자이로센서가 캘리브레이션 되는 단계(S410);
    를 포함하여 이루어지는 기울기센서를 이용한 자이로센서의 캘리브레이션 방법.
  2. 제 1항에 있어서,
    상기 대상물체에 움직임이 있는 경우(S300-Y), 상기 d)단계는,
    d-1) 상기 기울기센서로부터 수신된 기울기 데이터를 이용하여, X축 방향에 대한 회전을 감지하는 제 1자이로센서와 Y축 방향에 대한 회전을 감지하는 제 2자이로센서의 영점이 설정되는 단계(S411);
    d-2) 수평 상태의 상기 센서보드를 세워 수직 상태로 변경하는 단계(S412); 및
    d-3) 상기 기울기센서로부터 수신된 기울기 데이터를 이용하여, Z축 방향에 대한 회전을 감지하는 제 3자이로센서의 영점이 설정되는 단계(S413);
    를 포함하여 이루어지는 기울기센서를 이용한 자이로센서의 캘리브레이션 방법.
  3. 제 1항에 있어서, 상기 c)단계는,
    일정 시간 동안 상기 자이로센서 출력값에 변동이 있는 경우 움직임이 있다고 판단되며, 출력값이 일정한 경우 움직임이 없다고 판단되는 것을 특징으로 하는 기울기센서를 이용한 자이로센서의 캘리브레이션 방법.
  4. 제 3항에 있어서,
    상기 대상물체에 움직임이 없는 경우(S30-N) 상기 d)단계는,
    상기 c)단계에서 수신된 각각의 자이로센서 출력값이 영점으로 설정되는 단계(S420);
    를 포함하여 이루어지는 기울기센서를 이용한 자이로센서의 캘리브레이션 방법.
PCT/KR2017/001457 2016-02-12 2017-02-10 기울기센서를 이용한 자이로센서의 캘리브레이션 방법 WO2017138759A1 (ko)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201780022908.4A CN109073408A (zh) 2016-02-12 2017-02-10 利用倾角传感器的陀螺仪传感器的校准方法
US16/076,966 US10900806B2 (en) 2016-02-12 2017-02-10 Method for calibration of gyro sensor using tilt sensor

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
KR10-2016-0016088 2016-02-12
KR1020160016088A KR102365708B1 (ko) 2016-02-12 2016-02-12 기울기센서를 이용한 자이로센서의 캘리브레이션 방법

Publications (1)

Publication Number Publication Date
WO2017138759A1 true WO2017138759A1 (ko) 2017-08-17

Family

ID=59563687

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/KR2017/001457 WO2017138759A1 (ko) 2016-02-12 2017-02-10 기울기센서를 이용한 자이로센서의 캘리브레이션 방법

Country Status (4)

Country Link
US (1) US10900806B2 (ko)
KR (1) KR102365708B1 (ko)
CN (1) CN109073408A (ko)
WO (1) WO2017138759A1 (ko)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109443385B (zh) * 2018-11-13 2022-07-29 中国兵器装备集团自动化研究所有限公司 一种动中通天线的惯导安装误差自动标定方法
KR102081543B1 (ko) * 2019-09-18 2020-05-26 박효경 안전사고 방지용 스마트 기울임 경광 장치 및 그 동작방법
JP2022182708A (ja) * 2021-05-28 2022-12-08 株式会社デンソー 慣性検出装置
CN114034318A (zh) * 2021-11-23 2022-02-11 歌尔科技有限公司 音箱的校准控制方法、装置、设备及可读存储介质
CN114034320A (zh) * 2021-11-23 2022-02-11 歌尔科技有限公司 音箱的校准控制方法、装置、设备及可读存储介质
CN114034319A (zh) * 2021-11-23 2022-02-11 歌尔科技有限公司 音箱的校准控制方法、装置、设备及可读存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0611353A (ja) * 1992-06-29 1994-01-21 Mitsubishi Precision Co Ltd 慣性基準装置の座標系水平面の初期値設定方法
JPH07249918A (ja) * 1994-03-08 1995-09-26 Tokimec Inc アンテナ指向装置
JPH1123298A (ja) * 1997-07-01 1999-01-29 Unisia Jecs Corp 車両の変位角計測装置
KR20050051525A (ko) * 2003-11-27 2005-06-01 위월드 주식회사 개선된 이동체 탑재 위성추적 안테나 시스템 및 그 동작방법
JP2013079856A (ja) * 2011-10-04 2013-05-02 Tamagawa Seiki Co Ltd ジャイロ校正のための２回転軸直交ダブルターンテーブル

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070103366A1 (en) * 2003-11-27 2007-05-10 Park Chan G Antenna system for tracking moving object mounted satellite and its operating method
KR100985553B1 (ko) 2008-07-07 2010-10-05 엘아이지넥스원 주식회사 안테나 안정화 장치
KR101879821B1 (ko) * 2011-12-28 2018-08-17 한국단자공업 주식회사 Ｄｒ ｇｐｓ 모듈에서의 회전각 검출 오차 보정 방법
JP2013178136A (ja) * 2012-02-28 2013-09-09 Panasonic Corp 取付け角度補正装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0611353A (ja) * 1992-06-29 1994-01-21 Mitsubishi Precision Co Ltd 慣性基準装置の座標系水平面の初期値設定方法
JPH07249918A (ja) * 1994-03-08 1995-09-26 Tokimec Inc アンテナ指向装置
JPH1123298A (ja) * 1997-07-01 1999-01-29 Unisia Jecs Corp 車両の変位角計測装置
KR20050051525A (ko) * 2003-11-27 2005-06-01 위월드 주식회사 개선된 이동체 탑재 위성추적 안테나 시스템 및 그 동작방법
JP2013079856A (ja) * 2011-10-04 2013-05-02 Tamagawa Seiki Co Ltd ジャイロ校正のための２回転軸直交ダブルターンテーブル

Also Published As

Publication number Publication date
KR102365708B1 (ko) 2022-02-22
KR20170094851A (ko) 2017-08-22
CN109073408A (zh) 2018-12-21
US20190056239A1 (en) 2019-02-21
US10900806B2 (en) 2021-01-26

Similar Documents

Publication Publication Date Title
WO2017138759A1 (ko) 기울기센서를 이용한 자이로센서의 캘리브레이션 방법
CN111678538B (zh) 一种基于速度匹配的动态水平仪误差补偿方法
US6931323B2 (en) Apparatus and method of compensating for an attitude error of an earth magnetic sensor
US6813584B2 (en) Micro azimuth-level detector based on micro electro-mechanical systems and a method for determination of attitude
CN202974288U (zh) 一种微型捷联航姿系统
EP0321127B1 (en) Electronic tilt measuring system
CN106767805B (zh) 基于mems传感器阵列的高精度惯性量测量方法及测量系统
CN102980577A (zh) 一种微型捷联航姿系统及其工作方法
JP2004502951A (ja) 座標測定マシン（ｃｍｍ）の振動に起因した座標測定誤差を補正する方法および装置
CN107389968B (zh) 一种基于光流传感器和加速度传感器的无人机定点实现方法和装置
WO2016165295A1 (zh) 动中通卫星天线倾角校准过程中零点漂移值的测量方法
AU2008201684A1 (en) Heading stabilization for aided inertial navigation systems
EP0636862B1 (en) Inertial measurement unit and method for improving its measurement accuracy
CN113804185A (zh) 基于mems阵列式的新型惯性导航系统
WO2006031667A2 (en) Generalized inertial measurement error reduction through multiple axis rotation during flight
JP2000213934A (ja) 傾斜センサ―及びその精度を調整する方法
JP3860580B2 (ja) チルト補償型電子コンパスの伏角探索方法
US20220317149A1 (en) Reversing actuation type inertia detecting device and surveying instrument
KR102143462B1 (ko) Ahrs 센서, 그 바이어스 및 스케일 오차 보정 장치 및 방법
RU2339002C1 (ru) Способ определения навигационных параметров управляемых подвижных объектов и устройство для его осуществления
CN111750846A (zh) 一种船用罗经及其动态校准方法
CN112902954A (zh) 塔架晃动传感器和塔架晃动角度测量方法
CN112304339A (zh) 一种卫星移动通信天线的惯导校准方法
RU2239160C1 (ru) Система ориентации
Liu et al. Micro Inertial Measurement Unit based integrated velocity strapdown testing system

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17750451

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 17750451

Country of ref document: EP

Kind code of ref document: A1