JP6808997B2 - Signal processing circuit, physical quantity detection device, attitude calculation device, electronic device and mobile body - Google Patents

Signal processing circuit, physical quantity detection device, attitude calculation device, electronic device and mobile body Download PDF

Info

Publication number
JP6808997B2
JP6808997B2 JP2016125419A JP2016125419A JP6808997B2 JP 6808997 B2 JP6808997 B2 JP 6808997B2 JP 2016125419 A JP2016125419 A JP 2016125419A JP 2016125419 A JP2016125419 A JP 2016125419A JP 6808997 B2 JP6808997 B2 JP 6808997B2
Authority
JP
Japan
Prior art keywords
physical quantity
signal
signal processing
processing circuit
circuit
Prior art date
Legal status (The legal status 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 status listed.)
Expired - Fee Related
Application number
JP2016125419A
Other languages
Japanese (ja)
Other versions
JP2017227591A (en
Inventor
泰宏 須藤
泰宏 須藤
克仁 中島
克仁 中島
秀生 羽田
秀生 羽田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Seiko Epson Corp
Original Assignee
Seiko Epson Corp
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 Seiko Epson Corp filed Critical Seiko Epson Corp
Priority to JP2016125419A priority Critical patent/JP6808997B2/en
Publication of JP2017227591A publication Critical patent/JP2017227591A/en
Application granted granted Critical
Publication of JP6808997B2 publication Critical patent/JP6808997B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Gyroscopes (AREA)
  • Navigation (AREA)

Description

本発明は、信号処理回路、物理量検出装置、姿勢演算装置、電子機器及び移動体に関する。 The present invention relates to a signal processing circuit, a physical quantity detection device, a posture calculation device, an electronic device, and a mobile body.

ロボットや車両等の移動体の姿勢に応じて各種の制御を行うシステムでは、移動体に取り付けられた角速度センサー等の各種のセンサーが検出するデータを用いて移動体の姿勢を演算する姿勢演算装置が用いられる。例えば、特許文献1には、3軸上の角速度、加速度及び地磁気をそれぞれ計測する角速度センサー、加速度センサー及び磁気センサーと、これらのセンサーの計測値を基にクォータニオンの推定値を算出する演算処理部とを備えた小型姿勢センサーが開示されている。 In a system that performs various controls according to the posture of a moving body such as a robot or a vehicle, a posture calculation device that calculates the posture of the moving body using data detected by various sensors such as an angular velocity sensor attached to the moving body. Is used. For example, Patent Document 1 describes an angular velocity sensor, an acceleration sensor, and a magnetic sensor that measure angular velocity, acceleration, and geomagnetism on three axes, respectively, and an arithmetic processing unit that calculates an estimated value of quaternion based on the measured values of these sensors. A small attitude sensor with and is disclosed.

特開2013−200162号公報Japanese Unexamined Patent Publication No. 2013-200162

しかしながら、従来の姿勢演算装置では、姿勢演算を行う処理部(CPU(Central Processing Unit)等)が、移動体に取り付けられた各種のセンサーと通信して3軸分のデータを取得し、取得した3軸分のデータを用いて姿勢演算を行うため、姿勢演算のレートを3軸分のデータの受信レートよりも高くすることができない。すなわち、従来の姿勢演算装置では、処理部とセンサーとの間の通信レートに依存して姿勢演算の周期が長くなり、姿勢演算の精度を向上させることが難しいという問題がある。 However, in the conventional posture calculation device, a processing unit (CPU (Central Processing Unit) or the like) that performs posture calculation communicates with various sensors attached to the moving body to acquire and acquire data for three axes. Since the attitude calculation is performed using the data for the three axes, the rate of the attitude calculation cannot be higher than the reception rate of the data for the three axes. That is, the conventional posture calculation device has a problem that the posture calculation cycle becomes long depending on the communication rate between the processing unit and the sensor, and it is difficult to improve the accuracy of the posture calculation.

本発明は、以上のような問題点に鑑みてなされたものであり、本発明のいくつかの態様によれば、従来よりも姿勢演算の精度を向上させることが可能な信号処理回路、物理量検出装置及び姿勢演算装置を提供することができる。また、本発明のいくつかの態様によれば、当該姿勢演算装置を用いた電子機器及び移動体を提供することができる。 The present invention has been made in view of the above problems, and according to some aspects of the present invention, a signal processing circuit capable of improving the accuracy of posture calculation as compared with the conventional case, and physical quantity detection. A device and a posture calculation device can be provided. Further, according to some aspects of the present invention, it is possible to provide an electronic device and a mobile body using the posture calculation device.

本発明は前述の課題の少なくとも一部を解決するためになされたものであり、以下の態様または適用例として実現することが可能である。 The present invention has been made to solve at least a part of the above-mentioned problems, and can be realized as the following aspects or application examples.

[適用例1]
本適用例に係る信号処理回路は、物理量検出素子の出力信号に基づいて第1の物理量信号を生成する検出回路と、前記第1の物理量信号を出力可能な第1の端子と、第2〜第N(N≧2)の物理量信号を入力可能な第2の端子と、前記第1〜第Nの物理量信号に基づいて姿勢演算を実行可能な姿勢演算部と、を含む。
[Application example 1]
The signal processing circuit according to this application example includes a detection circuit that generates a first physical quantity signal based on the output signal of the physical quantity detection element, a first terminal capable of outputting the first physical quantity signal, and second and second terminals. It includes a second terminal capable of inputting a physical quantity signal of the Nth (N ≧ 2), and a posture calculation unit capable of executing a posture calculation based on the first to Nth physical quantity signals.

従来の姿勢演算装置が外部装置と通信して第1〜第Nの物理量信号を取得して姿勢演算を実行するのに対して、本適用例に係る信号処理回路は、検出回路が生成した第1の物理量信号及び第2の端子を介して外部から取得した第2〜第Nの物理量信号に基づいて姿勢演算を実行する。すなわち、本適用例に係る信号処理回路は、外部装置と通信して第1の物理量信号を取得する必要がなく、また、外部から第2〜第Nの物理量信号を取得するのと並行して、検出回路が第1の物理量信号を生成することができるので、第1〜第Nの物理量信号を取得する時間を短くすることができる。その結果、本適用例に係る信号処理回
路によれば、従来よりも姿勢演算の周期が短くなり、姿勢演算の精度を向上させることができる。
While the conventional attitude calculation device communicates with the external device to acquire the first to Nth physical quantity signals and executes the attitude calculation, the signal processing circuit according to this application example is the first generated by the detection circuit. The attitude calculation is executed based on the first physical quantity signal and the second to Nth physical quantity signals acquired from the outside via the second terminal. That is, the signal processing circuit according to this application example does not need to communicate with an external device to acquire the first physical quantity signal, and in parallel with acquiring the second to Nth physical quantity signals from the outside. Since the detection circuit can generate the first physical quantity signal, the time for acquiring the first to Nth physical quantity signals can be shortened. As a result, according to the signal processing circuit according to the present application example, the cycle of the posture calculation is shorter than in the conventional case, and the accuracy of the posture calculation can be improved.

また、本適用例に係る信号処理回路は、第1の端子から第1の物理量信号を出力可能であるとともに、第2の端子から第2〜第Nの物理量信号を入力可能であるので、第2の端子から入力される物理量信号を用いて姿勢演算を実行する回路(マスター)として機能することも、姿勢演算に用いられる物理量信号を出力する回路(スレーブ)として機能することもできる。従って、例えば、第1の信号処理回路の第2の端子と第2〜第Nの信号処理回路の各々の第1の端子とを電気的に接続することにより、第1の信号処理回路が第1の物理量信号を生成し、かつ、第2〜第Nの信号処理回路から第2〜第Nの物理量信号を取得して、姿勢演算を実行する姿勢演算装置を構成することができる。このような姿勢演算装置は、同じ構成のN個の信号処理回路を用いて実現することができるので、開発コストを削減することができる。 Further, the signal processing circuit according to this application example can output the first physical quantity signal from the first terminal and can input the second to Nth physical quantity signals from the second terminal. It can function as a circuit (master) that executes a physical quantity signal using the physical quantity signal input from the terminal 2, or can function as a circuit (slave) that outputs a physical quantity signal used for the physical quantity calculation. Therefore, for example, by electrically connecting the second terminal of the first signal processing circuit and the first terminal of each of the second to Nth signal processing circuits, the first signal processing circuit becomes the first. It is possible to configure a posture calculation device that generates the physical quantity signal of 1 and acquires the 2nd to Nth physical quantity signals from the 2nd to Nth signal processing circuits to execute the posture calculation. Since such an attitude calculation device can be realized by using N signal processing circuits having the same configuration, the development cost can be reduced.

[適用例2]
上記適用例に係る信号処理回路において、前記姿勢演算部は、クォータニオンを用いて前記姿勢演算を行ってもよい。
[Application example 2]
In the signal processing circuit according to the above application example, the posture calculation unit may perform the posture calculation using a quaternion.

[適用例3]
上記適用例に係る信号処理回路において、前記姿勢演算部は、前記姿勢演算として、前記第1〜第Nの物理量信号の各々を積分して第1〜第Nの角度を算出してもよい。
[Application example 3]
In the signal processing circuit according to the above application example, the posture calculation unit may calculate the first to Nth angles by integrating each of the first to Nth physical quantity signals as the posture calculation.

[適用例4]
上記適用例に係る信号処理回路において、前記姿勢演算部は、回転行列を用いて前記姿勢演算を行ってもよい。
[Application example 4]
In the signal processing circuit according to the above application example, the posture calculation unit may perform the posture calculation using a rotation matrix.

[適用例5]
上記適用例に係る信号処理回路は、前記物理量検出素子を駆動するための駆動信号を生成する駆動回路を含み、前記姿勢演算部は、前記駆動信号に基づくクロック信号を用いて前記姿勢演算を行ってもよい。
[Application example 5]
The signal processing circuit according to the application example includes a drive circuit that generates a drive signal for driving the physical quantity detection element, and the attitude calculation unit performs the attitude calculation using a clock signal based on the drive signal. You may.

本適用例に係る信号処理回路によれば、物理量検出素子を駆動するための駆動信号は、CR発振回路やリングオシレーターなどを用いて発生させたクロック信号よりも周波数偏差が小さいので、駆動信号に基づくクロック信号を用いることにより、姿勢演算の精度を向上させることができる。例えば、相対的に周波数偏差が大きいクロック信号に基づいてサンプリングされた物理量信号を用いた姿勢演算において、相対的に周波数偏差が小さい駆動信号に基づくクロック信号を用いてサンプリング周期(時間積分の周期)を補正することにより、姿勢演算の精度を向上させることができる。 According to the signal processing circuit according to this application example, the drive signal for driving the physical quantity detection element has a smaller frequency deviation than the clock signal generated by using the CR oscillation circuit, the ring oscillator, or the like. By using the based clock signal, the accuracy of the attitude calculation can be improved. For example, in an attitude calculation using a physical quantity signal sampled based on a clock signal having a relatively large frequency deviation, a sampling period (period of time integration) using a clock signal based on a drive signal having a relatively small frequency deviation. By correcting the above, the accuracy of the posture calculation can be improved.

[適用例6]
上記適用例に係る信号処理回路は、前記第1〜第Nの物理量信号と第1〜第Nの検出軸との対応関係の設定情報を記憶する記憶部を含み、前記姿勢演算部は、前記設定情報を用いて前記姿勢演算を行ってもよい。
[Application example 6]
The signal processing circuit according to the above application example includes a storage unit that stores setting information of the correspondence relationship between the first to first physical quantity signals and the first to Nth detection axes, and the posture calculation unit is the posture calculation unit. The posture calculation may be performed using the setting information.

本適用例に係る信号処理回路によれば、設定情報を変更することにより、第1〜第Nの物理量信号と第1〜第Nの検出軸との対応関係を変更することができるので、汎用性の高い信号処理回路を実現することができる。 According to the signal processing circuit according to this application example, the correspondence between the first to Nth physical quantity signals and the first to Nth detection axes can be changed by changing the setting information. A highly efficient signal processing circuit can be realized.

[適用例7]
上記適用例に係る信号処理回路において、前記第1〜第Nの物理量信号の各々は角速度
信号であってもよい。
[Application 7]
In the signal processing circuit according to the above application example, each of the first to Nth physical quantity signals may be an angular velocity signal.

[適用例8]
上記適用例に係る信号処理回路は、加速度検出素子及び地磁気検出素子の少なくとも一方の出力信号に基づいて、前記姿勢演算部による前記姿勢演算を補正する補正処理部を含んでもよい。
[Application Example 8]
The signal processing circuit according to the above application example may include a correction processing unit that corrects the posture calculation by the posture calculation unit based on the output signals of at least one of the acceleration detection element and the geomagnetic detection element.

本適用例に係る信号処理回路によれば、姿勢演算の誤差(例えば、積分誤差)を加速度検出素子及び地磁気検出素子の少なくとも一方の出力信号を用いて補正することができるので、姿勢演算の精度を向上させることができる。 According to the signal processing circuit according to this application example, the error of the attitude calculation (for example, the integration error) can be corrected by using the output signals of at least one of the acceleration detection element and the geomagnetic detection element, so that the accuracy of the attitude calculation can be corrected. Can be improved.

[適用例9]
本適用例に係る物理量検出装置は、上記のいずれかの信号処理回路と、物理量検出素子と、を備えている。
[Application 9]
The physical quantity detection device according to this application example includes any of the above signal processing circuits and a physical quantity detection element.

従来の姿勢演算装置が外部装置と通信して第1〜第Nの物理量信号を取得して姿勢演算を実行するのに対して、本適用例に係る物理量検出装置では、信号処理回路が、検出回路が生成した第1の物理量信号及び第2の端子を介して外部から取得した第2〜第Nの物理量信号に基づいて姿勢演算を実行する。すなわち、本適用例に係る物理量検出装置は、外部装置と通信して第1の物理量信号を取得する必要がなく、また、外部から第2〜第Nの物理量信号を取得するのと並行して、検出回路が第1の物理量信号を生成することができるので、第1〜第Nの物理量信号を取得する時間を短くすることができる。その結果、本適用例に係る物理量検出装置によれば、従来よりも姿勢演算の周期が短くなり、姿勢演算の精度を向上させることができる。 Whereas the conventional posture calculation device communicates with the external device to acquire the first to Nth physical quantity signals and executes the posture calculation, in the physical quantity detection device according to this application example, the signal processing circuit detects. The attitude calculation is executed based on the first physical quantity signal generated by the circuit and the second to Nth physical quantity signals acquired from the outside via the second terminal. That is, the physical quantity detecting device according to this application example does not need to communicate with the external device to acquire the first physical quantity signal, and also acquires the second to Nth physical quantity signals from the outside in parallel. Since the detection circuit can generate the first physical quantity signal, the time for acquiring the first to Nth physical quantity signals can be shortened. As a result, according to the physical quantity detection device according to the present application example, the cycle of the posture calculation is shorter than in the conventional case, and the accuracy of the posture calculation can be improved.

[適用例10]
本適用例に係る姿勢演算装置は、上記の物理量検出装置をN個備え、第1の前記物理量検出装置が備えている前記信号処理回路の前記第2の端子と、第2〜第Nの前記物理量検出装置の各々が備えている前記信号処理回路の前記第1の端子とが電気的に接続され、前記第1の前記物理量検出装置が備えている前記信号処理回路の前記姿勢演算部が前記姿勢演算を行う。
[Application Example 10]
The attitude calculation device according to the present application example includes N physical quantity detection devices, the second terminal of the signal processing circuit provided by the first physical quantity detection device, and the second to second Nth devices. The first terminal of the signal processing circuit provided in each of the physical quantity detection devices is electrically connected, and the posture calculation unit of the signal processing circuit provided in the first physical quantity detection device is said. Performs posture calculation.

本適用例によれば、第1の物理量検出装置が備える第1の信号処理回路が第1の物理量信号を生成し、かつ、第2の端子を介して、第2〜第Nの物理量検出装置がそれぞれ備える第2〜第Nの信号処理回路の第1の端子から出力される第2〜第Nの物理量信号を取得して、姿勢演算を実行する姿勢演算装置を構成することができる。 According to this application example, the first signal processing circuit included in the first physical quantity detecting device generates the first physical quantity signal, and the second and Nth physical quantity detecting devices are passed through the second terminal. It is possible to configure a posture calculation device that executes a posture calculation by acquiring the second to Nth physical quantity signals output from the first terminals of the second to Nth signal processing circuits provided by the two.

そして、本適用例に係る姿勢演算装置では、第1の物理量検出装置が備える信号処理回路は、外部装置と通信して第1の物理量信号を取得する必要がなく、また、第2〜第Nの物理量検出装置から第2〜第Nの物理量信号を取得するのと並行して、検出回路が第1の物理量信号を生成することができるので、第1〜第Nの物理量信号を取得する時間を短くすることができる。その結果、本適用例に係る姿勢演算装置によれば、従来よりも姿勢演算の周期が短くなり、姿勢演算の精度を向上させることができる。 In the attitude calculation device according to the present application example, the signal processing circuit included in the first physical quantity detection device does not need to communicate with the external device to acquire the first physical quantity signal, and the second to second N Since the detection circuit can generate the first physical quantity signal in parallel with acquiring the second to Nth physical quantity signals from the physical quantity detection device of the above, the time for acquiring the first to Nth physical quantity signals is Can be shortened. As a result, according to the posture calculation device according to the present application example, the posture calculation cycle is shorter than in the conventional case, and the accuracy of the posture calculation can be improved.

また、本適用例に係る姿勢演算装置は、同じ構成のN個の物理量検出装置を用いて実現することができるので、開発コストを削減することができる。 Further, since the posture calculation device according to this application example can be realized by using N physical quantity detection devices having the same configuration, the development cost can be reduced.

[適用例11]
本適用例に係る電子機器は、上記の姿勢演算装置を備えている。
[Application Example 11]
The electronic device according to this application example includes the above-mentioned posture calculation device.

[適用例12]
本適用例に係る移動体は、上記の姿勢演算装置を備えている。
[Application 12]
The moving body according to this application example includes the above-mentioned posture calculation device.

これらの適用例によれば、従来よりも姿勢演算の精度を向上させることが可能な姿勢演算装置を備えているので、例えば、信頼性の高い電子機器及び移動体を実現することも可能である。 According to these application examples, since the posture calculation device capable of improving the accuracy of the posture calculation as compared with the conventional one is provided, for example, it is possible to realize a highly reliable electronic device and a moving body. ..

本実施形態の物理量検出装置の機能ブロック図。The functional block diagram of the physical quantity detection apparatus of this embodiment. 物理量検出素子の振動片の平面図。Top view of the vibrating piece of the physical quantity detecting element. 物理量検出素子の動作について説明するための図。The figure for demonstrating the operation of a physical quantity detection element. 物理量検出素子の動作について説明するための図。The figure for demonstrating the operation of a physical quantity detection element. 駆動回路の構成例を示す図。The figure which shows the structural example of a drive circuit. 姿勢演算部の構成例を示す図。The figure which shows the configuration example of the posture calculation part. 第1インターフェース回路を介した通信フォーマットの一例を示す図。The figure which shows an example of the communication format via the 1st interface circuit. 第1インターフェース回路を介した通信フォーマットの一例を示す図。The figure which shows an example of the communication format via the 1st interface circuit. 第1インターフェース回路を介した通信フォーマットの一例を示す図。The figure which shows an example of the communication format via the 1st interface circuit. 第2インターフェース回路を介した通信フォーマットの一例を示す図。The figure which shows an example of the communication format via the 2nd interface circuit. 第2インターフェース回路を介した通信フォーマットの一例を示す図。The figure which shows an example of the communication format via the 2nd interface circuit. レジスターのアドレスマップの一例を示す図。The figure which shows an example of the address map of a register. 図12に示した書き込み可能な各アドレスのデータ構成を示す図。The figure which shows the data structure of each writable address shown in FIG. 不揮発性メモリーのアドレスマップの一例を示す図。The figure which shows an example of the address map of the non-volatile memory. 図14に示した各アドレスのデータ構成を示す図。The figure which shows the data structure of each address shown in FIG. 変形例の物理量検出装置の機能ブロック図。The functional block diagram of the physical quantity detection device of the modification. 本実施形態の姿勢演算装置の構成例を示す図。The figure which shows the configuration example of the posture calculation apparatus of this embodiment. 姿勢演算のタイムチャートの一例を示す図。The figure which shows an example of the time chart of posture calculation. 本実施形態の電子機器の構成の一例を示す機能ブロック図。The functional block diagram which shows an example of the structure of the electronic device of this embodiment. 電子機器の一例であるデジタルカメラを模式的に示す斜視図。The perspective view which shows typically the digital camera which is an example of an electronic device. 本実施形態の移動体の一例を示す図。The figure which shows an example of the moving body of this embodiment.

以下、本発明の好適な実施形態について図面を用いて詳細に説明する。なお、以下に説明する実施の形態は、特許請求の範囲に記載された本発明の内容を不当に限定するものではない。また以下で説明される構成の全てが本発明の必須構成要件であるとは限らない。 Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the drawings. It should be noted that the embodiments described below do not unreasonably limit the content of the present invention described in the claims. Moreover, not all of the configurations described below are essential constituent requirements of the present invention.

以下では、物理量として角速度を検出する物理量検出装置(角速度検出装置)を例にとり説明する。 In the following, a physical quantity detection device (angular velocity detection device) that detects an angular velocity as a physical quantity will be described as an example.

1.物理量検出装置
1−1.本実施形態
図1は、本実施形態の物理量検出装置の機能ブロック図である。本実施形態の物理量検出装置1は、物理量に関わるアナログ信号を出力する物理量検出素子(センサー素子)2と信号処理回路3を含んで構成されている。
1. 1. Physical quantity detector 1-1. FIG. 1 is a functional block diagram of the physical quantity detection device of the present embodiment. The physical quantity detection device 1 of the present embodiment includes a physical quantity detection element (sensor element) 2 for outputting an analog signal related to the physical quantity and a signal processing circuit 3.

物理量検出素子2は、駆動電極と検出電極が配置された振動片を有し、一般的に、振動片のインピーダンスをできるだけ小さくして発振効率を高めるために、振動片は気密性が確保されたパッケージに封止されている。本実施形態では、物理量検出素子2は、T型の2つの駆動振動腕を有するいわゆるダブルT型の振動片を有する。 The physical quantity detecting element 2 has a vibrating piece in which a driving electrode and a detecting electrode are arranged. Generally, in order to reduce the impedance of the vibrating piece as much as possible and improve the oscillation efficiency, the vibrating piece is ensured to be airtight. It is sealed in the package. In the present embodiment, the physical quantity detecting element 2 has a so-called double T-shaped vibrating piece having two T-shaped driving vibrating arms.

図2は、本実施形態の物理量検出素子2の振動片の平面図である。物理量検出素子2は
、例えば、Zカットの水晶基板により形成されたダブルT型の振動片を有する。水晶を材料とする振動片は、温度変化に対する共振周波数の変動が極めて小さいので、角速度の検出精度を高めることができるという利点がある。なお、図2におけるX軸、Y軸、Z軸は水晶の軸を示す。
FIG. 2 is a plan view of a vibrating piece of the physical quantity detecting element 2 of the present embodiment. The physical quantity detecting element 2 has, for example, a double T-shaped vibrating piece formed of a Z-cut crystal substrate. The vibrating piece made of quartz has an advantage that the detection accuracy of the angular velocity can be improved because the fluctuation of the resonance frequency with respect to the temperature change is extremely small. The X-axis, Y-axis, and Z-axis in FIG. 2 indicate the crystal axis.

図2に示すように、物理量検出素子2の振動片は、2つの駆動用基部104a、104bからそれぞれ駆動振動腕101a、101bが+Y軸方向及び−Y軸方向に延出している。駆動振動腕101aの側面及び上面にはそれぞれ駆動電極112及び113が形成されており、駆動振動腕101bの側面及び上面にはそれぞれ駆動電極113及び112が形成されている。駆動電極112、113は、それぞれ、図1に示した信号処理回路3のDS端子,DG端子を介して駆動回路20に接続される。 As shown in FIG. 2, in the vibrating piece of the physical quantity detecting element 2, the driving vibrating arms 101a and 101b extend from the two driving bases 104a and 104b in the + Y-axis direction and the −Y-axis direction, respectively. Drive electrodes 112 and 113 are formed on the side surface and the upper surface of the drive vibrating arm 101a, respectively, and drive electrodes 113 and 112 are formed on the side surface and the upper surface of the drive vibration arm 101b, respectively. The drive electrodes 112 and 113 are connected to the drive circuit 20 via the DS terminal and the DG terminal of the signal processing circuit 3 shown in FIG. 1, respectively.

駆動用基部104a、104bは、それぞれ−X軸方向と+X軸方向に延びる連結腕105a、105bを介して矩形状の検出用基部107に接続されている。 The drive bases 104a and 104b are connected to the rectangular detection base 107 via connecting arms 105a and 105b extending in the −X axis direction and the + X axis direction, respectively.

検出振動腕102は、検出用基部107から+Y軸方向及び−Y軸方向に延出している。検出振動腕102の上面には検出電極114及び115が形成されており、検出振動腕102の側面には共通電極116が形成されている。検出電極114、115は、それぞれ、図1に示した信号処理回路3のS1端子,S2端子を介して検出回路30に接続される。また、共通電極116は接地される。 The detection vibrating arm 102 extends from the detection base 107 in the + Y-axis direction and the −Y-axis direction. Detection electrodes 114 and 115 are formed on the upper surface of the detection vibrating arm 102, and a common electrode 116 is formed on the side surface of the detection vibration arm 102. The detection electrodes 114 and 115 are connected to the detection circuit 30 via the S1 terminal and the S2 terminal of the signal processing circuit 3 shown in FIG. 1, respectively. Further, the common electrode 116 is grounded.

駆動振動腕101a、101bの駆動電極112と駆動電極113との間に駆動信号として交流電圧が与えられると、図3に示すように、駆動振動腕101a、101bは逆圧電効果によって矢印Bのように、2本の駆動振動腕101a、101bの先端が互いに接近と離間を繰り返す屈曲振動(励振振動)をする。 When an AC voltage is applied as a drive signal between the drive electrodes 112 and the drive electrodes 113 of the drive vibrating arms 101a and 101b, as shown in FIG. 3, the drive vibrating arms 101a and 101b are shown by the inverse piezoelectric effect as shown by the arrow B. In addition, the tips of the two drive vibration arms 101a and 101b perform bending vibration (excitation vibration) in which the tips of the two driving vibration arms 101a and 101b repeatedly approach and separate from each other.

この状態で、物理量検出素子2の振動片にZ軸を回転軸とした角速度が加わると、駆動振動腕101a、101bは、矢印Bの屈曲振動の方向とZ軸の両方に垂直な方向にコリオリの力を得る。その結果、図4に示すように、連結腕105a、105bは矢印Cで示すような振動をする。そして、検出振動腕102は、連結腕105a、105bの振動(矢印C)に連動して矢印Dのように屈曲振動をする。このコリオリ力に伴う検出振動腕102の屈曲振動と駆動振動腕101a、101bの屈曲振動(励振振動)とは位相が90°ずれている。 In this state, when an angular velocity with the Z axis as the rotation axis is applied to the vibrating piece of the physical quantity detecting element 2, the drive vibrating arms 101a and 101b coriolis in the direction perpendicular to both the bending vibration direction of the arrow B and the Z axis. Get the power of. As a result, as shown in FIG. 4, the connecting arms 105a and 105b vibrate as shown by the arrow C. Then, the detection vibrating arm 102 bends and vibrates as shown by the arrow D in conjunction with the vibration (arrow C) of the connecting arms 105a and 105b. The bending vibration of the detected vibrating arm 102 and the bending vibration (exciting vibration) of the driving vibrating arms 101a and 101b due to the Coriolis force are out of phase by 90 °.

ところで、駆動振動腕101a、101bが屈曲振動(励振振動)をするときの振動エネルギーの大きさ又は振動の振幅の大きさが2本の駆動振動腕101a、101bで等しければ、駆動振動腕101a、101bの振動エネルギーのバランスがとれており、物理量検出素子2に角速度がかかっていない状態では検出振動腕102は屈曲振動しない。ところが、2つの駆動振動腕101a、101bの振動エネルギーのバランスがくずれると、物理量検出素子2に角速度がかかっていない状態でも検出振動腕102に屈曲振動が発生する。この屈曲振動は漏れ振動と呼ばれ、コリオリ力に基づく振動と同様に矢印Dの屈曲振動であるが、駆動信号とは同位相である。 By the way, if the magnitude of the vibration energy or the magnitude of the vibration amplitude when the drive vibration arms 101a and 101b perform bending vibration (excitation vibration) is equal to the two drive vibration arms 101a and 101b, the drive vibration arms 101a, The detection vibrating arm 102 does not bend and vibrate when the vibration energy of 101b is balanced and the physical quantity detecting element 2 is not subjected to angular velocity. However, if the vibration energies of the two drive vibration arms 101a and 101b are out of balance, bending vibration is generated in the detection vibration arm 102 even when the physical quantity detection element 2 is not subjected to an angular velocity. This bending vibration is called leakage vibration, which is the bending vibration of arrow D like the vibration based on the Coriolis force, but has the same phase as the drive signal.

そして、圧電効果によってこれらの屈曲振動に基づいた交流電荷が、検出振動腕102の検出電極114、115に発生する。ここで、コリオリ力に基づいて発生する交流電荷は、コリオリ力の大きさ(言い換えれば、物理量検出素子2に加わる角速度の大きさ)に応じて変化する。一方、漏れ振動に基づいて発生する交流電荷は、物理量検出素子2に加わる角速度の大きさに関係せず一定である。 Then, due to the piezoelectric effect, AC charges based on these bending vibrations are generated at the detection electrodes 114 and 115 of the detection vibration arm 102. Here, the AC charge generated based on the Coriolis force changes according to the magnitude of the Coriolis force (in other words, the magnitude of the angular velocity applied to the physical quantity detecting element 2). On the other hand, the AC charge generated based on the leakage vibration is constant regardless of the magnitude of the angular velocity applied to the physical quantity detecting element 2.

なお、駆動振動腕101a、101bの先端には、駆動振動腕101a、101bより
も幅の広い矩形状の錘部103が形成されている。駆動振動腕101a、101bの先端に錘部103を形成することにより、コリオリ力を大きくするとともに、所望の共振周波数を比較的短い振動腕で得ることができる。同様に、検出振動腕102の先端には、検出振動腕102よりも幅の広い錘部106が形成されている。検出振動腕102の先端に錘部106を形成することにより、検出電極114、115に発生する交流電荷を大きくすることができる。
At the tips of the drive vibrating arms 101a and 101b, a rectangular weight portion 103 wider than the drive vibrating arms 101a and 101b is formed. By forming the weight portion 103 at the tips of the drive vibrating arms 101a and 101b, the Coriolis force can be increased and a desired resonance frequency can be obtained with a relatively short vibrating arm. Similarly, a weight portion 106 wider than the detection vibrating arm 102 is formed at the tip of the detection vibrating arm 102. By forming the weight portion 106 at the tip of the detection vibrating arm 102, the AC charge generated in the detection electrodes 114 and 115 can be increased.

以上のようにして、物理量検出素子2は、Z軸を検出軸としてコリオリ力に基づく交流電荷(角速度成分)と、励振振動の漏れ振動に基づく交流電荷(振動漏れ成分)とを検出電極114、115を介して出力する。この物理量検出素子2は、角速度を検出する角速度センサーとして機能する。 As described above, the physical quantity detecting element 2 detects the AC charge (angular velocity component) based on the Coriolis force and the AC charge (vibration leakage component) based on the leakage vibration of the excitation vibration with the Z axis as the detection axis. Output via 115. The physical quantity detecting element 2 functions as an angular velocity sensor that detects the angular velocity.

図1に戻り、本実施形態の信号処理回路3は、基準電圧回路10、駆動回路20、検出回路30、姿勢演算部40、クロック生成回路50、記憶部60、第1インターフェース回路70及び第2インターフェース回路80を含んで構成されており、例えば、1チップの集積回路(IC:Integrated Circuit)であってもよい。なお、本実施形態の信号処理回路3は、これらの要素の一部を省略又は変更し、あるいは他の要素を追加した構成としてもよい。 Returning to FIG. 1, the signal processing circuit 3 of the present embodiment includes a reference voltage circuit 10, a drive circuit 20, a detection circuit 30, an attitude calculation unit 40, a clock generation circuit 50, a storage unit 60, a first interface circuit 70, and a second. It is configured to include an interface circuit 80, and may be, for example, a one-chip integrated circuit (IC). The signal processing circuit 3 of the present embodiment may have a configuration in which some of these elements are omitted or changed, or other elements are added.

基準電圧回路10は、信号処理回路3のVDD端子より供給される電源電圧から基準電圧VR1,VR2などの定電圧や定電流を生成し、駆動回路20や検出回路30に供給する。 The reference voltage circuit 10 generates constant voltages and currents such as reference voltages VR1 and VR2 from the power supply voltage supplied from the VDD terminal of the signal processing circuit 3 and supplies them to the drive circuit 20 and the detection circuit 30.

駆動回路20は、物理量検出素子2を駆動する(励振振動させる)ための駆動信号DRVを生成し、DS端子を介して物理量検出素子2の駆動電極112に供給する。また、駆動回路20は、物理量検出素子2の励振振動により駆動電極113に発生する発振電流がDG端子を介して入力され、この発振電流の振幅が一定に保持されるように駆動信号DRVの振幅レベルをフィードバック制御する。また、駆動回路20は、駆動信号DRVと位相が同じ検波信号SDETを生成し、検出回路30に出力する。 The drive circuit 20 generates a drive signal DRV for driving (exciting and vibrating) the physical quantity detection element 2 and supplies the drive signal DRV to the drive electrode 112 of the physical quantity detection element 2 via the DS terminal. Further, in the drive circuit 20, the oscillation current generated in the drive electrode 113 due to the excitation vibration of the physical quantity detection element 2 is input via the DG terminal, and the amplitude of the drive signal DRV is maintained so that the amplitude of the oscillation current is kept constant. Feedback control of the level. Further, the drive circuit 20 generates a detection signal SDET having the same phase as the drive signal DRV, and outputs the detection signal SDET to the detection circuit 30.

図5は、駆動回路20の構成例を示す図である。図5に示すように、駆動回路20は、I/V変換回路21、ローパスフィルター22、ハイパスフィルター23、コンパレーター24、全波整流回路25、積分器26、コンパレーター27及びコンパレーター28を含んで構成されている。なお、本実施形態の駆動回路20は、これらの要素の一部を省略又は変更し、あるいは他の要素を追加した構成としてもよい。 FIG. 5 is a diagram showing a configuration example of the drive circuit 20. As shown in FIG. 5, the drive circuit 20 includes an I / V conversion circuit 21, a low-pass filter 22, a high-pass filter 23, a comparator 24, a full-wave rectifier circuit 25, an integrator 26, a comparator 27, and a comparator 28. It is composed of. The drive circuit 20 of the present embodiment may have a configuration in which some of these elements are omitted or changed, or other elements are added.

I/V変換回路21、ローパスフィルター22、ハイパスフィルター23、コンパレーター24、全波整流回路25、コンパレーター27及びコンパレーター28は、基準電圧回路10から供給される基準電圧VR1を基準に動作する。基準電圧VR1は、アナロググランド電圧であり、例えば、VDD端子から供給される電源電圧の1/2の電圧である。また、積分器26は、基準電圧回路10から供給される基準電圧VR2を基準に動作する。 The I / V conversion circuit 21, the low-pass filter 22, the high-pass filter 23, the comparator 24, the full-wave rectifier circuit 25, the comparator 27, and the comparator 28 operate with reference to the reference voltage VR1 supplied from the reference voltage circuit 10. .. The reference voltage VR1 is an analog ground voltage, which is, for example, a voltage halved from the power supply voltage supplied from the VDD terminal. Further, the integrator 26 operates with reference to the reference voltage VR2 supplied from the reference voltage circuit 10.

I/V変換回路21は、物理量検出素子2の励振振動により発生し、DG端子を介して入力された発振電流を交流電圧信号に変換する。 The I / V conversion circuit 21 converts the oscillating current generated by the excitation vibration of the physical quantity detection element 2 and input via the DG terminal into an AC voltage signal.

ローパスフィルター22は、I/V変換回路21の出力信号の高周波成分を除去し、ハイパスフィルター23は、ローパスフィルター22の出力信号の低周波成分(オフセットなど)を除去する。ローパスフィルター22とハイパスフィルター23によってバンドパスフィルターが構成され、物理量検出素子2の励振振動により生じる信号を通過させる。 The low-pass filter 22 removes high-frequency components of the output signal of the I / V conversion circuit 21, and the high-pass filter 23 removes low-frequency components (offset, etc.) of the output signal of the low-pass filter 22. A bandpass filter is formed by the lowpass filter 22 and the highpass filter 23, and a signal generated by the excitation vibration of the physical quantity detecting element 2 is passed therethrough.

コンパレーター24は、ハイパスフィルター23の出力信号の電圧を基準電圧VR1と比較して2値化信号を生成する。この2値化信号は、ハイレベルの電圧が積分器26の出力電圧であり、ローレベルの電圧がグラウンド電圧(0V)である。そして、コンパレーター24の出力信号は、駆動信号DRVとして、DS端子を介して物理量検出素子2に供給される。駆動信号DRVの周波数(駆動周波数)を物理量検出素子2の共振周波数と一致させることで、物理量検出素子2を安定発振させることができる。 The comparator 24 compares the voltage of the output signal of the high-pass filter 23 with the reference voltage VR1 to generate a binarized signal. In this binarization signal, the high level voltage is the output voltage of the integrator 26, and the low level voltage is the ground voltage (0V). Then, the output signal of the comparator 24 is supplied to the physical quantity detecting element 2 as a drive signal DRV via the DS terminal. By matching the frequency (drive frequency) of the drive signal DRV with the resonance frequency of the physical quantity detection element 2, the physical quantity detection element 2 can be stably oscillated.

全波整流回路25は、I/V変換回路21の出力信号を整流(全波整流)して直流化された信号を出力する。 The full-wave rectifier circuit 25 rectifies the output signal of the I / V conversion circuit 21 (full-wave rectification) and outputs a DC signal.

積分器26は、基準電圧VR2を基準に、全波整流回路25の出力電圧を積分して出力する。この積分器26の出力電圧は、全波整流回路25の出力電圧が高いほど(I/V変換回路21の出力信号の振幅が大きいほど)低くなる。従って、発振振幅が大きいほど、コンパレーター24の出力信号(駆動信号DRV)のハイレベルの電圧が低くなり、発振振幅が小さいほど、コンパレーター24の出力信号(駆動信号DRV)のハイレベルの電圧が高くなるので、発振振幅が一定に保持されるように自動利得制御(AGC:Auto Gain Control)がかかる。 The integrator 26 integrates and outputs the output voltage of the full-wave rectifier circuit 25 with reference to the reference voltage VR2. The output voltage of the integrator 26 decreases as the output voltage of the full-wave rectifier circuit 25 increases (the larger the amplitude of the output signal of the I / V conversion circuit 21). Therefore, the larger the oscillation amplitude, the lower the high-level voltage of the output signal (drive signal DRV) of the comparator 24, and the smaller the oscillation amplitude, the higher the high-level voltage of the output signal (drive signal DRV) of the comparator 24. Therefore, automatic gain control (AGC: Auto Gain Control) is applied so that the oscillation amplitude is kept constant.

コンパレーター27は、ハイパスフィルター23の出力信号の電圧を増幅して2値化信号(方形波電圧信号)を生成し、検波信号SDETとして出力する。この検波信号SDETは、ハイレベルの電圧が電源電圧であり、ローレベルの電圧がグラウンド電圧(0V)である。 The comparator 27 amplifies the voltage of the output signal of the high-pass filter 23 to generate a binarized signal (square wave voltage signal), and outputs it as a detection signal SDET. In this detection signal SDET, the high level voltage is the power supply voltage and the low level voltage is the ground voltage (0V).

コンパレーター28は、ハイパスフィルター23の出力信号の電圧を増幅して2値化信号(方形波電圧信号)を生成し、クロック信号CKFとして出力する。このクロック信号CKFは、ハイレベルの電圧が電源電圧であり、ローレベルの電圧がグラウンド電圧(0V)である。 The comparator 28 amplifies the voltage of the output signal of the high-pass filter 23 to generate a binarized signal (square wave voltage signal), and outputs it as a clock signal CKF. In this clock signal CKF, the high level voltage is the power supply voltage, and the low level voltage is the ground voltage (0V).

図1に戻り、検出回路30は、QVアンプ31、可変ゲインアンプ(PGA:Programmable Gain Amplifier)32、同期検波回路33、A/D(Analog to Digital)変換回路34及びDSP(Digital Signal Processor)35を含んで構成されている。なお、本実施形態の検出回路30は、これらの要素の一部を省略又は変更し、あるいは他の要素を追加した構成としてもよい。 Returning to FIG. 1, the detection circuit 30 includes a QV amplifier 31, a variable gain amplifier (PGA) 32, a synchronous detection circuit 33, an A / D (Analog to Digital) conversion circuit 34, and a DSP (Digital Signal Processor) 35. Is configured to include. The detection circuit 30 of the present embodiment may have a configuration in which some of these elements are omitted or changed, or other elements are added.

QVアンプ31は、S1端子を介して、物理量検出素子2の検出電極114から、角速度成分と振動漏れ成分を含む交流電荷(検出電流)が入力され、当該交流電荷に応じた電圧の信号を発生させる。また、QVアンプ31は、S2端子を介して、物理量検出素子2の検出電極115から、角速度成分と振動漏れ成分を含む交流電荷(検出電流)が入力され、当該交流電荷に応じた電圧の信号を発生させる。検出電極114からQVアンプ31に入力される交流電荷と検出電極114からQVアンプ31に入力される交流電荷は互いに逆位相(位相差が180°)であり、QVアンプ31から出力される2つの信号も互いに逆位相である。 The QV amplifier 31 receives an AC charge (detection current) including an angular velocity component and a vibration leakage component from the detection electrode 114 of the physical quantity detection element 2 via the S1 terminal, and generates a voltage signal corresponding to the AC charge. Let me. Further, in the QV amplifier 31, an AC charge (detection current) including an angular velocity component and a vibration leakage component is input from the detection electrode 115 of the physical quantity detection element 2 via the S2 terminal, and a voltage signal corresponding to the AC charge is input. To generate. The AC charge input from the detection electrode 114 to the QV amplifier 31 and the AC charge input from the detection electrode 114 to the QV amplifier 31 are in opposite phases (phase difference is 180 °), and the two are output from the QV amplifier 31. The signals are also out of phase with each other.

可変ゲインアンプ32は、QVアンプ31から出力される2つの信号をそれぞれ増幅又は減衰させて、所望の電圧レベルの2つの信号を出力する。可変ゲインアンプ32から出力される2つの信号は、互いに逆位相である。 The variable gain amplifier 32 amplifies or attenuates the two signals output from the QV amplifier 31, respectively, and outputs two signals having a desired voltage level. The two signals output from the variable gain amplifier 32 are out of phase with each other.

同期検波回路33は、駆動回路20が出力する検波信号SDETを用いて、可変ゲインアンプ32から出力される2つの信号(被検波信号)のそれぞれに含まれる角速度成分を
同期検波する。同期検波回路33は、例えば、検波信号SDETがハイレベルの時は可変ゲインアンプ32から出力される2つの信号をそのまま出力し、検波信号SDETがローレベルの時は可変ゲインアンプ32から出力される2つの信号をそれぞれ基準電圧VR1に対して反転した2つの信号を出力する回路として構成することができる。
The synchronous detection circuit 33 uses the detection signal SDET output by the drive circuit 20 to synchronously detect angular velocity components included in each of the two signals (detected signals) output from the variable gain amplifier 32. The synchronous detection circuit 33 outputs, for example, two signals output from the variable gain amplifier 32 as they are when the detection signal SDET is at a high level, and is output from the variable gain amplifier 32 when the detection signal SDET is at a low level. It can be configured as a circuit that outputs two signals obtained by inverting the two signals with respect to the reference voltage VR1.

A/D変換回路34は、クロック生成回路50が生成するクロック信号ADCCLKに同期して動作し、同期検波回路33が出力する2つの信号の差信号の電圧値をデジタルデータ(角速度データ)に変換して出力する。このA/D変換回路34から出力されるデジタルデータは、所定のレート(例えば、1.5kHz)で順次更新される。A/D変換回路34は、例えば、デルタシグマ型や逐次比較型のA/D変換回路であってもよい。 The A / D conversion circuit 34 operates in synchronization with the clock signal ADCCLK generated by the clock generation circuit 50, and converts the voltage value of the difference signal between the two signals output by the synchronous detection circuit 33 into digital data (angular velocity data). And output. The digital data output from the A / D conversion circuit 34 is sequentially updated at a predetermined rate (for example, 1.5 kHz). The A / D conversion circuit 34 may be, for example, a delta-sigma type or a sequential comparison type A / D conversion circuit.

DSP35は、クロック生成回路50が生成するクロック信号DSPCLKに同期して動作し、A/D変換回路34から出力されるデジタルデータ(角速度データ)をフィルタリングする処理等を行う。DSP35による高速なデジタルフィルタリング処理等を実現するため、クロック信号DSPCLKの周波数は、A/D変換回路34の出力レート(例えば、1.5kHz)よりも十分高く、例えば、400kHz程度である。このDSP35から出力されるデジタルデータの値は、物理量検出素子2が検出した角速度ωを表し、所定のレート(例えば、1.5kHz)で順次更新される。また、DSP35は、当該デジタルデータの値ωが更新されたことを示すフラグ信号DRDYを出力する。 The DSP 35 operates in synchronization with the clock signal DSPCLK generated by the clock generation circuit 50, and performs processing such as filtering digital data (angular velocity data) output from the A / D conversion circuit 34. In order to realize high-speed digital filtering processing by the DSP35, the frequency of the clock signal DSPCLK is sufficiently higher than the output rate (for example, 1.5 kHz) of the A / D conversion circuit 34, for example, about 400 kHz. The value of the digital data output from the DSP 35 represents the angular velocity ω 1 detected by the physical quantity detecting element 2, and is sequentially updated at a predetermined rate (for example, 1.5 kHz). Further, the DSP 35 outputs a flag signal DRDY indicating that the value ω 1 of the digital data has been updated.

そして、DSP35から出力されるデジタルデータが検出回路30の出力データとなる。このように、検出回路30は、物理量検出素子2の出力信号に基づいて第1の物理量信号としてのデジタルデータ(角速度データ)を生成して出力する回路である。 Then, the digital data output from the DSP 35 becomes the output data of the detection circuit 30. As described above, the detection circuit 30 is a circuit that generates and outputs digital data (angular velocity data) as the first physical quantity signal based on the output signal of the physical quantity detection element 2.

姿勢演算部40は、第1〜第N(N≧2)の物理量信号に基づいて姿勢演算を実行可能である。本実施形態では、第1〜第Nの物理量信号は角速度信号であり、姿勢演算部40は、検出回路30(DSP35)から第1の物理量信号としてのデジタルデータ(角速度ω)を取得し、記憶部60(レジスター61)から第2〜第Nの物理量信号としてのN−1個のデジタルデータ(角速度ω〜ω)を取得する。そして、姿勢演算部40は、記憶部60(不揮発性メモリー62)に記憶されている、第1〜第Nの物理量信号と第1〜第Nの検出軸との対応関係の設定情報を用いて、取得した第1〜第Nの物理量信号(角速度ω〜ω)の各々の検出軸を認識し、姿勢演算を行う。 The posture calculation unit 40 can execute the posture calculation based on the first to Nth (N ≧ 2) physical quantity signals. In the present embodiment, the first to Nth physical quantity signals are angular velocity signals, and the attitude calculation unit 40 acquires digital data (angular velocity ω 1 ) as the first physical quantity signal from the detection circuit 30 (DSP35). N-1 digital data (angular velocities ω 2 to ω N ) as the second to Nth physical quantity signals are acquired from the storage unit 60 (register 61). Then, the attitude calculation unit 40 uses the setting information of the correspondence relationship between the first to Nth physical quantity signals and the first to Nth detection axes stored in the storage unit 60 (nonvolatile memory 62). , Each detection axis of the acquired first to Nth physical quantity signals (angular velocity ω 2 to ω N ) is recognized, and the attitude calculation is performed.

本実施形態では、姿勢演算部40は、クォータニオンを用いて姿勢演算を行う。あるいは、姿勢演算部40は、姿勢演算として、第1〜第Nの物理量信号の各々を積分して第1〜第Nの角度を算出する。姿勢演算部40が、クォータニオンを用いて姿勢演算を行うか、姿勢演算として第1〜第Nの角度を算出するかは、記憶部60(不揮発性メモリー62)に記憶されている設定情報により決定される。また、本実施形態では、姿勢演算部40による姿勢演算を許可又は禁止に設定することが可能であり、姿勢演算部40は、許可に設定された場合に、クロック生成回路50が生成するクロック信号MCLKに同期して姿勢演算を行い、禁止に設定された場合は姿勢演算を行わない。 In the present embodiment, the posture calculation unit 40 performs posture calculation using the quaternion. Alternatively, the posture calculation unit 40 integrates each of the first to Nth physical quantity signals to calculate the first to Nth angles as the posture calculation. Whether the posture calculation unit 40 performs the posture calculation using the quaternion or calculates the first to Nth angles as the posture calculation is determined by the setting information stored in the storage unit 60 (nonvolatile memory 62). Will be done. Further, in the present embodiment, the posture calculation by the posture calculation unit 40 can be set to allow or prohibit, and the posture calculation unit 40 generates a clock signal generated by the clock generation circuit 50 when the posture calculation unit 40 is set to allow. The attitude calculation is performed in synchronization with MCLK, and if it is set to prohibit, the attitude calculation is not performed.

例えば、姿勢演算部40は、第1〜第3(N=3のケース)の物理量信号に基づいて3次元の姿勢演算を行うのであれば、検出回路30から、第1の物理量信号として角速度ωを表すデジタルデータ(角速度データ)を所定の周期Δt(例えば、1/1.5kHz≒0.67ms)で順次取得する。また、姿勢演算部40は、記憶部60から、第2の物理量信号として角速度ωを表すデジタルデータ(角速度データ)を所定の周期Δt(例えば、0.67ms)で順次取得する。さらに、姿勢演算部40は、記憶部60から、第3の物理量信号として角速度ωを表すデジタルデータ(角速度データ)を周期Δt(例えば、0.67ms)で順次取得する。また、姿勢演算部40は、記憶部60(不揮発性
メモリー62)に記憶されている、第1〜第3の物理量信号と、第1〜第3の検出軸として互いに直交するx軸、y軸、z軸との対応関係の設定情報を用いて、例えば、第1の物理量信号としてのデジタルデータ(角速度ω)をx軸回りの角速度データ(角速度ω)と認識し、第2の物理量信号としてのデジタルデータ(角速度ω)をy軸回りの角速度データ(角速度ω)と認識し、第3の物理量信号としてのデジタルデータ(角速度ω)をz軸回りの角速度データ(角速度ω)と認識する。そして、姿勢演算部40は、x軸回りの角速度ω(=ω)、y軸回りの角速度ω(=ω)及びz軸回りの角速度ω(=ω)に基づき、クォータニオンを用いて姿勢演算を行うことができる。例えば、姿勢演算部40は、3軸分の角速度ω,ω,ωを取得する毎に、式(1)に従ってクォータニオンqを更新し、更新したクォータニオンqを式(2)に従って正規化することにより、姿勢演算を行う。
For example, if the attitude calculation unit 40 performs a three-dimensional attitude calculation based on the first to third (N = 3 cases) physical quantity signals, the detection circuit 30 can use the detection circuit 30 as the first physical quantity signal with an angular velocity ω. Digital data (angular velocity data) representing 1 is sequentially acquired at a predetermined period Δt (for example, 1 / 1.5 kHz ≈0.67 ms). Further, the attitude calculation unit 40 sequentially acquires digital data (angular velocity data) representing the angular velocity ω 2 as a second physical quantity signal from the storage unit 60 in a predetermined period Δt (for example, 0.67 ms). Further, the attitude calculation unit 40 sequentially acquires digital data (angular velocity data) representing the angular velocity ω 3 as a third physical quantity signal from the storage unit 60 in a period Δt (for example, 0.67 ms). Further, the attitude calculation unit 40 includes the first to third physical quantity signals stored in the storage unit 60 (nonvolatile memory 62), and the x-axis and y-axis that are orthogonal to each other as the first to third detection axes. , For example, the digital data (angular velocity ω 1 ) as the first physical quantity signal is recognized as the angular velocity data (angular velocity ω x ) around the x-axis by using the setting information of the correspondence with the z-axis, and the second physical quantity. Digital data as a signal (angular velocity ω 2 ) is recognized as angular velocity data around the y-axis (angular velocity ω y ), and digital data as a third physical quantity signal (angular velocity ω 3 ) is angular velocity data around the z-axis (angular velocity ω). Recognize as z ). Then, the quaternion unit 40 is based on the angular velocity ω x (= ω 1 ) around the x-axis, the angular velocity ω y (= ω 2 ) around the y-axis, and the angular velocity ω z (= ω 3 ) around the z-axis. The posture calculation can be performed using. For example, the attitude calculation unit 40 updates the quaternion q according to the equation (1) every time it acquires the angular velocities ω x , ω y , ω z for three axes, and normalizes the updated quaternion q according to the equation (2). By doing so, the posture calculation is performed.

Figure 0006808997
Figure 0006808997

Figure 0006808997
Figure 0006808997

あるいは、姿勢演算部40は、姿勢演算として、x軸回りの角速度ω(=ω)を積分してx軸の角度を算出し、y軸回りの角速度ω(=ω)を積分してy軸の角度を算出し、z軸回りの角速度ω(=ω)を積分してz軸の角度を算出することもできる。 Alternatively, the attitude calculation unit 40 integrates the angular velocity ω x (= ω 1 ) around the x-axis to calculate the angle of the x-axis, and integrates the angular velocity ω y (= ω 2 ) around the y-axis as the attitude calculation. Then, the angle of the y-axis can be calculated, and the angular velocity ω z (= ω 3 ) around the z-axis can be integrated to calculate the angle of the z-axis.

ところで、本実施形態では、クロック信号ADCCLK、クロック信号DSPCLK及びクロック信号MCLKは、クロック生成回路50において、CR発振器やリングオシレーター等の発振回路(不図示)の出力信号に基づいて生成されるため、プロセス変動や環境変動により、物理量検出装置1の動作保証温度範囲(例えば、−40℃〜+85℃)において、例えば±1%程度の周波数偏差を有する。そのため、クロック信号ADCCLK及びクロック信号DSPCLKに同期して動作する検出回路30から出力されるデジタルデータの更新周期、すなわち、式(1)のΔtが±1%程度の誤差を有するため、姿勢演算の結果も±1%程度の誤差を有することになる。一方、物理量検出素子2は、良好な周波数温度特性を有する水晶等を材料として構成されるため、励振振動の周波数、すなわち、駆動信号DRVの周波数の偏差は極めて小さく、例えば±0.01%程度である。そこで、本実施形態では、姿勢演算部40は、駆動信号DRVに基づくクロック信号CKFを用いて姿勢演算を行う。 By the way, in the present embodiment, the clock signal ADCCLK, the clock signal DSPCLK and the clock signal MCLK are generated in the clock generation circuit 50 based on the output signals of an oscillation circuit (not shown) such as a CR oscillator or a ring oscillator. Due to process fluctuations and environmental fluctuations, the physical quantity detection device 1 has a frequency deviation of, for example, about ± 1% in the guaranteed operating temperature range (for example, −40 ° C. to + 85 ° C.). Therefore, the update cycle of the digital data output from the detection circuit 30 that operates in synchronization with the clock signal ADCCLK and the clock signal DSPCLK, that is, Δt of the equation (1) has an error of about ± 1%, so that the attitude calculation is performed. The result will also have an error of about ± 1%. On the other hand, since the physical quantity detecting element 2 is made of quartz or the like having good frequency and temperature characteristics, the deviation of the excitation vibration frequency, that is, the frequency of the drive signal DRV is extremely small, for example, about ± 0.01%. Is. Therefore, in the present embodiment, the posture calculation unit 40 performs the posture calculation using the clock signal CKF based on the drive signal DRV.

図6は、クォータニオンを用いて姿勢演算を行う姿勢演算部40の構成例を示す図である。図6に示すように、姿勢演算部40は、Dフリップフロップ41A,41B、NOT回路42、NOR回路43、カウンター44、乗算器45A,45B、変換部46、行列
演算部47、加算器48及び正規化部49を含んで構成されている。なお、図6では、姿勢演算の許可/禁止を制御するための構成は省略されている。
FIG. 6 is a diagram showing a configuration example of a posture calculation unit 40 that performs a posture calculation using a quaternion. As shown in FIG. 6, the attitude calculation unit 40 includes D flip-flops 41A and 41B, NOT circuit 42, NOR circuit 43, counter 44, multiplier 45A and 45B, conversion unit 46, matrix calculation unit 47, adder 48 and It is configured to include a normalization unit 49. Note that in FIG. 6, the configuration for controlling the permission / prohibition of the posture calculation is omitted.

Dフリップフロップ41Aは、入力端子(D)にクロック信号CKFが入力され、クロック端子にクロック信号MCLKが入力される。Dフリップフロップ41Bは、入力端子(D)にDフリップフロップ41Aの出力端子(Q)から出力される信号が入力され、クロック端子にクロック信号MCLKが入力される。クロック信号CKFは、クロック信号MCLKと非同期であるため、Dフリップフロップ41A,41Bによってクロック信号MCLKに同期化される。Dフリップフロップ41Cは、入力端子(D)にDフリップフロップ41Bの出力端子(Q)から出力される信号(クロック信号MCLKに同期化されたクロック信号CKF)が入力され、クロック端子にクロック信号MCLKが入力される。Dフリップフロップ41Cの出力端子(Q)からは、フリップフロップ41Bの出力信号をクロック信号MCLKの1周期分遅らせた信号が出力される。 In the D flip-flop 41A, the clock signal CKF is input to the input terminal (D), and the clock signal MCLK is input to the clock terminal. In the D flip-flop 41B, a signal output from the output terminal (Q) of the D flip-flop 41A is input to the input terminal (D), and the clock signal MCLK is input to the clock terminal. Since the clock signal CKF is asynchronous with the clock signal MCLK, it is synchronized with the clock signal MCLK by the D flip-flops 41A and 41B. In the D flip-flop 41C, a signal (clock signal CKF synchronized with the clock signal MCLK) output from the output terminal (Q) of the D flip-flop 41B is input to the input terminal (D), and the clock signal MCLK is input to the clock terminal. Is entered. From the output terminal (Q) of the D flip-flop 41C, a signal obtained by delaying the output signal of the flip-flop 41B by one cycle of the clock signal MCLK is output.

NOT回路42は、Dフリップフロップ41Bの出力信号の電圧レベル(ローレベル/ハイレベル)を論理反転した信号を出力する。NOR回路43は、Dフリップフロップ41Cの出力信号とNOT回路42の出力信号の一方又は両方がハイレベルのときはローレベルとなり、Dフリップフロップ41Cの出力信号とNOT回路42の出力信号がともにローレベルのときにハイレベルとなる信号を出力する。すなわち、NOR回路43の出力信号には、クロック信号CKFがローレベルからハイレベルに変化する(立ち上がる)毎に、クロック信号MCLKの1周期分だけハイレベルとなる複数のパルスが含まれる。 The NOT circuit 42 outputs a signal in which the voltage level (low level / high level) of the output signal of the D flip-flop 41B is logically inverted. The NOR circuit 43 has a low level when one or both of the output signal of the D flip-flop 41C and the output signal of the NOT circuit 42 is high level, and both the output signal of the D flip-flop 41C and the output signal of the NOT circuit 42 are low. Outputs a high level signal when it is level. That is, the output signal of the NOR circuit 43 includes a plurality of pulses whose high level is increased by one cycle of the clock signal MCLK each time the clock signal CKF changes (rises) from the low level to the high level.

カウンター44は、フラグ信号DRDYがローレベルのときに、NOR回路43の出力信号のパルス数をカウントしてカウント値を出力し、フラグ信号DRDYがハイレベルになるとカウント値を0にリセットする。このカウント値は、クロック信号CKFとフラグ信号DRDYとの周波数比を表している。 The counter 44 counts the number of pulses of the output signal of the NOR circuit 43 and outputs a count value when the flag signal DRDY is at a low level, and resets the count value to 0 when the flag signal DRDY becomes a high level. This count value represents the frequency ratio of the clock signal CKF and the flag signal DRDY.

乗算器45Aは、カウンター44が出力するカウント値と係数値COEFとの積を計算して出力する。係数値COEFは、記憶部60(不揮発性メモリー62)に記憶されており、式(3)で計算される定数値である。 The multiplier 45A calculates and outputs the product of the count value output by the counter 44 and the coefficient value COEF. The coefficient value COEF is stored in the storage unit 60 (nonvolatile memory 62) and is a constant value calculated by the equation (3).

Figure 0006808997
Figure 0006808997

式(3)において、GSは、検出回路30(GSは物理量検出素子2)の検出感度(単位:°/s/LSB)である。また、FREQは、クロック信号CKFの周波数(単位はHz)である。 In the formula (3), GS is the detection sensitivity (unit: ° / s / LSB) of the detection circuit 30 (GS is the physical quantity detection element 2). Further, FRQ is the frequency (unit: Hz) of the clock signal CKF.

変換部46は、記憶部60(不揮発性メモリー62)に記憶されている、第1〜第3の物理量信号とx軸、y軸、z軸との対応関係の設定情報に基づいて、3軸の角速度データ(角速度ω,ω,ω)をx軸回りの角速度ω、y軸回りの角速度ω及びz軸回りの角速度ωに変換して出力する。 The conversion unit 46 has three axes based on the setting information of the correspondence between the first to third physical quantity signals and the x-axis, y-axis, and z-axis stored in the storage unit 60 (nonvolatile memory 62). The angular velocity data (angular velocity ω 1 , ω 2 , ω 3 ) is converted into the angular velocity ω x around the x-axis, the angular velocity ω y around the y-axis, and the angular velocity ω z around the z-axis and output.

行列演算部47は、クロック信号MCLKに同期して、x軸回りの角速度ω、y軸回りの角速度及びz軸回りの角速度ω(いずれも単位はLSB)と最新のクォータニオンq(各要素q,q,q,qの単位はラジアン)とを用いて、式(1)の右辺第1項中の行列積の部分を計算して出力する。 In synchronization with the clock signal MCLK, the matrix calculation unit 47 has an angular velocity ω x around the x-axis, an angular velocity around the y-axis, and an angular velocity ω z around the z-axis (both units are LSB) and the latest quaternion q (each element). The unit of q w , q x , q y , and q z is radian), and the part of the matrix product in the first term on the right side of equation (1) is calculated and output.

乗算器45Bは、行列演算部47の出力値と乗算器45Aの出力値との積を計算して出力する。この乗算器45Bの出力値は、式(1)の右辺第1項の計算値に相当する。 The multiplier 45B calculates and outputs the product of the output value of the matrix calculation unit 47 and the output value of the multiplier 45A. The output value of the multiplier 45B corresponds to the calculated value of the first term on the right side of the equation (1).

加算器48は、乗算器45Bの出力値と最新のクォータニオンqとの和を計算して出力する。この加算器48の出力値は、式(1)の計算値に相当する。 The adder 48 calculates and outputs the sum of the output value of the multiplier 45B and the latest quaternion q. The output value of the adder 48 corresponds to the calculated value of the equation (1).

正規化部49は、クロック信号MCLKに同期して、加算器48の出力値を、その大きさが1になるように正規化して出力する。この正規化部49の出力値は、式(2)の計算値に相当し、最新のクォータニオンqとなる。 The normalization unit 49 synchronizes with the clock signal MCLK and normalizes and outputs the output value of the adder 48 so that its magnitude becomes 1. The output value of the normalization unit 49 corresponds to the calculated value of the equation (2) and becomes the latest quaternion q.

このように構成された姿勢演算部40は、クロック信号CKF(例えば、周波数偏差が±0.01%)とフラグ信号DRDY(例えば、周波数偏差が±1%)との周波数比を求め、当該周波数比を用いてΔtを補正し、式(1)及び式(2)に従ってクォータニオンqを計算するので、姿勢演算の精度が向上する。 The attitude calculation unit 40 configured in this way obtains the frequency ratio between the clock signal CKF (for example, the frequency deviation is ± 0.01%) and the flag signal DRDY (for example, the frequency deviation is ± 1%), and obtains the frequency. Since Δt is corrected using the ratio and the quaternion q is calculated according to the equations (1) and (2), the accuracy of the attitude calculation is improved.

図1に戻り、記憶部60は、レジスター61及び不揮発性メモリー62を有している。レジスター61には、第1インターフェース回路70及び第2インターフェース回路80を介した外部装置(第1の外部装置)との通信において使用されるアドレスやデータの情報が設定される。また、レジスター61には、第1インターフェース回路70及び第2インターフェース回路80を介した外部装置(第2〜第Nの外部装置)との通信によって取得したデータ(例えば、第2〜第Nの物理量信号としてのデジタルデータ)や姿勢演算部40による姿勢演算の結果(例えば、クォータニオンq)等が記憶される。 Returning to FIG. 1, the storage unit 60 has a register 61 and a non-volatile memory 62. The register 61 is set with address and data information used in communication with an external device (first external device) via the first interface circuit 70 and the second interface circuit 80. Further, in the register 61, data acquired by communication with an external device (second to Nth external devices) via the first interface circuit 70 and the second interface circuit 80 (for example, the second to Nth physical quantities). Digital data as a signal), the result of the attitude calculation by the attitude calculation unit 40 (for example, the quarternion q), and the like are stored.

不揮発性メモリー62には、駆動回路20や検出回路30に対する各種のトリミングデータ(調整データや補正データ)や第1インターフェース回路70及び第2インターフェース回路80を介した外部との通信を成立させるための各種の情報が記憶されている。不揮発性メモリー62は、例えば、MONOS(Metal Oxide Nitride Oxide Silicon)型メモリーやEEPROM(Electrically Erasable Programmable Read-Only Memory)として構成することができる。 In the non-volatile memory 62, various trimming data (adjustment data and correction data) for the drive circuit 20 and the detection circuit 30 and communication with the outside via the first interface circuit 70 and the second interface circuit 80 are established. Various information is stored. The non-volatile memory 62 can be configured as, for example, a MONOS (Metal Oxide Nitride Oxide Silicon) type memory or an EEPROM (Electrically Erasable Programmable Read-Only Memory).

また、信号処理回路3の電源投入時(VDD端子の電圧が0Vから所望の電圧まで立ち上がる時)に、不揮発性メモリー62に記憶されている各種のトリミングデータがレジスター61に転送されて保持され、レジスター61に保持された各種のトリミングデータが駆動回路20や検出回路30に供給される。 Further, when the power of the signal processing circuit 3 is turned on (when the voltage of the VDD terminal rises from 0 V to a desired voltage), various trimming data stored in the non-volatile memory 62 are transferred to the register 61 and held. Various trimming data held in the register 61 are supplied to the drive circuit 20 and the detection circuit 30.

また、前述の通り、本実施形態では、記憶部60(不揮発性メモリー62)には、第1〜第Nの物理量信号と第1〜第Nの検出軸との対応関係の設定情報が記憶されており、姿勢演算部40は、当該設定情報を用いて姿勢演算を行う。 Further, as described above, in the present embodiment, the storage unit 60 (nonvolatile memory 62) stores the setting information of the correspondence relationship between the first to Nth physical quantity signals and the first to Nth detection axes. The posture calculation unit 40 performs a posture calculation using the setting information.

第1インターフェース回路70は、XCS端子、SCLK端子、MOSI端子及びMISO端子と電気的に接続されており、これらの端子を介して第1の外部装置と通信するための回路である。第1インターフェース回路70を介した通信では、第1の外部装置がマスターとして機能し、物理量検出装置1(信号処理回路3)がスレーブとして機能する。そして、第1の外部装置は、第1インターフェース回路70を介して、レジスター61の所定のアドレスにデータを書き込むことや、レジスター61の所定のアドレスからデータを読み出すことや、各種のコマンドを送信して信号処理回路3の動作を制御することができる。 The first interface circuit 70 is electrically connected to the XCS terminal, the SCLK terminal, the MOSI terminal, and the MISO terminal, and is a circuit for communicating with the first external device via these terminals. In communication via the first interface circuit 70, the first external device functions as a master, and the physical quantity detection device 1 (signal processing circuit 3) functions as a slave. Then, the first external device writes data to a predetermined address of the register 61, reads data from a predetermined address of the register 61, and transmits various commands via the first interface circuit 70. The operation of the signal processing circuit 3 can be controlled.

本実施形態では、第1インターフェース回路70は、SPI(Serial Peripheral Interface)インターフェース回路とIC(Inter-Integrated Circuit)インターフェース
回路のいずれか一方として機能する。例えば、第1インターフェース回路70は、XCS端子がローレベルのときは、SPIインターフェース回路として機能し、SCLK端子を介してクロック信号が入力され、MOSI端子を介してデータ信号が入力され、MISO端子を介してデータ信号が出力される。また、第1インターフェース回路70は、XCS端子がハイレベルのときは、ICインターフェース回路として機能し、SCLK端子を介してクロック信号が入力され、MOSI端子を介してデータ信号が入出力される。図7〜図9に、第1インターフェース回路70がSPIインターフェース回路として機能するときの、第1インターフェース回路70を介した通信フォーマット(XCS端子、SCLK端子、MOSI端子及びMISO端子の信号波形)の一例を示す。図7は、第1の外部装置が、レジスター61の所定のアドレスにデータを書き込むときの通信フォーマットである。また、図8は、第1の外部装置が、レジスター61の所定のアドレスからデータを読み出すときの通信フォーマットである。また、図9は、第1の外部装置が所定のコマンドを送信するときの通信フォーマットである。図7〜図9において、Rは読み出しビット、Wは書き込みビット、A6〜A0は7ビットアドレス、D7〜D0は8ビットデータである。
In this embodiment, the first interface circuit 70 functions as one of the SPI (Serial Peripheral Interface) interface circuit and I 2 C (Inter-Integrated Circuit ) interface circuit. For example, the first interface circuit 70 functions as an SPI interface circuit when the XCS terminal is at a low level, a clock signal is input via the SCLK terminal, a data signal is input via the MOSI terminal, and the MISO terminal is used. The data signal is output via. The first interface circuit 70, when the XCS pin is high level, and functions as an I 2 C interface circuit, a clock signal is input via the SCLK terminal, the data signal is input and output via the MOSI pin .. 7 to 9 show an example of communication formats (signal waveforms of XCS terminal, SCLK terminal, MOSI terminal, and MISO terminal) via the first interface circuit 70 when the first interface circuit 70 functions as an SPI interface circuit. Is shown. FIG. 7 is a communication format when the first external device writes data to a predetermined address of the register 61. Further, FIG. 8 shows a communication format when the first external device reads data from a predetermined address of the register 61. Further, FIG. 9 shows a communication format when the first external device transmits a predetermined command. In FIGS. 7 to 9, R is a read bit, W is a write bit, A6 to A0 are 7-bit addresses, and D7 to D0 are 8-bit data.

第2インターフェース回路80は、MSCK端子及びMSDA端子と電気的に接続されており、これらの端子を介して第2〜第Nの外部装置と通信するための回路である。第2インターフェース回路80を介した通信では、物理量検出装置1(信号処理回路3)がマスターとして機能し、第2〜第Nの外部装置がスレーブとして機能する。そして、物理量検出装置1(信号処理回路3)は、第2インターフェース回路80を介して、第2〜第Nの外部装置が有する記憶部(レジスター)の所定のアドレスにデータを書き込むことや、第2〜第Nの外部装置が有する記憶部(レジスター)の所定のアドレスからデータを読み出すことができる。 The second interface circuit 80 is a circuit that is electrically connected to the MSCK terminal and the MSDA terminal, and communicates with the second to second external devices via these terminals. In the communication via the second interface circuit 80, the physical quantity detection device 1 (signal processing circuit 3) functions as a master, and the second to second external devices function as slaves. Then, the physical quantity detection device 1 (signal processing circuit 3) writes data to a predetermined address of the storage unit (register) of the second to second external devices via the second interface circuit 80, and the first Data can be read from a predetermined address of the storage unit (register) of the second to Nth external devices.

本実施形態では、第2インターフェース回路80は、ICインターフェース回路として機能し、MSCK端子を介してクロック信号が出力され、MSDA端子を介してデータ信号が入出力される。図10及び図11に、第2インターフェース回路80を介した通信フォーマット(MSCK端子及びMSDA端子の信号波形)の一例を示す。図10は、物理量検出装置1(信号処理回路3)が、第2〜第Nの外部装置が有する記憶部(レジスター)の所定のアドレスにデータを書き込むときの信号波形である。また、図11は、物理量検出装置1(信号処理回路3)が、第2〜第Nの外部装置が有する記憶部(レジスター)の所定のアドレスからデータを読み出すときの信号波形である。図10及び図11において、Startはスタートコンディション、Stopはストップコンディション、Restartはリスタートコンディション、ACKはアクノリッジビット、NACKはノンアクノリッジビット、Rは読み出しビット、Wは書き込みビット、A7〜A0は8ビットのレジスターアドレス(MI2CRAD[7:0])、A6〜A0は7ビットのスレーブアドレス(MI2CSAD[6:0])、D7〜D0は7ビットの書き込みデータ又は読み出しデータである。 In this embodiment, second interface circuit 80 functions as I 2 C interface circuit, outputs a clock signal through the MSCK terminal, the data signal is input and output via the MSDA terminal. 10 and 11 show an example of a communication format (signal waveforms of the MSCK terminal and the MSDA terminal) via the second interface circuit 80. FIG. 10 is a signal waveform when the physical quantity detection device 1 (signal processing circuit 3) writes data to a predetermined address of the storage unit (register) of the second to Nth external devices. Further, FIG. 11 is a signal waveform when the physical quantity detection device 1 (signal processing circuit 3) reads data from a predetermined address of a storage unit (register) included in the second to Nth external devices. In FIGS. 10 and 11, Start is a start condition, Stop is a stop condition, Start is a restart condition, ACK is an acknowledge bit, NACK is a non-acknowledge bit, R is a read bit, W is a write bit, and A7 to A0 are 8 bits. Register addresses (MI2CRAD [7: 0]), A6 to A0 are 7-bit slave addresses (MI2CSAS [6: 0]), and D7 to D0 are 7-bit write data or read data.

第1インターフェース回路70を介した第1の外部装置との間の通信は、レジスター61に記憶される各種の情報に基づいて行われる。また、第2インターフェース回路80を介した第2〜第Nの外部装置との間の通信は、レジスター61及び不揮発性メモリー62に記憶される各種の情報に基づいて行われる。 Communication with the first external device via the first interface circuit 70 is performed based on various information stored in the register 61. Further, communication with the second to second external devices via the second interface circuit 80 is performed based on various information stored in the register 61 and the non-volatile memory 62.

図12は、レジスター61のアドレスマップの一例を示す図である。図12では、アドレスマップの一部のみが示されており、「R/W」の欄において、「R」は読み出しのみ可能であり、「R/W」は読み出し及び書き込みが可能であり、「W(C)」はコマンドであることを表している。また、図13は、図12に示した書き込み可能な各アドレスのデータ構成を示す図である。 FIG. 12 is a diagram showing an example of the address map of the register 61. In FIG. 12, only a part of the address map is shown, and in the “R / W” column, “R” can be read only, “R / W” can be read and written, and “R / W” can be read and written. "W (C)" indicates that it is a command. Further, FIG. 13 is a diagram showing a data structure of each writable address shown in FIG.

第1の外部装置は、例えば、図8に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x0A(レジスターRDGR)から第1の物理量信号としてのデジタルデータ(角速度データ)を読み出すことができる。このように、物理量検出装置1(信号処理回路3)は、第1の外部装置からの読み出し要求に応じて、MISO端子(「第1の端子」の一例)から第1の物理量信号としてのデジタルデータ(角速度データ)を出力可能に構成されている。なお、第1インターフェース回路70がICインターフェース回路として機能する場合は、第1の外部装置からの読み出し要求に応じて、MOSI端子(「第1の端子」の他の一例)から第1の物理量信号としてのデジタルデータ(角速度データ)が出力される。 The first external device is, for example, according to the communication format shown in FIG. 8, digital data (angular velocity data) as a first physical quantity signal from the address 0x0A (register RDGR) of the register 61 via the first interface circuit 70. Can be read. In this way, the physical quantity detection device 1 (signal processing circuit 3) is digitally used as the first physical quantity signal from the MISO terminal (an example of the "first terminal") in response to a read request from the first external device. It is configured to be able to output data (angular velocity data). Incidentally, if the first interface circuit 70 functions as an I 2 C interface circuit in response to a read request from the first external device, MOSI terminal from (another example of the "first terminal") first Digital data (angular velocity data) as a physical quantity signal is output.

また、第1の外部装置は、例えば、図7に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x11(レジスターMCTL)に姿勢演算部40や第2インターフェース回路80の設定情報を書き込むことができる。図13に示すように、アドレス0x11(レジスターMCTL)において、ビット2は、第2インターフェース回路80のマニュアル動作を書き込み又は読み出しに設定するためのビットであり、ビット1は、第2インターフェース回路80のマニュアル動作の許可又は禁止を設定するためのビットであり、ビット0は、姿勢演算部40による姿勢演算の許可又は禁止を設定するためのビットである。さらに、第1の外部装置は、例えば、図8に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x11(レジスターMCTL)から当該設定情報を読み出すこともできる。 Further, the first external device is, for example, according to the communication format shown in FIG. 7, the attitude calculation unit 40 and the second interface circuit 80 are connected to the address 0x11 (register MCTL) of the register 61 via the first interface circuit 70. Setting information can be written. As shown in FIG. 13, at address 0x11 (register MCTL), bit 2 is a bit for setting the manual operation of the second interface circuit 80 to write or read, and bit 1 is the bit 1 of the second interface circuit 80. It is a bit for setting permission or prohibition of manual operation, and bit 0 is a bit for setting permission or prohibition of posture calculation by the posture calculation unit 40. Further, the first external device can also read the setting information from the address 0x11 (register MCTL) of the register 61 via the first interface circuit 70, for example, according to the communication format shown in FIG.

また、第1の外部装置は、例えば、図8に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x12(レジスターRDAG)から姿勢演算部40の演算結果情報(3軸角度データ又は姿勢データ(例えば、クォータニオンq))を読み出すことができる。 Further, for example, the first external device follows the communication format shown in FIG. 8 and performs calculation result information (3 axes) of the attitude calculation unit 40 from the address 0x12 (register RDAG) of the register 61 via the first interface circuit 70. Angle data or attitude data (eg, quaternion q)) can be read out.

また、第1の外部装置は、例えば、図9に示した通信フォーマットに従い、第1インターフェース回路70に、レジスター61のアドレス0x13(レジスターAGRS)を指定して、姿勢演算部40の演算結果情報(3軸角度データ又は姿勢データ)をリセットするためのコマンドを送信することができる。第1インターフェース回路70は、当該コマンドを受信すると、姿勢演算部40の演算結果情報及び姿勢演算部40の動作を初期化する。 Further, the first external device specifies, for example, the address 0x13 (register AGRS) of the register 61 in the first interface circuit 70 according to the communication format shown in FIG. 9, and the calculation result information of the attitude calculation unit 40 (register AGRS). A command for resetting the triaxial angle data or the attitude data) can be transmitted. Upon receiving the command, the first interface circuit 70 initializes the calculation result information of the posture calculation unit 40 and the operation of the posture calculation unit 40.

また、第1の外部装置は、例えば、図9に示した通信フォーマットに従い、第1インターフェース回路70に、レジスター61のアドレス0x14(レジスターMI2CST)を指定して、第2インターフェース回路80のマニュアル動作を開始させるためのコマンドを送信することができる。 Further, for example, the first external device specifies the address 0x14 (register MI2CST) of the register 61 to the first interface circuit 70 according to the communication format shown in FIG. 9, and manually operates the second interface circuit 80. You can send a command to get it started.

また、第1の外部装置は、例えば、図7に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x15(レジスターMI2CSAD)に、第2インターフェース回路80のマニュアル動作による通信で用いられるスレーブアドレス(図10及び図11のスレーブアドレスMI2CSAD[6:0])を書き込むことができる。図13に示すように、アドレス0x15(レジスターMI2CSAD)において、ビット6〜0は、7ビットのスレーブアドレスを設定するためのビットである。さらに、第1の外部装置は、例えば、図8に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x15(レジスターMI2CSAD)から当該スレーブアドレスを読み出すこともできる。 Further, the first external device, for example, communicates with the address 0x15 (register MI2CSAS) of the register 61 via the first interface circuit 70 by the manual operation of the second interface circuit 80 according to the communication format shown in FIG. The slave address used in (FIG. 10 and FIG. 11 (slave address MI2CSAS [6: 0])) can be written. As shown in FIG. 13, at the address 0x15 (register MI2CSAS), bits 6 to 0 are bits for setting a 7-bit slave address. Further, the first external device can also read the slave address from the address 0x15 (register MI2CSAS) of the register 61 via the first interface circuit 70, for example, according to the communication format shown in FIG.

また、第1の外部装置は、例えば、図7に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x16(レジスターMI2CRAD)に、第2インターフェース回路80のマニュアル動作による通信で用いられるレジスターアドレス(図10及び図11のレジスターアドレスMI2CRAD[7:0])を書き込むことができる。図13に示すように、アドレス0x16(レジスターMI2CRAD)において、ビット7〜0は、8ビットのレジスターアドレスを設定するためのビットである。さらに、第1の外部装置は、例えば、図8に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x16(レジスターMI2CRAD)から当該レジスターアドレスを読み出すこともできる。 Further, the first external device, for example, communicates with the address 0x16 (register MI2CRAD) of the register 61 via the first interface circuit 70 by the manual operation of the second interface circuit 80 according to the communication format shown in FIG. The register address used in FIG. 10 (register address MI2CRAD [7: 0] in FIGS. 10 and 11) can be written. As shown in FIG. 13, in the address 0x16 (register MI2CRAD), bits 7 to 0 are bits for setting an 8-bit register address. Further, the first external device can also read the register address from the address 0x16 (register MI2CRAD) of the register 61 via the first interface circuit 70, for example, according to the communication format shown in FIG.

また、第1の外部装置は、例えば、図7に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x17(レジスターMI2CDAD)に、第2インターフェース回路80のマニュアル動作による通信で用いられる書き込みデータ(図10の書き込みデータMI2CDAD[7:0])を書き込むことができる。図13に示すように、アドレス0x17(レジスターMI2CDAD)において、ビット7〜0は、8ビットの書き込みデータを設定するためのビットである。さらに、第1の外部装置は、例えば、図8に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x17(レジスターMI2CDAD)から当該書き込みデータを読み出すこともできる。 Further, the first external device, for example, communicates with the address 0x17 (register MI2CDAD) of the register 61 via the first interface circuit 70 by the manual operation of the second interface circuit 80 according to the communication format shown in FIG. The write data used in (FIG. 10 write data MI2CDAD [7: 0]) can be written. As shown in FIG. 13, at the address 0x17 (register MI2CDAD), bits 7 to 0 are bits for setting 8-bit write data. Further, the first external device can also read the write data from the address 0x17 (register MI2CDAD) of the register 61 via the first interface circuit 70, for example, according to the communication format shown in FIG.

また、第1の外部装置は、例えば、図8に示した通信フォーマットに従い、第1インターフェース回路70を介して、レジスター61のアドレス0x18(レジスターMI2CRD)から、第2インターフェース回路80のマニュアル動作による通信で第2〜第Nの外部装置から取得した読み出しデータを読み出すことができる。 Further, for example, the first external device communicates from the address 0x18 (register MI2CRD) of the register 61 via the first interface circuit 70 by the manual operation of the second interface circuit 80 according to the communication format shown in FIG. Can read the read data acquired from the second to Nth external devices.

図14は、不揮発性メモリー62のアドレスマップの一例を示す図である。図14では、アドレスマップの一部のみが示されている。また、図15は、図14に示した各アドレスのデータ構成を示す図である。なお、図14及び図15は、信号処理回路3が、第2インターフェース回路80を介して、第2の外部装置及び第3の外部装置と通信する場合(N=3のケース)の例である。 FIG. 14 is a diagram showing an example of an address map of the non-volatile memory 62. In FIG. 14, only a part of the address map is shown. Further, FIG. 15 is a diagram showing a data structure of each address shown in FIG. 14 and 15 are examples of a case where the signal processing circuit 3 communicates with the second external device and the third external device via the second interface circuit 80 (case of N = 3). ..

図14及び図15に示すように、不揮発性メモリー62において、アドレス0x01(メモリーMI2CSA1)のビット6〜0には、第2の外部装置のスレーブアドレスが記憶され、アドレス0x02(メモリーMI2CSA2)のビット6〜0には、第3の外部装置のスレーブアドレスが記憶されている。また、不揮発性メモリー62において、アドレス0x03(メモリーMI2CRA1)のビット7〜0には、第2の外部装置のレジスターにおいて、第2の物理量信号としてのデジタルデータ(角速度ω)が記憶されるレジスターアドレスが記憶され、アドレス0x04(メモリーMI2CRA2)のビット7〜0には、第3の外部装置のレジスターにおいて、第3の物理量信号としてのデジタルデータ(角速度ω)が記憶されるレジスターアドレスが記憶されている。 As shown in FIGS. 14 and 15, in the non-volatile memory 62, the slave address of the second external device is stored in bits 6 to 0 of the address 0x01 (memory MI2CSA1), and the bit of the address 0x02 (memory MI2CSA2). The slave address of the third external device is stored in 6 to 0. Further, in the non-volatile memory 62, bits 7 to 0 of the address 0x03 (memory MI2CRA1) store digital data (angle velocity ω 2 ) as the second physical quantity signal in the register of the second external device. The address is stored, and the register address in which the digital data (angular velocity ω 3 ) as the third physical quantity signal is stored in the register of the third external device is stored in bits 7 to 0 of the address 0x04 (memory MI2CRA2). Has been done.

物理量検出装置1(信号処理回路3)は、レジスター61のアドレス0x11のビット0(MCTL[0])が1(姿勢演算部40による姿勢演算の許可)に設定されている場合、図11に示した通信フォーマットに従い、スレーブアドレスMI2CSAD[6:0]としてアドレス0x01に記憶されているスレーブアドレスを用い、レジスターアドレスMI2CRAD[7:0]としてアドレス0x03に記憶されているレジスターアドレスを用いることにより、第2インターフェース回路80を介して、第2の外部装置から、読み出しデータMI2CRD[6:0]として第2の物理量信号としてのデジタルデータ(角速度ω)を読み出す。また、物理量検出装置1(信号処理回路3)は、図11に示した通信フォーマットに従い、スレーブアドレスMI2CSAD[6:0]としてアドレ
ス0x02に記憶されているスレーブアドレスを用い、レジスターアドレスMI2CRAD[7:0]としてアドレス0x04に記憶されているレジスターアドレスを用いることにより、第2インターフェース回路80を介して、第3の外部装置から、読み出しデータMI2CRD[6:0]として第3の物理量信号としてのデジタルデータ(角速度ω)を読み出す。このように、物理量検出装置1(信号処理回路3)は、MSDA端子(「第2の端子」の一例)から第2〜第Nの物理量信号としてのデジタルデータ(角速度データ)に構成されている。
The physical quantity detection device 1 (signal processing circuit 3) is shown in FIG. 11 when bit 0 (MCTL [0]) of the address 0x11 of the register 61 is set to 1 (permission of posture calculation by the posture calculation unit 40). According to the communication format, the slave address stored in the address 0x01 is used as the slave address MI2CSAS [6: 0], and the register address stored in the address 0x03 is used as the register address MI2CRAD [7: 0]. Digital data (angular velocity ω 2 ) as a second physical quantity signal is read out as read data MI2CRD [6: 0] from the second external device via the two-interface circuit 80. Further, the physical quantity detection device 1 (signal processing circuit 3) uses the slave address stored in the address 0x02 as the slave address MI2CSAS [6: 0] according to the communication format shown in FIG. 11, and uses the register address MI2CRAD [7: By using the register address stored in the address 0x04 as 0], the data read from the third external device via the second interface circuit 80 is digitally used as the third physical quantity signal as MI2CRD [6: 0]. Read the data (angular velocity ω 3 ). As described above, the physical quantity detection device 1 (signal processing circuit 3) is configured from the MSDA terminal (an example of the "second terminal") to digital data (angular velocity data) as the second to Nth physical quantity signals. ..

また、不揮発性メモリー62において、アドレス0x04(メモリーAXISCTL)のビット2は、姿勢演算部40による姿勢演算として角度演算とクォータニオン演算のいずれか一方を設定するためのビットである。姿勢演算部40は、アドレス0x04のビット2が0であれば角度演算を行い、アドレス0x04のビット2が1であればクォータニオン演算を行う。 Further, in the non-volatile memory 62, the bit 2 at the address 0x04 (memory AXISTL) is a bit for setting either the angle calculation or the quaternion calculation as the posture calculation by the posture calculation unit 40. The attitude calculation unit 40 performs an angle calculation if the bit 2 of the address 0x04 is 0, and performs a quaternion calculation if the bit 2 of the address 0x04 is 1.

また、不揮発性メモリー62において、アドレス0x04(メモリーAXISCTL)のビット1〜0は、第1の物理量信号としてのデジタルデータ(角速度ω)の検出軸(物理量検出素子2の検出軸)を設定するためのビットである。姿勢演算部40は、アドレス0x04のビット1〜0が0であれば、第1の物理量信号としてのデジタルデータ(角速度ω)をx軸回りの角速度データ(角速度ω)と認識する。この場合、姿勢演算部40は、第2の物理量信号としてのデジタルデータ(角速度ω)をy軸回りの角速度データ(角速度ω)と認識し、第3の物理量信号としてのデジタルデータ(角速度ω)をz軸回りの角速度データ(角速度ω)と認識する。また、姿勢演算部40は、アドレス0x04のビット1〜0が1であれば、第1の物理量信号としてのデジタルデータ(角速度ω)をy軸回りの角速度データ(角速度ω)と認識する。この場合、姿勢演算部40は、第2の物理量信号としてのデジタルデータ(角速度ω)をx軸回りの角速度データ(角速度ω)と認識し、第3の物理量信号としてのデジタルデータ(角速度ω)をz軸回りの角速度データ(角速度ω)と認識する。また、姿勢演算部40は、アドレス0x04のビット1〜0が2であれば、第1の物理量信号としてのデジタルデータ(角速度ω)をz軸回りの角速度データ(角速度ω)と認識する。この場合、姿勢演算部40は、第2の物理量信号としてのデジタルデータ(角速度ω)をx軸回りの角速度データ(角速度ω)と認識し、第3の物理量信号としてのデジタルデータ(角速度ω)をy軸回りの角速度データ(角速度ω)と認識する。このように、不揮発性メモリー62において、アドレス0x04のビット1〜0は、第1〜第3の物理量信号とx軸、y軸、z軸との対応関係の設定情報である。 Further, in the non-volatile memory 62, bits 1 to 0 of the address 0x04 (memory AXISTL) set a detection axis (detection axis of the physical quantity detection element 2) of digital data (angular velocity ω 1 ) as a first physical quantity signal. Is a bit for. If the bits 1 to 0 of the address 0x04 are 0, the attitude calculation unit 40 recognizes the digital data (angular velocity ω 1 ) as the first physical quantity signal as the angular velocity data (angular velocity ω x ) around the x-axis. In this case, the attitude calculation unit 40 recognizes the digital data (angular velocity ω 2 ) as the second physical quantity signal as the angular velocity data (angular velocity ω y ) around the y-axis, and the digital data (angular velocity ω y ) as the third physical quantity signal. ω 3 ) is recognized as angular velocity data around the z-axis (angular velocity ω z ). Further, if the bits 1 to 0 of the address 0x04 are 1, the attitude calculation unit 40 recognizes the digital data (angular velocity ω 1 ) as the first physical quantity signal as the angular velocity data (angular velocity ω y ) around the y-axis. .. In this case, the attitude calculation unit 40 recognizes the digital data (angular velocity ω 2 ) as the second physical quantity signal as the angular velocity data (angular velocity ω x ) around the x-axis, and the digital data (angular velocity ω x ) as the third physical quantity signal. ω 3 ) is recognized as angular velocity data around the z-axis (angular velocity ω z ). Further, if the bits 1 to 0 of the address 0x04 are 2, the attitude calculation unit 40 recognizes the digital data (angular velocity ω 1 ) as the first physical quantity signal as the angular velocity data (angular velocity ω z ) around the z-axis. .. In this case, the attitude calculation unit 40 recognizes the digital data (angular velocity ω 2 ) as the second physical quantity signal as the angular velocity data (angular velocity ω x ) around the x-axis, and the digital data (angular velocity ω x ) as the third physical quantity signal. ω 3 ) is recognized as angular velocity data around the y-axis (angular velocity ω y ). As described above, in the non-volatile memory 62, the bits 1 to 0 of the address 0x04 are the setting information of the correspondence between the first to third physical quantity signals and the x-axis, y-axis, and z-axis.

以上に説明したように、従来の姿勢演算装置が外部装置と通信して第1〜第Nの物理量信号を取得して姿勢演算を実行するのに対して、本実施形態の物理量検出装置1(信号処理回路3)は、検出回路30が出力する第1の物理量信号及びMSDA端子を介して外部装置から取得した第2〜第Nの物理量信号に基づいて姿勢演算を実行する。すなわち、本実施形態の物理量検出装置1(信号処理回路3)では、検出回路30が第1の物理量信号を出力するので、外部装置と通信して第1の物理量信号を取得する必要がなく、また、外部装置から第2〜第Nの物理量信号を取得するのと並行して、検出回路30が第1の物理量信号を生成することができるので、第1〜第Nの物理量信号を取得する時間を短くすることができる。その結果、本実施形態の物理量検出装置1(信号処理回路3)によれば、従来よりも姿勢演算の周期が短くなり、姿勢演算の精度を向上させることができる。 As described above, while the conventional posture calculation device communicates with the external device to acquire the first to Nth physical quantity signals and executes the posture calculation, the physical quantity detection device 1 of the present embodiment ( The signal processing circuit 3) executes the attitude calculation based on the first physical quantity signal output by the detection circuit 30 and the second to Nth physical quantity signals acquired from the external device via the MSDA terminal. That is, in the physical quantity detection device 1 (signal processing circuit 3) of the present embodiment, since the detection circuit 30 outputs the first physical quantity signal, it is not necessary to communicate with the external device to acquire the first physical quantity signal. Further, since the detection circuit 30 can generate the first physical quantity signal in parallel with acquiring the second to Nth physical quantity signals from the external device, the first to Nth physical quantity signals are acquired. The time can be shortened. As a result, according to the physical quantity detection device 1 (signal processing circuit 3) of the present embodiment, the cycle of the posture calculation is shorter than in the conventional case, and the accuracy of the posture calculation can be improved.

また、本実施形態の物理量検出装置1では、信号処理回路3は、MISO端子あるいはMOSI端子から第1の物理量信号を出力可能であるとともに、MSDA端子から第2〜第Nの物理量信号を入力可能であるので、MSDA端子から入力される物理量信号を用いて姿勢演算を実行する回路(マスター)として機能することも、姿勢演算に用いられる物
理量信号を出力する回路(スレーブ)として機能することもできる。従って、例えば、第1の信号処理回路3のMSDA端子と第2〜第Nの信号処理回路3の各々のMOSI端子とを電気的に接続することにより、第1の信号処理回路3が第1の物理量信号を生成し、かつ、第2〜第Nの信号処理回路3から第2〜第Nの物理量信号を取得して、姿勢演算を実行する姿勢演算装置を構成することができる。このような姿勢演算装置は、同じ構成のN個の信号処理回路3を用いて実現することができるので、開発コストを削減することができる。
Further, in the physical quantity detection device 1 of the present embodiment, the signal processing circuit 3 can output the first physical quantity signal from the MISO terminal or the MOSI terminal, and can input the second to Nth physical quantity signals from the MSDA terminal. Therefore, it can function as a circuit (master) that executes a physical quantity signal using a physical quantity signal input from the MSDA terminal, or as a circuit (slave) that outputs a physical quantity signal used for a physical quantity calculation. .. Therefore, for example, by electrically connecting the MSDA terminal of the first signal processing circuit 3 and the MOSI terminal of each of the second to Nth signal processing circuits 3, the first signal processing circuit 3 becomes the first. It is possible to configure a posture calculation device that generates the physical quantity signal of the above and acquires the second to Nth physical quantity signals from the second to Nth signal processing circuits 3 to execute the posture calculation. Since such an attitude calculation device can be realized by using N signal processing circuits 3 having the same configuration, the development cost can be reduced.

また、本実施形態の物理量検出装置1(信号処理回路3)によれば、物理量検出素子2を駆動するための駆動信号DRVは、クロック生成回路50が発生させるクロック信号ADCCLK,DSPCLKよりも周波数偏差が小さいので、駆動信号DRVに基づくクロック信号CKFを用いることにより、姿勢演算の精度を向上させることができる。すなわち、本実施形態の物理量検出装置1(信号処理回路3)によれば、相対的に周波数偏差が大きいクロック信号ADCCLKに基づいてサンプリングされた物理量信号を用いた姿勢演算において、相対的に周波数偏差が小さい駆動信号DRVに基づくクロック信号CKFを用いてサンプリング周期(時間積分の周期)Δtを補正することにより、姿勢演算の精度を向上させることができる。 Further, according to the physical quantity detection device 1 (signal processing circuit 3) of the present embodiment, the drive signal DRV for driving the physical quantity detection element 2 has a frequency deviation larger than that of the clock signals ADCCLK and DSPCLK generated by the clock generation circuit 50. Is small, so that the accuracy of the attitude calculation can be improved by using the clock signal CKF based on the drive signal DRV. That is, according to the physical quantity detection device 1 (signal processing circuit 3) of the present embodiment, the frequency deviation is relatively large in the attitude calculation using the physical quantity signal sampled based on the clock signal ADCCLK having a relatively large frequency deviation. The accuracy of the posture calculation can be improved by correcting the sampling period (period of time integration) Δt by using the clock signal CKF based on the drive signal DRV having a small value.

本実施形態によれば、記憶部60(例えば、図14及び図15において、不揮発性メモリー62のアドレス0x04)に記憶される設定情報を変更することにより、第1〜第Nの物理量信号と第1〜第Nの検出軸との対応関係を変更することができるので、汎用性の高い物理量検出装置1(信号処理回路3)を実現することができる。 According to the present embodiment, by changing the setting information stored in the storage unit 60 (for example, the address 0x04 of the non-volatile memory 62 in FIGS. 14 and 15), the first to Nth physical quantity signals and the first physical quantity signal are changed. Since the correspondence with the first to Nth detection axes can be changed, a highly versatile physical quantity detection device 1 (signal processing circuit 3) can be realized.

1−2.変形例
上記の物理量検出装置1(信号処理回路3)では、姿勢演算部40は、第1〜第Nの物理量信号に基づいてクォータニオンを用いて姿勢演算を行い、あるいは、姿勢演算として、第1〜第Nの物理量信号の各々を積分して第1〜第Nの角度を算出するが、姿勢演算部40は、姿勢演算として、第1〜第Nの物理量信号に基づいて回転行列を用いて姿勢演算を行ってもよい。この変形例の物理量検出装置1(信号処理回路3)では、例えば、姿勢演算部40は、3軸の角速度データ(角速度ω,ω,ω)を取得する毎に、記憶部60(不揮発性メモリー62)に記憶されている、第1〜第3の物理量信号とx軸、y軸、z軸との対応関係の設定情報に基づいて、Δtごとに、角速度ω,ω,ωをx軸回りの角速度ω、y軸回りの角速度ω及びz軸回りの角速度ωに変換して式(4)で表される回転行列を計算し、当該回転行列と現在の姿勢ベクトルとの積を計算することにより姿勢ベクトルを更新する。
1-2. Modification example In the above physical quantity detection device 1 (signal processing circuit 3), the attitude calculation unit 40 performs a posture calculation using a quaternion based on the first to Nth physical quantity signals, or as a posture calculation, the first Each of the first to Nth physical quantity signals is integrated to calculate the first to Nth angles, and the attitude calculation unit 40 uses a rotation matrix based on the first to Nth physical quantity signals as the posture calculation. A posture calculation may be performed. In the physical quantity detection device 1 (signal processing circuit 3) of this modification, for example, the attitude calculation unit 40 acquires the three-axis angular velocity data (angular velocity ω 1 , ω 2 , ω 3 ) every time the storage unit 60 ( Based on the setting information of the correspondence between the first to third physical quantity signals and the x-axis, y-axis, and z-axis stored in the non-volatile memory 62), the angular velocities ω 1 , ω 2 , Converting ω 3 into an angular velocity ω x around the x-axis, an angular velocity ω y around the y-axis, and an angular velocity ω z around the z-axis, the rotation matrix represented by the equation (4) is calculated, and the rotation matrix and the current rotation matrix are calculated. The attitude vector is updated by calculating the product with the attitude vector.

Figure 0006808997
Figure 0006808997

また、上記の物理量検出装置1(信号処理回路3)において、姿勢演算部40による姿勢演算を補正するようにしてもよい。図16は、この変形例の物理量検出装置1の機能ブロック図である。図16において、本実施形態の物理量検出装置1(図1)と同様の構成要素には同じ符号を付しており、その説明を省略する。図16に示す変形例の物理量検出装置1は、本実施形態の物理量検出装置1(図1)に対して、補正処理部90が付加された構成である。 Further, in the physical quantity detection device 1 (signal processing circuit 3), the posture calculation by the posture calculation unit 40 may be corrected. FIG. 16 is a functional block diagram of the physical quantity detection device 1 of this modified example. In FIG. 16, the same components as those of the physical quantity detection device 1 (FIG. 1) of the present embodiment are designated by the same reference numerals, and the description thereof will be omitted. The physical quantity detection device 1 of the modified example shown in FIG. 16 has a configuration in which a correction processing unit 90 is added to the physical quantity detection device 1 (FIG. 1) of the present embodiment.

補正処理部90は、加速度検出素子及び地磁気検出素子の少なくとも一方の出力信号に基づいて、姿勢演算部40による姿勢演算を補正する。例えば、加速度検出素子が信号処理回路3の不図示の端子と電気的に接続され、補正処理部90は、当該不図示の端子を介して、加速度検出素子の出力信号を受け取り、当該加速度検出素子の出力信号に基づいて姿勢演算部40による姿勢演算を補正してもよい。また、例えば、補正処理部90は、第1インターフェース回路70あるいは第2インターフェース回路80を介して外部装置から加速度検出素子の出力信号を受け取り、当該加速度検出素子の出力信号に基づいて姿勢演算部40による姿勢演算を補正してもよい。同様に、例えば、地磁気検出素子が信号処理回路3の不図示の端子と電気的に接続され、補正処理部90は、当該不図示の端子を介して、地磁気検出素子の出力信号を受け取り、当該地磁気検出素子の出力信号に基づいて姿勢演算部40による姿勢演算を補正してもよい。また、例えば、補正処理部90は、第1インターフェース回路70あるいは第2インターフェース回路80を介して外部装置から地磁気検出素子の出力信号を受け取り、当該地磁気検出素子の出力信号に基づいて姿勢演算部40による姿勢演算を補正してもよい。 The correction processing unit 90 corrects the posture calculation by the posture calculation unit 40 based on the output signals of at least one of the acceleration detection element and the geomagnetic detection element. For example, the acceleration detection element is electrically connected to a terminal (not shown) of the signal processing circuit 3, and the correction processing unit 90 receives an output signal of the acceleration detection element via the terminal (not shown) and receives the acceleration detection element. The posture calculation by the posture calculation unit 40 may be corrected based on the output signal of. Further, for example, the correction processing unit 90 receives the output signal of the acceleration detection element from the external device via the first interface circuit 70 or the second interface circuit 80, and the attitude calculation unit 40 is based on the output signal of the acceleration detection element. You may correct the attitude calculation by. Similarly, for example, the geomagnetic detection element is electrically connected to a terminal (not shown) of the signal processing circuit 3, and the correction processing unit 90 receives the output signal of the geomagnetic detection element via the terminal (not shown), and the signal processing unit 90 receives the output signal of the geomagnetic detection element. The attitude calculation by the attitude calculation unit 40 may be corrected based on the output signal of the geomagnetic detection element. Further, for example, the correction processing unit 90 receives the output signal of the geomagnetic detection element from the external device via the first interface circuit 70 or the second interface circuit 80, and the attitude calculation unit 40 is based on the output signal of the geomagnetic detection element. You may correct the attitude calculation by.

例えば、補正処理部90は、姿勢演算部40による姿勢演算の結果から重力加速度ベクトルを推定し、加速度検出素子の出力信号から重力加速度ベクトルを算出し、拡張カルマンフィルターを用いて、推定した重力加速度ベクトルと算出した重力加速度ベクトルとの差に基づいて、第1〜第Nの物理量信号の誤差(バイアス)を推定してもよい。また、例えば、補正処理部90は、姿勢演算部40による姿勢演算の結果から地磁気ベクトルを推定し、地磁気検出素子の出力信号から地磁気ベクトルを算出し、拡張カルマンフィルターを用いて、推定した地磁気ベクトルと算出した地磁気ベクトルとの差に基づいて、第1〜第Nの物理量信号の誤差(バイアス)を推定してもよい。そして、姿勢演算部40が、補正処理部90によって推定された誤差(バイアス)が差し引かれた第1〜第Nの物理量信号に基づいて姿勢演算を行うことにより、積分誤差が補正され、姿勢演算の精度が向上する。 For example, the correction processing unit 90 estimates the gravitational acceleration vector from the result of the attitude calculation by the attitude calculation unit 40, calculates the gravitational acceleration vector from the output signal of the acceleration detection element, and uses the extended Kalman filter to estimate the gravitational acceleration. The error (bias) of the first to Nth physical quantity signals may be estimated based on the difference between the vector and the calculated gravitational acceleration vector. Further, for example, the correction processing unit 90 estimates the geomagnetic vector from the result of the attitude calculation by the attitude calculation unit 40, calculates the geomagnetic vector from the output signal of the geomagnetic detection element, and uses the extended Kalman filter to estimate the geomagnetic vector. The error (bias) of the first to Nth physical quantity signals may be estimated based on the difference from the calculated geomagnetic vector. Then, the posture calculation unit 40 corrects the integration error and performs the posture calculation based on the first to Nth physical quantity signals to which the error (bias) estimated by the correction processing unit 90 is subtracted. The accuracy of is improved.

2.姿勢演算装置
図17は、本実施形態の姿勢演算装置の構成例を示す図である。図17に示すように、本実施形態の姿勢演算装置4は、N個の物理量検出装置1−1〜1−Nを備えている。物理量検出装置1−1〜1−Nは、すべて、上述した本実施形態又は変形例の物理量検出装置1であり、各物理量検出装置1−k(k=1〜N)は、物理量検出素子2−k及び信号処理回路3−kを備えている。
2. 2. Posture calculation device FIG. 17 is a diagram showing a configuration example of the posture calculation device of the present embodiment. As shown in FIG. 17, the posture calculation device 4 of the present embodiment includes N physical quantity detection devices 1-1 to 1-N. The physical quantity detecting devices 1-1 to 1-N are all the physical quantity detecting devices 1 of the present embodiment or the modification described above, and each physical quantity detecting device 1-k (k = 1 to N) is a physical quantity detecting element 2. -K and signal processing circuit 3-k are provided.

物理量検出装置1−1(「第1の物理量検出装置」の一例)が備えている信号処理回路3−1のMSCK端子と物理量検出装置1−2〜1−N(「第2〜第Nの物理量検出装置」の一例)の各々が備えている信号処理回路3−2〜3−NのSCLK端子とが電気的に接続されている。また、物理量検出装置1−1が備えている信号処理回路3−1のMSDA端子(「第2の端子」の一例)と物理量検出装置1−2〜1−Nの各々が備えている信号処理回路3−2〜3−NのMOSI端子(「第1の端子」の一例)とが電気的に接続されている。そして、物理量検出装置1−1(信号処理回路3−1の姿勢演算部40(図1参照))が姿勢演算を行う。 The MSCK terminal of the signal processing circuit 3-1 provided in the physical quantity detection device 1-1 (an example of the "first physical quantity detection device") and the physical quantity detection device 1-2-1-N ("the second to Nth" The SCLK terminals of the signal processing circuits 3-2-3N provided in each of the "physical quantity detection devices") are electrically connected. Further, the signal processing provided by each of the MSDA terminal (an example of the "second terminal") of the signal processing circuit 3-1 provided in the physical quantity detection device 1-1 and the physical quantity detection device 1-2 to 1-N. The MOSI terminal (an example of the "first terminal") of the circuit 3-2-3-N is electrically connected. Then, the physical quantity detection device 1-1 (posture calculation unit 40 (see FIG. 1) of the signal processing circuit 3-1) performs the posture calculation.

物理量検出装置1−1(信号処理回路3−1)は、第1インターフェース回路70(図1参照)を介して、ホストである制御装置5と通信する。信号処理回路3−1の第1インターフェース回路70は、SPIインターフェース回路として機能し、マスターである制御装置5は、例えば、図7〜図9に示した通信フォーマットに従い、スレーブである物理量検出装置1−1(信号処理回路3−1)に対して、データの書き込みやデータの読み出しを行い、あるいは、コマンドを送信する。 The physical quantity detection device 1-1 (signal processing circuit 3-1) communicates with the control device 5 which is a host via the first interface circuit 70 (see FIG. 1). The first interface circuit 70 of the signal processing circuit 3-1 functions as an SPI interface circuit, and the master control device 5 is, for example, a slave physical quantity detection device 1 according to the communication formats shown in FIGS. 7 to 9. Data is written or read out to -1 (signal processing circuit 3-1), or a command is transmitted.

また、物理量検出装置1−1(信号処理回路3−1)は、ICインターフェース回路である第2インターフェース回路80(図1参照)を介して、物理量検出装置1−2〜1−Nとそれぞれ通信する。物理量検出装置1−2〜1−Nの各々は、第1インターフェース回路70(図1参照)を介して、物理量検出装置1−1と通信する。信号処理回路3−2〜3−Nの各々において、XCS端子が電源にプルアップされており、第1インターフェース回路70は、ICインターフェース回路として機能する。マスターである物理量検出装置1−1(信号処理回路3−1)は、例えば、図10及び図11に示した通信フォーマットに従い、スレーブである物理量検出装置1−2〜1−N(信号処理回路3−2〜3−N)に対して、データの書き込みやデータの読み出しを行う。 The physical quantity detecting device 1-1 (signal processing circuit 3-1) via a second interface circuit 80 (see FIG. 1) is I 2 C interface circuit, and a physical quantity detecting device 1-2 to 1-N Communicate with each other. Each of the physical quantity detecting devices 1-2 to 1-N communicates with the physical quantity detecting device 1-1 via the first interface circuit 70 (see FIG. 1). In each of the signal processing circuit 3-2 to 3-N, XCS terminal is pulled up to the power supply, the first interface circuit 70 functions as an I 2 C interface circuit. The master physical quantity detection device 1-1 (signal processing circuit 3-1) is, for example, a slave physical quantity detection device 1-2-1 to N (signal processing circuit) according to the communication formats shown in FIGS. 10 and 11. Data is written and data is read for 3-2-3-N).

なお、物理量検出装置1−1から視たとき、制御装置5は、前述の「第1の外部装置」に相当し、物理量検出装置1−2〜1−Nは、前述の「第2の外部装置」〜「第Nの外部装置」に相当する。 When viewed from the physical quantity detection device 1-1, the control device 5 corresponds to the above-mentioned "first external device", and the physical quantity detection device 1-2-1-N corresponds to the above-mentioned "second external device". Corresponds to "device" to "Nth external device".

制御装置5は、姿勢演算装置4から、第1〜第Nの物理量信号の値(角速度ω〜ω)や姿勢の情報(クォータニオンあるいは第1〜第Nの角度等)を取得することができる。 The control device 5 can acquire the values of the first to Nth physical quantity signals (angular velocity ω 1 to ω N ) and the attitude information (quaternion, the first to Nth angles, etc.) from the attitude calculation device 4. it can.

例えば、N=3のケースにおいて、物理量検出装置1−1の信号処理回路3−1の記憶部60(レジスター61及び不揮発性メモリー62)が図12〜図15に示したアドレスマップのように構成されている場合、制御装置5が姿勢演算装置4から第1〜第3の物理量信号の値(角速度ω,ω,ω)を所定の周期Δtで取得するための手順は以下のようになる。 For example, in the case of N = 3, the storage unit 60 (register 61 and non-volatile memory 62) of the signal processing circuit 3-1 of the physical quantity detection device 1-1 is configured as shown in the address maps shown in FIGS. 12 to 15. If this is the case, the procedure for the control device 5 to acquire the values (angular velocities ω 1 , ω 2 , ω 3 ) of the first to third physical quantity signals from the attitude calculation device 4 in a predetermined period Δt is as follows. become.

まず、制御装置5は、図7に示した通信フォーマットに従い、信号処理回路3−1のレジスター61のアドレス0x11のビット2(MCTL[2])とビット1(MCTL[1])にともに1を書き込み、第2インターフェース回路80のマニュアル動作を「読み出し」と「許可」に設定する。 First, the control device 5 sets 1 for both bit 2 (MCTL [2]) and bit 1 (MCTL [1]) at address 0x11 of the register 61 of the signal processing circuit 3-1 according to the communication format shown in FIG. Write and set the manual operation of the second interface circuit 80 to "read" and "permit".

また、制御装置5は、図7に示した通信フォーマットに従い、信号処理回路3−1のレジスター61のアドレス0x16のビット7〜0(レジスターMI2CRAD[7:0])に0x0Aを書き込み、信号処理回路3−1の第2インターフェース回路80のマニュアル動作による通信で用いられるレジスターアドレス(図10及び図11のレジスターアドレスMI2CRAD[7:0])を0x0Aに設定する。 Further, the control device 5 writes 0x0A to bits 7 to 0 (register MI2CRAD [7: 0]) at the address 0x16 of the register 61 of the signal processing circuit 3-1 according to the communication format shown in FIG. 7, and the signal processing circuit The register address (register address MI2CRAD [7: 0] in FIGS. 10 and 11) used in the communication by the manual operation of the second interface circuit 80 of 3-1 is set to 0x0A.

次に、制御装置5は、周期Δtで、図8に示した通信フォーマットに従い、信号処理回路3−1のレジスター61のアドレス0x0A(レジスターRDGR)から第1の物理量信号(角速度ω)を読み出して取得する。 Next, the control device 5 reads the first physical quantity signal (angular velocity ω 1 ) from the address 0x0A (register RDGR) of the register 61 of the signal processing circuit 3-1 according to the communication format shown in FIG. 8 in the period Δt. To get.

また、制御装置5は、周期Δtで、図7に示した通信フォーマットに従い、信号処理回路3−1のレジスター61のアドレス0x15のビット6〜0(レジスターMI2CSAD[6:0])に物理量検出装置1−2のスレーブアドレスを書き込んだ後、図9に示した通信フォーマットに従い、当該レジスター61のアドレス0x14(レジスターMI2CST)を指定して、信号処理回路3−1の第2インターフェース回路80のマニュアル動作を開始させるためのコマンドを送信する。これにより、物理量検出装置1−1(信号処理回路3−1)は、周期Δtで、図11に示した通信フォーマットに従い、物理量検出装置1−2(信号処理回路3−2)のレジスター61のアドレス0x0Aから第2の物理量信号(角速度ω)を読み出して自身のレジスター61のアドレス0x18(レジスターMI2CRD)に記憶する。 Further, the control device 5 has a period Δt, and according to the communication format shown in FIG. 7, the physical quantity detection device is set to bits 6 to 0 (register MI2CSAS [6: 0]) at the address 0x15 of the register 61 of the signal processing circuit 3-1. After writing the slave address of 1-2, the address 0x14 (register MI2CST) of the register 61 is specified according to the communication format shown in FIG. 9, and the manual operation of the second interface circuit 80 of the signal processing circuit 3-1 is performed. Send a command to start. As a result, the physical quantity detection device 1-1 (signal processing circuit 3-1) has a period Δt, and according to the communication format shown in FIG. 11, the register 61 of the physical quantity detection device 1-2 (signal processing circuit 3-2) The second physical quantity signal (angle velocity ω 2 ) is read from the address 0x0A and stored in the address 0x18 (register MI2CRD) of its own register 61.

そして、制御装置5は、周期Δtで、図8に示した通信フォーマットに従い、信号処理回路3−1のレジスター61のアドレス0x18(レジスターRDGR)から第2の物理量信号(角速度ω)を読み出して取得する。 Then, the control device 5 reads the second physical quantity signal (angular velocity ω 2 ) from the address 0x18 (register RDGR) of the register 61 of the signal processing circuit 3-1 according to the communication format shown in FIG. 8 in the period Δt. get.

また、制御装置5は、周期Δtで、図7に示した通信フォーマットに従い、信号処理回路3−1のレジスター61のアドレス0x15のビット6〜0(レジスターMI2CSAD[6:0])に物理量検出装置1−3のスレーブアドレスを書き込んだ後、図9に示した通信フォーマットに従い、当該レジスター61のアドレス0x14(レジスターMI2CST)を指定して、信号処理回路3−1の第2インターフェース回路80のマニュアル動作を開始させるためのコマンドを送信する。これにより、物理量検出装置1−1(信号処理回路3−1)は、周期Δtで、図11に示した通信フォーマットに従い、物理量検出装置1−3(信号処理回路3−3)のレジスター61のアドレス0x0Aから第3の物理量信号(角速度ω)を読み出して自身のレジスター61のアドレス0x18(レジスターMI2CRD)に記憶する。 Further, the control device 5 has a period Δt, and according to the communication format shown in FIG. 7, the physical quantity detection device is set to bits 6 to 0 (register MI2CSAS [6: 0]) at the address 0x15 of the register 61 of the signal processing circuit 3-1. After writing the slave addresses of 1-3, the address 0x14 (register MI2CST) of the register 61 is specified according to the communication format shown in FIG. 9, and the manual operation of the second interface circuit 80 of the signal processing circuit 3-1 is performed. Send a command to start. As a result, the physical quantity detection device 1-1 (signal processing circuit 3-1) has a period Δt, and the register 61 of the physical quantity detection device 1-3 (signal processing circuit 3-3) follows the communication format shown in FIG. The third physical quantity signal (angle velocity ω 3 ) is read from the address 0x0A and stored in the address 0x18 (register MI2CRD) of its own register 61.

そして、制御装置5は、周期Δtで、図8に示した通信フォーマットに従い、信号処理回路3−1のレジスター61のアドレス0x18(レジスターRDGR)から第3の物理量信号(角速度ω)を読み出して取得する。 Then, the control device 5 reads the third physical quantity signal (angular velocity ω 3 ) from the address 0x18 (register RDGR) of the register 61 of the signal processing circuit 3-1 according to the communication format shown in FIG. 8 in the period Δt. get.

また、例えば、N=3のケースにおいて、物理量検出装置1−1の信号処理回路3−1の記憶部60(レジスター61及び不揮発性メモリー62)が図12〜図15に示したアドレスマップのように構成されている場合、制御装置5が姿勢演算装置4から姿勢の情報を所定の周期Δtで取得するための手順は以下のようになる。 Further, for example, in the case of N = 3, the storage unit 60 (register 61 and non-volatile memory 62) of the signal processing circuit 3-1 of the physical quantity detection device 1-1 is like the address map shown in FIGS. 12 to 15. In the case of the above configuration, the procedure for the control device 5 to acquire the posture information from the posture calculation device 4 at a predetermined period Δt is as follows.

まず、制御装置5は、図7に示した通信フォーマットに従い、信号処理回路3−1のレジスター61のアドレス0x11のビット0(MCTL[0])に1を書き込み、姿勢演算部40による姿勢演算を許可する。 First, the control device 5 writes 1 to bit 0 (MCTL [0]) of the address 0x11 of the register 61 of the signal processing circuit 3-1 according to the communication format shown in FIG. 7, and the attitude calculation unit 40 performs the attitude calculation. To give permission.

これにより、物理量検出装置1−1(信号処理回路3−1)は、周期Δtで、図11に示した通信フォーマットに従い、物理量検出装置1−2(信号処理回路3−2)のレジスター61のアドレス0x0Aから第2の物理量信号(角速度ω)を読み出して自身の記憶部60(レジスター61)に記憶する。なお、あらかじめ、信号処理回路3−1の不揮発性メモリー62において、アドレス0x00(メモリーMI2CSA1)には物理量検出装置1−2のスレーブアドレスが記憶され、アドレス0x02(メモリーMI2CRA1)には0x0Aが記憶されており、信号処理回路3−1は、これらの情報を用いて、第2の物理量信号(角速度ω)を読み出す。 As a result, the physical quantity detection device 1-1 (signal processing circuit 3-1) has a period Δt, and according to the communication format shown in FIG. 11, the register 61 of the physical quantity detection device 1-2 (signal processing circuit 3-2) The second physical quantity signal (angular velocity ω 2 ) is read from the address 0x0A and stored in its own storage unit 60 (register 61). In the non-volatile memory 62 of the signal processing circuit 3-1 in advance, the slave address of the physical quantity detection device 1-2 is stored in the address 0x00 (memory MI2CSA1), and 0x0A is stored in the address 0x02 (memory MI2CRA1). The signal processing circuit 3-1 uses this information to read out the second physical quantity signal (angle velocity ω 2 ).

また、物理量検出装置1−1(信号処理回路3−1)は、周期Δtで、図11に示した通信フォーマットに従い、物理量検出装置1−3(信号処理回路3−3)のレジスター61のアドレス0x0Aから第3の物理量信号(角速度ω)を読み出して自身の記憶部60(レジスター61)に記憶する。なお、あらかじめ、信号処理回路3−1の不揮発性メモリー62において、アドレス0x01(メモリーMI2CSA2)には物理量検出装置1−3のスレーブアドレスが記憶され、アドレス0x03(メモリーMI2CRA2)には0x0Aが記憶されており、信号処理回路3−1は、これらの情報を用いて、第3の物理量信号(角速度ω)を読み出す。 Further, the physical quantity detection device 1-1 (signal processing circuit 3-1) has a period Δt and according to the communication format shown in FIG. 11, the address of the register 61 of the physical quantity detection device 1-3 (signal processing circuit 3-3). A third physical quantity signal (angular velocity ω 3 ) is read from 0x0A and stored in its own storage unit 60 (register 61). In the non-volatile memory 62 of the signal processing circuit 3-1 in advance, the slave address of the physical quantity detection device 1-3 is stored in the address 0x01 (memory MI2CSA2), and 0x0A is stored in the address 0x03 (memory MI2CRA2). The signal processing circuit 3-1 uses this information to read out a third physical quantity signal (angular velocity ω 3 ).

そして、信号処理回路3−1の姿勢演算部40は、周期Δtで、検出回路30から第1の物理量信号(角速度ω)を取得し、また、それぞれ周期Δtで、記憶部60(レジスター61)から第2の物理量信号(角速度ω)及び第3の物理量信号(角速度ω)を取得し、姿勢演算を行い、姿勢演算の結果の情報をレジスター61のアドレス0x12(
レジスターRDAR)に記憶する。なお、信号処理回路3−1の姿勢演算部40は、不揮発性メモリー62のアドレス0x04のビット1〜0(AXISCTL[1:0])に応じて、第1〜第3の物理量信号(角速度ω,ω,ω)を3軸角速度ω,ω,ωに変換し、不揮発性メモリー62のアドレス0x04のビット2(AXISCTL[2])の設定に応じて、姿勢演算として角度演算又はクォータニオン演算を行う。
Then, the attitude calculation unit 40 of the signal processing circuit 3-1 acquires the first physical quantity signal (angular velocity ω 1 ) from the detection circuit 30 in the period Δt, and the storage unit 60 (register 61) in the period Δt, respectively. ), The second physical quantity signal (angular velocity ω 2 ) and the third physical quantity signal (angular velocity ω 3 ) are acquired, the posture calculation is performed, and the information of the result of the posture calculation is sent to the address 0x12 (register 61) of the register 61.
Store in register RDAR). The attitude calculation unit 40 of the signal processing circuit 3-1 has a first to third physical quantity signal (angular velocity ω) according to bits 1 to 0 (AXISCTL [1: 0]) of the address 0x04 of the non-volatile memory 62. 1 , ω 2 , ω 3 ) is converted into triaxial angular velocities ω x , ω y , ω z , and the angle is used as a posture calculation according to the setting of bit 2 (AXISCTL [2]) at address 0x04 of the non-volatile memory 62. Performs arithmetic or quaternion arithmetic.

次に、制御装置5は、周期Δtで、図8に示した通信フォーマットに従い、信号処理回路3−1のレジスター61のアドレス0x12(レジスターRDAR)から姿勢演算の結果を読み出して取得する。 Next, the control device 5 reads and acquires the result of the attitude calculation from the address 0x12 (register RDAR) of the register 61 of the signal processing circuit 3-1 according to the communication format shown in FIG. 8 in the period Δt.

図18に、物理量検出装置1−1(信号処理回路3−1)における姿勢演算のタイムチャートの一例を示す。図18に示すように、物理量検出装置1−1(信号処理回路3−1)において、姿勢演算部40は、第1の物理量信号(角速度ω)を検出回路30から取得するため、第2インターフェース回路80を介して第1の物理量信号(角速度ω)を取得する必要がない。そのため、本実施形態の姿勢演算装置4では、姿勢演算の周期Δtは、物理量検出装置1−1(信号処理回路3−1)が、第2インターフェース回路80を介して、物理量検出装置1−2(信号処理回路3−2)及び物理量検出装置1−3(信号処理回路3−3)からそれぞれ第2の物理量信号(角速度ω)及び第3の物理量信号(角速度ω)を取得するのに要する通信時間によって決まる。これに対して、従来の姿勢演算システムでは、ホストである制御装置5が、物理量検出装置1−1〜1−3からそれぞれ第1〜第3の物理量信号(角速度ω,ω,ω)を取得して姿勢演算を行うため、姿勢演算の周期Δtは、制御装置5が、物理量検出装置1−1〜1−3(信号処理回路3−2)及び物理量検出装置1−3(信号処理回路3−3)から第1〜第3の物理量信号(角速度ω,ω,ω)を取得するのに要する通信時間よりも短くすることができない。すなわち、本実施形態の姿勢演算装置4は、従来の姿勢演算システムよりも短い周期(高いレート)で姿勢演算を行うことができる。 FIG. 18 shows an example of a time chart of attitude calculation in the physical quantity detection device 1-1 (signal processing circuit 3-1). As shown in FIG. 18, in the physical quantity detection device 1-1 (signal processing circuit 3-1), the attitude calculation unit 40 acquires the first physical quantity signal (angular velocity ω 1 ) from the detection circuit 30, so that it is second. It is not necessary to acquire the first physical quantity signal (angular velocity ω 1 ) via the interface circuit 80. Therefore, in the attitude calculation device 4 of the present embodiment, the physical quantity detection device 1-1 (signal processing circuit 3-1) sets the physical quantity detection device 1-2 via the second interface circuit 80 in the posture calculation cycle Δt. The second physical quantity signal (angular velocity ω 2 ) and the third physical quantity signal (angular velocity ω 3 ) are acquired from (signal processing circuit 3-2) and physical quantity detection device 1-3 (signal processing circuit 3-3), respectively. It depends on the communication time required for. On the other hand, in the conventional posture calculation system, the control device 5 which is the host receives the first to third physical quantity signals (angular velocity ω 1 , ω 2 , ω 3) from the physical quantity detection devices 1-1 to 1-3, respectively. ) Is acquired and the posture calculation is performed. Therefore, the control device 5 sets the physical quantity detection device 1-1 to 1-3 (signal processing circuit 3-2) and the physical quantity detection device 1-3 (signal) in the posture calculation cycle Δt. It cannot be shorter than the communication time required to acquire the first to third physical quantity signals (angular velocities ω 1 , ω 2 , ω 3 ) from the processing circuit 3-3). That is, the posture calculation device 4 of the present embodiment can perform posture calculation with a shorter cycle (higher rate) than the conventional posture calculation system.

以上に説明したように、本実施形態によれば、物理量検出装置1−1が備える信号処理回路3−1が第1の物理量信号を生成し、かつ、MSDA端子を介して、物理量検出装置1−2〜1−Nがそれぞれ備える信号処理回路3−1〜3−NのMOSI端子から出力される第2〜第Nの物理量信号を取得して、姿勢演算を実行する姿勢演算装置4を構成することができる。 As described above, according to the present embodiment, the signal processing circuit 3-1 included in the physical quantity detection device 1-1 generates the first physical quantity signal, and the physical quantity detection device 1 is transmitted via the MSDA terminal. A posture calculation device 4 is configured to acquire the second to second physical quantity signals output from the MOSI terminals of the signal processing circuits 3-1 to 3-N included in each of −2 to 1-N and execute the posture calculation. can do.

そして、本実施形態の姿勢演算装置4では、物理量検出装置1−1が備える信号処理回路3−1は、外部装置と通信して第1の物理量信号を取得する必要がなく、また、物理量検出装置1−2〜1−Nがそれぞれ備える信号処理回路3−2〜3−Nから第2〜第Nの物理量信号を取得するのと並行して、検出回路30が第1の物理量信号を生成することができるので、第1〜第Nの物理量信号を取得する時間を短くすることができる。その結果、本実施形態の姿勢演算装置4によれば、従来よりも姿勢演算の周期Δtが短くなり、姿勢演算の精度を向上させることができる。 In the attitude calculation device 4 of the present embodiment, the signal processing circuit 3-1 included in the physical quantity detection device 1-1 does not need to communicate with the external device to acquire the first physical quantity signal, and the physical quantity detection The detection circuit 30 generates the first physical quantity signal in parallel with acquiring the second and second physical quantity signals from the signal processing circuits 3-2-3 N provided by the devices 1-2 to 1-N, respectively. Therefore, the time for acquiring the first to Nth physical quantity signals can be shortened. As a result, according to the posture calculation device 4 of the present embodiment, the posture calculation cycle Δt is shorter than in the conventional case, and the accuracy of the posture calculation can be improved.

また、本実施形態の姿勢演算装置4は、同じ構成のN個の物理量検出装置を用いて実現することができるので、開発コストを削減することができる。 Further, since the posture calculation device 4 of the present embodiment can be realized by using N physical quantity detection devices having the same configuration, the development cost can be reduced.

3.電子機器
図19は、本実施形態の電子機器の構成の一例を示す機能ブロック図である。図19に示すように、本実施形態の電子機器300は、姿勢演算装置310、制御装置(MCU)320、操作部330、ROM(Read Only Memory)340、RAM(Random Access Memory)350、通信部360、表示部370を含んで構成されている。なお、本実施形態の電子機器は、図19の構成要素(各部)の一部を省略又は変更し、あるいは、他の構成
要素を付加した構成としてもよい。
3. 3. Electronic device FIG. 19 is a functional block diagram showing an example of the configuration of the electronic device of the present embodiment. As shown in FIG. 19, the electronic device 300 of the present embodiment includes an attitude calculation device 310, a control device (MCU) 320, an operation unit 330, a ROM (Read Only Memory) 340, a RAM (Random Access Memory) 350, and a communication unit. It is configured to include 360 and a display unit 370. The electronic device of the present embodiment may have a configuration in which some of the constituent elements (each part) of FIG. 19 are omitted or changed, or other constituent elements are added.

姿勢演算装置310は、第1〜第Nの物理量信号に基づいて姿勢演算を行い、姿勢演算の結果を制御装置(MCU)320に出力する。姿勢演算装置310として、例えば、上述した本実施形態の姿勢演算装置4を適用することができる。 The posture calculation device 310 performs a posture calculation based on the first to Nth physical quantity signals, and outputs the result of the posture calculation to the control device (MCU) 320. As the posture calculation device 310, for example, the posture calculation device 4 of the present embodiment described above can be applied.

制御装置(MCU)320は、ROM340等に記憶されているプログラムに従い、姿勢演算装置310に通信信号を発信し、姿勢演算装置310の出力信号を用いて各種の計算処理や制御処理を行う。その他、制御装置(MCU)320は、操作部330からの操作信号に応じた各種の処理、外部装置とデータ通信を行うために通信部360を制御する処理、表示部370に各種の情報を表示させるための表示信号を送信する処理等を行う。 The control device (MCU) 320 transmits a communication signal to the attitude calculation device 310 according to a program stored in the ROM 340 or the like, and performs various calculation processes and control processes using the output signal of the attitude calculation device 310. In addition, the control device (MCU) 320 performs various processes according to the operation signal from the operation unit 330, processes for controlling the communication unit 360 for data communication with the external device, and displays various information on the display unit 370. Performs processing such as transmitting a display signal for making the display signal.

操作部330は、操作キーやボタンスイッチ等により構成される入力装置であり、ユーザーによる操作に応じた操作信号を制御装置(MCU)320に出力する。 The operation unit 330 is an input device composed of operation keys, button switches, and the like, and outputs an operation signal corresponding to the operation by the user to the control device (MCU) 320.

ROM340は、制御装置(MCU)320が各種の計算処理や制御処理を行うためのプログラムやデータ等を記憶している。 The ROM 340 stores programs, data, and the like for the control device (MCU) 320 to perform various calculation processes and control processes.

RAM350は、制御装置(MCU)320の作業領域として用いられ、ROM340から読み出されたプログラムやデータ、操作部330から入力されたデータ、制御装置(MCU)320が各種プログラムに従って実行した演算結果等を一時的に記憶する。 The RAM 350 is used as a work area of the control device (MCU) 320, and includes programs and data read from the ROM 340, data input from the operation unit 330, calculation results executed by the control device (MCU) 320 according to various programs, and the like. Is temporarily memorized.

通信部360は、制御装置(MCU)320と外部装置との間のデータ通信を成立させるための各種制御を行う。 The communication unit 360 performs various controls for establishing data communication between the control device (MCU) 320 and the external device.

表示部370は、LCD(Liquid Crystal Display)等により構成される表示装置であり、CPU320から入力される表示信号に基づいて各種の情報を表示する。表示部370には操作部330として機能するタッチパネルが設けられていてもよい。 The display unit 370 is a display device composed of an LCD (Liquid Crystal Display) or the like, and displays various information based on a display signal input from the CPU 320. The display unit 370 may be provided with a touch panel that functions as an operation unit 330.

姿勢演算装置310として、例えば上述した本実施形態の姿勢演算装置4を適用することにより、姿勢演算の精度を向上させることができるので、信頼性の高い電子機器を実現することができる。 By applying, for example, the posture calculation device 4 of the present embodiment described above as the posture calculation device 310, the accuracy of the posture calculation can be improved, so that a highly reliable electronic device can be realized.

このような電子機器300としては種々の電子機器が考えられ、例えば、パーソナルコンピューター(例えば、モバイル型パーソナルコンピューター、ラップトップ型パーソナルコンピューター、タブレット型パーソナルコンピューター)、スマートフォンや携帯電話機などの移動体端末、デジタルカメラ、インクジェット式吐出装置(例えば、インクジェットプリンター)、ルーターやスイッチなどのストレージエリアネットワーク機器、ローカルエリアネットワーク機器、移動体端末基地局用機器、テレビ、ビデオカメラ、ビデオレコーダー、カーナビゲーション装置、リアルタイムクロック装置、ページャー、電子手帳(通信機能付も含む)、電子辞書、電卓、電子ゲーム機器、ゲーム用コントローラー、ワードプロセッサー、ワークステーション、テレビ電話、防犯用テレビモニター、電子双眼鏡、POS端末、医療機器(例えば電子体温計、血圧計、血糖計、心電図計測装置、超音波診断装置、電子内視鏡)、魚群探知機、各種測定機器、計器類(例えば、車両、航空機、船舶の計器類)、フライトシミュレーター、ヘッドマウントディスプレイ、モーショントレース、モーショントラッキング、モーションコントローラー、PDR(歩行者位置方位計測)等が挙げられる。 Various electronic devices can be considered as such an electronic device 300, for example, a personal computer (for example, a mobile personal computer, a laptop personal computer, a tablet personal computer), a mobile terminal such as a smartphone or a mobile phone, and the like. Digital cameras, inkjet ejection devices (for example, inkjet printers), storage area network devices such as routers and switches, local area network devices, mobile terminal base station devices, televisions, video cameras, video recorders, car navigation devices, real-time Clock devices, pagers, electronic notebooks (including those with communication functions), electronic dictionaries, calculators, electronic game devices, game controllers, word processors, workstations, videophones, security TV monitors, electronic binoculars, POS terminals, medical devices ( For example, electronic thermometer, blood pressure monitor, blood glucose meter, electrocardiogram measuring device, ultrasonic diagnostic device, electronic endoscope), fish finder, various measuring devices, instruments (for example, instruments for vehicles, aircraft, ships), flight simulator. , Head mount display, motion trace, motion tracking, motion controller, PDR (pedestrian position and orientation measurement) and the like.

図20は、本実施形態の電子機器300の一例であるデジタルカメラ1300を模式的に示す斜視図である。なお、図20には、外部機器との接続についても簡易的に示してい
る。ここで、通常のカメラは、被写体の光像により銀塩写真フィルムを感光するのに対し、デジタルカメラ1300は、被写体の光像をCCD(Charge Coupled Device)などの撮像素子により光電変換して撮像信号(画像信号)を生成する。
FIG. 20 is a perspective view schematically showing a digital camera 1300 which is an example of the electronic device 300 of the present embodiment. Note that FIG. 20 also briefly shows the connection with an external device. Here, while a normal camera sensitizes a silver halide photographic film by the light image of the subject, the digital camera 1300 performs photoelectric conversion of the light image of the subject by an image sensor such as a CCD (Charge Coupled Device) and captures the image. Generate a signal (image signal).

デジタルカメラ1300におけるケース(ボディー)1302の背面には、表示部1310が設けられ、CCDによる撮像信号に基づいて表示を行う構成になっており、表示部1310は、被写体を電子画像として表示するファインダーとして機能する。また、ケース1302の正面側(図中裏面側)には、光学レンズ(撮像光学系)やCCDなどを含む受光ユニット1304が設けられている。撮影者が表示部1310に表示された被写体像を確認し、シャッターボタン1306を押下すると、その時点におけるCCDの撮像信号が、メモリー1308に転送・格納される。また、このデジタルカメラ1300においては、ケース1302の側面に、ビデオ信号出力端子1312と、データ通信用の入出力端子1314とが設けられている。そして、ビデオ信号出力端子1312には、テレビモニター1430が、データ通信用の入出力端子1314には、パーソナルコンピューター1440が、それぞれ必要に応じて接続される。さらに、所定の操作により、メモリー1308に格納された撮像信号が、テレビモニター1430や、パーソナルコンピューター1440に出力される構成になっている。デジタルカメラ1300は、姿勢演算装置310を有し、姿勢演算装置310の出力信号を用いて、例えば手振れ補正等の処理を行う。 A display unit 1310 is provided on the back surface of the case (body) 1302 of the digital camera 1300, and is configured to display based on an image pickup signal by a CCD. The display unit 1310 is a finder that displays a subject as an electronic image. Functions as. Further, on the front side (back side in the drawing) of the case 1302, a light receiving unit 1304 including an optical lens (imaging optical system), a CCD, and the like is provided. When the photographer confirms the subject image displayed on the display unit 1310 and presses the shutter button 1306, the image pickup signal of the CCD at that time is transferred and stored in the memory 1308. Further, in the digital camera 1300, a video signal output terminal 1312 and an input / output terminal 1314 for data communication are provided on the side surface of the case 1302. A television monitor 1430 is connected to the video signal output terminal 1312, and a personal computer 1440 is connected to the data communication input / output terminal 1314, respectively, as needed. Further, the imaging signal stored in the memory 1308 is output to the television monitor 1430 or the personal computer 1440 by a predetermined operation. The digital camera 1300 has a posture calculation device 310, and uses the output signal of the posture calculation device 310 to perform processing such as camera shake correction.

4.移動体
図21は、本実施形態の移動体の一例を示す図(上面図)である。図21に示す移動体400は、姿勢演算装置410、コントローラー440,450,460、バッテリー470、ナビゲーション装置480を含んで構成されている。なお、本実施形態の移動体は、図21の構成要素(各部)の一部を省略し、あるいは、他の構成要素を付加した構成としてもよい。
4. The moving body FIG. 21 is a view (top view) showing an example of the moving body of the present embodiment. The mobile body 400 shown in FIG. 21 includes a posture calculation device 410, controllers 440, 450, 460, a battery 470, and a navigation device 480. The moving body of the present embodiment may be configured by omitting a part of the constituent elements (each part) of FIG. 21 or adding other constituent elements.

姿勢演算装置410、コントローラー440,450,460、ナビゲーション装置480は、バッテリー470から供給される電源電圧で動作する。 The attitude arithmetic unit 410, the controllers 440, 450, 460, and the navigation device 480 operate on the power supply voltage supplied from the battery 470.

姿勢演算装置410は、第1〜第Nの物理量信号に基づいて姿勢演算を行い、姿勢演算の結果をコントローラー440,450,460に出力する。 The posture calculation device 410 performs the posture calculation based on the first to Nth physical quantity signals, and outputs the result of the posture calculation to the controllers 440, 450, 460.

コントローラー440,450,460は、それぞれ、姿勢演算装置410の出力信号を用いて、姿勢制御システム、横転防止システム、ブレーキシステム等の各種の制御を行う制御装置である。 The controllers 440, 450, and 460 are control devices that perform various controls such as a posture control system, a rollover prevention system, and a brake system, respectively, using the output signals of the posture calculation device 410.

ナビゲーション装置480は、内蔵のGPS受信機(不図示)の出力情報に基づき、移動体400の位置や時刻その他の各種の情報をディスプレイに表示する。また、ナビゲーション装置480は、GPSの電波が届かない時でも姿勢演算装置410の出力信号に基づいて移動体400の位置や向きを特定し、必要な情報の表示を継続する。 The navigation device 480 displays various information such as the position and time of the mobile body 400 on the display based on the output information of the built-in GPS receiver (not shown). Further, the navigation device 480 identifies the position and orientation of the moving body 400 based on the output signal of the posture calculation device 410 even when the GPS radio wave does not reach, and continues to display necessary information.

例えば、姿勢演算装置410として、上述した各実施形態の姿勢演算装置4を適用することにより、姿勢演算の精度を向上させることができるので、信頼性の高い移動体を実現することができる。 For example, by applying the posture calculation device 4 of each of the above-described embodiments as the posture calculation device 410, the accuracy of the posture calculation can be improved, so that a highly reliable moving body can be realized.

このような移動体400としては種々の移動体が考えられ、例えば、自動車(電気自動車も含む)、ジェット機やヘリコプター等の航空機、船舶、ロケット、人工衛星等が挙げられる。 Various moving bodies can be considered as such moving bodies 400, and examples thereof include automobiles (including electric vehicles), aircraft such as jet aircraft and helicopters, ships, rockets, and artificial satellites.

本発明は本実施形態に限定されず、本発明の要旨の範囲内で種々の変形実施が可能であ
る。
The present invention is not limited to the present embodiment, and various modifications can be made within the scope of the gist of the present invention.

例えば、上述した実施形態では、角速度を検出する物理量検出素子を含む物理量検出装置(角速度検出装置)並びに当該物理量検出装置(角速度検出装置)を備えた姿勢演算装置、電子機器及び移動体を例に挙げて説明したが、本発明は、種々の物理量を検出する物理量検出素子を含む物理量検出装置並びに当該物理量検出装置を備えた姿勢演算装置、電子機器及び移動体にも適用することができる。物理量検出素子が検出する物理量は、角速度に限らず、角加速度、加速度、地磁気、傾斜などであってもよい。また、物理量検出素子の振動片は、ダブルT型でなくてもよく、例えば、音叉型やくし歯型であってもよいし、三角柱、四角柱、円柱状等の形状の音片型であってもよい。また、物理量検出素子の振動片の材料としては、水晶(SiO2)の代わりに、例えば、タンタル酸リチウム(LiTaO3)、ニオブ酸リチウム(LiNbO3)等の圧電単結晶やジルコン酸チタン酸鉛(PZT)等の圧電セラミックスなどの圧電性材料を用いてもよいし、シリコン半導体を用いてもよい。また、例えば、シリコン半導体の表面の一部に、駆動電極に挟まれた酸化亜鉛(ZnO)、窒化アルミニウム(AlN)等の圧電薄膜を配置した構造であってもよい。また、物理量検出素子は、圧電型の素子に限らず、動電型、静電容量型、渦電流型、光学型、ひずみゲージ型等の振動式の素子であってもよい。あるいは、物理量検出素子の方式は、振動式に限らず、例えば、光学式、回転式、流体式であってもよい。 For example, in the above-described embodiment, a physical quantity detection device (angular velocity detection device) including a physical quantity detection element for detecting an angular velocity, an attitude calculation device provided with the physical quantity detection device (angular velocity detection device), an electronic device, and a moving body are taken as examples. As described above, the present invention can also be applied to a physical quantity detecting device including a physical quantity detecting element for detecting various physical quantities, an attitude calculation device provided with the physical quantity detecting device, an electronic device, and a moving body. The physical quantity detected by the physical quantity detecting element is not limited to the angular velocity, and may be angular acceleration, acceleration, geomagnetism, inclination, or the like. Further, the vibrating piece of the physical quantity detecting element does not have to be a double T type, for example, a tuning fork type or a comb tooth type, or a sound piece type having a shape such as a triangular prism, a square prism, or a columnar prism. May be good. As a material for the vibrating piece of the physical quantity detecting element, instead of crystal (SiO 2 ), for example, a piezoelectric single crystal such as lithium tantalate (LiTaO 3 ) or lithium niobate (LiNbO 3 ) or lead zirconate titanate is used. Piezoelectric materials such as piezoelectric ceramics such as (PZT) may be used, or silicon semiconductors may be used. Further, for example, the structure may be such that a piezoelectric thin film such as zinc oxide (ZnO) or aluminum nitride (AlN) sandwiched between driving electrodes is arranged on a part of the surface of the silicon semiconductor. Further, the physical quantity detecting element is not limited to the piezoelectric type element, and may be a vibration type element such as an electrokinetic type, a capacitance type, an eddy current type, an optical type, or a strain gauge type. Alternatively, the method of the physical quantity detecting element is not limited to the vibration type, and may be, for example, an optical type, a rotary type, or a fluid type.

上述した実施形態および変形例は一例であって、これらに限定されるわけではない。例えば、各実施形態および各変形例を適宜組み合わせることも可能である。 The above-described embodiments and modifications are merely examples, and the present invention is not limited thereto. For example, it is also possible to appropriately combine each embodiment and each modification.

本発明は、実施の形態で説明した構成と実質的に同一の構成(例えば、機能、方法及び結果が同一の構成、あるいは目的及び効果が同一の構成)を含む。また、本発明は、実施の形態で説明した構成の本質的でない部分を置き換えた構成を含む。また、本発明は、実施の形態で説明した構成と同一の作用効果を奏する構成又は同一の目的を達成することができる構成を含む。また、本発明は、実施の形態で説明した構成に公知技術を付加した構成を含む。 The present invention includes a configuration substantially the same as the configuration described in the embodiment (for example, a configuration having the same function, method and result, or a configuration having the same purpose and effect). The present invention also includes a configuration in which a non-essential part of the configuration described in the embodiment is replaced. The present invention also includes a configuration that exhibits the same effects as the configuration described in the embodiment or a configuration that can achieve the same object. The present invention also includes a configuration in which a known technique is added to the configuration described in the embodiment.

1…物理量検出装置、2…物理量検出素子、3…信号処理回路、4…姿勢演算装置、5…制御装置、10…基準電圧回路、20…駆動回路、21…I/V変換回路、22…ローパスフィルター、23…ハイパスフィルター、24…コンパレーター、25…全波整流回路、26…積分器、27…コンパレーター、28…コンパレーター、30…検出回路、31…QVアンプ、32…可変ゲインアンプ、33…同期検波回路、34…A/D変換回路、35…DSP、40…姿勢演算部、41A,41B,41C…Dフリップフロップ、42…NOT回路、43…NOR回路、44…カウンター、45A,45B…乗算器、46…変換部、47…行列演算部、48…加算器、49…正規化部、50…クロック生成回路、60…記憶部、61…レジスター、62…不揮発性メモリー、70…第1インターフェース回路、80…第2インターフェース回路、90…補正処理部、101a,101b…駆動振動腕、102…検出振動腕、103…錘部、104a,104b…駆動用基部、105a,105b…連結腕、106…錘部、107…検出用基部、112,113…駆動電極、114,115…検出電極、116…共通電極、300…電子機器、310…姿勢演算装置、312…駆動回路、320…制御装置(MCU)、330…操作部、340…ROM、350…RAM、360…通信部、370…表示部、400…移動体、410…姿勢演算装置、440,450,460…コントローラー、470…バッテリー、480…ナビゲーション装置、1300…デジタルカメラ、1302…ケース、1304…受光ユニット、1306…シャッターボタン、1308…メモリー、1310…表示部、1312…ビデオ信号出力端子、1314…入出力端子、1430…テレビモニター、1440…パーソナルコンピューター 1 ... Physical quantity detection device, 2 ... Physical quantity detection element, 3 ... Signal processing circuit, 4 ... Attitude calculation device, 5 ... Control device, 10 ... Reference voltage circuit, 20 ... Drive circuit, 21 ... I / V conversion circuit, 22 ... Low-pass filter, 23 ... high-pass filter, 24 ... comparator, 25 ... full-wave rectifier circuit, 26 ... integrator, 27 ... comparator, 28 ... comparator, 30 ... detection circuit, 31 ... QV amplifier, 32 ... variable gain amplifier , 33 ... Synchronous detection circuit, 34 ... A / D conversion circuit, 35 ... DSP, 40 ... Attitude calculation unit, 41A, 41B, 41C ... D flip flop, 42 ... NOT circuit, 43 ... NOR circuit, 44 ... Counter, 45A , 45B ... Multiplier, 46 ... Conversion unit, 47 ... Matrix calculation unit, 48 ... Adder, 49 ... Normalization unit, 50 ... Clock generation circuit, 60 ... Storage unit, 61 ... Register, 62 ... Non-volatile memory, 70 ... 1st interface circuit, 80 ... 2nd interface circuit, 90 ... Correction processing unit, 101a, 101b ... Drive vibration arm, 102 ... Detection vibration arm, 103 ... Weight part, 104a, 104b ... Drive base, 105a, 105b ... Connecting arm, 106 ... Weight, 107 ... Detection base, 112, 113 ... Drive electrode, 114, 115 ... Detection electrode, 116 ... Common electrode, 300 ... Electronic device, 310 ... Attitude calculation device, 312 ... Drive circuit, 320 ... Control device (MCU), 330 ... Operation unit, 340 ... ROM, 350 ... RAM, 360 ... Communication unit, 370 ... Display unit, 400 ... Moving object, 410 ... Attitude calculation device, 440, 450, 460 ... Controller, 470 ... Battery, 480 ... Navigation device, 1300 ... Digital camera, 1302 ... Case, 1304 ... Light receiving unit, 1306 ... Shutter button, 1308 ... Memory, 1310 ... Display unit, 1312 ... Video signal output terminal, 1314 ... Input / output terminal, 1430 ... TV monitor, 1440 ... Personal computer

Claims (11)

物理量検出素子の出力信号に基づいて第1の物理量信号を生成する検出回路と、
前記物理量検出素子を駆動するための駆動信号を生成する駆動回路と、
前記第1の物理量信号を出力可能な第1の端子と、
第2〜第N(N≧2)の物理量信号を入力可能な第2の端子と、
前記第1〜第Nの物理量信号に基づいて姿勢演算を実行可能な姿勢演算部と、を含み、
前記検出回路は、第1のクロック信号を用いて前記第1の物理量信号を生成し、
前記姿勢演算部は、前記駆動信号に基づく、前記第1のクロック信号よりも周波数偏差が小さい第2のクロック信号を用いて前記姿勢演算を行う、信号処理回路。
A detection circuit that generates a first physical quantity signal based on the output signal of the physical quantity detection element,
A drive circuit that generates a drive signal for driving the physical quantity detection element, and
The first terminal capable of outputting the first physical quantity signal and
A second terminal capable of inputting a second N (N ≧ 2) physical quantity signal, and
See containing and a posture computing unit capable of executing the posture calculated based on the physical quantity signal of the first to N,
The detection circuit uses the first clock signal to generate the first physical quantity signal.
The posture computing unit, based on the drive signal, the frequency deviation than the first clock signal with a smaller second clock signal performs the posture computing, signal processing circuit.
請求項1において、
前記姿勢演算部は、クォータニオンを用いて前記姿勢演算を行う信号処理回路。
In claim 1,
The posture computing unit, line cormorants signal processing circuit the position calculation using the quaternion.
請求項1において、
前記姿勢演算部は、前記姿勢演算として、前記第1〜第Nの物理量信号の各々を積分して第1〜第Nの角度を算出する信号処理回路。
In claim 1,
The posture computing unit, said as posture calculation, the first to N physical quantity signal signal processing circuit each you calculate the angle of the first to N by integrating the.
請求項1において、
前記姿勢演算部は、回転行列を用いて前記姿勢演算を行う信号処理回路。
In claim 1,
The posture computing unit, line cormorants signal processing circuit the position calculation using the rotation matrix.
請求項1乃至4のいずれか一項において、
前記第1〜第Nの物理量信号と第1〜第Nの検出軸との対応関係の設定情報を記憶する記憶部を含み、
前記姿勢演算部は、前記設定情報を用いて前記姿勢演算を行う信号処理回路。
In any one of claims 1 to 4,
A storage unit that stores setting information of the correspondence between the first to Nth physical quantity signals and the first to Nth detection axes is included.
The posture computing unit, line cormorants signal processing circuit the position calculation using the setting information.
請求項1乃至5のいずれか一項において、
前記第1〜第Nの物理量信号の各々は角速度信号である信号処理回路。
In any one of claims 1 to 5,
The first to each of the physical quantity signal of the N angular velocity signal der Ru signal processing circuit.
請求項5又は6において、
加速度検出素子及び地磁気検出素子の少なくとも一方の出力信号に基づいて、前記姿勢演算部による前記姿勢演算を補正する補正処理部を含む信号処理回路。
In claim 5 or 6,
Based on at least one of the output signal of the acceleration detection element and the geomagnetism detection element, the correction processing unit including signal processing circuitry for correcting the orientation calculation by the position calculation unit.
請求項1乃至のいずれか項に記載の信号処理回路と、前記物理量検出素子と、を備えている物理量検出装置。 A signal processing circuit according to any one of claims 1 to 7, wherein the physical quantity detecting device and, physical quantity detecting device have that ones provided with. 請求項に記載の物理量検出装置をN個備え、
第1の前記物理量検出装置が備えている前記信号処理回路の前記第2の端子と、第2〜第Nの前記物理量検出装置の各々が備えている前記信号処理回路の前記第1の端子とが電気的に接続され、
前記第1の前記物理量検出装置が備えている前記信号処理回路の前記姿勢演算部が前記姿勢演算を行う、姿勢演算装置。
The physical quantity detecting device according to claim 8 is provided with N pieces.
The second terminal of the signal processing circuit provided by the first physical quantity detecting device, and the first terminal of the signal processing circuit provided by each of the second to Nth physical quantity detecting devices. Is electrically connected,
The posture computing unit of the signal processing circuit, wherein the first of said physical quantity detecting device comprises performs the posture calculation, attitude computing device.
請求項に記載の姿勢演算装置を備えている、電子機器。 An electronic device including the posture calculation device according to claim 9 . 請求項に記載の姿勢演算装置を備えている、移動体。 A mobile body including the posture calculation device according to claim 9 .
JP2016125419A 2016-06-24 2016-06-24 Signal processing circuit, physical quantity detection device, attitude calculation device, electronic device and mobile body Expired - Fee Related JP6808997B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016125419A JP6808997B2 (en) 2016-06-24 2016-06-24 Signal processing circuit, physical quantity detection device, attitude calculation device, electronic device and mobile body

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016125419A JP6808997B2 (en) 2016-06-24 2016-06-24 Signal processing circuit, physical quantity detection device, attitude calculation device, electronic device and mobile body

Publications (2)

Publication Number Publication Date
JP2017227591A JP2017227591A (en) 2017-12-28
JP6808997B2 true JP6808997B2 (en) 2021-01-06

Family

ID=60889173

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016125419A Expired - Fee Related JP6808997B2 (en) 2016-06-24 2016-06-24 Signal processing circuit, physical quantity detection device, attitude calculation device, electronic device and mobile body

Country Status (1)

Country Link
JP (1) JP6808997B2 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6197347B2 (en) * 2013-04-24 2017-09-20 セイコーエプソン株式会社 Electronic equipment and physical quantity detection device
DE102018222608B4 (en) * 2018-12-20 2021-06-10 Robert Bosch Gmbh System with micromechanical clock-generating system components
WO2023026470A1 (en) * 2021-08-27 2023-03-02 国立大学法人東北大学 Magnetic field sensor and magnetic field detection method
CN113741262A (en) * 2021-08-27 2021-12-03 天津新松智能科技有限公司 Ship control system

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4876204B2 (en) * 2006-01-05 2012-02-15 ヒロボー株式会社 Small attitude sensor
US8250921B2 (en) * 2007-07-06 2012-08-28 Invensense, Inc. Integrated motion processing unit (MPU) with MEMS inertial sensing and embedded digital electronics
JP6221295B2 (en) * 2013-03-28 2017-11-01 セイコーエプソン株式会社 Position calculation method and position calculation apparatus
JP6119978B2 (en) * 2013-04-18 2017-04-26 セイコーエプソン株式会社 Electronic device, integrated circuit, electronic apparatus, and moving object
JP6315185B2 (en) * 2014-03-25 2018-04-25 セイコーエプソン株式会社 Physical quantity detection circuit, physical quantity detection device, electronic device, and moving object
JP2015184158A (en) * 2014-03-25 2015-10-22 セイコーエプソン株式会社 Error estimation method, motion analysis method, error estimation device, and program

Also Published As

Publication number Publication date
JP2017227591A (en) 2017-12-28

Similar Documents

Publication Publication Date Title
JP6834581B2 (en) Physical quantity sensors, electronic devices and mobile objects
JP6828544B2 (en) Failure diagnosis method for sensor element control device, physical quantity sensor, electronic device, mobile body and physical quantity sensor
JP6808997B2 (en) Signal processing circuit, physical quantity detection device, attitude calculation device, electronic device and mobile body
JP7151061B2 (en) FAILURE DETERMINATION CIRCUIT, PHYSICAL QUALITY DETECTION DEVICE, ELECTRONIC DEVICE, MOBILE OBJECT, AND FAILURE DETERMINATION METHOD
US10116275B2 (en) Physical quantity detection circuit, physical quantity detection device, electronic apparatus, and vehicle
JP2016178601A (en) Data processing circuit, circuit for physical quantity detection, physical quantity detection device, electronic equipment, and mobile body
JP2018165641A (en) Failure determination circuit, physical quantity detection device, electronic apparatus, and movable body
JP2021185356A (en) Physical quantity detection circuit, physical quantity detection device, electronic apparatus and moving body
JP7234655B2 (en) Physical quantity detection circuit, physical quantity sensor, electronic device, moving object, and operation method of physical quantity detection circuit
JP7447571B2 (en) Physical quantity detection circuit, physical quantity sensor, electronic equipment, moving object, and operation method of physical quantity detection circuit
JP7491439B2 (en) PHYSICAL QUANTITY DETECTION CIRCUIT, PHYSICAL QUANTITY SENSOR, ELECTRONIC DEVICE, AND MOBILE PHYSICAL QUANTITY SENSOR
JP7456284B2 (en) PHYSICAL QUANTITY DETECTION CIRCUIT, PHYSICAL QUANTITY DETECTION DEV
US9987662B2 (en) Drive circuit, vibrator device, electronic apparatus, and moving object
JP7322718B2 (en) Physical quantity detection circuit, physical quantity sensor, electronic device, moving object, and operation method of physical quantity detection circuit
JP6756175B2 (en) Rectifier circuit, drive circuit, physical quantity detector, electronic device and moving object
JP6521236B2 (en) Physical quantity processing circuit, physical quantity processing device, electronic device and moving body
JP6780467B2 (en) Physical quantity sensors, electronic devices and mobile objects
JP7323015B2 (en) Physical quantity processing circuit, physical quantity detection device, electronic device, and moving object
JP6641874B2 (en) Physical quantity detection device, electronic equipment and moving object
JP6478034B2 (en) Angular velocity detection device evaluation method, signal processing circuit, angular velocity detection device, electronic apparatus, and moving body

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190411

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200324

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200331

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200525

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20201110

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20201123

R150 Certificate of patent or registration of utility model

Ref document number: 6808997

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees