WO2022249292A1 - 姿勢センサーのキャリブレーション装置 - Google Patents

姿勢センサーのキャリブレーション装置 Download PDF

Info

Publication number
WO2022249292A1
WO2022249292A1 PCT/JP2021/019836 JP2021019836W WO2022249292A1 WO 2022249292 A1 WO2022249292 A1 WO 2022249292A1 JP 2021019836 W JP2021019836 W JP 2021019836W WO 2022249292 A1 WO2022249292 A1 WO 2022249292A1
Authority
WO
WIPO (PCT)
Prior art keywords
sphere
power transmission
contact point
sensor
rotation
Prior art date
Application number
PCT/JP2021/019836
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 JP2023523769A priority Critical patent/JPWO2022249292A1/ja
Priority to PCT/JP2021/019836 priority patent/WO2022249292A1/ja
Publication of WO2022249292A1 publication Critical patent/WO2022249292A1/ja

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P21/00Testing or calibrating of apparatus or devices covered by the preceding groups

Definitions

  • the present invention relates to a calibration device and a calibration method used to calibrate an orientation sensor.
  • attitude sensors used to detect the orientation and movement of objects are known, such as acceleration sensors, gyro sensors, geomagnetic sensors, and inertial measurement units (IMUs) that combine these functions.
  • IMUs inertial measurement units
  • the present invention has been made in consideration of the above circumstances, and one of its objects is to provide a calibration device and a calibration method capable of relatively easily and accurately calibrating an orientation sensor. to do.
  • An orientation sensor calibration device is configured such that a sphere housing the orientation sensor contacts the sphere at a first contact point, and rotates the sphere via the first contact point.
  • a first power transmission unit that transmits power
  • a second power transmission unit that contacts the sphere at a second contact point and transmits power to rotate the sphere through the second contact point
  • a control device that changes the orientation of the sphere by transmitting power from each of the first power transmission section and the second power transmission section, wherein the Rotation of the sphere is rotation about a rotation axis passing through the second contact point, and rotation of the sphere caused by the second power transmission section is rotation about a rotation axis passing through the first contact point. Characterized by rotation about a center.
  • a method of calibrating an orientation sensor includes: a sphere; and a second power transmission unit that contacts the sphere at a second contact point and transmits power to rotate the sphere through the second contact point.
  • a method for calibrating an orientation sensor to be used comprising the step of housing the orientation sensor in the sphere, and transmitting power from each of the first power transmission unit and the second power transmission unit, changing the orientation of the sphere; obtaining measurement values of the orientation sensor with the sphere oriented in a plurality of orientations; and calculating calibration parameters of the orientation sensor using the obtained measurement values. and calculating a value.
  • FIG. 4 is a flow diagram showing the flow of calibration of the orientation sensor
  • FIG. 1 and 2 are perspective views schematically showing a calibration device 1 according to an embodiment of the present invention, where FIG. 1 shows the front side and FIG. 2 shows the back side.
  • the calibration device 1 is a device used to calibrate the attitude sensor 10, and includes a sphere 20, a pedestal 30, a support portion 31, motors 32a and 32b, power transmission portions 33a and 33b, a drive It includes a circuit 34 and a control device 40 .
  • the orientation sensor 10 to be calibrated is an inertial measurement device capable of measuring acceleration and angular velocity of rotation.
  • the posture sensor 10 measures the acceleration applied along each of the three reference axes that are orthogonal to each other, the X-axis, the Y-axis, and the Z-axis, and the rotation about the reference axis.
  • Angular velocity shall be measured and a signal indicating the result shall be output. That is, in this embodiment, the orientation sensor 10 outputs a total of six measured values.
  • the bias values offset values
  • sensitivity scale factor
  • the bias value and sensitivity for each of the six measurement values are specified by calibrating the orientation sensor 10 in advance.
  • the three reference axes that serve as references for the orientation sensor 10 to measure the acceleration and the angular velocity are orthogonal to each other, they are not exactly orthogonal in reality, and there is an axis deviation.
  • the direction and degree of axis misalignment are specified in advance for each of the acceleration measurement system and the angular velocity measurement system. It is necessary to correct the measured value to take into account. Therefore, in the present embodiment, parameters indicating the direction and magnitude of such axis misalignment are also specified by calibration. Note that, hereinafter, parameters such as bias values, sensitivities, and amounts of axis deviation specified by calibration as described above are collectively referred to as calibration parameters.
  • the orientation sensor 10 is assumed to be mounted on the sensor substrate 11 .
  • a control circuit 12 and a communication circuit 13 are mounted on the sensor substrate 11 together with the attitude sensor 10 .
  • the control circuit 12 is a microprocessor or the like, acquires measurement results output from the orientation sensor 10 during calibration, and transmits the results to the control device 40 via the communication circuit 13 .
  • the communication circuit 13 is a communication module for wireless communication with the control device 40 .
  • the measurement result of the attitude sensor 10 is transmitted to the control device 40 in real time by wireless communication.
  • the sphere 20 has a spherical surface with substantially no unevenness, and has a space inside to accommodate the attitude sensor 10 .
  • sphere 20 may be a plastic capsule or the like.
  • the sensor board 11 on which the orientation sensor 10 to be calibrated is mounted is housed inside the sphere 20 .
  • the orientation sensor 10 is fixed within the sphere 20, and its position and orientation relative to the sphere 20 are maintained so as not to change during calibration.
  • the sensor substrate 11 may be fixed to the inner wall of the sphere 20, for example.
  • the orientation sensor 10 may be fixed at any position within the sphere 20, but it is preferably located at a position closer to the outer surface of the sphere 20 than the center O of the sphere 20 in order to improve the accuracy of calibration.
  • a member for supporting or fixing the sensor substrate 11 may be included in the spherical body 20 .
  • the pedestal 30 is a table for supporting the sphere 20, and is placed on a desk or the like so as to be substantially parallel to the horizontal plane and so that the position and inclination with respect to the horizontal plane do not change during calibration.
  • a support portion 31 , a motor 32 a and a motor 32 b are fixed to the base 30 .
  • the support portion 31 is a member for supporting the sphere 20 at its tip, and is arranged to protrude upward from the base 30 . It is desirable that the tip of the support portion 31 has a small area in contact with the sphere 20 and has a small coefficient of friction with the sphere 20 . Therefore, in this embodiment, the tip of the support portion 31 is formed in a spherical shape from a material such as plastic, and is in contact with the spherical body 20 at one point on its surface. Below, the point at which the tip of the support portion 31 contacts the sphere 20 is referred to as a contact point P0 .
  • the motors 32a and 32b are fixed on the pedestal 30 so as to face each other, and operate according to drive signals input from a drive circuit 34, which will be described later.
  • Motors 32a and 32b may be various motors and the like. However, it is not desirable to cause vibration when stopping the driving of the motors 32a and 32b, or vibration due to torque during stopping. Therefore, it is desirable to employ a motor such as a stepping motor that is less susceptible to such vibrations.
  • the power transmission parts 33a and 33b both have a disk-like shape and have the same size.
  • a rotation shaft of a motor 32a is connected to the center of the power transmission portion 33a, and the power transmission portion 33a rotates about the rotation shaft by driving the motor 32a.
  • the rotation shaft of the motor 32b is connected to the center of the power transmission portion 33b, and the power transmission portion 33b rotates about the rotation shaft by driving the motor 32b.
  • the motors 32a and 32b are collectively referred to as the motor 32
  • the two power transmission units 33a and 33b are collectively referred to as the power transmission unit 33 as necessary.
  • the drive circuit 34 is a control circuit for driving the motors 32a and 32b.
  • the drive circuit 34 is wired or wirelessly connected to the control device 40 and receives control instructions from the control device 40 . Then, a drive signal is output to each of the motors 32a and 32b to rotate the power transmission section 33 by an amount determined according to the control command.
  • the control device 40 is an information processing device such as a personal computer, and controls the execution of calibration based on the instructions of the calibration operator. Specifically, the control device 40 drives each of the motors 32a and 32b by outputting a control command to the drive circuit 34 . Thereby, the control device 40 can change the direction of the sphere 20 to any direction as described later. Further, the control device 40 receives data of measurement values output by the attitude sensor 10 during execution of calibration from the communication circuit 13 by wireless communication. Then, the data of the measured values are used to calculate the values of the calibration parameters.
  • each power transmission part 33 supports the sphere 20 at one point on the side thereof opposite to the connected motor 32 side.
  • the position at which the ball 20 contacts the power transmission portion 33a is referred to as a contact point P1
  • the position at which the ball 20 contacts the power transmission portion 33b is referred to as a contact point P2 . That is, the sphere 20 is supported at three contact points P 0 , P 1 and P 2 .
  • FIG. 3 is a diagram showing the positional relationship between the power transmission units 33a and 33b and the spherical body 20, and is a plan view of the calibration device 1 viewed from above.
  • the rotation shafts of the motors 32a and 32b are arranged substantially on the same straight line, and the power transmission units 33a and 33b are arranged parallel to each other and facing each other.
  • the power transmission portions 33a and 33b are of the same size and arranged so that their heights relative to the horizontal plane are equal to each other.
  • the power transmission portions 33 a and 33 b are arranged such that the contact points P 1 and P 2 are substantially perpendicular to the center O of the sphere 20 . That is, the positional relationship between the power transmission portion 33a, the power transmission portion 33b, and the sphere 20 is determined such that the angle P1OP2 is substantially right .
  • the contact points P 0 , P 1 , and P 2 are all located vertically below the center O of the sphere 20 (that is, on the pedestal 30 side), and form a triangle containing the center O inside when viewed from above.
  • the contact point P0 of the support portion 31 is arranged at approximately the same distance from the contact point P1 and the contact point P2 . That is, the triangle P 0 P 1 P 2 is an isosceles triangle. A perpendicular drawn from the point P 0 to the line segment P 1 P 2 overlaps the center O in plan view.
  • each power transmission portion 33 is made of a material that increases the coefficient of friction with the spherical body 20 .
  • the friction coefficients of the contact points P 1 and P 2 between the power transmission portion 33 and the sphere 20 are at least greater than the friction coefficient of the contact point P 0 between the support portion 31 and the sphere 20 .
  • the side surface of the power transmission portion 33 may be made of a material having greater elasticity than the tip portion of the support portion 31, such as rubber. As a result, the coefficient of friction between the power transmission portion 33 and the sphere 20 can be increased, and the vibration generated by driving the motor 32 can be made difficult to be transmitted to the sphere 20 .
  • the power transmission part 33a when the power transmission part 33a is rotated by the motor 32a, the power for rotating the sphere 20 is transmitted from the contact point P1 .
  • the friction coefficient of the contact point P2 is larger than the friction coefficient of the contact point P0 , the sphere 20 slides on the contact point P0 but does not slide on the contact point P2 , as indicated by the arrow A1 in FIG. , it rotates about the rotation axis R1 passing through the contact point P2 and the center O of the sphere 20.
  • the motor 32b when the motor 32b is driven, the rotation of the power transmission portion 33b is transmitted to the sphere 20 from the contact point P2 .
  • the controller 40 does not operate the motors 32a and 32b at the same time during execution of the calibration, and always operates only one of them. By operating the respective motors 32 in this manner, the controller 40 can rotate the sphere 20 along two axes of rotation.
  • the control device 40 rotates each motor 32 by an angle calculated according to this ratio, thereby rotating the sphere 20 by a target amount of rotation along each of the rotation axes R1 and R2. can.
  • the two rotation axes R1 and R2 are substantially orthogonal because the angles P 1 OP 2 are arranged to be substantially right angles. Therefore, by combining rotation about the rotation axis R1 and rotation about the rotation axis R2, the control device 40 can orient the spherical body 20 in any direction around the whole sky. As a result, the attitude sensor 10 fixed inside the sphere 20 can also be oriented in any direction. Even if the angles P 1 OP 2 are not strictly right angles, the sphere 20 can be oriented in any direction as long as the sphere 20 can be rotated along two mutually intersecting axes. However, in order to change the orientation of the sphere 20 efficiently, it is desirable that the angle P 1 OP 2 is close to a right angle, and that angle should be in the range of at least 45 degrees to 135 degrees.
  • the calibration operator accommodates the orientation sensor 10 in the sphere 20 by fixing the sensor substrate 11 on which the orientation sensor 10 to be calibrated is mounted in the sphere 20 (S1). Then, the sphere 20 containing the attitude sensor 10 is arranged on the support portion 31, the power transmission portion 33a, and the power transmission portion 33b (S2).
  • the control device 40 starts measurement control for calibration. Specifically, first, the control device 40 instructs the control circuit 12 to start measurement by the attitude sensor 10 (S3). The timing of this measurement start becomes a reference point in a series of measurement control. After this reference time, the control circuit 12 continuously acquires the measurement results of the attitude sensor 10 and transmits the acquired measurement results to the control device 40 via the communication circuit 13 until the necessary measurements are completed.
  • the control device 40 acquires the measurement result of the orientation sensor 10 while maintaining the state in which the sphere 20 is placed in S2 and remains stationary for a predetermined time (S4).
  • This initial state becomes the reference state for calibration.
  • the control device 40 does not need to know in advance how the orientation sensor 10 is oriented with respect to the horizontal plane.
  • the controller 40 can estimate the calibration parameters taking into account the change in . In other words, the control device 40 can perform calibration without knowing the true value of the parameter to be measured during measurement.
  • the control device 40 rotates the sphere 20 to face the target (S5). Specifically, the control device 40 outputs a control command to the drive circuit 34 to operate the motor 32a or 32b to rotate the connected power transmission section 33 . At this time, as described above, the control device 40 does not operate both the motors 32a and 32b at the same time, and always operates only one of them. By operating either one of the motors 32a and 32b, or by operating both motors 32 one after the other, the control device 40 can orient the sphere 20 in any direction through a combination of two directions of rotation. can.
  • the control device 40 stops the sphere 20 for a predetermined time or more in a state where the rotation control of S5 is completed and the sphere 20 has reached the target orientation (S6).
  • the measured value in this state indicates the gravitational acceleration detected by the orientation sensor 10 in a predetermined orientation.
  • the control device 40 repeats the above-described controls of S5 and S6 a predetermined number of times while continuing to acquire the measurement results of the attitude sensor 10 (S7). At this time, the control device 40 determines the new target orientation of the sphere 20 to be different from the target orientation in the past control of S5. Accordingly, the control device 40 can acquire the measurement values of the orientation sensor 10 with the orientation sensor 10 directed in a plurality of mutually different directions.
  • the control device 40 After repeating the controls of S5 and S6 a predetermined number of times, the control device 40 ends the measurement control of the attitude sensor 10 (S8). Through the measurement control thus far, the control device 40 controls the state of the attitude sensor 10 (orientation and rotation of the attitude sensor with respect to the reference state) estimated from the content of the control command to the drive circuit 34 at each time point after the reference time point. ) and the measurement result of the attitude sensor 10 at that time can be obtained.
  • control device 40 calculates the value of the calibration parameter of the orientation sensor 10 using the time-series data of the measurement values of the orientation sensor 10 acquired during execution of the measurement control from S3 to S8 (S9).
  • This calibration parameter calculation process itself can be realized by a known algorithm. By using the results of measurements performed with the orientation sensor 10 directed in various directions different from each other, it is possible to obtain the values of the calibration parameters with high accuracy.
  • the values of the calibration parameters calculated by the procedure described above are recorded in the terminal device.
  • the recorded calibration parameter values are used to calculate the true values of the parameters to be measured from the measured values of the orientation sensor 10 .
  • the measurement control necessary for calibration can be automated, and measurement with relatively high reproducibility can be performed without much effort.
  • the orientation of the orientation sensor 10 is changed by rotating the two rotation axes R1 and R2.
  • the driving systems for realizing these rotations are independent of each other, an accumulated error occurs. Therefore, the measurement accuracy can be improved.
  • the attitude sensor 10 is an inertial measurement device that measures both acceleration and rotational angular velocity.
  • the orientation sensor targeted by the calibration device 1 according to the embodiment of the present invention is not limited to such sensors, and may be various sensors for measuring orientation and movement.
  • the attitude sensor may be an acceleration sensor that measures acceleration, a gyro sensor that measures angular velocity of rotation, or a geomagnetic sensor that measures geomagnetism.
  • the types of calibration parameters calculated by calibration are not limited to those described above. For example, depending on the type of sensor, only some of the parameters described above may be obtained, or more numerical values may be obtained.
  • the control circuit 12 transmits the measurement result of the attitude sensor 10 to the control device 40 by wireless communication each time.
  • the measurement results output by the orientation sensor 10 may be accumulated without being transmitted to the outside.
  • the sensor substrate 11 is taken out from the sphere 20, and the measurement results accumulated therein are used to calibrate the calibration value. Calculate In this case, it is not necessary to mount the communication circuit 13 on the sensor substrate 11 .
  • the control device 40 determines the direction and amount of rotation of the sphere 20 from the amounts of rotation of the motors 32a and 32b, and uses them to calculate the calibration parameters.
  • the control device 40 may specify the actual rotation direction and rotation amount of the sphere 20 at the time of execution of the calibration by another means, and use the specified result to calculate the value of the calibration parameter.
  • a plurality of identification markers may be placed on the surface of the sphere 20, and the control device 40 may use a camera to identify the movement of the markers.
  • a camera is installed at a position where the sphere 20 can be photographed, and the control device 40 acquires an image photographed by the camera in real time during execution of calibration. Then, the position of the marker appearing in the captured image is specified by image recognition, and the movement of the marker during measurement control is tracked. As a result, the actual rotation direction and rotation amount of the sphere 20 can be specified with high accuracy.

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

姿勢センサー(10)を収容する球体(20)と、第1の接触点で球体(20)と接触し、当該第1の接触点を介して球体(20)を回転させる動力を伝達する第1の動力伝達部(33a)と、第2の接触点で球体(20)と接触し、当該第2の接触点を介して球体(20)を回転させる動力を伝達する第2の動力伝達部(33b)と、第1の動力伝達部(33a)、及び第2の動力伝達部(33b)のそれぞれから動力を伝達させることで、球体の向きを変化させる制御装置(40)と、を備え、第1の動力伝達部(33a)により生じる球体(20)の回転は、第2の接触点を通る回転軸を中心とする回転であって、第2の動力伝達部(33b)により生じる球体(20)の回転は、第1の接触点を通る回転軸を中心とする回転となる姿勢センサーのキャリブレーション装置である。

Description

姿勢センサーのキャリブレーション装置
 本発明は、姿勢センサーのキャリブレーションを行うために用いられるキャリブレーション装置、及びキャリブレーション方法に関する。
 加速度センサーやジャイロセンサー、地磁気センサー、またこれらの機能を複合的に備える慣性計測装置(IMU)など、物体の向きや動きを検出するために用いられる各種の姿勢センサーが知られている。一般に、このような姿勢センサーを使用する際には、予めキャリブレーションを行ってその出力特性(バイアス値や感度など)を把握する必要がある。
 姿勢センサーのキャリブレーションを行う際には、上下左右前後といったように3次元空間内の様々な向きに姿勢センサーを向けた状態で測定を行う必要がある。このように姿勢センサーを様々な方向に向ける作業を手作業で行うこととすると、手間が掛かったり、測定精度に問題が生じたりする。また、キャリブレーションに利用する装置の構成によっては、特定の向きに姿勢センサーを向けることが難しかったり、キャリブレーション時の測定結果に特定の傾向の誤差が含まれたりすることがある。
 本発明は上記実情を考慮してなされたものであって、その目的の一つは、比較的簡単に、かつ精度よく姿勢センサーのキャリブレーションを実現可能なキャリブレーション装置、及びキャリブレーション方法を提供することにある。
 本発明の一態様に係る姿勢センサーのキャリブレーション装置は、前記姿勢センサーを収容する球体と、第1の接触点で前記球体と接触し、当該第1の接触点を介して前記球体を回転させる動力を伝達する第1の動力伝達部と、第2の接触点で前記球体と接触し、当該第2の接触点を介して前記球体を回転させる動力を伝達する第2の動力伝達部と、前記第1の動力伝達部、及び前記第2の動力伝達部のそれぞれから動力を伝達させることで、前記球体の向きを変化させる制御装置と、を備え、前記第1の動力伝達部により生じる前記球体の回転は、前記第2の接触点を通る回転軸を中心とする回転であって、前記第2の動力伝達部により生じる前記球体の回転は、前記第1の接触点を通る回転軸を中心とする回転であることを特徴とする。
 本発明の一態様に係る姿勢センサーのキャリブレーション方法は、球体と、第1の接触点で前記球体と接触し、当該第1の接触点を介して前記球体を回転させる動力を伝達する第1の動力伝達部と、第2の接触点で前記球体と接触し、当該第2の接触点を介して前記球体を回転させる動力を伝達する第2の動力伝達部と、を備えるキャリブレーション装置を用いる姿勢センサーのキャリブレーション方法であって、前記姿勢センサーを前記球体内に収容するステップと、前記第1の動力伝達部、及び前記第2の動力伝達部のそれぞれから動力を伝達させることで、前記球体の向きを変化させるステップと、前記球体が複数の向きに向けられた状態における前記姿勢センサーの計測値を取得するステップと、前記取得した計測値を用いて前記姿勢センサーのキャリブレーションパラメーターの値を算出するステップと、を含むことを特徴とする。
本発明の実施の形態に係るキャリブレーション装置を正面側から見た様子を示す斜視図である。 本発明の実施の形態に係るキャリブレーション装置を背面側から見た様子を示す斜視図である。 動力伝達部と球体の位置関係を示す平面図である。 姿勢センサーのキャリブレーションの流れを示すフロー図である。
 以下、本発明の実施の形態について、図面に基づき詳細に説明する。
 図1及び図2は、本発明の一実施形態に係るキャリブレーション装置1を模式的に示す斜視図であって、図1は正面側、図2は背面側から見た様子を示している。キャリブレーション装置1は、姿勢センサー10をキャリブレーションするために用いられる装置であって、球体20と、台座30と、支持部31と、モーター32a及び32bと、動力伝達部33a及び33bと、駆動回路34と、制御装置40と、を含んで構成されている。
 本実施形態において、キャリブレーションの対象となる姿勢センサー10は、加速度、及び回転の角速度を計測可能な慣性計測装置であることとする。具体的に姿勢センサー10は、互いに直交する3つの基準軸であるX軸、Y軸、及びZ軸のそれぞれについて、その基準軸に沿って加わる加速度、及びその基準軸を回転中心とした回転の角速度を計測し、その結果を示す信号を出力するものとする。すなわち、本実施形態において姿勢センサー10は計6個の計測値を出力する。姿勢センサー10の計測値に基づいて加速度や各速度の真の値を知るためには、これら6個の計測値のそれぞれについて、真の値が0の場合に出力されるバイアス値(オフセット値)、及び真の値の変化に応じた計測値の比例定数に相当する感度(スケールファクター)の2種類の数値を予め把握する必要がある。そのため本実施形態では、姿勢センサー10のキャリブレーションを予め実行することによって、6個の計測値のそれぞれについてのバイアス値及び感度を特定するものとする。
 また、姿勢センサー10が加速度、及び角速度それぞれの計測を行う基準となる3つの基準軸は互いに直交していることが理想だが、実際には正確に直交しておらず、軸ずれが生じていることがある。このような姿勢センサー10を使用する場合、加速度の計測系、及び角速度の計測系のそれぞれについて、どの方向にどの程度の軸ずれが生じているかを予め特定し、実際の使用時にはその軸ずれを考慮して計測値を補正する必要がある。そこで本実施形態では、このような軸ずれの向き及び大きさを示すパラメーターもキャリブレーションによって特定するものとする。なお、以下では以上説明したようにキャリブレーションによって特定されるバイアス値や感度、軸ずれ量などのパラメーターを総称してキャリブレーションパラメーターと表記する。
 本実施形態において姿勢センサー10は、センサー基板11に搭載されているものとする。センサー基板11には、姿勢センサー10とともに制御回路12、及び通信回路13が搭載されている。制御回路12はマイクロプロセッサ等であって、キャリブレーションの実行中、姿勢センサー10が出力する計測結果を取得し、通信回路13を介して制御装置40に対して送信する。通信回路13は、制御装置40との間で無線通信を行うための通信モジュールである。本実施形態において姿勢センサー10の計測結果は、無線通信によってリアルタイムで制御装置40に対して送信される。
 球体20は、その表面が略凹凸のない球状になっており、内部に姿勢センサー10を収容するための空間が設けられている。例えば球体20は、プラスティック製のカプセルなどであってよい。
 キャリブレーションの対象となる姿勢センサー10が搭載されたセンサー基板11は、球体20の内部に収容される。具体的に、姿勢センサー10は球体20内において固定され、その球体20に対する相対的な位置や向きがキャリブレーションの実行中に変化しないように維持される。センサー基板11は、例えば球体20の内壁に固定されてよい。なお、姿勢センサー10は球体20内の任意の位置に固定されてよいが、キャリブレーションの精度を高めるためには、球体20の中心Oよりも外表面に近い位置に配置することが好ましい。また、球体20内には、センサー基板11を支持したり固定したりするための部材が含まれてよい。
 台座30は、球体20を支持するための台であって、水平面と略平行になるように、かつ水平面に対する位置や傾きがキャリブレーションの実行中に変化しないように、卓上などに配置される。台座30には、支持部31、モーター32a、及びモーター32bが固定されている。
 支持部31は、その先端で球体20を支持するための部材であって、台座30から上方に突出するように配置されている。支持部31の先端は、球体20と接触する部分の面積が小さく、球体20との間の摩擦係数が小さくなることが望ましい。そのため本実施形態では、支持部31の先端はプラスティック等の素材によって球状に形成されており、その表面の一点で球体20と接するようになっている。以下では支持部31の先端が球体20と接触する点を接触点Pと表記する。
 モーター32a及び32bは、互いに対向するように台座30上に固定されており、後述する駆動回路34から入力される駆動信号に従って動作する。モーター32a及び32bは、各種のモーターなどであってよい。ただし、モーター32a及び32bの駆動を停止させる際に振動が生じたり、停止中にトルクによる振動が生じたりすることは望ましくない。そこで、このような振動が生じにくいステッピングモーターなどのモーターを採用することが望ましい。
 動力伝達部33a及び33bは、いずれも円板状の形状を有しており、互いに同じ大きさを有している。動力伝達部33aの中心にはモーター32aの回転軸が連結されており、動力伝達部33aはモーター32aの駆動によってその回転軸を中心に回転する。同様に、動力伝達部33bの中心にはモーター32bの回転軸が連結されており、動力伝達部33bはモーター32bの駆動によってその回転軸を中心に回転する。なお、以下では必要に応じて、モーター32a及び32bをまとめてモーター32と表記し、動力伝達部33a及び33bの二つをまとめて動力伝達部33と表記する。これらの動力伝達部33を回転させることで、キャリブレーションを実行する際に、姿勢センサー10を収容する球体20を回転させて任意の向きに向けることができる。球体20の回転制御の詳細については、後述する。
 駆動回路34は、モーター32a及び32bを駆動させるための制御回路である。駆動回路34は有線又は無線で制御装置40と接続されており、制御装置40からの制御命令を受け付ける。そして、モーター32a及び32bのそれぞれに対して、制御命令に応じて決まる量だけ動力伝達部33を回転させる駆動信号を出力する。
 制御装置40は、パーソナルコンピュータ等の情報処理装置であって、キャリブレーション作業者の指示などに基づいてキャリブレーションの実行制御を行う。具体的に制御装置40は、駆動回路34に対して制御命令を出力することによってモーター32a及び32bのそれぞれを駆動させる。これにより制御装置40は、後述するように球体20の向きを任意の向きに変化させることができる。また、制御装置40は、キャリブレーション実行中に姿勢センサー10が出力する計測値のデータを無線通信によって通信回路13から受信する。そして、この計測値のデータを用いてキャリブレーションパラメーターの値を算出する。
 以下、球体20の回転制御について説明する。キャリブレーションを実行する際、球体20は、支持部31、動力伝達部33a、及び動力伝達部33bのそれぞれと接触し、これらの部材によって支持される。ただし、球体20は、これらの部材のいずれとも接着されているわけではなく、単にこれらの部材の上に載せられた状態になる。具体的に各動力伝達部33は、その側面の、連結されたモーター32側と反対側の一点で球体20を支持する。以下では、球体20が動力伝達部33aと接する位置を接触点P、動力伝達部33bと接する位置を接触点Pと表記する。すなわち、球体20は接触点P、P、及びPの3点で支持されることとなる。
 図3は、動力伝達部33a及び33bと球体20との間の位置関係を示す図であって、キャリブレーション装置1を上方から見た平面図である。同図に示されるように、モーター32a及び32bの回転軸は略同一直線上に配置されており、動力伝達部33a及び33bは互いに平行に、かつ対向するように配置されている。また、動力伝達部33a及び33bは互いに同じ大きさであって、その水平面に対する高さが互いに等しくなるように配置されている。さらに、動力伝達部33a及び33bは、接触点P及びPが球体20の中心Oに対して略直角をなすように配置されている。すなわち、角POPが略直角になるように動力伝達部33a、動力伝達部33b、及び球体20の位置関係が決定されている。
 接触点P、P、及びPは、いずれも球体20の中心Oよりも鉛直下方(すなわち、台座30側)に位置し、平面視においてその内部に中心Oを含む三角形を形成している。さらに、本実施形態において支持部31の接触点Pは、接触点P及び接触点Pから略等しい距離になるように配置されている。すなわち、三角形Pは二等辺三角形になっている。そして、点Pから線分Pに下ろした垂線が、平面視において中心Oと重なっている。
 各動力伝達部33の側面は、球体20との間の摩擦係数が大きくなるような材質により構成されている。具体的に、動力伝達部33と球体20との間の接触点P及びPの摩擦係数は、少なくとも支持部31と球体20との間の接触点Pの摩擦係数よりも大きくなる。例えば動力伝達部33の側面は、ゴムなどのように支持部31の先端部分よりも弾性が大きい素材によって形成されてよい。これにより、動力伝達部33と球体20との間の摩擦係数を大きくするとともに、モーター32の駆動によって生じる振動は球体20に伝達しにくくすることができる。
 接触点P及びPの摩擦係数を大きくすることにより、どちらかのモーター32を駆動させて連結された動力伝達部33を回転させると、その回転が球体20に伝達され、球体20が回転する。このとき、前述したように球体20は接触点Pを含む3点で支持されているので、その位置は変化せず、その場で回転することになる。すなわち、キャリブレーションの実行中、球体20が回転しても、その中心Oの3次元空間内における位置は変化しない。
 具体的に、モーター32aによって動力伝達部33aが回転すると、接触点Pから球体20を回転させようとする動力が伝達される。ここで、接触点Pの摩擦係数より接触点Pの摩擦係数が大きいため、球体20は接触点P上を滑る一方で接触点Pでは滑らず、図3において矢印A1で示されるように、接触点Pと球体20の中心Oを通る回転軸R1を中心に回転する。同様に、モーター32bを駆動させた場合、動力伝達部33bの回転が接触点Pから球体20に伝達される。その結果、図3において矢印A2で示されるように、球体20は接触点Pと中心Oを通る回転軸R2を中心に回転する。なお、キャリブレーションの実行中、制御装置40はモーター32a及び32bを同時に動作させることはなく、常にどちらか一方のみを動作させることとする。このように、それぞれのモーター32を動作させることで、制御装置40は球体20を2つの回転軸に沿って回転させることができる。
 ここで、モーター32の回転量に対して球体20がどの程度回転するかは、動力伝達部33の半径と球体20の半径の比率によって予め求められる。そのため制御装置40は、この比率に応じて計算される角度の分だけ各モーター32を回転させることによって、球体20を回転軸R1及びR2のそれぞれに沿って目標とする回転量だけ回転させることができる。
 前述したように、角POPは略直角になるように配置されているので、2つの回転軸R1及びR2は略直交する。そのため、回転軸R1を中心とした回転と回転軸R2を中心とした回転を組み合わせることで、制御装置40は球体20を全天周どの向きにも向けることができる。これにより、球体20内に固定されている姿勢センサー10も任意の向きに向けることができる。なお、角POPは厳密に直角にならずとも、互いに交差する2軸に沿って球体20を回転させることができれば、任意の向きに球体20を向けることができる。しかしながら、効率的に球体20の向きを変化させるためには角POPが直角に近いことが望ましく、その角度は少なくとも45度以上135度以下の範囲とすることが望ましい。
 なお、本実施形態では姿勢センサー10の計測結果を無線通信によって制御装置40に送信するので、球体20自体にはケーブル等が接続されていない。そのため、球体20がどのような向きに向けられてもその動きが阻害されることはない。
 以下、このキャリブレーション装置1を用いた姿勢センサー10のキャリブレーションの流れについて、図4のフロー図を用いて説明する。まずキャリブレーション作業者は、キャリブレーション対象となる姿勢センサー10を搭載したセンサー基板11を球体20内に固定することで、姿勢センサー10を球体20内に収容する(S1)。そして、姿勢センサー10を収容した球体20を支持部31、動力伝達部33a、及び動力伝達部33bの上に配置する(S2)。
 その後、制御装置40がキャリブレーションのための計測制御を開始する。具体的に、まず制御装置40は、制御回路12に対して姿勢センサー10の計測開始を指示する(S3)。この計測開始のタイミングが、一連の計測制御における基準時点となる。この基準時点以降、必要な計測が終了するまで、制御回路12は姿勢センサー10の計測結果を継続的に取得し、取得した計測結果を通信回路13経由で制御装置40に送信する。
 続いて制御装置40は、S2で配置されて球体20が静止した状態を所定時間維持したまま、姿勢センサー10の計測結果を取得する(S4)。この最初の状態が、キャリブレーションにおける基準状態となる。なお、このとき水平面に対して姿勢センサー10がどのような向きにあるかを制御装置40は予め把握する必要はなく、姿勢センサー10がどのような向きにあってもその状態を基準とした姿勢の変化を考慮して制御装置40はキャリブレーションパラメーターを推定することができる。つまり、制御装置40は、計測対象となるパラメーターの計測中における真の値を知ることなく、キャリブレーションを行うことができる。
 その後、制御装置40は、球体20を目標の向きに向けるよう回転させる(S5)。具体的に制御装置40は、駆動回路34に対して制御命令を出力することによって、モーター32a又は32bを動作させ、連結された動力伝達部33を回転させる。このとき制御装置40は、前述したように、モーター32a及び32bを両方同時に動かさずに、常にいずれか一方のみを動作させることとする。モーター32a及びモーター32bのいずれか一方を動作させるか、あるいは両方のモーター32を順に一つずつ動作させることによって、2方向の回転の組み合わせによって制御装置40は球体20を任意の向きに向けることができる。
 その後、制御装置40は、S5の回転制御が終了し、球体20が目標の向きに到達した状態で、球体20を所定時間以上静止させる(S6)。この状態における計測値は、所定の向きにおいて姿勢センサー10が検知する重力加速度を示している。
 制御装置40は、姿勢センサー10の計測結果の取得を継続しながら、以上説明したS5及びS6の制御を予め定められた回数だけ繰り返す(S7)。このとき制御装置40は、新たな球体20の目標の向きを過去のS5の制御で目標とした向きとは異なる向きになるように決定する。これにより制御装置40は、互いに異なる複数の向きに姿勢センサー10を向けた状態で姿勢センサー10の計測値を取得することができる。
 S5及びS6の制御を予め定められた回数だけ繰り返すと、制御装置40は姿勢センサー10の計測制御を終了する(S8)。ここまでの計測制御により、制御装置40は、基準時点以降の各時点において、駆動回路34に対する制御命令の内容から推定される姿勢センサー10の状態(基準状態を基準とした姿勢センサーの向き及び回転の角速度)とその時点の姿勢センサー10の計測結果との組み合わせからなる時系列データを得ることができる。
 最後に制御装置40は、S3からS8までの計測制御を実行中に取得した姿勢センサー10の計測値の時系列データを用いて、姿勢センサー10のキャリブレーションパラメーターの値を算出する(S9)。このキャリブレーションパラメーターの算出処理自体は、公知のアルゴリズムによって実現可能である。互いに異なる様々な向きに姿勢センサー10を向けた状態で計測を行った結果を用いることで、精度よくキャリブレーションパラメーターの値を求めることができる。
 キャリブレーションの対象となった姿勢センサー10を搭載した端末装置を製造する際には、以上説明した手順によって算出されたキャリブレーションパラメーターの値を、その端末装置内に記録する。その端末装置を実際に使用する際には、記録されたキャリブレーションパラメーターの値を用いて、姿勢センサー10の計測値から計測対象となるパラメーターの真の値を算出する。
 以上説明した本実施形態に係るキャリブレーション装置1によれば、キャリブレーションに必要な計測制御を自動化し、手間をかけずに比較的再現性の高い計測を行うことができる。また、本実施形態では、回転軸R1及びR2の2軸の回転によって姿勢センサー10の姿勢を変化させているが、これらの回転を実現する駆動系は互いに独立しているため、累積誤差が生じず、計測精度を高めることができる。
 本発明の実施の形態は、以上説明したものに限られるものではない。例えば以上の説明においては、姿勢センサー10は、加速度及び回転の角速度の双方を計測する慣性計測装置であることとした。しかしながら、本発明の実施の形態に係るキャリブレーション装置1が対象とする姿勢センサーはこのようなものに限られず、その向きや動きを計測する各種のセンサーであってよい。例えば姿勢センサーは、加速度を計測する加速度センサーや、回転の角速度を計測するジャイロセンサーや、地磁気を計測する地磁気センサーなどであってよい。
 また、キャリブレーションによって算出するキャリブレーションパラメーターの種類についても、以上説明したものに限られない。例えばセンサーの種類によっては、以上説明したパラメーターの一部のみを求めることとしてもよいし、さらにより多くの数値を求めることとしてもよい。
 また、以上の説明では、制御回路12は姿勢センサー10の計測結果をつど無線通信で制御装置40に対して送信することとしたが、これに限らず制御回路12は、キャリブレーションの実行中に姿勢センサー10が出力する計測結果を外部に送信せずに蓄積することとしてもよい。この場合、上述したように球体20を回転させてキャリブレーションに必要な計測制御を完了した後に、球体20内からセンサー基板11を取り出し、その内部に蓄積された計測結果を利用してキャリブレーション値を算出する。この場合、通信回路13をセンサー基板11に搭載する必要はない。
 また、以上の説明では制御装置40は、モーター32a及び32bの回転量から球体20の回転方向及び回転量を決定し、キャリブレーションパラメーターの算出に用いることとした。しかしながら、接触点Pや接触点Pで滑りが生じるなどして、モーター32の回転量から算出される球体20の回転量と実際の球体20の回転量との間にずれが生じる可能性もある。そこで制御装置40は、別の手段でキャリブレーションの実行時における球体20の現実の回転方向及び回転量を特定し、その特定結果を用いてキャリブレーションパラメーターの値を算出してもよい。例えば球体20の表面に識別用のマーカーを複数配置し、制御装置40はカメラを用いてそのマーカーの動きを特定することとしてもよい。この場合、球体20を撮影可能な位置にカメラを設置し、キャリブレーションの実行中、制御装置40はカメラによる撮影画像をリアルタイムで取得する。そして、画像認識によってその撮影画像に写っているマーカーの位置を特定し、計測制御中のマーカーの動きを追跡する。これにより、実際の球体20の回転の向きや回転量を精度よく特定することができる。
 1 キャリブレーション装置、10 姿勢センサー、11 センサー基板、12 制御回路、13 通信回路、20 球体、30 台座、31 支持部、32a及び32b モーター、33a及び33b 動力伝達部、34 駆動回路、40 制御装置。

Claims (5)

  1.  姿勢センサーのキャリブレーション装置であって、
     前記姿勢センサーを収容する球体と、
     第1の接触点で前記球体と接触し、当該第1の接触点を介して前記球体を回転させる動力を伝達する第1の動力伝達部と、
     第2の接触点で前記球体と接触し、当該第2の接触点を介して前記球体を回転させる動力を伝達する第2の動力伝達部と、
     前記第1の動力伝達部、及び前記第2の動力伝達部のそれぞれから動力を伝達させることで、前記球体の向きを変化させる制御装置と、
     を備え、
     前記第1の動力伝達部により生じる前記球体の回転は、前記第2の接触点を通る回転軸を中心とする回転であって、
     前記第2の動力伝達部により生じる前記球体の回転は、前記第1の接触点を通る回転軸を中心とする回転である
     ことを特徴とする姿勢センサーのキャリブレーション装置。
  2.  請求項1に記載の姿勢センサーのキャリブレーション装置において、
     前記第1の動力伝達部、及び前記第2の動力伝達部とともに前記球体を支持する支持部をさらに備え、
     前記支持部と前記球体とが接触する接触点の摩擦係数は、前記第1の接触点、及び前記第2の接触点の摩擦係数よりも小さい
     ことを特徴とする姿勢センサーのキャリブレーション装置。
  3.  請求項1又は2に記載の姿勢センサーのキャリブレーション装置において、
     前記第1の動力伝達部は第1のモーターに連結され、
     前記第2の動力伝達部は第2のモーターに連結され、
     前記制御装置は、前記第1のモーター及び前記第2のモーターのそれぞれを駆動させて前記第1の動力伝達部、及び前記第2の動力伝達部から前記球体に動力を伝達させる
     ことを特徴とする姿勢センサーのキャリブレーション装置。
  4.  請求項1から3のいずれか一項に記載の姿勢センサーのキャリブレーション装置において、
     前記第1の動力伝達部、及び前記第2の動力伝達部は、前記第1の接触点と前記第2の接触点が前記球体の中心に対してなす角度が45度以上135度以下となるように配置されている
     ことを特徴とする姿勢センサーのキャリブレーション装置。
  5.  球体と、
     第1の接触点で前記球体と接触し、当該第1の接触点を介して前記球体を回転させる動力を伝達する第1の動力伝達部と、
     第2の接触点で前記球体と接触し、当該第2の接触点を介して前記球体を回転させる動力を伝達する第2の動力伝達部と、
     を備えるキャリブレーション装置を用いる姿勢センサーのキャリブレーション方法であって、
     前記姿勢センサーを前記球体内に収容するステップと、
     前記第1の動力伝達部、及び前記第2の動力伝達部のそれぞれから動力を伝達させることで、前記球体の向きを変化させるステップと、
     前記球体が複数の向きに向けられた状態における前記姿勢センサーの計測値を取得するステップと、
     前記取得した計測値を用いて前記姿勢センサーのキャリブレーションパラメーターの値を算出するステップと、
     を含むことを特徴とする姿勢センサーのキャリブレーション方法。
PCT/JP2021/019836 2021-05-25 2021-05-25 姿勢センサーのキャリブレーション装置 WO2022249292A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2023523769A JPWO2022249292A1 (ja) 2021-05-25 2021-05-25
PCT/JP2021/019836 WO2022249292A1 (ja) 2021-05-25 2021-05-25 姿勢センサーのキャリブレーション装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2021/019836 WO2022249292A1 (ja) 2021-05-25 2021-05-25 姿勢センサーのキャリブレーション装置

Publications (1)

Publication Number Publication Date
WO2022249292A1 true WO2022249292A1 (ja) 2022-12-01

Family

ID=84229705

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/019836 WO2022249292A1 (ja) 2021-05-25 2021-05-25 姿勢センサーのキャリブレーション装置

Country Status (2)

Country Link
JP (1) JPWO2022249292A1 (ja)
WO (1) WO2022249292A1 (ja)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006226680A (ja) * 2005-02-15 2006-08-31 Nippon Telegr & Teleph Corp <Ntt> 加速度センサの校正方法及び加速度測定装置
JP2006331365A (ja) * 2005-05-26 2006-12-07 Ritsu Onodera コンタクトレンズおよび眼鏡の販売システム
JP2011136813A (ja) * 2009-12-28 2011-07-14 Canon Inc シート搬送装置及び画像形成装置
US20160178371A1 (en) * 2014-12-17 2016-06-23 Honeywell International Inc. Magnetic sensor calibration for aircraft
CN105737855A (zh) * 2016-02-05 2016-07-06 杭州士兰微电子股份有限公司 用于传感器校准与测试的转台系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006226680A (ja) * 2005-02-15 2006-08-31 Nippon Telegr & Teleph Corp <Ntt> 加速度センサの校正方法及び加速度測定装置
JP2006331365A (ja) * 2005-05-26 2006-12-07 Ritsu Onodera コンタクトレンズおよび眼鏡の販売システム
JP2011136813A (ja) * 2009-12-28 2011-07-14 Canon Inc シート搬送装置及び画像形成装置
US20160178371A1 (en) * 2014-12-17 2016-06-23 Honeywell International Inc. Magnetic sensor calibration for aircraft
CN105737855A (zh) * 2016-02-05 2016-07-06 杭州士兰微电子股份有限公司 用于传感器校准与测试的转台系统

Also Published As

Publication number Publication date
JPWO2022249292A1 (ja) 2022-12-01

Similar Documents

Publication Publication Date Title
CN109813336B (zh) 惯性测量单元标定方法
JP4005921B2 (ja) 産業ロボットの較正装置、方法及びその較正に関するコンピュータプログラム製品
ES2313580T3 (es) Dispositivo y metodo para calibracion de sondas de ultrasonido.
WO2012066852A1 (ja) 6方向指向装置
JPH08500460A (ja) ロボットで運ばれるセンサーや道具のような可動物体の3次元における位置を特定する方法及び装置
JP2004530889A5 (ja)
US10036799B2 (en) Device system and method for determining the relative orientation between two different locations
US10634795B2 (en) Rover and rover measuring system
EP2920547B1 (en) System and method for measuring the relative positions of rotary components
CN107345795A (zh) 用于机床的测量的旋转激光器
CN103968812B (zh) 一种测量设备以及用于确定该设备的特性的方法
CN109551518A (zh) 计测系统
US11940274B2 (en) Tilt detecting device and surveying instrument
WO2022249292A1 (ja) 姿勢センサーのキャリブレーション装置
JP2011089844A (ja) 風向風速計測装置および風向風速計測システム
CN103968787B (zh) 用于对结构的元件的位置进行测量的测量方法和系统
JP7093618B2 (ja) 測量装置
JP2011089842A (ja) 風向風速計測装置および風向風速計測システム
US20220317149A1 (en) Reversing actuation type inertia detecting device and surveying instrument
CN113939383A (zh) 使用惯性测量单元(imu)和拉线编码器位置传感器的3d位置和方向计算以及机器人应用结构
JPH10185563A (ja) 写真測量用ターゲットおよびこの写真測量用ターゲットを用いた写真測量
KR102143462B1 (ko) Ahrs 센서, 그 바이어스 및 스케일 오차 보정 장치 및 방법
US20150035865A1 (en) Mobile display unit for showing graphic information which represents an arrangement of physical components
CN114487968A (zh) 一种磁球校准方法和磁球校准装置
Boronakhin et al. Test beds for small-sized inertial systems and sensors

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

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2023523769

Country of ref document: JP

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21942947

Country of ref document: EP

Kind code of ref document: A1