Inertial measuring device
The inertial measurement device uses a relay circuit to time-divisionally output data from multiple units, addressing port and rate limitations, enabling high-precision data synthesis with reduced noise and increased unit count.
Patent Information
- Application Number
- JP2022204119
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2022-12-21
- Publication Date
- 2026-11-11
- Estimated Expiration
- 2042-12-21
AI Technical Summary
Inertial measurement devices face limitations due to insufficient communication ports and decreased data output rates when the number of inertial measurement units is increased, restricting the number of units that can be provided.
The device incorporates a relay circuit that time-divisionally outputs detection data from multiple inertial measurement units to a processing device, allowing for synthesis processing and reducing noise, thereby increasing the number of units without exceeding the communication port limit.
This configuration enables high-precision data output at equivalent rates to individual units, reducing random noise by half and allowing for a higher number of inertial measurement units to be integrated without overwhelming the processing device.
Smart Images

Figure 0007947966000001 
Figure 0007947966000002 
Figure 0007947966000003
Abstract
Description
Technical Field
[0001] The present invention relates to an inertial measurement device and the like.
Background Art
[0002] Patent Document 1 discloses an inertial measurement device having a plurality of inertial measurement units. In the conventional technique of this Patent Document 1, misalignment of three axes X, Y, and Z is corrected for each of the plurality of inertial measurement units, and axis alignment of the inertial measurement units is performed after the correction.
Prior Art Documents
Patent Documents
[0003]
Patent Document 1
Summary of Invention
Problem to be Solved by the Invention
[0004] In such an inertial measurement device, for example, when the number of inertial measurement units is increased, problems occur such as insufficient communication ports of a processing device provided in the inertial measurement device, or a decrease in the data output rate of detection data output from the inertial measurement device. For this reason, there is a problem that the number of inertial measurement units provided in the inertial measurement device is limited.
Means for Solving the Problem
[0005] One aspect of the present disclosure relates to an inertial measurement device including: 1st to n-th inertial measurement units; a relay circuit to which 1st to n-th detection data from the 1st to n-th inertial measurement units are input, and which time-divisionally outputs the 1st to n-th detection data as output data; and a processing device to which the output data from the relay circuit is input, and which performs synthesis processing of the 1st to n-th detection data.
Brief Description of the Drawings
[0006] [Figure 1] An example configuration of the inertial measuring device of this embodiment. [Figure 2] A detailed configuration example of the inertial measuring device of this embodiment. [Figure 3] A specific first configuration example of this embodiment. [Figure 4] A specific first configuration example of this embodiment. [Figure 5] A timing chart illustrating the operation of the first configuration example. [Figure 6] A timing chart illustrating the operation of the first configuration example. [Figure 7] A comparative example of this embodiment. [Figure 8] A specific second configuration example of this embodiment. [Figure 9] A timing chart illustrating the operation of the second configuration example. [Figure 10] A perspective view illustrating an inertial measurement device. [Figure 11] An exploded perspective view illustrating an inertial measurement device. [Figure 12] An example configuration of an inertial measurement unit. [Figure 13] Exploded perspective view of the inertial measurement unit. [Modes for carrying out the invention]
[0007] Preferred embodiments of this disclosure will be described in detail below. These embodiments are not intended to unduly limit the scope of the claims, and not all configurations described in these embodiments are necessarily essential.
[0008] 1. Example of an inertial measurement device configuration Figure 1 shows an example of the configuration of the inertial measurement device 10 of this embodiment. The inertial measurement device 10 includes inertial measurement units 30-1 to 30-n, a relay circuit 40, and a processing device 50. The inertial measurement units 30-1 to 30-n are the first to nth inertial measurement units, where n is an integer of 2 or more.
[0009] The inertial measurement device 10 detects inertial information. Inertial information includes, for example, acceleration data and angular velocity data. The inertial measurement device 10 is a 6-axis inertial measurement device that detects, for example, acceleration in 3 axes and angular velocity in 3 axes. By using this 6DoF (six degrees of freedom) inertial measurement device 10, it becomes possible to detect the attitude of moving objects such as automobiles and robots, their behavior which is their inertial momentum, or vibrations of structures and equipment. However, the amount of inertial information detected by the inertial measurement device 10 and the number of detection axes are not limited to this.
[0010] The inertial measurement device 10 detects inertial information using a plurality of inertial measurement units 30-1 to 30-n. Each of the inertial measurement units 30-1 to 30-n includes, for example, an acceleration sensor device and an angular velocity sensor device. The acceleration sensor device detects acceleration in the X, Y, and Z axes. The acceleration sensor device may be a single device that detects acceleration in all three axes, or multiple acceleration sensor devices may be provided, each detecting one or more axes. The angular velocity sensor device detects angular velocity around the X, Y, and Z axes, for example. In this case, angular velocity sensor devices can be provided for the X axis, the Y axis, and the Z axis. The angular velocity sensor device may be a single device that detects angular velocity in all three axes, or multiple angular velocity sensor devices may be provided, each detecting one or more axes.
[0011] The relay circuit 40 receives detection data D1 to Dn from inertial measurement units 30-1 to 30-n. The relay circuit 40 can also be called a relay device. The detection data D1 to Dn are the first to nth detection data input from the first to nth inertial measurement units. The relay circuit 40 then outputs the detection data D1 to Dn as output data DQ1 in time division. The detection data D1 to Dn is inertial information measured by the inertial measurement units 30-1 to 30-n. Each detection data D1 to Dn includes acceleration data and angular acceleration data detected by each inertial measurement unit 30-1 to 30-n. Each detection data may also include various data such as error detection code data and temperature detection data. Furthermore, communication between each inertial measurement unit and the relay circuit 40 is, for example, serial communication, and each inertial measurement unit 30-1 to 30-n outputs data such as acceleration data and angular velocity data to the relay circuit 40, for example, as serial data. For example, if detection data is input from each inertial measurement unit in the order of detection data D1, D2...Dn, the relay circuit 40 outputs the detection data D1, D2...Dn in that order as output data DQ1 to the processing unit 50. The output order of each detection data from each inertial measurement unit is arbitrary, and for example, each detection data is output in an order corresponding to the detection timing at each inertial measurement unit. That is, each detection data D1 to Dn is input to the relay circuit 40 in the order of the detection timing of the inertial information at each inertial measurement unit 30-1 to 30-n. Then the relay circuit 40 outputs each detection data D1 to Dn as output data DQ1 to the processing unit 50 in the order of that detection timing.
[0012] The processing device 50 receives the output data DQ1 from the relay circuit 40, and performs a combining process on the detection data D1 to Dn. The processing device 50 can also be referred to as a processing circuit. For example, the processing device 50 performs a combining process on the detection data D1 of the inertial measurement unit 30-1, the detection data D2 of the inertial measurement unit 30-2, ..., and the detection data Dn of the inertial measurement unit 30-n. For example, the processing device 50 performs a combining process such as an averaging process on the detection data D1 to Dn input at equivalent timings, and outputs the combined data DQH. The processing device 50 can be implemented by, for example, a processor such as an MPU or a CPU. For example, the processing device 50 is what is called a microcontroller or the like. Alternatively, the processing device 50 may be implemented by an ASIC using automatic placement and routing such as a gate array.
[0013] As described above, in the inertial measurement device 10 of the present embodiment, the detection data D1 to Dn from the inertial measurement units 30-1 to 30-n are input to the relay circuit 40, and the relay circuit 40 time-divisionally outputs the detection data D1 to Dn as output data DQ1. Then, the processing device 50 performs a combining process on the detection data D1 to Dn based on the output data DQ1 from the relay circuit 40. With this configuration, even when the number of communication ports of the processing device 50 is limited, the detection data D1 to Dn from the inertial measurement units 30-1 to 30-n can be time-divisionally input to the processing device 50 as the output data DQ1 via the relay circuit 40. Then, by performing the combining process on the detection data D1 to Dn by the processing device 50, noise in the combined data DQH can be reduced as compared with, for example, a case where detection data from a single inertial measurement unit is used. For example, by performing the combining process on the detection data D1 to Dn of the n inertial measurement units 30-1 to 30-n, the random noise of the combined data DQH is reduced to, for example, 1 / n 1 / 2 can be reduced. Accordingly, it is possible to provide the inertial measurement device 10 that can easily achieve low noise in output data by increasing the number of inertial measurement units provided in the inertial measurement device 10.
[0014] Further, the processing device 50 performs a combining process on first axis detection data included in the detection data D1 to Dn. Further, the processing device 50 performs a combining process on second axis detection data included in the detection data D1 to Dn. The first axis detection data is, for example, acceleration data in the first axis direction or angular velocity data about the first axis, and the second axis detection data is, for example, acceleration data in the second axis direction or angular velocity data about the second axis. The first axis is, for example, one of the X-axis, Y-axis, and Z-axis, and the second axis is an axis other than the first axis among the X-axis, Y-axis, and Z-axis. Further, the processing device 50 performs a combining process on third axis detection data included in the detection data D1 to Dn, for example. The third axis detection data is, for example, acceleration data in the third axis direction or angular velocity data about the third axis. The third axis is an axis other than the first axis and the second axis among the X-axis, Y-axis, and Z-axis. When the detection data D1 to Dn include first axis detection data DA1 to DAn and second axis detection data DB1 to DBn, the processing device 50 performs the combining process on the first axis detection data DA1 to DAn and the combining process on the second axis detection data DB1 to DBn. When the detection data D1 to Dn further include third axis detection data DC1 to DCn, the processing device 50 performs the combining process on the third axis detection data DC1 to DCn. In this way, the combining process of the first axis detection data and the second axis detection data included in the detection data D1 to Dn is performed, so that noise in the first axis detection data and the second axis detection data after the combining process can be reduced. For example, random noise in the first axis detection data and the second axis detection data after the combining process can be reduced to 1 / n 1 / 2
[0015] Further, the combining process performed by the processing device 50 is, for example, an averaging process. For example, the processing device 50 performs an averaging process on the detection data D1 to Dn, and outputs data DQH after the averaging process. For example, the processing device 50 performs an averaging process on the detection data D1 to Dn corresponding to the same detection timing, and outputs the result as the data DQH. The averaging process is, for example, a sum averaging. By performing such an averaging process, the random noise of the data DQH output by the processing device 50 can be reduced to, for example, 1 / n, as compared with a case where detection data from one inertial measurement unit is used, for example. 1 / 2
[0016] As shown in Figure 1, the inertial measurement units 30-1 to 30-n output detection data D1 to Dn at a data output rate RT. The relay circuit 40 then outputs output data DQ1 at a data output rate RTQ = n × RT. The unit of the data output rate is, for example, sps (samples per second), which is the number of sample data per unit time, or 1 second. The sample data of detection data D1 to Dn includes detection data for multiple axes. For example, the sample data of detection data D1 to Dn includes detection data for the first axis, the second axis, and the third axis. When the relay circuit 40 outputs detection data D1 to Dn in time division, it outputs it as output data DQ1 at a data output rate RTQ = n × RT, which is n times the data output rate RT of the inertial measurement units 30-1 to 30-n. In this way, the detected data D1 to Dn can be input to the processing unit 50 as output data DQ1 in a time-division manner at a data output rate RTQ that is n times the data output rate RT of the inertial measurement units 30-1 to 30-n. This makes it possible to input the detected data D1 to Dn, which are the target of synthesis processing in the processing unit 50, to the processing unit 50 at a high data output rate RTQ = n × RT, even if the number of communication ports of the processing unit 50 is limited.
[0017] Furthermore, the data output rate RTQ may be higher than n × RT. That is, it is sufficient that RTQ ≥ n × RT, and the relay circuit 40 can output output data DQ1 when the data output rate RTQ is n × RT or greater.
[0018] Furthermore, the processing unit 50 outputs the combined data DQH at a data output rate RT. For example, the processing unit 50 outputs the combined data DQH of the detected data D1 to Dn at the same data output rate RT as the inertial measurement units 30-1 to 30-n. For example, the processing unit 50 receives the detected data D1 to Dn as time-division output data DQ1 at a data output rate RTQ that is n times the data output rate RT of the inertial measurement units 30-1 to 30-n. Therefore, by performing the combined processing of the detected data D1 to Dn, which are input at a high speed of n times the data output rate RT, the processing unit 50 can output the combined data DQH at the same data output rate RT as the inertial measurement units 30-1 to 30-n. In this way, the noise in the data DQH output from the processing unit 50 can be reduced by the combined processing, and the combined data DQH can be output at a data output rate RT equivalent to that of the inertial measurement units 30-1 to 30-n. Therefore, the synthesized data DQH can be output externally at a data output rate RT corresponding to the performance of the inertial measurement units 30-1 to 30-n. For example, if the data output rate RT of the inertial measurement units 30-1 to 30-n is 2 ksps, and n=3, then the data output rate RTQ of the relay circuit 40 becomes 2 ksps × n = 6 ksps. The processing unit 50 then outputs the synthesized data DQH at a data output rate RT=2 ksps, equivalent to that of the inertial measurement units 30-1 to 30-n.
[0019] Furthermore, the data output rate of the data DQH after synthesis processing by the processing unit 50 is not limited to being the same as the data output rate of the inertial measurement units 30-1 to 30-n, but may be lower than the data output rate of the inertial measurement units 30-1 to 30-n. In other words, the processing unit 50 can output the data DQH after synthesis processing at a data output rate RT or lower. Alternatively, the data output rate of the data DQH can be higher than the data output rate of the inertial measurement units 30-1 to 30-n.
[0020] Figure 2 shows a detailed configuration example of the inertial measurement device 10 of this embodiment. In addition to the configuration in Figure 1, the inertial measurement device 10 in Figure 2 is further provided with inertial measurement units 30-k to 30-m and a relay circuit 41. The data DQH after synthesis processing from the processing device 50 is output to, for example, a host 200. The host 200 is, for example, a PC (personal computer) or microcontroller located outside the inertial measurement device 10. Note that the inertial measurement device 10 of this embodiment is not limited to the configuration in Figure 2, and various modifications can be made, such as omitting some of these components, adding other components, or replacing some components with other components. The same applies to other specific configuration examples described later.
[0021] Inertial measurement units 30-k to 30-m are the kth to mth inertial measurement units. Each inertial measurement unit in inertial measurement units 30-k to 30-m includes, for example, an acceleration sensor device and an angular velocity sensor device. The configuration and operation of inertial measurement units 30-k to 30-m are the same as those of the inertial measurement units 30-1 to 30-n described above, so a detailed explanation is omitted.
[0022] The relay circuit 41 receives detection data Dk to Dm from inertial measurement units 30-k to 30-m and outputs the detection data Dk to Dm as output data DQ2 in a time-division manner. The relay circuit 41 is the second relay circuit and can also be called the second relay device. The detection data Dk to Dm are the kth detection data and the mth detection data input from the kth to the mth inertial measurement units. The output data DQ2 is the second output data. Here, k and m are integers such that mk ≥ 1, for example, k = n + 1. Each detection data in the detection data Dk to Dm includes acceleration data and angular acceleration data detected by each inertial measurement unit 30-k to 30-m. The communication between each inertial measurement unit and the relay circuit 41 is, for example, serial communication. For example, if detection data is input from each inertial measurement unit in the order of detection data Dk, Dk+1...Dm, the relay circuit 41 outputs the detection data Dk, Dk+1...Dm as output data DQ2 in that order. However, the output order of each detection data is arbitrary, and the relay circuit 41 receives each detection data Dk to Dm in the order of the detection timing of the inertial information from each inertial measurement unit 30-k to 30-m. The relay circuit 41 then outputs each detection data Dk to Dm as output data DQ2 in the order of that detection timing. The configuration and operation of the relay circuit 41 are the same as those of the first relay circuit, relay circuit 40, so a detailed explanation is omitted.
[0023] The processing unit 50 receives output data DQ1 and output data DQ2 as input and performs a synthesis process on the detected data D1~Dn and detected data Dk~Dm. This synthesis process is performed by a synthesis processing unit 54 provided in the processing unit 50. For example, the processing unit 50 performs a synthesis process on the detected data D1 from inertial measurement unit 30-1, the detected data D2 from inertial measurement unit 30-2, ... the detected data Dn from inertial measurement unit 30-n, the detected data Dk from inertial measurement unit 30-k, the detected data Dk+1 from inertial measurement unit 30-k+1, ... the detected data Dm from inertial measurement unit 30-m. For example, the processing unit 50 performs synthesis processing such as averaging of the detected data D1~Dn and Dk~Dm that are input at the same timing and outputs the synthesized data DQH.
[0024] Furthermore, the inertial measurement units 30-k to 30-m output detection data Dk to Dm at a data output rate RT. The relay circuit 41 then outputs output data DQ2 at a data output rate RTQ = (m-k+1) × RT. The sample data for detection data Dk to Dm includes detection data for multiple axes, for example, data including detection data for the first axis, second axis, and third axis. When the relay circuit 41 outputs detection data Dk to Dm in time division, it outputs it as output data DQ2 at a data output rate RTQ which is (m-k+1) times the data output rate RT of the inertial measurement units 30-k to 30-m. Here, for example, the relationship m-k+1 = n holds.
[0025] As shown in Figure 2, in addition to the inertial measurement units 30-1 to 30-n and the relay circuit 40, inertial measurement units 30-k to 30-m and the relay circuit 41 are further provided, and the detection data Dk to Dm from the inertial measurement units 30-k to 30-m are input to the relay circuit 41. The relay circuit 41 then outputs the detection data Dk to Dm as output data DQ2 in time division, and the processing unit 50 performs a synthesis process on the detection data D1 to Dn and Dk to Dm. In this way, the synthesis process is performed using the detection data Dk to Dm from the inertial measurement units 30-k to 30-m in addition to the detection data D1 to Dn from the inertial measurement units 30-1 to 30-n, so that the noise of the synthesized data DQH can be further reduced.
[0026] For example, if the processing unit 50 has only one communication port, a relay circuit 40 is sufficient. However, if the processing unit 50 has two or more communication ports, a relay circuit 41 is further provided, with the relay circuit 40 connected to the first communication port and the relay circuit 41 connected to the second communication port. For example, if only the relay circuit 40 is provided and the inertial measurement units 30-k to 30-m are connected to the relay circuit 40 in addition to the inertial measurement units 30-1 to 30-n, the communication speed between the relay circuit 40 and the processing unit 50 needs to be increased even further. In contrast, as shown in Figure 2, if the inertial measurement units 30-1 to 30-n are connected to the relay circuit 40 and the inertial measurement units 30-k to 30-m are connected to the relay circuit 41, the communication speed between the relay circuits 40, 41 and the processing unit 50 can be reduced compared to a configuration with only the relay circuit 40. Therefore, the processing unit 50 can receive output data DQ1 and DQ2 from the relay circuits 40 and 41 at a communication speed corresponding to its communication port, and output low-noise data DQH after synthesis processing.
[0027] In Figure 2, the relay circuit 40 includes communication circuits 42-1 to 42-n that receive detection data D1 to Dn from inertial measurement units 30-1 to 30-n, and an output-side communication circuit 48 that transmits output data DQ1 to the processing unit 50. Communication circuits 42-1 to 42-n are the first to nth communication circuits. Communication between the inertial measurement units 30-1 to 30-n and the communication circuits 42-1 to 42-n, and between the output-side communication circuit 48 and the processing unit 50, can be realized, for example, by serial communication of a given communication standard. Specifically, it can be realized by communication of the SPI or I2C communication standard, or a communication standard that is an evolution of SPI or I2C. Alternatively, it may be realized by communication such as UART. SPI (Serial Peripheral Interface) is a synchronous serial communication that transmits data in synchronization with a clock, and is a communication using four bus lines, for example, a clock signal line, a chip select signal line, and two data signal lines. I2C (Inter-Integrated Circuit) is a half-duplex serial communication method, using two bus lines, such as a clock signal line and a data signal line. In this configuration, detection data D1 to Dn from inertial measurement units 30-1 to 30-n can be received by communication circuits 42-1 to 42-n, and the detection data D1 to Dn can be output as output data DQ1 to the processing unit 50 by the output-side communication circuit 48. For example, in the configuration shown in Figure 2, detection data D1 to Dn can be received at the communication speed allowed for communication between communication circuits 42-1 to 42-n, and can be received at a communication speed that ensures the data output rate RT. For example, in a configuration where only one communication circuit is provided in the relay circuit 40, in order to receive detection data D1 to Dn from n inertial measurement units 30-1 to 30-n while ensuring the data output rate RT, the communication speed of the communication circuit needs to be high. In contrast, as shown in Figure 2, by providing n communication circuits 42-1 to 42-n corresponding to n inertial measurement units 30-1 to 30-n, it is possible to easily receive detection data D1 to Dn while ensuring a data output rate RT.Furthermore, while the number of communication ports in a processing unit 50 such as a microcontroller is limited, the relay circuit 40 of an ASIC, for example, does not have such limitations, and has the advantage of being able to easily provide n communication circuits 42-1 to 42-n. In Figure 2, one output-side communication circuit 48 is provided as the communication interface of the processing unit 50. Therefore, by connecting the first communication port of the processing unit 50 and the output-side communication circuit 48, output data DQ1 can be output to the processing unit 50, and this can be addressed even when the number of communication ports of the processing unit 50 is limited.
[0028] The relay circuit 40 also includes memories 44-1 to 44-n that store detection data D1 to Dn from inertial measurement units 30-1 to 30-n. Memories 44-1 to 44-n are the first to nth memories. Memories 44-1 to 44-n can be implemented using semiconductor memory such as RAM. For example, detection data D1 to Dn received by communication circuits 42-1 to 42-n are written to memories 44-1 to 44-n. In this case, memories 44-1 to 44-n may operate as FIFO memories. The detection data D1 to Dn written to memories 44-1 to 44-n are then read out by, for example, the arbitration circuit 46 and transmitted to the processing unit 50 via the output communication circuit 48. For example, the arbitration circuit 46 reads the detection data D1 to Dn from the memories 44-1 to 44-n in the order of the reception timings of the detection data D1 to Dn from the inertial measurement units 30-1 to 30-n, and transfers it to the output communication circuit 48. The order of the reception timings corresponds, for example, to the order of the detection timings of the inertial measurement units 30-1 to 30-n. By providing such memories 44-1 to 44-n, the detection data D1 to Dn from the inertial measurement units 30-1 to 30-n can be stored in the memories 44-1 to 44-n, and the stored detection data D1 to Dn can be output to the processing unit 50 as output data DQ1 in a time-division manner.
[0029] In Figure 2, the relay circuit 41 also includes communication circuits 42-k to 42-m that receive detection data Dk to Dm from the inertial measurement units 30-k to 30-m, and an output-side communication circuit 49 that transmits output data DQ2 to the processing unit 50. The communication circuits 42-k to 42-m are the kth to mth communication circuits, and the output-side communication circuit 49 is the second output-side communication circuit. In this way, the detection data Dk to Dm from the inertial measurement units 30-k to 30-m can be received by the communication circuits 42-k to 42-m, and the detection data Dk to Dm can be output to the processing unit 50 as output data DQ2 by the output-side communication circuit 49.
[0030] The relay circuit 41 also includes memories 44-k to 44-m that store detection data Dk to Dm from the inertial measurement units 30-k to 30-m. Memories 44-k to 44-m are the k-th memory to the m-th memory. For example, detection data Dk to Dm received by the communication circuits 42-k to 42-m is written to memories 44-k to 44-m. Then, the detection data Dk to Dm written to memories 44-k to 44-m is read out by, for example, the arbitration circuit 47 and transmitted to the processing unit 50 via the output-side communication circuit 49. By providing such memories 44-k to 44-m, detection data Dk to Dm from the inertial measurement units 30-k to 30-m can be stored in memories 44-k to 44-m, and the stored detection data Dk to Dm can be output to the processing unit 50 as time-division output data DQ2.
[0031] In Figure 2, the relay circuit 40 receives data-ready signals RDY1 to RDYn from inertial measurement units 30-1 to 30-n and outputs an output data-ready signal RDQ1 to the processing unit 50. Data-ready signals RDY1 to RDYn are the first to the nth data-ready signals. The relay circuit 41 receives data-ready signals RDYk to RDYm from inertial measurement units 30-k to 30-m and outputs an output data-ready signal RDQ2 to the processing unit 50. Data-ready signals RDYk to RDYm are the kth to the mth data-ready signals, and output data-ready signal RDQ2 is the second output data-ready signal. Details of these data-ready signals and output data-ready signals will be described later.
[0032] 2. Specific Configuration Examples Next, a specific configuration example of the inertial measurement device 10 of this embodiment will be described. Figures 3 and 4 show a specific first configuration example of this embodiment. Hereafter, the inertial measurement unit will be referred to as IMU (Inertial Measurement Unit) as appropriate. Furthermore, a specific example will be described in which n, m, and k in Figures 1 and 2 are n=m-k+1=3, and three relay circuits RL1, RL2, and RL3 are provided.
[0033] For example, when attempting to implement a multi-IMU by combining many more IMUs than the existing multi-IMU which combines three IMUs, there is a problem in that the number of communication ports on the processing unit, such as the control microcontroller, is insufficient. For example, there is a limit to the number of communication ports that can communicate with the IMUs mounted on the processing unit. Therefore, in this embodiment, a relay circuit, which is a communication relay device that converts multiple communication ports into one communication port, is introduced so that even a processing unit with few communication ports can control many IMUs. For example, by combining N IMUs, the number of IMUs can be divided by 1 / N. 1 / 2This reduces random noise and makes it possible to easily configure high-precision multi-IMUs. For example, by incorporating even more IMUs, it becomes possible to realize even higher-precision multi-IMUs. When communicating with IMUs via SPI, it is possible to connect multiple IMUs to one communication port by adopting the SPI multi-slave connection method, but there is a problem that the data output rate, which is the read rate from the IMU, decreases to 1 / 3 when, for example, three IMUs are connected. The IMU is an inertial sensor that incorporates a 3-axis angular velocity sensor and a 3-axis accelerometer, which are 3-axis gyroscopes that achieve high stability and accuracy by performing temperature compensation for bias and sensitivity, and orthogonal alignment correction, and has 6 axes, so it is also called a 6DoF sensor. IMUs are used in a wide range of applications in industrial and manufacturing systems, such as analyzing the behavior of equipment and analyzing rotational and translational motion.
[0034] Now, in the inertial measurement device 10 shown in Figure 3, N=9 IMUs 1 to IMU 9 are provided. This results in 1 / N 1 / 2Random noise can be reduced to 1 / 3. IMU1, IMU2, and IMU3 correspond to inertial measurement units 30-1 to 30-n in Figures 1 and 2, for example, and IMU4, IMU5, and IMU6 correspond to inertial measurement units 30-k to 30-m. In Figure 3, IMU1 to IMU3 are connected to relay circuit RL1, and for example, detect data D1 to D3 are output to relay circuit RL1 at a data output rate RT. Relay circuit RL1 then outputs the detected data D1 to D3 as time-division output data DQ1 to the processing unit 50. Relay circuit RL1 corresponds to relay circuit 40 in Figures 1 and 2, for example. IMU4 to IMU6 are connected to relay circuit RL2, and for example, detect data D4 to D6 are output to relay circuit RL2 at a data output rate RT. Relay circuit RL2 then outputs the detected data D4 to D6 as time-division output data DQ2 to the processing unit 50. Relay circuit RL2 corresponds to, for example, relay circuit 41. IMU7~IMU9 are connected to relay circuit RL3 and output detection data D7~D9 to relay circuit RL3 at, for example, a data output rate RT. Relay circuit RL3 then outputs the detection data D7~D9 as output data DQ3 in a time-division manner to processing unit 50.
[0035] The processing unit 50 includes a communication unit 52, storage memories M1 to M9, a synthesis processing unit 54, a timer 56, and a host communication unit 58. The communication unit 52 receives output data DQ1 from the relay circuit RL1. The detection data D1, D2, and D3 included in the output data DQ1 are then written to the storage memories M1, M2, and M3. The processing unit 50 also has a second communication unit and a third communication unit (not shown). The second communication unit receives output data DQ2 from the relay circuit RL2. The detection data D4, D5, and D6 included in the output data DQ2 are then written to the storage memories M4, M5, and M6. The third communication unit receives output data DQ3 from the relay circuit RL3. The detection data D7, D8, and D9 included in the output data DQ3 are then written to the storage memories M7, M8, and M9. The storage memories M1 to M9 can be implemented, for example, by the built-in RAM of the processing unit 50, but may also be implemented by external RAM.
[0036] The communication unit 52, consisting of the first communication unit, the second communication unit, and the third communication unit, corresponds to the communication ports of the processing unit 50, and in Figure 3, the processing unit 50 has three communication ports. In a configuration without a relay circuit, these three communication ports are connected to, for example, IMU1, IMU2, and IMU3, thus reducing random noise by 1 / 3. 1 / 2 It can only be reduced to this extent. In contrast, in Figure 3, by providing three relay circuits RL1, RL2, and RL3, it becomes possible to use N=9 IMU1~IMU9, and the random noise is reduced to 1 / 9 1 / 2 This will reduce the reduction to 1 / 3.
[0037] The synthesis processing unit 54 reads the detection data D1 to D9 from the storage memories M1 to M9 and performs synthesis processing on the detection data D1 to D9. For example, as mentioned above, the synthesis processing unit 54 performs synthesis processing of the first axis detection data included in the detection data D1 to D9, synthesis processing of the second axis detection data included in the detection data D1 to D9, and synthesis processing of the third axis detection data included in the detection data D1 to D9. For example, the first axis detection data is X-axis acceleration data and angular velocity data around the X axis, the second axis detection data is Y-axis acceleration data and angular velocity data around the Y axis, and the third axis detection data is Z-axis acceleration data and angular velocity data around the Z axis. The synthesis processing unit 54 performs synthesis processing of the acceleration data for each axis (X, Y, and Z) included in the detection data D1 to D9, and synthesis processing of the angular velocity data around the X, Y, and Z axes included in the detection data D1 to D9.
[0038] Timer 56 receives a clock signal CK and outputs a synchronization clock signal CKSY to the synthesis processing unit 54, etc., for example, through counter processing. Host communication unit 58 is a communication unit that acts as an interface with the host 200 and communicates with the host 200 according to a given communication standard.
[0039] Figure 4 shows an example of the configuration of relay circuit RL1 in the first configuration example. Since the configurations of relay circuits RL2 and RL3 are the same as those of relay circuit RL1, a detailed explanation is omitted.
[0040] The relay circuit RL1 includes communication circuits CC1, CC2, CC3, memories ME1, ME2, E3, arbitration circuit 46, and output-side communication circuit 48. Communication circuits CC1, CC2, CC3 correspond to, for example, communication circuits 42-1 to 42-n in Figure 2, and memories ME1, ME2, ME3 correspond to, for example, memories 44-1 to 44-n.
[0041] Communication circuit CC1 is connected to IMU1 and receives detection data D1 from IMU1 via serial communication such as SPI. Communication circuit CC1 also receives data ready signal RDY1 from IMU1. The detection data D1 received by communication circuit CC1 is then written to memory ME1 for storage. Specifically, memory ME1 stores the IMU number = 1, which is the identification information of IMU1, in association with the detection data D1.
[0042] Communication circuit CC2 is connected to IMU2 and receives detection data D2 from IMU2 via serial communication such as SPI. Communication circuit CC2 also receives data ready signal RDY2 from IMU2. The detection data D2 received by communication circuit CC2 is then written to memory ME2 and stored. Specifically, memory ME2 stores the IMU number = 2, which is the identification information of IMU2, in association with the detection data D2.
[0043] Communication circuit CC3 is connected to IMU3 and receives detection data D3 from IMU3 via serial communication such as SPI. Communication circuit CC3 also receives data ready signal RDY3 from IMU3. The detection data D3 received by communication circuit CC3 is then written to memory ME3 for storage. Specifically, memory ME3 stores the IMU number = 3, which is the identification information of IMU3, in association with the detection data D3.
[0044] The arbitration circuit 46 reads the detected data D1, D2, and D3 from the memories ME1, ME2, and ME3 and transfers them to the output communication circuit 48. The arbitration circuit 46 receives, for example, data ready signals RDM1, RDM2, and RDM3 from the memories ME1, ME2, and ME3 as input. The arbitration circuit 46 reads the detected data D1, D2, and D3 from the memories ME1, ME2, and ME3 in the order of the reception timings of the detected data D1, D2, and D3. The reception timings of the detected data D1, D2, and D3 correspond to the timings in which the data ready signals RDY1, RDY2, and RDY3 become active, and the arbitration circuit 46 identifies these timings using, for example, the data ready signals RDM1, RDM2, and RDM3 from the memories ME1, ME2, and ME3. For example, suppose the detected data is received in the order of D1, D2, and D3. In this case, the arbitration circuit 46 reads the detection data from memory ME1, ME2, and ME3 in the order of D1, D2, and D3 and transfers it to the output communication circuit 48, which then transmits the detection data as output data DQ1 to the processing unit 50 in the order of D1, D2, and D3. Alternatively, suppose the detection data is received in the order of D2, D3, and D1. In this case, the arbitration circuit 46 reads the detection data from memory ME2, ME3, and ME1 in the order of D2, D3, and D1 and transfers it to the output communication circuit 48, which then transmits the detection data as output data DQ1 to the processing unit 50 in the order of D2, D3, and D1. The arbitration circuit 46 also outputs an output data ready signal RDQ1 for DQ1 to the processing unit 50.
[0045] Figure 5 is a timing chart illustrating the operation of the first configuration example. Figure 5 shows an example where detection data is read from each IMU, for example, at 2 ksps. In this case, the data ready signal RDY1 from IMU1 becomes active at time intervals of approximately 500 μs, and the detection data D1[1], which is sensor data, is read from IMU1 in synchronization with this data ready signal RDY1. The detection data D1[1] read from IMU1 via the communication circuit CC1 is then stored in the memory ME1 for storing sensor data. At the same time, the IMU number = 1, which is the identification information of IMU1, is also stored in memory ME1. When the storage of the detection data D1[1] into memory ME1 is complete, the data ready signal RDM1 from memory ME1 becomes active. This data ready signal RDM1, which is an internal output synchronization signal, is output as an output data ready signal RDQ1, which is an output synchronization signal to the processing unit 50, via the arbitration circuit 46. Then, in synchronization with the output data ready signal RDQ1, the detection data D1[1] and IMU number=1, which are the contents of memory ME1, are output to the processing unit 50 via the output side communication circuit 48. The output of the contents of memory ME1 to the processing unit 50 is completed before the next data ready signal RDY1 from IMU1 becomes active. By repeating the above process, it becomes possible to continuously send the detection data D1[1], D1[2], D1[3]... from IMU1 to the processing unit 50.
[0046] Similarly, in synchronization with the data ready signal RDY2, the detection data D2[1] is read from the IMU2. The detection data D2[1] read from the IMU2 via the communication circuit CC2 is stored in memory ME2. At the same time, the IMU number = 2, which is the identification information of the IMU2, is also stored in memory ME2. When the storage of the detection data D2[1] into memory ME2 is complete, the data ready signal RDM2 from memory ME2 becomes active. This data ready signal RDM2 is output as the output data ready signal RDQ1 to the processing unit 50 via the arbitration circuit 46. In synchronization with the output data ready signal RDQ1, the contents of memory ME2, namely the detection data D2[1] and the IMU number = 2, are output to the processing unit 50 via the output communication circuit 48. The output of the contents of memory ME2 to the processing unit 50 is completed before the next data ready signal RDY2 from the IMU2 becomes active. By repeating the above process, it becomes possible to continuously send detection data D2[1], D2[2], D2[3]... from IMU2 to the processing unit 50. Similarly, detection data D3[1], D3[2], D3[3]... from IMU3 are also sent to the processing unit 50 from the communication circuit CC3 via memory ME3, arbitration circuit 46, and output-side communication circuit 48.
[0047] Furthermore, when the three IMUs 1, 2, and 3 are connected to the relay circuit RL1 as shown in Figure 4, the data output rate RTQ corresponding to the communication speed with the processing unit 50 is set to, for example, three times or more the data output rate RT corresponding to the read speed from IMU1, IMU2, and IM3.
[0048] In this embodiment, each of the first to nth memories stores identification information for each of the first to nth inertial measurement units, corresponding to each of the first to nth detection data. Taking Figure 4 as an example, memory ME1 stores identification number = 1, which is the identification information for IMU1, corresponding to the detection data D1 of IMU1. Memory ME2 stores identification number = 2, which is the identification information for IMU2, corresponding to the detection data D2. Memory ME3 stores identification number = 3, which is the identification information for IMU3, corresponding to the detection data D3. In this way, the subsequent processing unit 50 can use the identification information of the inertial measurement unit corresponding to each detection data to perform appropriate synthesis processing of the detection data. That is, the detection data D1 to D9 from IMU1 to IMU9 are sent to the processing unit 50 via relay circuits RL1 to RL3. The processing unit 50 then performs synthesis processing of the detection data D1 to D9 and outputs the synthesized data DQH. For example, the processing unit 50 performs synthesis processing of inertial measurement information such as acceleration data and angular velocity data for each axis detected by IMU1 to IMU9. In this case, the processing unit 50 performs synthesis processing of the detected data D1 to D9 of IMU1 to IMU9 at the first timing, then performs synthesis processing of the detected data D1 to D9 of IMU1 to IMU9 at the second timing following the first timing, and so on, performing synthesis processing of the detected data D1 to D9 at each timing. Therefore, if the processing unit 50 cannot identify which IMU among IMU1 to IMU9 each detected data D1 to D9 corresponds to, it will not be able to perform proper synthesis processing. In this embodiment, however, since identification information of the IMU corresponding to each detected data is associated with each detected data, proper synthesis processing can be achieved.
[0049] In this embodiment, each of the first to nth memories may store the read time information for each detection data, associated with each detection data from the first to nth detection data. Taking Figure 4 as an example, memory ME1 stores the read time information for detection data D1 from IMU1. Similarly, memory ME2 stores the read time information for detection data D2 from IMU2, and memory ME3 stores the read time information for detection data D3 from IMU3. The read time information is information for identifying the time when the detection data was read. For example, the detection timing of detection data from multiple inertial measurement units is different, and the read timing of detection data from each inertial measurement unit is also different. When the processing unit 50 performs synthesis processing of multiple detection data from multiple inertial measurement units, the detection timing of the multiple detection data is different. Therefore, in order to perform synthesis processing more accurately, it is desirable to perform interpolation processing in the time direction of each detection data so that the detection data is at the same timing, and then perform synthesis processing. The read time of the detection data corresponds to the detection timing of the detection data. Therefore, by associating the read time information of the detected data with each detected data, the processing unit 50 can use this read time information to perform appropriate interpolation processing in the time direction of the detected data.
[0050] In this embodiment, the relay circuit receives the first data ready signal and the nth data ready signal from the first inertial measurement unit to the nth inertial measurement unit, and outputs the first detection data and the nth detection data to the processing unit 50 as output data in the order in which the first data ready signal and the nth data ready signal were received. Taking Figures 4 and 5 as examples, the relay circuit RL1 receives data ready signals RDY1, RDY2, and RDY3 from IMU1, IMU2, and IMU3. IMU1 to IMU3 correspond to the first inertial measurement unit to the nth inertial measurement unit, and data ready signals RDY1 to RDY3 correspond to the first data ready signal and the nth data ready signal. Then, as shown in Figure 5, the relay circuit RL1 outputs the detection data D1 to D3 to the processing unit 50 as output data DQ1 in the order in which the data ready signals RDY1 to RDY3 were received. The detection data D1 to D3 correspond to the first detection data and the nth detection data. For example, in Figure 5, the relay circuit RL1 receives detection data in the order RDY1, RDY2, and RDY3, and therefore outputs the detection data to the processing unit 50 in the order D1, D2, and D3. Here, the order in which the data ready signals RDY1, RDY2, and RDY3 are received corresponds to the detection order of the detection data D1, D2, and D3 in IMU1, IMU2, and IMU3, and can be any order. For example, if the relay circuit RL1 receives the data ready signals in the order RDY2, RDY3, and RDY1, it outputs the detection data as output data DQ1 in the order D2, D3, and D1. Also, if it receives the data ready signals in the order RDY3, RDY2, and RDY1, it outputs the detection data as output data DQ1 in the order D3, D2, and D1. In this way, the relay circuit RL1 monitors the reception timing of the data ready signals RDY1 to RDY3 from IMU1 to IMU3, and in order corresponding to the detection timing of the detection data D1 to D3 in IMU1 to IMU3, it can output each detection data D1 to D3 to the subsequent processing unit 50.
[0051] Specifically, in Figures 4 and 5, the data ready signals RDM1, RDM2, and RDM3 are input to the arbitration circuit 46 from memories ME1, ME2, and ME3 in the same order as the reception order of the data ready signals RDY1, RDY2, and RDY3. The arbitration circuit 46 then arbitrates the output order of the detected data D1, D2, and D3 based on the data ready signals RDM1, RDM2, and RDM3. Specifically, the arbitration circuit 46 performs arbitration so that the detected data D1, D2, and D3 are output at the timing of the data ready signals RDM1, RDM2, and RDM3 corresponding to the data ready signals RDY1, RDY2, and RDY3.
[0052] In this embodiment, the relay circuit receives the first data ready signal to the nth data ready signal from the first inertial measurement unit to the nth inertial measurement unit, and outputs an output data ready signal to the processing unit 50 based on the first data ready signal to the nth data ready signal. Taking Figures 4 and 5 as examples, the relay circuit RL1 receives the data ready signals RDY1, RDY2, and RDY3 from IMU1, IMU2, and IMU3, and outputs the output data ready signal RDQ1 to the processing unit 50 based on RDY1, RDY2, and RDY3. In this way, the relay circuit RL1 can output the output data ready signal RDQ1, which is generated based on the timing of the data ready signals RDY1 to RDY3 from IMU1 to IMU3, to the processing unit 50 as the data ready signal for the detection data D1 to D3 from IMU1 to IMU3. The processing unit 50 can then properly receive the detection data D1 to D3 output from the relay circuit RL1 in a time-division manner based on this output data ready signal RDQ1.
[0053] Specifically, as shown in Figure 5, memories ME1, ME2, and ME3 output data ready signals RDM1, RDM2, and RDM3 to the arbitration circuit 46 at timings corresponding to the data ready signals RDY1, RDY2, and RDY3 from IMU1, IMU2, and IMU3. The data ready signals RDM1, RDM2, and RDM3 become active at a timing, for example, a given period of delay from the data ready signals RDY1, RDY2, and RDY3. The arbitration circuit 46 then generates an output data ready signal RDQ1 based on the data ready signals RDM1 to RDM3 from memories ME1 to ME3 and outputs it to the processing unit 50. For example, the output data ready signal RDQ1 is a signal corresponding to the logical OR of the data ready signals RDM1 to RDM3.
[0054] In this embodiment, the number of pulses per unit time of the output data ready signal corresponds to the sum of the number of pulses per unit time of the first to the nth data ready signals. Taking Figures 4 and 5 as examples, the number of pulses per unit time of the output data ready signal RDQ1 corresponds to the sum of the number of pulses per unit time of the data ready signals RDY1, RDY2, and RDY3. For example, when the relay circuit RL1 receives the first detection data D1[1], D2[1], and D3[1] from IMU1, IMU2, and IMU3, it receives data ready signals RDY1, RDY2, and RDY3 with three pulse counts, and accordingly, the number of pulses of the output data ready signal RDQ1 output to the processing unit 50 is also 3. Similarly, when the relay circuit RL1 receives the second detection data D1[2], D2[2], and D3[2] from IMU1, IMU2, and IMU3, it receives data-ready signals RDY1, RDY2, and RDY3 with three pulse counts. Correspondingly, the output data-ready signal RDQ1 output to the processing unit 50 also has three pulse counts. In this way, the relay circuit RL1 outputs an output data-ready signal RDQ1 with a pulse count corresponding to the pulse counts of the data-ready signals RDY1 to RDY3 from IMU1 to IMU3 to the processing unit 50, enabling the detection data D1 to D3 to be output to the processing unit 50 in a time-division manner. The processing unit 50 then properly receives the detection data D1 to D3 output in a time-division manner from the relay circuit RL1 based on this output data-ready signal RDQ1 with a pulse count.
[0055] In the configuration example shown in Figure 4, if the data output rate of IMU1 to IMU3 is RT, and for example 1 / RT = 500 μs, then the sum of the time it takes to read the detection data from each IMU (IMU1 to IMU3) and the time it takes to send it to the processing unit 50 must satisfy the condition that 1 / RT = 500 μs or less. If this condition is not met, data from each IMU may be written before the data from each memory (ME1 to ME3) is read, potentially resulting in data loss.
[0056] Furthermore, if data arrives simultaneously from multiple IMUs 1 to 3, the data needs to be sent to the processing unit 50 at an even faster speed. Figure 6 shows the timing chart of this embodiment in such a worst-case scenario. In Figure 6, the data ready signals RDY1, RDY2, and RDY3 from IMU1, IMU2, and IMU3 are active simultaneously, and the detected data D1, D2, and D3 are read out simultaneously. In this case, the relay circuit RL1 generates an output data ready signal RDQ1 based on the simultaneously active data ready signals RDM1, RDM2, and RDM3 from memories ME1, ME2, and ME3, and sends the detected data D1, D2, and D3 as output data DQ1 at high speed in a time-division multiplexer. The transmission is completed within 1 / RT = 500 μs.
[0057] Figure 7 shows the configuration of a comparative example of this embodiment. In Figure 7, no relay circuit like in this embodiment is provided, and detection data D1 to D9 from IMU1 to IMU9 are directly input to the processing unit 50. In this comparative example, as shown in A1 of Figure 7, the processing unit 50 requires a large number of communication ports to input the detection data D1 to D9. For example, in Figure 7, nine SPI or other communication ports are required. Therefore, if the processing unit 50 does not have such a large number of communication ports, it becomes difficult to accommodate this. For example, since the number of communication ports to the IMU mounted on the microcontroller, which is the processing unit 50, is limited, such a microcontroller cannot be used. In this case, if the SPI multi-slave connection method is adopted, detection data from IMU1 to IMU9 can be input to the processing unit 50 even if the number of communication ports on the processing unit 50 is limited, but a problem arises in that the data read rate decreases.
[0058] Figure 8 shows a configuration example of the relay circuit RL1 in a detailed second configuration example of this embodiment. The difference between Figure 8 and Figure 4 is that Figure 8 has a two-sided memory configuration. In Figure 8, as shown in B1 and B2, during the period when detection data D1 from IMU1 is written to memory ME11, detection data D1 written to memory ME12 is read, and during the period when detection data D1 is written to memory ME12, detection data D1 written to memory ME11 is read. Also, as shown in B3 and B4, during the period when detection data D2 from IMU2 is written to memory ME21, detection data D2 written to memory ME22 is read, and during the period when detection data D2 is written to memory ME22, detection data D2 written to memory ME21 is read. Similar writing and reading operations are performed in memories ME31 and ME32 as shown in B5 and B6.
[0059] Figure 9 is a timing chart illustrating the operation of the second configuration example in Figure 8. Synchronized with the data ready signal RDY1, the detection data D1[1] is read from the IMU1 and stored in memory ME11. At the same time, the IMU number = 1 is also stored in memory ME11. When the storage of the detection data D1[1] into memory ME11 is complete, the data ready signal RDM11 from memory ME11 becomes active, and the data ready signal RDM11 is output to the processing unit 50 as the output data ready signal RDQ1 via the arbitration circuit 46. Synchronized with the output data ready signal RDQ1, the contents of memory ME11, namely the detection data D1[1] and the IMU number = 1, are output to the processing unit 50.
[0060] The contents of memory ME12 are output to the processing unit 50 at the following timings. Specifically, in synchronization with the data ready signal RDY1, the detection data D1[2] from IMU1 is read, and the read detection data D1[2] is stored in memory ME12. At the same time, IMU number=1 is also stored in memory ME12. When the storage of detection data D1[2] into memory ME12 is complete, the data ready signal RDM12 from memory ME12 becomes active, and the data ready signal RDM12 is output to the processing unit 50 as the output data ready signal RDQ1 via the arbitration circuit 46. Then, in synchronization with the output data ready signal RDQ1, the contents of memory ME12, namely the detection data D1[2] and IMU number=1, are output to the processing unit 50. As shown in Figures 8 and 9, memory ME11 and memory ME12 are used by switching between them alternately, making it possible to continuously send the detection data D1[1], D1[2], D1[3]... read from IMU1 to the processing unit 50.
[0061] Similarly to memories ME21, ME22, ME31, and ME32, the storage and retrieval of detected data are performed in parallel, just like with memories ME11 and ME12. However, since this is the same as with memories ME11 and ME12, a detailed explanation will be omitted.
[0062] In the second configuration example shown in Figures 8 and 9, two memory panels are provided, making it possible to write to one memory panel and read from the other simultaneously. Therefore, when the data output rate is 1 / RT = 500 μs, data will be held in each memory panel for a period of (1 / RT) × 2 = 1 ms minus the data writing period to the memory. Consequently, the time constraints on reading data from memory can be reduced compared to the first configuration example shown in Figures 4 and 5. On the other hand, the first configuration example shown in Figures 4 and 5 has the advantage of requiring less memory capacity compared to the second configuration example shown in Figures 7 and 8.
[0063] 3. Example of Inertial Measurement Device Structure Figure 10 is a perspective view illustrating a specific example of the inertial measurement device 10. The inertial measurement device 10 includes a case 13 that houses the inertial measurement units 30-1 to 30-n, relay circuit 40, and processing device 50, as described in Figures 1 and 2. The case 13 can also be called a container. The case 13 includes a base 11 and a lid 12. Specifically, the case 13 includes a base 11 having a recess that opens upward and a lid 12 fixed to the base 11 so as to close the opening of the base 11. The housing space S sealed by the base 11 and the lid 12 becomes a space for housing components such as the inertial measurement units 30-1 to 30-n, relay circuit 40, and processing device 50. The case 13 protects the components housed in the housing space S from dust, moisture, shock, ultraviolet rays, etc.
[0064] The base 11 and lid 12 of case 13 can be made of aluminum, for example, but are not limited to this, and may be made of other metal materials such as aluminum alloys and stainless steel, various ceramics, various resin materials, or composite materials thereof.
[0065] The inertial measurement device 10 also has a connector 14 attached to the side wall of the base 11. This connector 14 is a receptacle for making an electrical connection between the outside and inside of the case 13, and is for communicating with an external device such as a host outside the inertial measurement device 10.
[0066] Figure 11 is an exploded perspective view illustrating the inertial measurement device 10. Figure 11 shows an example where the inertial measurement device 10 is equipped with three inertial measurement units 30-1, 30-2, and 30-3. However, the number of inertial measurement units provided in the inertial measurement device 10 is not limited to this, and for example, four or more inertial measurement units can be provided. Each of the inertial measurement units 30-1, 30-2, and 30-3 can also be called a sensor module.
[0067] As shown in Figure 11, the inertial measurement device 10 has a substrate 16. The substrate 16 can also be called a circuit board. The inertial measurement units 30-1, 30-2, and 30-3 are mounted on the substrate 16. In Figures 11 and 10, the axes that are orthogonal to each other along the main surface of the substrate 16 are defined as the X-axis and Y-axis, and the direction perpendicular to the substrate 16 is defined as the Z-axis. For example, the X-axis is the axis in the direction along the long side, which is the first side of the substrate 16, and the Y-axis is the axis in the direction along the short side, which is the second side of the substrate 16. The first and second sides are intersecting sides. In Figure 11, the inertial measurement unit 30-1 is positioned, for example, on the top surface, which is the first surface of the substrate 16. The inertial measurement units 30-2 and 30-3 are positioned, for example, along the direction of the X-axis, on the bottom surface, which is the second surface of the substrate 16. However, the arrangement of the inertial measurement units is not limited to this arrangement.
[0068] A processing unit 50, implemented by a microcontroller or the like, is arranged on the top surface of the circuit board 16. A relay circuit 40 is also arranged on the top surface of the circuit board 16. The relay circuit 40 can be implemented as a relay device in which, for example, a relay circuit IC is housed in a package, but is not limited to this. An internal connector 18 is also provided on the top surface of the circuit board 16.
[0069] The inertial measurement units 30-1, 30-2, and 30-3, the relay circuit 40, and the processing unit 50 are electrically connected via wiring on the circuit board 16. The processing unit 50 is connected to a communication board (not shown) via wiring on the circuit board 16, an internal connector 18, etc. The communication board contains a communication IC and other components that facilitate communication between the inertial measurement device 10 and an external device such as a host.
[0070] As described above, the inertial measurement device 10 of this embodiment includes a case 13 that houses inertial measurement units 30-1 to 30-3, a relay circuit 40, and a processing unit 50. By providing multiple inertial measurement units in the inertial measurement device 10 and performing synthesis processing on the detection data from these inertial measurement units, it becomes possible to output data with reduced noise, such as random noise, to the outside. Furthermore, by providing the relay circuit 40 and the processing unit 50 in the case of the inertial measurement device 10, the detection data from the inertial measurement units 30-1 to 30-3 is input to the relay circuit 40, and the relay circuit 40 can output this detection data as output data to the processing unit 50, which is also located in the same case 13, in a time-division manner.Therefore, the inertial measurement units 30-1 to 30-3, the relay circuit 40, and the processing unit 50 located in the case 13 make it possible to output detection data of low-noise inertial information to the outside, for example, at the same data output rate as the inertial measurement units.
[0071] Figure 12 shows an example configuration of the inertial measurement unit 30. The inertial measurement unit 30 corresponds to inertial measurement units 30-1, 30-2, and 30-3, respectively. The inertial measurement unit 30 includes an X-axis angular velocity sensor device 32X, a Y-axis angular velocity sensor device 32Y, a Z-axis angular velocity sensor device 32Z, an acceleration sensor device 34, and a processing unit 36. The processing unit 36 is, for example, a microcontroller, and the processing unit 36 and each sensor device are electrically connected, for example, by a digital interface bus.
[0072] The X-axis angular velocity sensor device 32X detects the angular velocity around the X-axis and outputs X-axis angular velocity data. The X-axis angular velocity sensor device 32X has a sensor element that detects the angular velocity around the X-axis. The sensor element is a gyro sensor element composed of a piezoelectric oscillator such as a quartz crystal oscillator. However, the sensor element is not limited to this and may be a Si-MEMS gyro sensor element of a capacitive detection type formed from a silicon substrate or the like. For example, the sensor element may be a multi-connected configuration of multiple Si-MEMS gyro sensor elements. The X-axis angular velocity sensor device 32X also includes an analog circuit that has an amplification circuit for amplifying the detection signal from the sensor element and a synchronous detection circuit for performing synchronous detection on the detection signal. The X-axis angular velocity sensor device 32X also includes an A / D conversion circuit that converts the analog signal from the analog circuit into digital data. The output data of this A / D conversion circuit, or data obtained by performing correction processing such as temperature correction, offset correction, or sensitivity correction on the output data, becomes the X-axis angular velocity data.
[0073] The Y-axis angular velocity sensor device 32Y detects the angular velocity around the Y-axis and outputs Y-axis angular velocity data. The Y-axis angular velocity sensor device 32Y has a sensor element that detects the angular velocity around the Y-axis. Various types of sensor elements can be used as described above. The Z-axis angular velocity sensor device 32Z detects the angular velocity around the Z-axis and outputs Z-axis angular velocity data. The Z-axis angular velocity sensor device 32Z has a sensor element that detects the angular velocity around the Z-axis. Various types of sensor elements can be used as described above. The detailed configuration and operation of the Y-axis angular velocity sensor device 32Y and the Z-axis angular velocity sensor device 32Z are the same as those of the X-axis angular velocity sensor device 32X, so a detailed explanation is omitted.
[0074] The acceleration sensor device 34 detects acceleration in the X-axis direction, Y-axis direction, and Z-axis direction and outputs X-axis acceleration data, Y-axis acceleration data, and Z-axis acceleration data. The acceleration sensor device 34 is, for example, a capacitive Si-MEMS sensor device capable of detecting acceleration in the X-axis direction, Y-axis direction, and Z-axis direction with a single device. However, this embodiment is not limited to this. The acceleration sensor device 34 may be a frequency-varying quartz acceleration sensor, a piezoresistive acceleration sensor, or a thermal-sensing acceleration sensor. The acceleration sensor device 34 includes a sensor element for detecting X-axis acceleration, a sensor element for detecting Y-axis acceleration, and a sensor element for detecting Z-axis acceleration. Multiple sensor elements may be provided as sensor elements for detecting acceleration in each axis. The acceleration sensor device 34 also includes an analog circuit having an amplification circuit for amplifying the detection signals from these sensor elements for detecting acceleration in each axis, and an A / D conversion circuit for converting the analog signals from the analog circuit into digital data. The A / D conversion circuit converts, for example, the analog signals of X-axis acceleration, Y-axis acceleration, and Z-axis acceleration into digital data in a time-division manner. The output data of this A / D conversion circuit, or data obtained by applying correction processing such as temperature correction to the output data, becomes the X-axis acceleration data, Y-axis acceleration data, and Z-axis acceleration data. Here, the X-axis, Y-axis, and Z-axis refer to the X-axis, Y-axis, and Z-axis as detection axes of the inertial measurement unit 30, which is a sensor module.
[0075] The processing unit 36 is a master controller for the X-axis angular velocity sensor device 32X, the Y-axis angular velocity sensor device 32Y, the Z-axis angular velocity sensor device 32Z, and the acceleration sensor device 34. The processing unit 36 is an integrated circuit device and can be implemented by a processor such as an MPU or CPU. Alternatively, the processing unit 36 may be implemented by an ASIC with automatic placement and routing, such as a gate array.
[0076] Figure 13 is an exploded perspective view showing a specific example of the inertial measurement unit 30. The inertial measurement unit 30 in Figure 13 includes a circuit board 100, an inner case 120, an annular cushioning material 130, and an outer case 140. The inertial measurement unit 30 is configured such that the circuit board 100 is mounted inside the outer case 140 with the annular cushioning material 130 interposed therebetween. Sensor devices such as an angular velocity sensor device and an acceleration sensor device are mounted on the circuit board 100.
[0077] The inertial measurement unit 30 has a rectangular prism shape in plan view, and screw holes 142 and 144 are formed near two vertices located diagonally opposite each other on the rectangle, serving as fixing points. Two screws are passed through these screw holes 142 and 144 to fix the inertial measurement unit 30 to the mounting surface for use. An opening 122 is formed on the surface of the inertial measurement unit 30 when viewed from above. A plug-type connector 110 is located inside the opening 122. Multiple pins are arranged in a row on the connector 110. A socket-type connector is connected to this connector 110 to transmit and receive electrical signals, such as power supply to the inertial measurement unit 30 and output of detection data detected by the inertial measurement unit 30. The outer case 140 is, for example, a base machined from aluminum into a box shape. The external shape of the outer case 140 is a rectangular prism shape in plan view, similar to the overall shape of the inertial measurement unit 30 described above.
[0078] In Figure 13, a recess 121 is provided on the bottom side of the inner case 120. In a plan view from the thickness direction of the circuit board 100, a group of sensor devices, including an angular velocity sensor device and an acceleration sensor device, are arranged in the area overlapping with the recess 121. A filler material is then filled and solidified into the space formed by the circuit board 100 and the recess 121. As a result, part or all of the circuit board 100 and the group of sensor devices are covered by the filler material, making it possible to shift the resonant frequency out of the band of external noise vibrations.
[0079] As described above, the inertial measurement device of this embodiment includes a first inertial measurement unit to an nth inertial measurement unit, a relay circuit that receives first detection data to nth detection data from the first inertial measurement unit to the nth inertial measurement unit and outputs the first detection data to nth detection data as time-division output data, and a processing device that receives the output data from the relay circuit and performs synthesis processing on the first detection data to nth detection data.
[0080] According to this embodiment, the first detection data to the nth detection data from the first inertial measurement unit to the nth inertial measurement unit are input to the relay circuit, and the relay circuit outputs the first detection data to the nth detection data as time-division output data. The processing unit then performs a synthesis process on the first detection data to the nth detection data based on the output data from the relay circuit. In this way, the first detection data to the nth detection data from the first inertial measurement unit to the nth inertial measurement unit can be input to the processing unit as time-division output data via the relay circuit. Furthermore, by performing a synthesis process on the first detection data to the nth detection data by the processing unit, it becomes possible to reduce the noise in the data after the synthesis process. Therefore, it becomes possible to provide an inertial measurement device that can easily achieve low noise in the output data by increasing the number of inertial measurement units installed in the inertial measurement device.
[0081] In this embodiment, the relay circuit may also include a first communication circuit to an nth communication circuit that receive first detection data to nth detection data from a first inertial measurement unit to an nth inertial measurement unit, and an output-side communication circuit that transmits output data to a processing unit.
[0082] In this way, the first detection data and the nth detection data from the first inertial measurement unit to the nth inertial measurement unit can be received by the first communication circuit and the nth communication circuit, and the first detection data and the nth detection data can be output as output data to the processing unit by the output-side communication circuit.
[0083] In this embodiment, the processing device may also perform a synthesis process of the first axis detection data included in the first detection data to the nth detection data, and a synthesis process of the second axis detection data included in the first detection data to the nth detection data.
[0084] In this way, the first axis detection data and second axis detection data included in the first to nth detection data are combined, and the noise in the combined first axis detection data and second axis detection data can be reduced.
[0085] In this embodiment, the synthesis process may also be an averaging process.
[0086] By performing this averaging process, random noise in the data output by the processing unit can be reduced compared to, for example, using detection data from a single inertial measurement unit.
[0087] In this embodiment, the relay circuit may also include a first memory to an nth memory that stores first detection data from the first inertial measurement unit to the nth inertial measurement unit to the nth detection data.
[0088] By providing such first to nth memories, first detection data from the first to nth inertial measurement unit to the nth inertial measurement unit can be stored in the first to nth memories, and the stored first to nth detection data can be output to the processing unit as time-division output data.
[0089] In this embodiment, each of the first to nth memories may store identification information for each of the first to nth inertial measurement units, associated with each of the detection data from the first to nth detection data.
[0090] In this way, the subsequent processing unit can use the identification information of the inertial measurement unit associated with each detected data to perform appropriate synthesis processing of the detected data.
[0091] In this embodiment, the relay circuit may receive the first data ready signal and the nth data ready signal from the first inertial measurement unit and the nth inertial measurement unit, and output the first detection data and the nth detection data to the processing unit as output data in the order in which the first data ready signal and the nth data ready signal were received.
[0092] In this way, the relay circuit can monitor the reception timing of the first data ready signal to the nth data ready signal from the first inertial measurement unit to the nth inertial measurement unit, and output each detection data to the subsequent processing unit in the order corresponding to the detection timing of the first detection data to the nth detection data in the first inertial measurement unit to the nth inertial measurement unit.
[0093] In this embodiment, the relay circuit may receive the first data ready signal to the nth data ready signal from the first inertial measurement unit to the nth inertial measurement unit, and output an output data ready signal to the processing unit based on the first data ready signal to the nth data ready signal.
[0094] In this way, the relay circuit can output an output data-ready signal, generated based on the timing of the first data-ready signal and the nth data-ready signal from the first inertial measurement unit to the nth inertial measurement unit, to the processing unit as a data-ready signal for the first detection data and the nth detection data from the first inertial measurement unit to the nth inertial measurement unit.
[0095] In this embodiment, the number of pulses per unit time of the output data-ready signal may correspond to the sum of the number of pulses per unit time of the first data-ready signal to the nth data-ready signal.
[0096] In this way, the relay circuit outputs output data-ready signals with a number of pulses corresponding to the number of pulses of the first data-ready signals from the first inertial measurement unit to the nth inertial measurement unit to the processing unit, enabling the first detection data to the nth detection data to be output to the processing unit in a time-division manner.
[0097] In this embodiment, the first to nth inertial measurement units output the first to nth detection data at a data output rate RT, and the relay circuit may output the data at a data output rate RTQ of n × RT or greater.
[0098] In this way, the first to nth detection data, which are to be synthesized in the processing unit, can be input to the processing unit at a high data output rate.
[0099] In this embodiment, the processing device may also output the data after synthesis at a data output rate of RT or less.
[0100] In this way, noise in the data output from the processing unit can be reduced through synthesis processing, and the synthesized data can be output at a data output rate equivalent to that of the first to nth inertial measurement units.
[0101] Furthermore, this embodiment may include a second relay circuit that receives the kth detection data to the mth detection data from the kth detection unit to the mth detection unit, and outputs the kth detection data to the mth detection data as second output data in a time-division manner. The processing device may then receive the output data and the second output data and perform a synthesis process of the first detection data to the nth detection data and the kth detection data to the mth detection data.
[0102] In this way, the first detection data to the nth detection data from the first to the nth inertial measurement unit, as well as the kth detection data to the mth detection data from the kth to the mth inertial measurement unit, are used in the synthesis process, thereby achieving further noise reduction of the synthesized data.
[0103] In this embodiment, the second relay circuit may also include a kth communication circuit to the mth communication circuit that receives kth detection data to mth detection data from the kth inertial measurement unit to the mth inertial measurement unit, and a second output-side communication circuit that transmits the second output data to the processing unit.
[0104] In this way, the kth detection data and the mth detection data from the kth inertial measurement unit to the mth inertial measurement unit can be received by the kth communication circuit and the mth communication circuit, and the kth detection data and the mth detection data can be output as output data to the processing unit by the second output side communication circuit.
[0105] Furthermore, this embodiment may include a case that houses the first to nth inertial measurement units, a relay circuit, and a processing unit.
[0106] In this way, multiple inertial measurement units are installed in the case of the inertial measurement device, and the detection data from these inertial measurement units is relayed by a relay circuit installed in the case and input to a processing unit installed in the case. By performing synthesis processing in the processing unit, data with reduced noise can be output to the outside.
[0107] Although this embodiment has been described in detail above, it will be readily apparent to those skilled in the art that many modifications are possible without substantially departing from the novelty and effects of this disclosure. Therefore, all such modifications are included within the scope of this disclosure. For example, any term that appears at least once in the specification or drawings together with a broader or synonymous term may be replaced with that different term anywhere in the specification or drawings. Furthermore, all combinations of this embodiment and its modifications are also included within the scope of this disclosure. In addition, the configuration and operation of the inertial measuring device, inertial measuring unit, relay circuit, processing device, etc., are not limited to those described in this embodiment, and various modifications are possible. [Explanation of symbols]
[0108] 10...Inertial measurement device, 11...Base, 12...Lid, 13...Case, 14...Connector, 16...Circuit board, 18...Internal connector, 30, 30-1~30-n, 30-k~30-m...Inertial measurement unit, 32X...X-axis angular velocity sensor device, 32Y...Y-axis angular velocity sensor device, 32Z...Z-axis angular velocity sensor device, 34...Accelerometer device, 36...Processing unit, 40, 41...Relay circuit, 42-1~42-n, 42-m~42-k...Communication circuit, 44-1~44-n, 44-m~44-k...Memory, 46, 47...Arbitration circuit, 48, 49...Output side communication circuit, 50...Processing unit, 52...Communication unit, 54...Synthesis unit, 56...Timer, 58...Host communication unit, 100...Circuit board ,110…Connector, 120…Inner case, 121…Recess, 122…Opening, 130…Cushioning material, 140…Outer case, 142, 144…Screw holes, 200…Host, CC1~CC3…Communication circuit, CK, CKSY…Clock signal, DQ1, DQ2, DQ3…Output data, DQH…Data, D1~Dk, Dm~Dn…Detection data, M1~M9…Storage memory, ME1~ME3, ME11~ME32…Memory, RDM1~RDM3…Data ready signal, RDQ1, RDQ2…Output data ready signal, RDY1~RDYn, RDYm~RDYk…Data ready signal, RL1~RL3…Relay circuit, RT…Data output rate, RTQ…Data output rate, S…Storage space
Claims
1. The first inertial measurement unit to the nth inertial measurement unit, A relay circuit receives the first detection data to the nth detection data from the first inertial measurement unit to the nth inertial measurement unit, and outputs the first detection data to the nth detection data as time-division output data. A processing device that receives the output data from the relay circuit and performs synthesis processing on the first detection data to the nth detection data, Includes, The relay circuit is characterized by including a first memory to an nth memory for storing the first detection data to the nth detection data.
2. In the inertial measuring device according to Claim 1, Each of the above-mentioned memories from the first memory to the nth memory is: An inertial measuring device characterized by storing identification information of each inertial measuring unit from the first inertial measuring unit to the nth inertial measuring unit in association with each of the detection data from the first detection data to the nth detection data.
3. In the inertial measuring device according to claim 1, The relay circuit is, The first inertial measurement unit to the first detection data from the nth inertial measurement unit to the first communication circuit to the nth communication circuit that receives the nth detection data, An output-side communication circuit that transmits the output data to the processing device, An inertial measuring device characterized by including [a certain element].
4. A first inertial measurement unit to the nth inertial measurement unit, A relay circuit receives the first detection data to the nth detection data from the first inertial measurement unit to the nth inertial measurement unit, and outputs the first detection data to the nth detection data as time-division output data. A processing device that receives the output data from the relay circuit and performs synthesis processing on the first detection data to the nth detection data, Includes, The inertial measuring device is characterized in that the relay circuit receives a first data ready signal to an nth data ready signal from the first inertial measuring unit to the nth inertial measuring unit, and outputs an output data ready signal to the processing unit based on the first data ready signal to the nth data ready signal.
5. In the inertial measuring device according to claim 4, An inertial measuring device characterized in that the number of pulses per unit time of the output data ready signal corresponds to the sum of the number of pulses per unit time of the first data ready signal to the n data ready signals.
6. A first inertial measurement unit to the nth inertial measurement unit, A relay circuit receives the first detection data and the nth detection data from the first inertial measurement unit and the nth inertial measurement unit, and outputs the first detection data and the nth detection data as time-division output data. A processing device that receives the output data from the relay circuit and performs synthesis processing on the first detection data to the nth detection data, Includes, The first inertial measurement unit to the nth inertial measurement unit output the first detection data to the nth detection data at a data output rate RT. The relay circuit is characterized in that it outputs the output data with a data output rate RTQ of n × RT or more.
7. In the inertial measuring device according to claim 6, The aforementioned processing apparatus is An inertial measuring device characterized by outputting the data after the synthesis process at a data output rate RT or less.
8. In an inertial measuring device according to any one of claims 1, 4, or 6, The aforementioned processing apparatus is The synthesis process of the first axis detection data included in the first detection data to the nth detection data, The synthesis process of the second axis detection data included in the first detection data to the nth detection data, An inertial measuring device characterized by performing the following.
9. In an inertial measuring device according to any one of claims 1, 4, or 6, The inertial measuring device is characterized in that the synthesis process is an averaging process.
10. In an inertial measuring device according to any one of claims 1, 4, or 6, The relay circuit is, An inertial measuring device characterized by receiving a first data ready signal to an nth data ready signal from the first inertial measuring unit to the nth inertial measuring unit, and outputting the first detection data to the nth detection data as output data to the processing device in the order in which the first data ready signal to the nth data ready signal were received.
11. In an inertial measuring device according to any one of claims 1, 4, or 6, k-th inertial measurement unit to m-th inertial measurement unit, A second relay circuit receives the k-th detection data to the m-th detection data from the k-th inertial measurement unit to the m-th inertial measurement unit, and outputs the k-th detection data to the m-th detection data as second output data in a time-division manner. Includes, The aforementioned processing apparatus is An inertial measuring device characterized in that the output data and the second output data are input, and the first detection data to the n detection data and the k detection data to the m detection data are combined.
12. In the inertial measuring device according to claim 11, The second relay circuit is, The k-th communication circuit to the m-th communication circuit receive the k-detection data from the k-inertia measurement unit to the m-inertia measurement unit, A second output-side communication circuit that transmits the second output data to the processing unit, An inertial measuring device characterized by including [a certain element].
13. In an inertial measuring device according to any one of claims 1, 4, or 6, An inertial measuring device characterized by including a case that houses the first to n inertial measuring units, the relay circuit, and the processing device.
Citation Information
Patent Citations
JP1975016292A
Meter-reading system and repeater system
JP2004094530A
Inertia sensor device and method for manufacturing inertia sensor device
JP2021196191A
Time-domain multiplexed signal processing block and method for use with multiple MEMS devices
US9699534B1
Drive control device and drive control method
WO2022004375A1
