The present application is based on, and claims priority from JP Application Serial Number 2023-004934, filed Jan. 17, 2023, the disclosure of which is hereby incorporated by reference herein in its entirety.
The present disclosure relates to a sensor module.
JP-A-2021-196191 discloses an inertia sensor apparatus including: a plurality of sensor modules each including an inertia sensor and a correction circuit that generates a corrected signal by performing misalignment correction in which a correction coefficient is applied to a signal output from the inertia sensor such that a plurality of detection axes of the inertia sensor are orthogonal to one another; a matching processor that generates a plurality of matched signals by applying a correction coefficient for causing the plurality of detection axes of each of the plurality of sensor modules to match with a plurality of detection axes of any one of the plurality of sensor modules to each corrected signal; and a combining processor that combines the plurality of matched signals with the plurality of corrected signals and outputs the combined signal. According to the inertia sensor apparatus disclosed in JP-A-2021-196191, since a deviation of the detection axes between the plurality of sensor modules is eliminated, deterioration of detection accuracy of inertia data can be prevented. In addition, in the inertia sensor apparatus disclosed in JP-A-2021-196191, acceleration sensors included in the inertia sensors included in each sensor module are close to each other, and a difference in acceleration received by each of the plurality of acceleration sensors can be limited small.
However, since the plurality of acceleration sensors cannot be disposed at exactly the same position, outputs of the plurality of acceleration sensors may be different when a rotational motion is applied to the plurality of acceleration sensors.
An aspect of a sensor module according to the present disclosure includes:
Another aspect of a sensor module according to the present disclosure includes:
Hereinafter, preferred embodiments of the present disclosure will be described in detail with reference to the drawings. The embodiments to be described below do not unduly limit contents of the present disclosure described in the claims. In addition, not all configurations to be described below are necessarily essential components of the present disclosure.
The sensor devices 2-1 to 2-n are accommodated in a housing (not illustrated) of the sensor module 1, and detect accelerations α1 to αn applied to first to n-th positions of the housing, respectively. That is, for each integer j of 1 or more and n or less, the sensor device 2-j includes at least an acceleration sensor provided at the j-th position, and the acceleration sensor detects the acceleration αj. The sensor device 2-n further detects an angular velocity ω applied to the housing of the sensor module 1. That is, the sensor device 2-n includes an angular velocity sensor together with an acceleration sensor, and the angular velocity sensor detects the angular velocity ω applied to the housing.
For example, the sensor devices 2-1 to 2-(n−1) may be three-axis acceleration sensor devices, and the sensor device 2-n may be an inertia measurement unit including a three-axis acceleration sensor and a three-axis angular velocity sensor. Further, each of the first to n-th sensor devices 2-1 to 2-n may be an inertia measurement unit.
Hereinafter, a case where the sensor devices 2-1 to 2-n are inertia measurement units having the same structure will be described as an example, and a structure and a function thereof will be described. Hereinafter, any one of the sensor devices 2-1 to 2-n may be referred to as a sensor device 2.
As illustrated in
As illustrated in
As illustrated in
The correction circuit 28 is implemented with, for example, an integrated circuit. The correction circuit 28 is coupled to the three-axis acceleration sensor 27, the first angular velocity sensor 26a, the second angular velocity sensor 26b, and the third angular velocity sensor 26c via the circuit substrate 24. In general, signals output from the three-axis acceleration sensor 27, the first angular velocity sensor 26a, the second angular velocity sensor 26b, and the third angular velocity sensor 26c have misalignment, which is an angular error with respect to the three detection axes caused by, for example, a deviation during assembly of the sensor device 2. Therefore, the correction circuit 28 generates corrected signals by correcting the signals output from the three-axis acceleration sensor 27, the first angular velocity sensor 26a, the second angular velocity sensor 26b, and the third angular velocity sensor 26c such that the three detection axes of the sensor device 2 are orthogonal to one another. Specifically, the correction circuit 28 generates the corrected signals by executing misalignment correction in which a predetermined correction coefficient such as a rotation matrix is applied to the signals output from the three-axis acceleration sensor 27, the first angular velocity sensor 26a, the second angular velocity sensor 26b, and the third angular velocity sensor 26c. The three detection axes forming a three-dimensional orthogonal coordinate system are set for each sensor device 2.
In addition, the correction circuit 28 corrects offset errors and scale factor errors included in the signals output from the three-axis acceleration sensor 27, the first angular velocity sensor 26a, the second angular velocity sensor 26b, and the third angular velocity sensor 26c. The correction circuit 28 outputs the corrected signals to the processing circuit 100 via the interface circuit 29.
The circuit substrate 24 has, for example, a square shape when viewed from the direction along the c-axis. Defining four quadrants defined around a center O of the circuit substrate 24 as a first quadrant Q1, a second quadrant Q2, a third quadrant Q3, and a fourth quadrant Q4, the three-axis acceleration sensor 27 is disposed in the first quadrant Q1.
The module connector 25 is disposed at an upper surface 241 of the circuit substrate 24 in the second quadrant Q2 and the third quadrant Q3. The first angular velocity sensor 26a is disposed at a side surface of the circuit substrate 24 in the fourth quadrant Q4. The second angular velocity sensor 26b is disposed at the side surface of the circuit substrate 24 in the first quadrant Q1. The third angular velocity sensor 26c is disposed at the upper surface 241 of the circuit substrate 24 in the fourth quadrant Q4. The three-axis acceleration sensor 27 is disposed at the upper surface 241 of the circuit substrate 24 in the first quadrant Q1. The correction circuit 28 is disposed at a lower surface 242 of the circuit substrate 24 in the third quadrant Q3. The screw hole 211 is disposed in the second quadrant Q2, and the screw hole 212 is disposed in the fourth quadrant Q4.
As illustrated in
As illustrated in
The base 91 and lid 92 may be made of aluminum (Al). In addition, examples of materials of the base 91 and the lid 92 include metal materials such as Al alloy, zinc (Zn), and stainless steel, a variety of ceramics, a variety of resin materials, and composite materials thereof.
The sensor module 1 includes a connector 93 attached to a side wall of the base 91 and a communication substrate 931 disposed in the accommodation space S. The connector 93 is a receptacle that electrically couples an interior and an exterior of the container 9. The communication substrate 931 includes a circuit that processes communication between the sensor module 1 and another apparatus.
The substrate 10 is a circuit substrate including a variety of elements and wirings. The sensor devices 2A, 2B, and 2C, the processing circuit 100, an internal connector 150, and the like are mounted at the substrate 10. The substrate 10 is relatively fixed, for example, to the base 91.
As illustrated in
The sensor devices 2A, 2B, and 2C are coupled to the processing circuit 100 via the substrate 10. The processing circuit 100 controls driving of the sensor devices 2A, 2B, and 2C. The processing circuit 100 is coupled to the communication substrate 931 via the internal connector 150 and a wiring (not illustrated) coupled to the internal connector 150.
As illustrated in
Assuming that a reference position of the housing of the sensor module 1 is located at a position po of a spatial coordinate system and the sensor device 2-j is mounted at a position rj of a housing coordinate system, a position pj of the spatial coordinate system is represented by Equation (1). For example, the position rj is an acceleration sensitivity point position of the sensor device 2-j.
In Equation (1), C is a coordinate transformation matrix representing a posture of housing coordinates with respect to spatial coordinates. By time-differentiating Equation (1), a velocity v of the sensor device 2-j in the spatial coordinate system is obtained as in Equation (2). Further, by time-differentiating Equation (2), the acceleration aj of the sensor device 2-j in the spatial coordinate system is obtained as in Equation (3).
In Equations (2) and (3), vo is a spatial translation velocity of the reference position of the housing in the spatial coordinate system, α0 is the acceleration of the reference position of the housing in the spatial coordinate system, and ω is a rotational angular velocity in the housing coordinate system. The angular velocity ω is the same value in the housing regardless of a mounting position of the sensor device 2-j.
The acceleration αj detected by the sensor device 2-j is obtained by converting the acceleration αj obtained by Equation (3) into the housing coordinate system as in Equation (4).
In Equation (4), αo is the acceleration of the reference position in the housing coordinate system. In Equation (4), Equation (5) is obtained by expressing a cross product in a matrix form.
From Equation (5), it can be understood that the acceleration applied to the sensor devices 2-1 to 2-n is different due to a difference in mounting position, and in particular, the difference in acceleration increases as the angular velocity ω increases. In the embodiment, the processing circuit 100 converts the accelerations α1 to an detected by the sensor devices 2-1 to 2-n into accelerations α1′ to αn′ applied to the reference position of the housing.
Referring back to
The acceleration conversion unit 101 converts, based on the angular velocity ω applied to the housing of the sensor module 1 and detected by the sensor device 2-n, the accelerations α1 to αn respectively applied to the first to n-th positions detected by the sensor devices 2-1 to 2-n into the reference position accelerations α1′ to αn′, respectively, the reference position accelerations being accelerations applied to the predetermined reference position of the housing. The accelerations α1 to αn and the reference position accelerations α1′ to αn′ are accelerations of the sensor module 1 in the housing coordinate system, and the angular velocity ω is an angular velocity of the sensor module 1 in the housing coordinate system. The sensor devices 2-1 to 2-n may output the accelerations α1 to αn in the housing coordinate system, or the sensor devices 2-1 to 2-n may output the accelerations in a sensor coordinate system and the acceleration conversion unit 101 may convert the accelerations into the accelerations α1 to αn in the housing coordinate system. Further, the sensor device 2-n may output the angular velocity ω in the housing coordinate system, or the sensor device 2-n may output an angular velocity in the sensor coordinate system and the acceleration conversion unit 101 may convert the angular velocity into the angular velocity ω in the housing coordinate system. In the example of
Here, assume that a k-th angular velocity detected by the sensor device 2-n every sampling interval Δt is an angular velocity ωk=[ωx,k ωy,k ωz,k]T, and the k-th acceleration detected by the sensor device 2-j for each integer j of 1 or more and n or less is αj,K=[αjx,k αjy,k αjz,k]T. From Equation (5) described above, Equation (6) for converting the k-th acceleration αj,k into a reference position acceleration αj,k′ is derived.
From Equation (6), the k-th average acceleration α′k, which is an average value of the k-th accelerations α1,k to αn,k detected by the sensor devices 2-1 to 2-n, is calculated based on Equation (7).
The acceleration conversion unit 101 may convert the acceleration αj applied to the j-th position r into a reference position acceleration αj′ based on Equation (6) for each integer j of 1 or more and n or less. For example, first to n-th positions r1 to rn are stored in the storage circuit 110.
The averaging unit 102 calculates an average acceleration α′ which is an average value of the reference position accelerations α1′ to αn′ based on Equation (7).
The mismatch determination unit 103 determines whether the reference position accelerations α1′ to αn′ match. Here, “the reference position accelerations α1′ to αn′ match” is not limited to a case where all of the reference position accelerations α1′ to αn′ match exactly, and also includes a case where a difference between the reference position accelerations α1′ to αn′ is less than a predetermined threshold.
For example, the mismatch determination unit 103 calculates an absolute value of difference |αi′−αj′| of αi′ and αj′ for integers i and j (i≠j) of 1 or more and n or less, and determines that the reference position accelerations αi′ to αn′ match when the absolute value of difference |αi′−αj′| is equal to or less than the predetermined threshold for all sets of the integers i and j (i≠j). In addition, when the absolute value of difference |αi′−αj′| is larger than the predetermined threshold for at least one set of the integers i and j (i≠j), the mismatch determination unit 103 determines that at least one of the reference position accelerations α1′ to αn′ does not match the others.
Alternatively, the mismatch determination unit 103 calculates an absolute value of ratio |αi′/αj′| of αi′ and αj′ for the integers i and j (i≠j) of 1 or more and n or less, and determines that the reference position accelerations α1′ to αn′ match when the absolute value of ratio |αi′/αj′| is included in a predetermined range for all the sets of the integers i and j (i≠j). In addition, when the absolute value of ratio |αi′/αj′| is not included in the predetermined range for at least one set of the integers i and j (i≠j), the mismatch determination unit 103 determines that at least one of the reference position accelerations α1′ to αn′ does not match the others.
Then, the mismatch determination unit 103 generates a flag flg indicating a determination result. For example, the flag flg may be 0 when determined as match, and may be 1 when determined as mismatch.
The average acceleration α′ calculated by the averaging unit 102 and the flag flg generated by the mismatch determination unit 103 are transmitted to αn external device (not illustrated) via the communication circuit 120. For example, the external device may perform predetermined calculation using the average acceleration α′ when the flag flg indicates determination as match, and may not perform the predetermined calculation when the flag flg indicates determination as mismatch.
The sensor device 2 is not limited to the configuration illustrated in
The three-axis acceleration sensor 27-1 detects an acceleration Aa1 in the direction along the a-axis, an acceleration Ab1 in the direction along the b-axis, and an acceleration Ac1 in the direction along the c-axis. The three-axis acceleration sensor 27-2 detects an acceleration Aa2 in the direction along the a-axis, an acceleration Ab2 in the direction along the b-axis, and an acceleration Ac2 in the direction along the c-axis. The three detection axes including the a-axis, the b-axis, and the c-axis are defined for each sensor device 2.
The correction circuit 28 generates the corrected signals by executing the misalignment correction in which the predetermined correction coefficient such as the rotation matrix is applied to signals output from the three-axis acceleration sensor 27-1, the three-axis acceleration sensor 27-2, the first angular velocity sensor 26a, the second angular velocity sensor 26b, and the third angular velocity sensor 26c. The three detection axes forming a three-dimensional orthogonal coordinate system are set for each sensor device 2. Then, the correction circuit 28 averages the corrected signals of the three-axis accelerations Aa1, Ab1, and Ac1 and the corrected signals of the three-axis accelerations Aa2, Ab2, and Ac2 to calculate the corrected signals having reduced noise. In addition, the correction circuit 28 corrects offset errors and scale factor errors included in the signals output from the three-axis acceleration sensor 27-1, the three-axis acceleration sensor 27-2, the first angular velocity sensor 26a, the second angular velocity sensor 26b, and the third angular velocity sensor 26c. The correction circuit 28 outputs the corrected signals to the processing circuit 100 via the interface circuit 29.
Since other configurations of the sensor device 2 illustrated in
Further, the sensor module 1 according to the first embodiment is not limited to the configuration illustrated in
The sensor devices 2-1 to 2-n are accommodated in a housing (not illustrated) of the sensor module 1, and detect accelerations α1 to αn applied to first to n-th positions of the housing, respectively. That is, for each integer j of 1 or more and n or less, the sensor device 2-j includes at least an acceleration sensor provided at the j-th position, and the acceleration sensor detects the acceleration αj. The sensor device 2-(n+1) detects the angular velocity ω applied to the housing of the sensor module 1. That is, the sensor device 2-(n+1) includes αn angular velocity sensor, and the angular velocity sensor detects the angular velocity ω applied to the housing.
For example, the sensor devices 2-1 to 2-n may be three-axis acceleration sensor devices, and the sensor device 2-(n+1) may be a three-axis angular velocity sensor. Further, each of the first to (n+1)-th sensor devices 2-1 to 2-(n+1) may be an inertia measurement unit.
The acceleration conversion unit 101 converts, based on the angular velocity ω applied to the housing of the sensor module 1 and detected by the sensor device 2-(n+1), the accelerations α1 to αn respectively applied to the first to n-th positions detected by the sensor devices 2-1 to 2-n into the reference position accelerations α1′ to αn′, respectively, the reference position accelerations being accelerations applied to the predetermined reference position of the housing.
Since other configurations of the sensor module 1 illustrated in
In the sensor module 1 according to the first embodiment, the sensor devices 2-1 to 2-n are an example of “first to n-th sensor devices”. The sensor devices 2-1 to 2-(n+1) are an example of αn “first to (n+1)-th sensor device”. The accelerations α1 to αn are an example of “first to n-th accelerations”. Further, the reference position accelerations α1′ to αn′ are an example of “first to n-th reference position accelerations”.
In the sensor module 1 according to the first embodiment described above, the processing circuit 100 converts, based on the angular velocity ω applied to the housing, the accelerations α1 to αn applied to the first to n-th positions r1 to rn of the housing and detected by the sensor devices 2-1 to 2-n into the reference position accelerations α1′ to αn′ applied to the reference position of the housing. Therefore, according to the sensor module 1 of the first embodiment, the accelerations α1 to αn can be corrected even when a rotational motion is applied to the sensor devices 2-1 to 2-n.
According to the sensor module 1 of the first embodiment, it is possible to calculate the average acceleration α′ in which random noise components are reduced by averaging processing of the averaging unit 102 of the processing circuit 100.
Further, according to the sensor module 1 of the first embodiment, for example, the external device can determine whether all of the three-axis acceleration sensors 27 included in the sensor devices 2-1 to 2-n are normal or at least one of the three-axis acceleration sensors 27 is out of order based on the flag flg indicating the determination result obtained by the mismatch determination unit 103 of the processing circuit 100.
Hereinafter, regarding a sensor module according to the second embodiment, the same components as those in the first embodiment are denoted by the same reference numerals, description overlapping with that of the first embodiment is omitted or simplified, and contents different from those of the first embodiment will be mainly described.
In the sensor module 1 according to the second embodiment, the processing circuit 100 sets the first position r1 as a predetermined reference position of a housing, sets the acceleration α1 detected by the sensor device 2-1 as the reference position acceleration α1′ which is the acceleration applied to the reference position, and converts, based on the angular velocity ω applied to the housing, the accelerations α2 to αn and detected by the sensor devices 2-2 to 2-n into the reference position accelerations α2′ to αn′, respectively, the reference position accelerations being the accelerations applied to the reference position.
As illustrated in
The acceleration conversion unit 101 sets the first position r1 at which the acceleration sensor included in the sensor device 2-1 is mounted as the predetermined reference position of the housing, and converts, based on the angular velocity ω applied to the housing of the sensor module 1 and detected by the sensor device 2-n, the accelerations α2 to αn applied to the second to n-th positions r2 to rn and detected by the sensor devices 2-2 to 2-n into the reference position accelerations α2′ to αn′ applied to the first position r1, respectively, the first position being the reference position of the housing.
The acceleration conversion unit 101 may convert the acceleration αj applied to the j-th position r into the reference position acceleration αj′ based on Equation (6) described above for each integer j of 2 or more and n or less. The second to n-th positions r2 to rn are positions with respect to the first position r1, and are, for example, stored in the storage circuit 110.
The averaging unit 102 calculates the average acceleration α′, which is the average value of the reference position accelerations α1′ to αn′, based on Equation (7) described above. However, the reference position acceleration α1′ is the acceleration α1 detected by the sensor device 2-1.
Since a function of the mismatch determination unit 103 is the same as that of the first embodiment, description thereof will be omitted. Other configurations, functions, and structures of the sensor module 1 according to the second embodiment are the same as those of the first embodiment, and description thereof will be omitted.
The sensor module 1 according to the second embodiment is not limited to the configuration illustrated in
In the sensor module 1 according to the second embodiment, the sensor devices 2-1 to 2-n are an example of “first to n-th sensor devices”. The sensor devices 2-1 to 2-(n+1) are an example of αn “first to (n+1)-th sensor device”. The accelerations α1 to αn are an example of “first to n-th accelerations”. Further, the reference position accelerations α1′ to αn′ are an example of “first to n-th reference position accelerations”.
In the sensor module 1 according to the second embodiment described above, the processing circuit 100 sets the acceleration α1 applied to the first position r1 of the housing and detected by the sensor device 2-1 to the reference position acceleration α1′ applied to the first position r1 which is the reference position, and converts, based on the angular velocity ω applied to the housing, the accelerations α2 to αn applied to the second to n-th positions r2 to rn of the housing and detected by the sensor devices 2-2 to 2-n into the reference position accelerations α2′ to αn′ applied to the first position r1. Therefore, according to the sensor module 1 of the second embodiment, the accelerations α1 to αn can be corrected even when a rotational motion is applied to the sensor devices 2-1 to 2-n.
According to the sensor module 1 of the second embodiment, since the acceleration α1 applied to the first position r1 of the housing can be set as the reference position acceleration α1′ applied to the first position r1 which is the reference position, a calculation load for calculating the reference position accelerations α1′ to αn′ is smaller than that of the sensor module 1 according to the first embodiment.
According to the sensor module 1 of the second embodiment, it is possible to calculate the average acceleration α′ in which random noise components are reduced by averaging processing of the averaging unit 102 of the processing circuit 100.
Further, according to the sensor module 1 of the second embodiment, for example, αn external device can determine, based on the flag flg indicating a determination result obtained by the mismatch determination unit 103 of the processing circuit 100, whether all of the three-axis acceleration sensors 27 included in the sensor devices 2-1 to 2-n are normal or at least one of the three-axis acceleration sensors 27 is out of order.
Hereinafter, regarding a sensor module according to a third embodiment, the same components as those in the first embodiment or the second embodiment are denoted by the same reference numerals, description overlapping with that of the first embodiment or the second embodiment is omitted or simplified, and contents different from those of the first embodiment and the second embodiment will be mainly described.
As illustrated in
Since functions of the acceleration conversion unit 101 are the same as those of the second embodiment, description thereof will be omitted.
The majority decision unit 104 determines whether each of the reference position accelerations α1′ to αn′ is normal by majority decision on the reference position accelerations α1′ to αn′.
For example, the majority decision unit 104 calculates an absolute value of difference |α1′−αj′| of αi′ and αj′ for integers i and j (i≠j) of 1 or more and n or less, and determines that the reference position accelerations αk′ and αl′ are normal when the absolute value of difference |αk′−αl′ is equal to or less than a predetermined threshold for any set of the integers k and l (k≠l). Further, for any set of integers k, l, and m (k≠l≠m), when an absolute value of difference |αk′−αl′I is larger than the predetermined threshold, an absolute value of difference |αk′−αm′| is larger than the predetermined threshold, and an absolute value of difference |αl′−αm′| is equal to or less than the predetermined threshold, the majority decision unit 104 determines that the reference position acceleration αk′ is abnormal and the reference position accelerations αl′ and αm′ are normal.
Alternatively, the majority decision unit 104 calculates an absolute value of ratio |αi′/αj′| of αi′ and αj′ for the integers i and j (i≠j) of 1 or more and n or less, and determines that the reference position accelerations αk′ and αl′ are normal when the absolute value of ratio |αk′/αl′| is included in the predetermined range for any set of the integers k and l (k≠l). In addition, for any set of the integers k, l, and m (k≠l≠m), when an absolute value of ratio |αk′/αl′| is not included in the predetermined range, an absolute value of ratio |αk′/αm′| is not included in the predetermined range, and an absolute value of ratio |αl′/αm′| is included in the predetermined range, the majority decision unit 104 determines that the reference position acceleration αk′ is abnormal and the reference position accelerations αl′ and αm′ are normal.
Then, the majority decision unit 104 generates the flag flg indicating a determination result. For example, the flag flg may be n-bit data, each being 1 when the reference position acceleration α1′ to αn′ is normal and 0 when abnormal.
The averaging unit 102 calculates, based on a majority decision result obtained by the majority decision unit 104, the average acceleration α′, which is αn average value of normal accelerations among the reference position accelerations α1′ to αn′. For example, when the reference position acceleration α1′ is abnormal and the reference position accelerations α2′ to αn′ are normal, the averaging unit 102 calculates the average acceleration α′ of the reference position accelerations α2′ to αn′.
The average acceleration α′ calculated by the averaging unit 102 and the flag flg generated by the majority decision unit 104 are transmitted to αn external device (not illustrated) via the communication circuit 120. For example, the external device may perform predetermined calculation using the average acceleration α′.
Other configurations, functions, and structures of the sensor module 1 according to the third embodiment are the same as those of the first embodiment or the second embodiment, and description thereof will be omitted.
The sensor module 1 according to the third embodiment is not limited to the configuration illustrated in
In the sensor module 1 according to the third embodiment, the sensor devices 2-1 to 2-n are an example of “first to n-th sensor devices”. The sensor devices 2-1 to 2-(n+1) are an example of αn “first to (n+1)-th sensor device”. The accelerations α1 to αn are an example of “first to n-th accelerations”. Further, the reference position accelerations α1′ to αn′ are an example of “first to n-th reference position accelerations”.
In the sensor module 1 according to the third embodiment described above, the processing circuit 100 sets the acceleration α1 applied to the first position ri of the housing and detected by the sensor device 2-1 to the reference position acceleration α1′ applied to the first position r1 which is the reference position, and converts, based on the angular velocity ω applied to the housing, the accelerations α2 to αn applied to the second to n-th positions r2 to rn of the housing and detected by the sensor devices 2-2 to 2-n into the reference position accelerations α2′ to αn′ applied to the first position r1. Alternatively, the processing circuit 100 converts, based on the angular velocity ω applied to the housing, the accelerations α1 to αn applied to the first to n-th positions r1 to rn of the housing and detected by the sensor devices 2-1 to 2-n into the reference position accelerations α1′ to αn′ applied to the reference position of the housing. Therefore, according to the sensor module 1 of the third embodiment, the accelerations α1 to αn can be corrected even when a rotational motion is applied to the sensor devices 2-1 to 2-n.
According to the sensor module 1 of the third embodiment, when the acceleration α1 applied to the first position ri of the housing is set to the reference position acceleration α1′ applied to the first position ri which is the reference position, a calculation load for calculating the reference position accelerations α1′ to αn′ is smaller than that of the sensor module 1 according to the first embodiment.
According to the sensor module 1 of the third embodiment, it is possible to calculate the average acceleration α′ in which random noise components are reduced by averaging processing of the averaging unit 102 of the processing circuit 100. Even when any one of the sensor devices 2-1 to 2-n is out of order, the processing circuit 100 can calculate the average acceleration α′ by using the acceleration detected by the normal sensor device.
Further, according to the sensor module 1 of the third embodiment, for example, the external device can determine, based on the flag flg indicating a determination result obtained by the majority decision unit 104 of the processing circuit 100, whether the three-axis acceleration sensor 27 included in each of the sensor devices 2-1 to 2-n is normal or out of order.
Hereinafter, regarding a sensor module according to a fourth embodiment, the same components as those in the first to third embodiments are denoted by the same reference numerals, description overlapping with that of the first to third embodiments is omitted or simplified, and contents different from those of the first to third embodiments will be mainly described.
In the sensor module 1 according to the fourth embodiment, each of the sensor devices 2-1 to 2-n is an inertia measurement unit. For each integer j of 1 or more and n or less, the sensor device 2-j detects the acceleration αj applied to the j-th position of a housing of the sensor module 1 and detects the angular velocity ω applied to the housing. A configuration of the sensor devices 2-1 to 2-n is the same as that of
As illustrated in
The acceleration conversion unit 101 converts, based on αn average angular velocity ω′ that is an average value of the angular velocities ω1 to ωn calculated by the averaging unit 102 as the angular velocity applied to the housing of the sensor module 1, the accelerations α1 to αn respectively applied to the second to n-th positions r2 to rn and detected by the sensor devices 2-2 to 2-n into the reference position accelerations α1′ to αn′, respectively, the reference position accelerations being the accelerations applied to the first position ri of the housing. The acceleration conversion unit 101 may convert the acceleration αj applied to the j-th position re into the reference position acceleration αj′ based on Equation (6) described above for each integer j of 2 or more and n or less.
The majority decision unit 104 determines whether each of the reference position accelerations α1′ to αn′ is normal by majority decision on the reference position accelerations α1′ to αn′ as in the third embodiment. In addition, the majority decision unit 104 determines whether each of the angular velocities ω1 to ωn is normal based on majority decision on the angular velocities ω1 to ωn.
For example, the majority decision unit 104 calculates an absolute value of difference |ωi−ωj| of ω1 and w for the integers i and j (i≠j) of 1 or more and n or less, and determines that the angular velocities ωk and ω1 are normal when an absolute value |ωk−ωl| is equal to or less than a predetermined threshold for any set of the integers k and l (k≠l). In addition, for any set of integers k, l, and m (k≠l≠m), when the absolute value |ωk−ωl| is larger than the predetermined threshold, an absolute value |ωk−ωm| is larger than a predetermined threshold, and an absolute value |ωl−ωm| is equal to or less than a predetermined threshold, the majority decision unit 104 determines that the angular velocity ωk is abnormal and the angular velocities ωl and ωm are normal.
Alternatively, the majority decision unit 104 calculates an absolute value of ratio |ωi/αj| of ωi and ωj for the integers i and j (i≠j) of 1 or more and n or less, and determines that the angular velocities ωk and ωl are normal when an absolute value of ratio ωk/ωl| is included in a predetermined range for any set of the integers k and l (k≠l). For any set of integers k, l, and m (k≠l≠m), when the absolute value of ratio ωk/ωl| is not included in the predetermined range, an absolute value of ratio |ωk/ωm| is not included in a predetermined range, and an absolute value of ratio |ωl/ωm| is included in a predetermined range, the majority decision unit 104 determines that the angular velocity ωk is abnormal and the angular velocities ωl and ωm are normal.
Then, the majority decision unit 104 generates a first flag flg1 and a second flag flg2 indicating determination results. For example, the first flag flg1 may be n-bit data that is 1 when the reference position accelerations α1′ to αn′ are normal and is 0 when abnormal. Further, the second flag flg2 may be n-bit data that is 1 when the angular velocities ω1 to ωn are normal and is 0 when abnormal.
The averaging unit 102 calculates, based on a majority decision result obtained by the majority decision unit 104, the average acceleration α′, which is αn average value of normal accelerations among the reference position accelerations α1′ to αn′. For example, when the reference position acceleration α1′ is abnormal and the reference position accelerations α2′ to αn′ are normal, the averaging unit 102 calculates the average acceleration α′ of the reference position accelerations α2′ to αn′. In addition, the averaging unit 102 calculates, based on the majority decision result obtained by the majority decision unit 104, the average angular velocity ω′, which is an average value of normal angular velocities among the angular velocities ωl to ωn. For example, when the angular velocity ω1 is abnormal and the angular velocities ω2 to ωn are normal, the averaging unit 102 calculates the average angular velocity ω′ of the angular velocities ω2 to ωn.
The average acceleration α′ and the average angular velocity ω′ which are calculated by the averaging unit 102, and the first flag flg1 and the second flag flg2 which are generated by the majority decision unit 104 are transmitted to an external device (not illustrated) via the communication circuit 120. For example, the external device may perform predetermined calculation using the average acceleration α′ and the average angular velocity ω′.
Other configurations, functions, and structures of the sensor module 1 according to the fourth embodiment are the same as those of the first embodiment, the second embodiment, or the third embodiment, and description thereof will be omitted.
The sensor module 1 according to the fourth embodiment is not limited to the configuration illustrated in
In the sensor module 1 according to the fourth embodiment, the sensor devices 2-1 to 2-n are an example of “first to n-th sensor devices”. The accelerations α1 to αn are an example of “first to n-th accelerations”. Further, the reference position accelerations α1′ to αn′ are αn example of “first to n-th reference position accelerations”. Further, the angular velocities ω1 to ωn are an example of “first to n-th angular velocities”.
In the sensor module 1 according to the fourth embodiment described above, the processing circuit 100 sets the acceleration α1 applied to the first position ri of the housing and detected by the sensor device 2-1 to the reference position acceleration α1′ applied to the first position r1 which is the reference position, and converts, based on the angular velocity ω applied to the housing, the accelerations α2 to αn applied to the second to n-th positions r2 to rn of the housing and detected by the sensor devices 2-2 to 2-n into the reference position accelerations α2′ to αn′ applied to the first position r1. Alternatively, the processing circuit 100 converts, based on the angular velocity ω applied to the housing, the accelerations α1 to αn applied to the first to n-th positions r1 to rn of the housing and detected by the sensor devices 2-1 to 2-n into the reference position accelerations α1′ to αn′ applied to the reference position of the housing. Therefore, according to the sensor module 1 of the fourth embodiment, the accelerations α1 to αn can be corrected even when a rotational motion is applied to the sensor devices 2-1 to 2-n.
According to the sensor module 1 of the fourth embodiment, when the acceleration α1 applied to the first position r1 of the housing is set to the reference position acceleration α1′ applied to the first position r1 which is the reference position, a calculation load for calculating the reference position accelerations α2′ to αn′ is smaller than that of the sensor module 1 according to the first embodiment.
According to the sensor module 1 of the fourth embodiment, it is possible to calculate the average acceleration α′ and the average angular velocity ω′ in which random noise components are reduced by averaging processing of the averaging unit 102 of the processing circuit 100. Even when any one of the sensor devices 2-1 to 2-n is out of order, the processing circuit 100 can calculate the average acceleration α′ and the average angular velocity ω′ by using the acceleration and the angular velocity which are detected by the normal sensor device.
Further, according to the sensor module 1 of the fourth embodiment, for example, the external device can determine, based on the first flag flg1 indicating the determination result obtained by the majority decision unit 104 of the processing circuit 100, whether the three-axis acceleration sensor 27 included in each of the sensor devices 2-1 to 2-n is normal or out of order. For example, the external device can determine, based on the second flag flg2 indicating the determination result obtained by the majority decision unit 104 of the processing circuit 100, whether the first angular velocity sensor 26a, the second angular velocity sensor 26b, and the third angular velocity sensor 26c included in each of the sensor devices 2-1 to 2-n are normal or out of order.
The present disclosure is not limited to the embodiment, and various modifications can be made within the scope of the gist of the present disclosure.
The above-described embodiments and modifications are examples, and the present disclosure is not limited thereto. For example, the embodiments and the modifications may be combined as appropriate.
The present disclosure includes substantially the same configurations as the configurations described in the embodiments, such as a configuration having the same function, method, and result or a configuration having the same object and effect. The present disclosure includes a configuration in which a non-essential portion of the configuration described in the embodiments is replaced. The present disclosure may include a configuration capable of achieving the same function and effect or a configuration capable of achieving the same object as the configuration described in the embodiments. The present disclosure includes a configuration obtained by adding a known technique to the configuration described in the embodiments.
The following contents are derived from the above-described embodiments and modifications.
An aspect of a sensor module includes:
According to the sensor module, since the first to n-th accelerations applied to the first to n-th positions of the housing and detected by the first to n-th sensor devices is converted, based on the angular velocity applied to the housing, into the first to n-th reference position accelerations applied to the reference position, the first to n-th accelerations can be corrected even when a rotational motion is applied to the first to n-th sensor devices.
Another aspect of a sensor module includes: a housing;
According to the sensor module, since the first acceleration applied to the first position of the housing and detected by the first sensor device is set as the first reference position acceleration applied to the first position which is the reference position, and the second to n-th accelerations applied to the second to n-th positions of the housing and detected by the second to n-th sensor devices is converted, based on the angular velocity of the housing, into the second to n-th reference position accelerations applied to the first position, the first to n-th accelerations can be corrected even when a rotational motion is applied to the first to n-th sensor devices.
Further, according to the sensor module, since the first acceleration applied to the first position of the housing can be set as the first reference position acceleration applied to the first position which is the reference position, a calculation load for calculating the first to n-th reference position accelerations is reduced.
In an aspect of the sensor module, the processing circuit may determine whether the first to n-th reference position accelerations match.
According to the sensor module, for example, the external device can determine, based on a determination result, whether all of the acceleration sensors included in the first to n-th sensor devices are normal or at least one of the acceleration sensors is out of order.
In an aspect of the sensor module,
According to the sensor module, for example, the external device can determine, based on the determination result, whether the acceleration sensor included in each of the first to n-th sensor devices is normal or out of order.
In an aspect of the sensor module,
According to the sensor module, it is possible to calculate an acceleration in which random noise components are reduced by averaging. Further, even when any one of the first to n-th sensor devices is out of order, the processing circuit can calculate the average acceleration by using the acceleration detected by the normal sensor devices.
An aspect of the sensor module may further include
In αn aspect of the sensor module,
In αn aspect of the sensor module,
According to the sensor module, it is possible to calculate αn angular velocity in which random noise components are reduced by averaging, and for example, the external device can determine, based on a determination result, whether the angular velocity sensor included in each of the first to n-th sensor devices is normal or out of order.
Number | Date | Country | Kind |
---|---|---|---|
2023-004934 | Jan 2023 | JP | national |