Inertial Measurement Unit
By employing a storage unit with multiple correction parameters and a correction calculation unit, the inertial measurement device improves accuracy by selecting the optimal parameter for each detection range, ensuring precise inertial information detection.
Patent Information
- Application Number
- JP2020181708
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2020-10-29
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2040-10-29
AI Technical Summary
Existing inertial measurement devices fix sensitivity correction parameters based on a narrow detection range, leading to lower correction accuracy.
The inertial measurement device includes a storage unit with multiple correction parameters for different detection ranges, allowing selection of the optimal parameter based on the detection range, and a correction calculation unit to adjust inertial information accordingly.
This approach enhances correction accuracy by using the appropriate correction parameter for the specific detection range, enabling precise inertial information detection across the entire range.
Smart Images

Figure 0007585717000001 
Figure 0007585717000002 
Figure 0007585717000003
Abstract
Description
[Technical field]
[0001] The present invention relates to inertial measurement units. [Background technology]
[0002] As a conventional technology for an inertial measurement unit (IMU) having an angular velocity sensor device and an acceleration sensor device, for example, Patent Document 1 describes a sensor module that converts analog signals output from an angular velocity sensor device and an acceleration sensor device into digital data and performs correction processing such as temperature correction, offset correction, or sensitivity correction on this digital data to achieve high accuracy. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2019-163955 A Summary of the Invention [Problem to be solved by the invention]
[0004] However, in the sensor module described in Patent Document 1, the correction parameters for correcting the sensitivity are fixed to correction parameters calculated from the maximum detection range, so when the detection range of the sensor is narrow, there is a problem that the correction accuracy is reduced compared to the value corrected with the correction parameters calculated from the narrow detection range. [Means for solving the problem]
[0005] The inertial measurement device includes an inertial sensor that outputs inertial information, a memory unit that stores a plurality of correction parameters associated with a range of values of the inertial information, a parameter control unit that selects a selected correction parameter from the plurality of correction parameters, and a correction calculation unit that corrects the inertial information using the selected correction parameter. [Brief description of the drawings]
[0006] [Figure 1] FIG. 1 is a block diagram showing the configuration of an inertial measurement unit according to a first embodiment. [Diagram 2] FIG. 11 is a flowchart showing a method for setting correction parameters in a parameter control unit. [Diagram 3] FIG. 11 is a flowchart showing a correction parameter calculation and inspection method. [Figure 4] FIG. 11 is a block diagram showing the configuration of an inertial measurement unit according to a second embodiment. [Diagram 5] FIG. 11 is a flowchart showing a method for setting correction parameters in a parameter control unit. [Figure 6] FIG. 11 is a block diagram showing the configuration of an inertial measurement unit according to a third embodiment. [Figure 7] FIG. 11 is a flowchart showing a method for setting correction parameters in a parameter control unit. [Figure 8] FIG. 11 is a block diagram showing the configuration of an inertial measurement unit according to a fourth embodiment. [Figure 9] FIG. 11 is a flowchart showing a method for setting correction parameters in a parameter control unit. [Figure 10] FIG. 13 is a diagram showing the configuration of a moving body including an inertial measurement device according to a fifth embodiment. [Figure 11] FIG. 13 is a diagram showing the configuration of a moving body including an inertial measurement device according to a sixth embodiment. [Figure 12] FIG. 1 is a block diagram showing a configuration of a moving body. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0007] 1. First embodiment First, an inertial measurement device 1 according to a first embodiment will be described with reference to FIGS. 1, 2, and 3. FIG.
[0008] 1, the inertial measurement device 1 of this embodiment includes an angular velocity sensor 12 and an acceleration sensor 14 as inertial sensors, a signal processing unit 16, a correction calculation unit 18, a parameter control unit 20, a storage unit 22, and a communication unit 24. Therefore, the inertial information in this embodiment is the angular velocity output from the angular velocity sensor 12 and the acceleration output from the acceleration sensor 14.
[0009] The angular velocity sensor 12 measures the angular velocity in each of three axial directions that intersect with one another, ideally perpendicular to one another, and outputs an analog signal according to the magnitude and direction of the measured three-axis angular velocities.
[0010] The acceleration sensor 14 measures acceleration in each of three axial directions that intersect with one another, ideally perpendicular to one another, and outputs an analog signal according to the magnitude and direction of the measured three-axis acceleration.
[0011] The signal processing unit 16 samples the output signal of the angular velocity sensor 12 at a predetermined sampling interval and converts it into angular velocity data of a digital value. The signal processing unit 16 also samples the output signal of the acceleration sensor 14 at a predetermined sampling interval and converts it into acceleration data of a digital value.
[0012] The angular velocity sensor 12 and the acceleration sensor 14 may have built-in functions such as A / D conversion and temperature compensation.
[0013] Furthermore, the signal processing unit 16 outputs the angular velocity data and acceleration data after A / D conversion processing to the correction calculation unit 18.
[0014] The correction calculation unit 18 performs various processes according to a program stored in the ROM of the storage unit 22 or a recording medium, or a program received from a server via a network and stored in the RAM of the storage unit 22 or a recording medium.
[0015] The correction calculation unit 18 corrects the angular velocity data and acceleration data output from the signal processing unit 16 using selected correction parameters corresponding to the detection range of the angular velocity or acceleration value specified by the user, selected by the parameter control unit 20 from the memory unit 22, which stores a plurality of correction parameters related to the detection range of the angular velocity or acceleration value.
[0016] Furthermore, the correction calculation unit 18 performs a predetermined calculation on the angular velocity data and acceleration data output by the signal processing unit 16 at a predetermined sampling interval, and performs a correction process on the angular velocity data and acceleration data. The corrected angular velocity data and acceleration data output by the correction calculation unit 18 are output to the outside via the communication unit 24. The corrected angular velocity data and acceleration data are stored in the storage unit 22 as angular velocity information and acceleration information.
[0017] In response to a mode setting input by a user from an input unit (not shown) of the correction calculation unit 18, the parameter control unit 20 selects a selected correction parameter corresponding to the mode setting from among multiple correction parameters based on the correction parameter selection information stored in the memory unit 22, and sets the selected correction parameter in the correction calculation unit 18.
[0018] Specifically, as shown in Fig. 2, when the user sets a mode related to the detection range of the value of inertia information in step S11, in step S12, in the case of mode A, a first parameter P1 is selected from the storage unit 22 based on the correction parameter selection information in step S13, and the first parameter P1 is set in the correction calculation unit 18 as the selected correction parameter. In addition, in the case of mode B, a second parameter P2 is selected from the storage unit 22 based on the correction parameter selection information in step S14, and the second parameter P2 is set in the correction calculation unit 18 as the selected correction parameter. In addition, in the case of mode C, a third parameter P3 is selected from the storage unit 22 based on the correction parameter selection information in step S15, and the third parameter P3 is set in the correction calculation unit 18 as the selected correction parameter.
[0019] In this embodiment, the range of the inertial information value is the detection range of the angular velocity or acceleration value of the inertial measurement device 1, and the selected correction parameters are different depending on the difference in the detection range. For example, the first parameter P1 is a correction parameter when the detection range of the angular velocity value is the maximum of ±500 dps, the second parameter P2 is a correction parameter when the detection range of the angular velocity value is ±250 dps, and the third parameter P3 is a correction parameter when the detection range of the angular velocity value is ±100 dps. Therefore, the correction parameter selection information is an association between the mode conditioned by the detection range of the inertial information value and the corresponding correction parameter.
[0020] Ideally, the angular velocity sensor 12 and the acceleration sensor 14 are attached to the inertial measurement unit 1 so that their three axes coincide with the three axes (x-axis, y-axis, z-axis) of the sensor coordinate system, which is an orthogonal coordinate system defined for the inertial measurement unit 1. However, in reality, an error in the mounting angle occurs. Therefore, the signal processing unit 16 also performs a process of converting the angular velocity data and acceleration data into data in the xyz coordinate system using a correction parameter calculated in advance according to the mounting angle error. Furthermore, the signal processing unit 16 also performs a process of temperature-correcting the angular velocity data and acceleration data according to the temperature characteristics of the angular velocity sensor 12 and the acceleration sensor 14.
[0021] The storage unit 22 stores a plurality of correction parameters and correction parameter selection information related to the detection range of the value of the inertia information.
[0022] The storage unit 22 also includes a ROM that stores programs for the correction calculation unit 18 to perform various processes, various programs and data for implementing application functions, and the like.
[0023] In addition, the memory unit 22 is used as a working area for the correction calculation unit 18, and includes a RAM for temporarily storing programs and data read from the ROM, calculation results executed by the correction calculation unit 18 in accordance with various programs, correction parameter selection information, and multiple correction parameters related to the detection range of the inertia information values.
[0024] The storage unit 22 also includes a non-volatile recording medium that stores data that needs to be stored for a long period of time among the data generated by the processing of the correction calculation unit 18. The recording medium may store programs for the correction calculation unit 18 to perform various processes, various programs and data for implementing application functions, and the like.
[0025] The communication unit 24 is capable of transmitting the inertial information corrected by the correction calculation unit 18 in accordance with the detection range of the value of the inertial information to other devices, etc., and is capable of receiving control signals, etc. from other devices, etc.
[0026] Next, a method for calculating the correction parameters and inspecting the inertial measurement unit 1 according to this embodiment will be described with reference to Fig. 3. Note that the correction parameter calculation and inspection method will be described by taking as an example an inertial measurement unit 1 having an angular velocity sensor 12 with a detection range of ±500 dps.
[0027] As shown in FIG. 3, the correction parameter calculation and inspection method according to this embodiment includes an inertial information acquisition process, a first parameter calculation process, a second parameter calculation process, a third parameter calculation process, a first parameter inspection process, a second parameter inspection process, and a third parameter inspection process.
[0028] 1.1 Inertial information acquisition process First, in step S101, a known angular velocity in the angular velocity range of ±500 dps is applied to the inertial measurement unit 1 in steps of, for example, 5 dps, and angular velocity data output from the signal processing unit 16 of the inertial measurement unit 1 is obtained.
[0029] 1.2 First parameter calculation process Next, in step S102, a correction coefficient for nonlinearity, which is an error relative to the linearity of the known angular velocity value, is calculated by the least squares method or the like from the known angular velocity values in the angular velocity range of ±500 dps acquired in step S101 and the angular velocity data output from the signal processing unit 16, to obtain a first parameter P1.
[0030] 1.3 Second parameter calculation process Next, in step S103, from the known angular velocity values in the angular velocity range of ±500 dps acquired in step S101 and the angular velocity data output from the signal processing unit 16, the known angular velocity values in the angular velocity range of ±250 dps and the angular velocity data output from the signal processing unit 16 are extracted, and a correction coefficient for non-linearity, which is an error relative to the linearity of the known angular velocity values, is calculated by the least squares method or the like, to obtain a second parameter P2.
[0031] 1.4 Third parameter calculation process Next, in step S104, from the known angular velocity values in the angular velocity range of ±500 dps acquired in step S101 and the angular velocity data output from the signal processing unit 16, the known angular velocity values in the angular velocity range of ±100 dps and the angular velocity data output from the signal processing unit 16 are extracted, and a correction coefficient for nonlinearity, which is an error relative to the linearity of the known angular velocity values, is calculated by the least squares method or the like, to obtain a third parameter P3.
[0032] 1.5 First parameter inspection process Next, in step S105, a known angular velocity in the angular velocity range of ±500 dps is applied to the inertial measurement unit 1, and a correction calculation is performed using the first parameter P1 to obtain angular velocity data output from the correction calculation unit 18. The known angular velocity value and the corrected angular velocity data are compared to check whether they are within a desired inspection error.
[0033] 1.6 Second parameter inspection process Next, in step S106, a known angular velocity in the angular velocity range of ±250 dps is applied to the inertial measurement unit 1, and a correction calculation is performed using the second parameter P2 to obtain angular velocity data output from the correction calculation unit 18. The known angular velocity value and the corrected angular velocity data are compared to check whether they are within a desired inspection error.
[0034] 1.7 Third parameter inspection process Next, in step S107, a known angular velocity in the angular velocity range of ±100 dps is applied to the inertial measurement unit 1, and a correction calculation is performed using the third parameter P3 to obtain angular velocity data output from the correction calculation unit 18. The known angular velocity value and the corrected angular velocity data are compared to check whether they are within a desired inspection error.
[0035] In this embodiment, a known angular velocity is applied to the inertial measurement unit 1 and the correction parameter is calculated, but it is also possible to prepare a reference inertial measurement unit, apply any angular velocity within the detection range to the reference inertial measurement unit and the inertial measurement unit 1 for calculating the correction parameter, and calculate the correction parameter from the angular velocity data output by the reference inertial measurement unit and the angular velocity data output by the inertial measurement unit 1 for calculating the correction parameter.
[0036] As described above, in the inertial measurement device 1 of this embodiment, the parameter control unit 20 selects a selected correction parameter from a plurality of correction parameters related to the detection range of the value of the inertial information based on the correction parameter selection information, and the correction calculation unit 18 corrects the inertial information such as angular velocity data and acceleration data using the selected correction parameter according to the detection range of the value of the inertial information. Therefore, when the detection range is narrow, the correction can be performed using the correction parameter for the narrow detection range, compared to when the correction parameter is only the correction parameter for the maximum detection range, so that when the detection range is narrow, the inertial information can be corrected with high accuracy. Therefore, with one inertial measurement device 1, the entire range of the detection range of the value of the inertial information can be detected with high accuracy.
[0037] In this embodiment, the angular velocity data is corrected according to the detection range of the angular velocity value, but the present invention is not limited to this, and the acceleration data may be corrected according to the detection range of the acceleration value. Furthermore, the angular velocity data or the acceleration data may be corrected according to the detection range of the angular velocity and acceleration values. Furthermore, the angular velocity data and the acceleration data may be corrected according to the detection range of the angular velocity and acceleration values.
[0038] 2. Second Embodiment Next, the inertial measurement device 1a according to the second embodiment will be described with reference to FIGS. 4 and 5.
[0039] The inertial measurement device 1a of this embodiment is the same as the inertial measurement device 1 of the first embodiment, except that the parameter control unit 20a selects a selection correction parameter from a plurality of correction parameters based on the inertial information output from the signal processing unit 16. Note that the description will focus on the differences from the above-described first embodiment, and the description of similar matters will be omitted.
[0040] As shown in FIG. 4, the correction calculation unit 18 performs correction processing on the angular velocity data and the acceleration data using the selection correction parameter selected by the parameter control unit 20a from a plurality of correction parameters based on the angular velocity data, which is the inertial information output from the signal processing unit 16.
[0041] Based on the angular velocity data output from the signal processing unit 16, the parameter control unit 20a selects a selection correction parameter corresponding to the angular velocity data from among the plurality of correction parameters stored in the storage unit 22 and sets it in the correction calculation unit 18.
[0042] Specifically, as shown in FIG. 5, in step S21, the angular velocity data from the signal processing unit 16 is detected. In step S22, when the assumed angular velocity D, which is the detected angular velocity, is D < y, in step S23, the first parameter P1 is selected from the storage unit 22 and set in the correction calculation unit 18. Here, y is, for example, ±250 dps, and the first parameter P1 is, for example, a correction parameter when the detection range of the angular velocity value is ±500 dps.
[0043] When the assumed angular velocity D satisfies x ≤ D ≤ y, in step S24, the second parameter P2 is selected from the storage unit 22 and set in the correction calculation unit 18. Here, x is, for example, ±100 dps, and the second parameter P2 is, for example, a correction parameter when the detection range of the angular velocity value is ±250 dps.
[0044] Also, when the assumed angular velocity D is less than D<x, in step S25, the third parameter P3 is selected from the storage unit 22 and set in the correction calculation unit 18. Note that the third parameter P3 is, for example, a correction parameter when the detection range of the angular velocity value is ±100 dps.
[0045] With such a configuration, the inertial measurement device 1a of the present embodiment can automatically select an optimal selection correction parameter according to the angular velocity data based on the angular velocity data output from the signal processing unit 16, which is inertial information. Therefore, the angular velocity data can be corrected more accurately.
[0046] Note that in the present embodiment, the angular velocity data is corrected based on the angular velocity data output from the signal processing unit 16. However, the present invention is not limited to this, and the acceleration data may be corrected based on the angular velocity data output from the signal processing unit 16. Also, the angular velocity data may be corrected based on the acceleration data output from the signal processing unit 16. Further, the angular velocity data and the acceleration data may be corrected based on the angular velocity data and the acceleration data output from the signal processing unit 16.
[0047] 3. Third Embodiment Next, the inertial measurement device 1b according to the third embodiment will be described with reference to FIGS. 6 and 7.
[0048] The inertial measurement device 1b of the present embodiment is the same as the inertial measurement device 1 of the first embodiment, except that the parameter control unit 20b selects a selection correction parameter from a plurality of correction parameters based on external information from the communication unit 24. Note that the description will focus on the differences from the above-described first embodiment, and the description of the same matters will be omitted.
[0049] As shown in FIG. 6, based on the Pulse signal, which is external information from the communication unit 24, the correction calculation unit 18 performs correction processing on the angular velocity data and the acceleration data using the selected correction parameter selected by the parameter control unit 20b from a plurality of correction parameters. Note that the Pulse signal is, for example, an acceleration pulse signal obtained by measuring the acceleration of a moving body equipped with the inertial measurement device 1b, or a PPS (Pulse Per Second) signal output from a GPS attached to the moving body.
[0050] Based on the Pulse signal, which is external information from the communication unit 24, the parameter control unit 20b selects a selected correction parameter corresponding to the Pulse signal from among the plurality of correction parameters stored in the storage unit 22, and sets it in the correction calculation unit 18.
[0051] Specifically, as shown in FIG. 7, in step S51, the acceleration is detected from the Pulse signal from the communication unit 24. In step S52, when the assumed acceleration E, which is the detected acceleration, is E < x, in step S53, the first parameter P1 is selected from the storage unit 22 and set in the correction calculation unit 18. Note that x is, for example, 1G, and the first parameter P1 is, for example, a correction parameter when the detection range of the angular velocity value is ±500 dps.
[0052] Also, when x ≤ E ≤ y, in step S54, the second parameter P2 is selected from the storage unit 22 and set in the correction calculation unit 18. Note that y is, for example, 5G, and the second parameter P2 is, for example, a correction parameter when the detection range of the angular velocity value is ±250 dps.
[0053] Also, when y < E, in step S55, the third parameter P3 is selected from the storage unit 22 and set in the correction calculation unit 18. Note that the third parameter P3 is, for example, a correction parameter when the detection range of the angular velocity value is ±100 dps.
[0054] With this configuration, the inertial measurement unit 1b of this embodiment can automatically select optimal correction parameters based on the pulse signal, which is external information, and can therefore correct angular velocity data more accurately.
[0055] In this embodiment, the angular velocity data is corrected based on the pulse signal, which is external information, but the present invention is not limited to this, and the acceleration data may be corrected based on the pulse signal. Moreover, both the angular velocity data and the acceleration data may be corrected based on the pulse signal.
[0056] 4. Fourth embodiment Next, an inertial measurement device 1c according to a fourth embodiment will be described with reference to FIGS.
[0057] The inertial measurement unit 1c of this embodiment is similar to the inertial measurement unit 1 of the first embodiment, except that the configuration of the correction calculation unit 18c is different and a parameter control unit 20c selects at least two correction parameters as selected correction parameters based on external information from a communication unit 24, multiplies each of the selected correction parameters by a weighting coefficient set in a weighting coefficient switching unit 26, and adds them up. Note that the following description will focus on the differences from the first embodiment described above, and a description of similar points will be omitted.
[0058] As shown in FIG. 8, the inertial measurement device 1c includes a correction calculation unit 18c having a first correction calculation unit 181, a second correction calculation unit 182, and a third correction calculation unit 183, a parameter control unit 20c, and a weighting factor switching unit 26. The parameter control unit 20c selects at least two correction parameters as selected correction parameters based on a Pulse signal that is external information from the communication unit 24, multiplies each of the selected correction parameters by a weighting factor R, performs a correction calculation for the inertial information, and adds the results of the correction calculation, thereby performing a correction process for the inertial information. Note that the Pulse signal is, for example, a vehicle speed pulse signal that measures the speed of a moving body such as an automobile t equipped with the inertial measurement device 1c. In this embodiment, a case in which three correction parameters are selected will be described as an example.
[0059] The first correction calculation unit 181 performs a correction calculation for the inertia information using a correction parameter obtained by multiplying the first parameter P1 selected by the parameter control unit 20c by the weighting factor R set by the weighting factor switching unit .
[0060] The second correction calculation unit 182 performs a correction calculation for the inertia information using a correction parameter obtained by multiplying the second parameter P2 selected by the parameter control unit 20c by the weighting factor R set by the weighting factor switching unit .
[0061] The third correction calculation unit 183 performs a correction calculation for the inertia information using a correction parameter obtained by multiplying the third parameter P3 selected by the parameter control unit 20c by the weighting factor R set by the weighting factor switching unit .
[0062] The parameter control unit 20c multiplies a first parameter P1 selected from the multiple correction parameters stored in the memory unit 22 by a weighting coefficient R corresponding to the first parameter P1 set in the weighting coefficient switching unit 26, and sets the result in the first correction calculation unit 181.
[0063] The parameter control unit 20c multiplies a second parameter P2 selected from the multiple correction parameters stored in the memory unit 22 by a weighting coefficient R corresponding to the second parameter P2 set in the weighting coefficient switching unit 26, and sets the result in the second correction calculation unit 182.
[0064] The parameter control unit 20c multiplies a third parameter P3 selected from the multiple correction parameters stored in the memory unit 22 by a weighting coefficient R corresponding to the third parameter P3 set in the weighting coefficient switching unit 26, and sets the result in the third correction calculation unit 183.
[0065] The weighting factor switching unit 26 switches the weighting factor R for the first parameter P1, the weighting factor R for the second parameter P2, and the weighting factor R for the third parameter P3 based on a Pulse signal that is external information from the communication unit 24.
[0066] As shown in Fig. 9, the correction process of the inertia information in the correction calculation unit 18c first detects the speed from the pulse signal from the communication unit 24 in step S31. Next, in step S32, conditions are determined according to the estimated speed F, which is the detected speed. Note that x is, for example, 10 Km / h, and y is, for example, 80 Km / h. The first parameter P1 is, for example, a correction parameter when the detection range of the angular velocity value is ±500 dps, the second parameter P2 is, for example, a correction parameter when the detection range of the angular velocity value is ±250 dps, and the third parameter P3 is, for example, a correction parameter when the detection range of the angular velocity value is ±100 dps.
[0067] When the assumed speed F is less than F<x, in step S33, the inertial information is corrected and calculated by the first correction calculation unit 181 using the first parameter P1 multiplied by the weight coefficient R1 (for example, 0.6) set by the weight coefficient switching unit 26. Next, in step S34, the inertial information is corrected and calculated by the second correction calculation unit 182 using the second parameter P2 multiplied by the weight coefficient R2 (for example, 0.3) set by the weight coefficient switching unit 26. In step S35, the inertial information is corrected and calculated by the third correction calculation unit 183 using the third parameter P3 multiplied by the weight coefficient R3 (for example, 0.1) set by the weight coefficient switching unit 26. Then, in step S36, the calculation result of the first correction calculation unit 181, the calculation result of the second correction calculation unit 182, and the calculation result of the third correction calculation unit 183 are added together to obtain the correction result of the inertial information.
[0068] When the assumed speed F satisfies x≦F≦y, in step S37, the inertial information is corrected and calculated by the first correction calculation unit 181 using the first parameter P1 multiplied by the weight coefficient R4 (for example, 0.2) set by the weight coefficient switching unit 26. Next, in step S38, the inertial information is corrected and calculated by the second correction calculation unit 182 using the second parameter P2 multiplied by the weight coefficient R5 (for example, 0.6) set by the weight coefficient switching unit 26. In step S39, the inertial information is corrected and calculated by the third correction calculation unit 183 using the third parameter P3 multiplied by the weight coefficient R6 (for example, 0.2) set by the weight coefficient switching unit 26. Then, in step S40, the calculation result of the first correction calculation unit 181, the calculation result of the second correction calculation unit 182, and the calculation result of the third correction calculation unit 183 are added together to obtain the correction result of the inertial information.
[0069] When the assumed speed F satisfies y < F, in step S41, the inertial information is corrected and calculated by the first correction calculation unit 181 using the first parameter P1 multiplied by the weight coefficient R7 (for example, 0.1) set by the weight coefficient switching unit 26. Next, in step S42, the inertial information is corrected and calculated by the second correction calculation unit 182 using the second parameter P2 multiplied by the weight coefficient R8 (for example, 0.3) set by the weight coefficient switching unit 26. In step S43, the inertial information is corrected and calculated by the third correction calculation unit 183 using the third parameter P3 multiplied by the weight coefficient R9 (for example, 0.6) set by the weight coefficient switching unit 26. Then, in step S44, the calculation results of the first correction calculation unit 181, the calculation result of the second correction calculation unit 182, and the calculation result of the third correction calculation unit 183 are added together to obtain the correction result of the inertial information.
[0070] With such a configuration, the inertial measurement device 1c of the present embodiment can automatically switch the weight coefficient R of the selection correction parameter according to the movement of a moving body such as an automobile from the Pulse signal which is external information, so that the inertial information can be corrected more accurately.
[0071] 5. Fifth Embodiment Next, a moving body 100 equipped with the inertial measurement devices 1, 1a, 1b, 1c according to the fifth embodiment will be described with reference to FIG. 10. In the following description, a configuration applying the inertial measurement device 1b will be exemplified and described. The inertial measurement device 1b of the above embodiment can be effectively used in attitude control of a flying device, and a drone which is an example of a flying device will be cited as the moving body 100 for explanation.
[0072] As shown in FIG. 10, the moving body 100 includes an inertial measurement device 1b and an acceleration sensor 114. Based on the acceleration information from the acceleration sensor 114 which is external information from the communication unit 24, the inertial measurement device 1b selects a selection correction parameter corresponding to the acceleration information from a plurality of correction parameters related to the detection range of the value of the inertial information of the inertial measurement device 1b, and corrects the inertial information using the selected selection correction parameter. Therefore, when the moving body 100 is hovering and moving at a low speed, for example, the angular velocity does not change significantly, so the angular velocity data can be corrected using a correction parameter with a narrow detection range, and when the moving body 100 is moving at a high speed, for example, the angular velocity may change significantly, so the angular velocity data can be corrected using a correction parameter with a wide detection range. Therefore, the attitude of the moving body 100 can be controlled with high accuracy.
[0073] In this embodiment, the optimal selective correction parameters can be automatically selected according to the inertial information based on the acceleration information from the moving body 100, so that the inertial information can be corrected more accurately, which is effective in posture control of the moving body 100, etc.
[0074] 6. Sixth embodiment Next, a moving body 600 including the inertial measurement devices 1, 1a, 1b, and 1c according to a sixth embodiment will be described with reference to Fig. 11 and Fig. 12. In the following description, a configuration to which the inertial measurement device 1 is applied will be described as an example. The inertial measurement system 1 of the above embodiment can be effectively used for controlling the attitude of construction machinery, and a hydraulic excavator, which is an example of construction machinery, will be described as the moving body 600.
[0075] 11, the moving body 600 is composed of a vehicle body including a lower running body 612 and an upper rotating body 611 rotatably mounted on the lower running body 612, and a working mechanism 620 composed of a plurality of members rotatable in the vertical direction is provided on the front side of the upper rotating body 611. A driver's seat (not shown) is provided on the upper rotating body 611, and an operating device (not shown) for operating each member constituting the working mechanism 620 is provided on the driver's seat. The inertial measurement unit 1 of the above embodiment is disposed on the upper rotating body 611 and functions as an inclination sensor for detecting the inclination angle of the upper rotating body 611.
[0076] The working mechanism 620 comprises, as multiple components, a boom 613 attached to the front side of the upper rotating body 611 so as to be able to move up and down, an arm 614 attached to the tip side of the boom 613 so as to be able to move up and down, a bucket link 616 rotatably attached to the tip side of the arm 614, a bucket 615 rotatably attached to the tips of the arm 614 and the bucket link 616, a boom cylinder 617 that drives the boom 613, an arm cylinder 618 that drives the arm 614, and a bucket cylinder 619 that drives the bucket 615 via the bucket link 616.
[0077] A base end side of the boom 613 is supported by the upper rotating body 611 so as to be rotatable in the vertical direction, and the boom 613 is rotated relative to the upper rotating body 611 by the extension and contraction of a boom cylinder 617. An inertial measurement unit 103 that functions as an inertial sensor that detects the movement state of the boom 613 is disposed on the boom 613.
[0078] One end of an arm 614 is rotatably supported on the tip side of the boom 613, and the arm 614 is rotated relative to the boom 613 by the extension and contraction of an arm cylinder 618. An inertial measurement unit 102 that functions as an inertial sensor that detects the state of movement of the arm 614 is disposed on the arm 614.
[0079] A bucket link 616 and a bucket 615 are rotatably supported on the tip side of the arm 614, and the bucket link 616 is rotationally driven relative to the arm 614 in response to the expansion and contraction of a bucket cylinder 619, and in conjunction with this, the bucket 615 is rotationally driven relative to the arm 614. An inertial measurement unit 101 that functions as an inertial sensor that detects the movement state of the bucket link 616 is disposed on the bucket link 616.
[0080] The inertial measurement units 101, 102, and 103 can detect at least one of the angular velocity and acceleration acting on each member of the working mechanism 620 and the upper rotating body 611. The inertial measurement units 101, 102, and 103 are connected in series as shown in Fig. 12, and can transmit detection signals to the arithmetic unit 630. By connecting the inertial measurement units 101, 102, and 103 in series in this way, the number of wires for transmitting detection signals within the movable range can be reduced, and a compact wiring structure can be obtained. The compact wiring structure makes it easier to select a wiring installation method, and makes it possible to reduce the occurrence of deterioration and damage of the wiring.
[0081] Furthermore, the moving body 600 is provided with a calculation device 630 that calculates the tilt angle of the upper rotating body 611 and the positions and attitudes of the boom 613, the arm 614, and the bucket 615 that configure the working mechanism 620, as shown in FIG. 12. As shown in FIG. 12, the calculation device 630 includes a posture estimation device 631 and a control device 632. The posture estimation device 631 estimates posture information of the moving body 600 based on output signals from the inertial measurement units 1, 101, 102, and 103. The control device 632 controls the posture of the moving body 600 based on the posture information of the moving body 600 estimated by the posture estimation device 631. Specifically, the calculation device 630 inputs various detection signals from the inertial measurement units 1, 101, 102, and 103, and calculates the positions, postures, or posture angles of the boom 613, the arm 614, and the bucket 615 and the tilt state of the upper rotating body 611 based on the various detection signals. The calculated position and attitude signals including the attitude angles of the boom 613, arm 614, and bucket 615 and the tilt signal including the attitude angle of the upper rotating body 611, for example the position and attitude signal of the bucket 615, are used for display on a monitor device (not shown) in the driver's seat or as feedback information for controlling the operation of the work mechanism 620 and the upper rotating body 611.
[0082] In addition, examples of construction machinery in which the inertial measurement device 1 of the above embodiment can be used include, in addition to the hydraulic excavators (backhoes, backhoes, and power shovels) exemplified above, rough terrain cranes (crane trucks), bulldozers, excavators / loaders, wheel loaders, and aerial work vehicles (lift trucks).
[0083] According to this embodiment, the inertial measurement unit 1 can obtain attitude information with high accuracy, thereby realizing appropriate attitude control of the moving body 600. In addition, since the moving body 600 is equipped with a compact inertial measurement unit 1, it is possible to provide a construction machine in which, even within an extremely limited small area such as the bucket link 616, multiple inertial measurement units 1 can be connected in series (multi-connected) at each installation location of the inertial measurement units 1 and arranged compactly, and the cables connecting the inertial measurement units 1 installed at each location in series can be laid out compactly.
[0084] In this embodiment, four-wheeled automobiles such as agricultural machinery and construction machinery are used as examples of moving bodies in which the inertial measurement unit 1 can be used. However, other examples include motorcycles, bicycles, trains, airplanes, bipedal robots, remote-controlled or autonomous flying bodies such as radio-controlled airplanes, radio-controlled helicopters, and drones, rockets, artificial satellites, ships, and AGVs (automated guided vehicles).
[0085] In addition to moving bodies, examples of applications in which the inertial measurement unit 1 is used include wearable devices such as smartphones, tablet terminals, smart watches, smart glasses, and HMDs (head-mounted displays), as well as electronic devices such as cameras and video cameras with stabilizers. [Explanation of symbols]
[0086] 1, 1a, 1b, 1c... inertial measurement device, 12... angular velocity sensor, 14... acceleration sensor, 16... signal processing unit, 18... correction calculation unit, 20... parameter control unit, 22... memory unit, 24... communication unit, 26... weighting coefficient switching unit, 100, 600... moving body.
Claims
[Claim 1] an angular velocity sensor that detects an angular velocity and outputs an analog output signal; an acceleration sensor that detects acceleration and outputs an analog output signal; The output signal of the angular velocity sensor is sampled at a predetermined sampling interval and digitalized. The output signal of the acceleration sensor is converted into angular velocity data of a predetermined sampling value. a signal processing unit for sampling at intervals and converting the sampled data into digital acceleration data; A storage unit that stores a plurality of correction parameters; At least one of the angular velocity data and the acceleration data output from the signal processing unit A parameter for selecting a selected correction parameter from the plurality of correction parameters based on the method. a controller; The angular velocity data output from the signal processing unit using the selected correction parameter. and a correction calculation unit for correcting at least one of the acceleration data. Equipped with Inertial measurement unit.
Citation Information
Patent Citations
Circuit device, physical quantity detection device, electronic apparatus, and movable body
JP2018028473A
Sensor module, measurement system, electronic device, and mobile object
JP2019163955A
