Acceleration detection device, working machine and acceleration detection method
By combining non-mechanical acceleration sensors and mechanical acceleration sensors, and using the correction value calculation department to perform data correction, the problem of performance changes of mechanical acceleration sensors in temperature, vibration and impact environments is solved, and the accuracy and stability of acceleration detection are improved sex.
Patent Information
- Application Number
- CN202080061773.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2019-10-18
- Filing Date
- 2020-10-12
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2040-10-12
AI Technical Summary
The performance of mechanical acceleration sensors is prone to change in temperature, vibration and impact environments, resulting in changes in performance after calibration and affecting the acceleration detection accuracy.
The tilt sensor using a non-mechanical acceleration sensor is combined with a mechanical acceleration sensor. The calibration value calculation unit uses the data of the non-mechanical acceleration sensor to correct the mechanical acceleration sensor to reduce performance changes.
It effectively reduces the performance changes of mechanical acceleration sensors in detection and improves the accuracy and stability of acceleration detection.
Smart Images

Figure CN114341651B_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to an acceleration detection device, a working machine, and an acceleration detection method.
[0002] This application claims priority to Japanese Patent Application No. 2019-191351 filed in Japan on October 18, 2019, the contents of which are incorporated herein by reference. Background Art
[0003] For example, as shown in Patent Document 1, an IMU (Inertial Measurement Unit) is installed on a hydraulic excavator, a bulldozer, or other working machine, and the IMU can be used to obtain attitude angles such as roll angle and pitch angle as information related to the inclination of the working machine. It should be noted that the IMU is a measuring device having a three-axis gyro sensor and a three-axis acceleration sensor.
[0004] Prior Art Literature
[0005] Patent Literature
[0006] Patent Document 1: International Publication No. 2015 / 177843 Summary of the invention
[0007] Problems to be solved by the invention
[0008] As an acceleration sensor provided by the IMU, for example, an acceleration sensor using electrostatic capacitance detection as a mechanical sensor is used. The acceleration sensor using electrostatic capacitance detection has a fixed electrode and a movable electrode, and detects acceleration based on the change in electrostatic capacitance between the fixed electrode and the movable electrode corresponding to the acceleration. In the acceleration sensor having a mechanical movable part as described above, the performance changes when an environment such as temperature, vibration, and impact is applied. Therefore, depending on the use environment, there is a case where the performance of the acceleration sensor changes from the performance at the time of shipment after calibration.
[0009] The present disclosure has been made in view of the above circumstances, and an object of the present disclosure is to provide an acceleration detection device, a working machine, and an acceleration detection method that can reduce performance variation.
[0010] Means for solving problems
[0011] In order to solve the above-mentioned problems, one method of the present invention is an acceleration detection device, which includes: a first acceleration acquisition unit, which acquires a first acceleration from a mechanical acceleration sensor; a second acceleration acquisition unit, which acquires a second acceleration from a non-mechanical acceleration sensor; and a correction value calculation unit, which uses the second acceleration calculation to correct the correction value of the first acceleration.
[0012] Effects of the Invention
[0013] According to each aspect of the present disclosure, it is possible to reduce the variation in the performance of the mechanical acceleration sensor in detecting acceleration. BRIEF DESCRIPTION OF THE DRAWINGS
[0014] Figure 1 It is a perspective view of a working machine according to an embodiment of the present disclosure.
[0015] Figure 2 It is shown Figure 1 A block diagram of a configuration example of the IMU 30 shown.
[0016] Figure 3 It is shown Figure 2 Flowchart of an example of the operation of the correction value calculation unit 315 shown in FIG. DETAILED DESCRIPTION
[0017] Hereinafter, embodiments of the present disclosure will be described with reference to the accompanying drawings. It should be noted that in each of the drawings, the same or corresponding structures are denoted by the same reference numerals, and the description thereof will be appropriately omitted.
[0018] Figure 1 It is a perspective view of a working machine according to an embodiment of the present disclosure. Figure 2 It is shown Figure 1 The block diagram of the configuration example of the IMU (Inertial Measurement Unit) 30 shown in FIG. 1 is a hydraulic excavator 100 as a working machine, which has a vehicle body 1 and a working device 2. The vehicle body 1 has an upper revolving body 3 as a revolving body, and a traveling device 5 as a traveling body. An equipment room 3EG is arranged on the rear end side of the upper revolving body 3.
[0019] In this embodiment, the hydraulic excavator 100 is provided with an internal combustion engine such as a diesel engine as a power generation device in the equipment room 3EG, and a hydraulic pump that converts the power generated by the power generation device into the pressure of the working oil (hereinafter, appropriately referred to as the hydraulic pressure). However, the power generation device is not limited to the internal combustion engine. The power generation device of the hydraulic excavator 100 may also be a so-called hybrid power device that combines an internal combustion engine, a generator motor, and a power storage device.
[0020] The upper revolving body 3 has a cab 4. The cab 4 is provided at the front end side of the upper revolving body 3. That is, the cab 4 is provided at the side opposite to the side where the equipment room 3EG is provided. Display devices, operating devices, etc. not shown in the figure are provided in the cab 4. In addition, an IMU 30 and a vehicle body controller 40 are provided at the lower part of the cab 4. The vehicle body controller 40 controls sensors such as the IMU 30, and controls a power generation device, a hydraulic control valve described later, etc. according to operations performed on the operating devices by an operator, etc.
[0021] The travel device 5 has crawler tracks 5a and 5b. The travel device 5 is driven by one or both of the hydraulic motors 5c provided on the left and right sides to rotate the crawler tracks 5a and 5b, thereby causing the hydraulic excavator 100 to travel forward and backward or to turn. The working device 2 is mounted on the side of the cab 4 of the upper turning body 3.
[0022] It should be noted that the hydraulic excavator 100 may also include a travel device such as the following, which includes tires instead of the crawler tracks 5a and 5b, and transmits the driving force from the engine or the like housed in the equipment room 3EG to the tires via a transmission, so that the hydraulic excavator 100 can be driven. As a hydraulic excavator 100 of the above-mentioned type, for example, there is a wheel-type hydraulic excavator. In addition, the hydraulic excavator 100 may also be a backhoe loader having a structure such as the following, in which a working device is installed on the vehicle body and the travel device having tires constituting a part of the vehicle body.
[0023] In addition, for the upper swing body 3, the side where the work implement 2 and the cab 4 are arranged is the front, and the side where the equipment room 3EG is arranged is the rear. The left side when facing forward is the left of the upper swing body 3, and the right side when facing forward is the right of the upper swing body 3. In addition, for the hydraulic excavator 100 or the vehicle body 1, the side of the travel device 5 is the bottom with the upper swing body 3 as the reference, and the side of the upper swing body 3 is the top with the travel device 5 as the reference. When the hydraulic excavator 100 is installed on a horizontal plane, the bottom is the vertical direction, that is, the direction of action of gravity, and the top is the side opposite to the vertical direction.
[0024] The working device 2 includes a boom 6, an arm 7, a bucket 8, a boom cylinder 10, an arm cylinder 11, and a bucket cylinder 12. The base end of the boom 6 is swingably mounted to the front portion of the upper revolving body 3 via a boom pin 13. The base end of the arm 7 is swingably mounted to the front end of the boom 6 via an arm pin 14. The bucket 8 is mounted to the front end of the arm 7 via a bucket pin 15. The bucket 8 swings around the bucket pin 15. The bucket 8 is mounted with a plurality of teeth 8B on the side opposite to the bucket pin 15.
[0025] The bucket 8 may not have a plurality of teeth 8B. In other words, for example, the bucket may be one in which the blade tip is formed into a straight shape by a steel plate. In addition, the working device 2 may also include a tilting bucket having one tooth, for example. The tilting bucket refers to a bucket that is provided with a bucket tilt cylinder, and the bucket is tilted to the left or right, so that even if the hydraulic excavator is on an inclined ground, the inclined surface and the flat ground can be formed into a free shape and leveled, and rolling operations based on the bottom plate can also be performed. In addition, the working device 2 may also include a bucket for slopes instead of the bucket 8, or an accessory for rock drilling having a rock drilling chisel, etc.
[0026] Figure 1 The boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 are hydraulic cylinders driven by hydraulic pressure. The boom cylinder 10 drives the boom 6 to move up and down. The arm cylinder 11 drives the arm 7 to rotate around the arm pin 14. The bucket cylinder 12 drives the bucket 8 to rotate around the bucket pin 15.
[0027] A hydraulic control valve (not shown) is provided between the hydraulic cylinders such as the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 and the hydraulic pump accommodated in the equipment room 3EG. The hydraulic control valve includes a travel control valve for driving the hydraulic motor 5c, and a work device control valve for controlling the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the slewing motor for slewing the upper slewing body 3. The vehicle body controller 40 controls the flow rate of the working oil supplied to the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, the slewing motor or the hydraulic motor 5c by controlling these hydraulic control valves. As a result, the actions of the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, etc. are controlled.
[0028] In addition, antennas 20 and 21 are installed on the upper part of the upper rotating body 3. The antennas 20 and 21 are used to detect the current position of the hydraulic excavator 100. The antennas 20 and 21 are electrically connected to a position detection device (not shown) for detecting the current position of the hydraulic excavator 100. The position detection device uses RTK-GNSS (Real Time Kinematic-Global Navigation Satellite SYstems, GNSS is called Global Navigation Satellite System) to detect the current position of the hydraulic excavator 100, and outputs the detected position information to the vehicle body controller 40. The signal corresponding to the GNSS radio wave received by the antennas 20 and 21 is input to the position detection device. The position detection device detects the setting position of the antennas 20 and 21. Figure 1 As shown, the antennas 20 and 21 are preferably provided on the upper swing body 3 at both end positions separated in the left-right direction of the hydraulic excavator 100 .
[0029] like Figure 2As shown, the IMU 30 and the vehicle body controller 40 are connected via an in-vehicle signal line 41, and transmit and receive predetermined control signals to each other. In addition, the vehicle body controller 40 is connected to a display device, an operating device, etc. (not shown) provided in the cab 4 via the in-vehicle signal line 41, etc., and communicates with the vehicle body controller 40. Figure 1 Various sensors not shown in the figure are connected, such as a sensor for detecting the stroke of the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12, a sensor for detecting the angle of the boom 6 and the angle of the arm 7, and a sensor for detecting the rotation angle of the upper rotating body 3. As sensors for detecting the stroke of the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12, a proximity sensor, a rotary encoder, etc. that detects the extension and contraction amount of each hydraulic cylinder can be used. In addition, an encoder not shown in the figure may be provided at the base end of the boom 6 and the base end of the arm 7, and the detection value of the proximity sensor or the rotary encoder that detects the extension and contraction amount of each hydraulic cylinder can be reset by the encoder.
[0030] The IMU 30 detects the angular velocity and acceleration of the hydraulic excavator 100. As the hydraulic excavator 100 moves, various accelerations such as acceleration generated during travel, angular acceleration generated during rotation, and gravity acceleration are generated. However, the IMU 30 detects accelerations including at least gravity acceleration, and detects them in a manner that does not distinguish between the types of accelerations. In order to detect acceleration with higher accuracy, the IMU 30 is preferably installed on the rotation center axis of the upper rotating body 3 of the hydraulic excavator 100, for example, but the IMU 30 may also be installed at the lower part of the cab 4 as described above.
[0031] IMU30 Figure 1 In the coordinate system (X, Y, Z) shown in FIG, acceleration in the X-axis direction, the Y-axis direction, and the Z-axis direction, and angular velocity around the X-axis, the Y-axis, and the Z-axis are detected. Figure 1 In the example shown, the Y axis is parallel to the front-rear direction of the hydraulic excavator 100, the X axis is parallel to the width direction of the hydraulic excavator 100, and the Z axis is orthogonal to both the X axis and the Y axis. The coordinate system (X, Y, Z) can be set to, for example, a vehicle body coordinate system.
[0032] In addition, the IMU 30 calculates the attitude angle of the hydraulic excavator 100 based on the detected angular velocity and acceleration and outputs it to the vehicle body controller 40. The inclination of the hydraulic excavator 100 can be represented by a pitch angle, a roll angle, and a yaw angle. The pitch angle is an angle (θp) when the hydraulic excavator 100 is tilted around the X-axis, the roll angle is an angle (θr) when the hydraulic excavator 100 is tilted around the Y-axis, and the yaw angle is an angle (θy) when the hydraulic excavator 100 is tilted around the Z-axis. In this embodiment, the pitch angle and the roll angle are referred to as the attitude angle of the hydraulic excavator 100.
[0033] Figure 2: is a block diagram showing an example of the IMU 30 . The IMU 30 includes a CPU (Central Processing Unit) 31 , a main memory 31 a , a gyro sensor 32 , an acceleration sensor 33 , a tilt sensor 34 , a temperature sensor 35 , a nonvolatile memory 36 , and a communication unit 37 .
[0034] It should be noted that the above-mentioned structures of the IMU 30 are housed in a sealed housing (not shown).
[0035] The CPU 31 has hardware such as a computing device, a control device, a storage device such as a volatile memory and a non-volatile memory, an input / output device, a timer, a counter, and an A / D (analog / digital) conversion device, and controls each part by executing a program stored in the storage device. In the present embodiment, the CPU 31 has an angular velocity acquisition unit 311, a first acceleration acquisition unit 312, a second acceleration acquisition unit 313, a temperature acquisition unit 314, a correction value operation unit 315, an acceleration correction unit 316, an attitude angle calculation unit 317, and a storage unit 318 as a functional component composed of a combination of hardware and software such as a program. Here, the storage unit 318 is, for example, a cache memory provided inside the CPU 31.
[0036] The main memory 31 a is a so-called main storage device, which is provided outside the CPU 31 and provides a storage area that can be directly read and written in the calculation processing performed by the CPU.
[0037] The gyro sensor 32 detects angular velocities of three axes, and outputs a signal indicating the detected angular velocity (hereinafter, the signal indicating the angular velocity is also referred to as angular velocity) to the CPU 31 .
[0038] The acceleration sensor 33 detects acceleration in three axes, namely, the X-axis direction, the Y-axis direction, and the Z-axis direction, and outputs a signal (hereinafter, the signal indicating the acceleration is also referred to as acceleration) indicating the detected acceleration (hereinafter, also referred to as the first acceleration) to the CPU 31. The acceleration sensor 33 is, for example, a mechanical acceleration sensor having a mechanically movable part, such as an acceleration sensor of an electrostatic capacitance detection method or an acceleration sensor of a piezo-resistance method. Here, mechanical operation refers to, for example, deformation and sliding of a solid member.
[0039] The tilt sensor 34 detects the acceleration of the two axes, the X-axis direction and the Y-axis direction, and outputs a signal indicating the detected acceleration (hereinafter, also referred to as the second acceleration) to the CPU 31. The tilt sensor 34 is, for example, a non-mechanical acceleration sensor without a mechanical movable part, such as a heat detection type acceleration sensor and a liquid-sealed acceleration sensor. The heat detection type acceleration sensor heats the sealed gas with a heater, and based on the change in temperature, measures the change in convection caused by acceleration such as gravity acceleration, thereby detecting the acceleration. The liquid-sealed acceleration sensor measures the change in the liquid level in the chamber based on the change in electrostatic capacitance, thereby detecting the acceleration. Compared with the mechanical acceleration sensor, the non-mechanical acceleration sensor has no mechanical movable part, so it has the advantages of no component adhesion, no or small mechanical and temperature hysteresis, no mechanical resonance point, and high impact resistance. On the other hand, compared with the non-mechanical acceleration sensor, the mechanical acceleration sensor has the advantage of excellent frequency characteristics, that is, a wider measurement frequency band. It should be noted that the tilt sensor 34 may detect acceleration in three axes, for example, the X-axis direction, the Y-axis direction, and the Z-axis direction.
[0040] The temperature sensor 35 detects the ambient temperature of the IMU 30 , and outputs a signal indicating the detected temperature to the CPU 31 .
[0041] The angular velocity acquisition unit 311 acquires angular velocity from the gyro sensor 32. The angular velocity acquisition unit 311 repeatedly acquires angular velocity of three axes from the gyro sensor 32 at a predetermined cycle, and stores the angular velocity of the most recent predetermined time period in the main memory 31a or a predetermined storage area of the storage unit 318, for example.
[0042] The first acceleration acquisition unit 312 acquires the first acceleration from the acceleration sensor 33, which is a mechanical acceleration sensor. The first acceleration acquisition unit 312 repeatedly acquires the acceleration of three axes from the acceleration sensor 33 at a predetermined period, and stores the first acceleration of, for example, the most recent predetermined time period in the main memory 31a or a predetermined storage area of the storage unit 318.
[0043] The second acceleration acquisition unit 313 acquires the second acceleration from the tilt sensor 34, which is a non-mechanical acceleration sensor. The second acceleration acquisition unit 313 repeatedly acquires the biaxial acceleration from the tilt sensor 34 at a predetermined period, and stores, for example, the second acceleration of the most recent predetermined time period in the main memory 31a or a predetermined storage area of the storage unit 318.
[0044] The temperature acquisition unit 314 acquires a signal indicating temperature from the temperature sensor 35. The temperature acquisition unit 314 repeatedly acquires a signal indicating temperature from the temperature sensor 35 at a predetermined period, and stores the signal indicating temperature in the most recent predetermined time period in a predetermined storage area of the main memory 31a or the storage unit 318, for example.
[0045] The correction value calculation unit 315 uses the second acceleration to calculate a correction value (hereinafter referred to as an acceleration correction value) for correcting the first acceleration. The correction value calculation unit 315, for example, obtains the difference between the average value of the first acceleration in the most recent prescribed time period and the average value of the second acceleration in the most recent prescribed time period as the acceleration correction value. At this time, the correction value calculation unit 315 calculates the acceleration correction value for each axis. Here, the prescribed time refers to, for example, 10 seconds.
[0046] In addition, the correction value calculation unit 315 can also determine whether the stationary state has continued for a specified time, and calculate the acceleration correction value when it is determined that it has continued for the specified time. It is difficult to calculate the acceleration correction value as an offset when there is noise and delay in the acceleration during the action, but if it is in a stationary state, the offset can be calculated with good accuracy. The judgment on whether it is in a stationary state can be made, for example, as follows, that is, when the value of the three-axis composite value representing the angular velocity, the angular velocity, the first acceleration, the second acceleration, etc. is less than a specified threshold, it is judged to be a stationary state, or a signal indicating whether the hydraulic excavator 100 is in a stationary state, a signal indicating the vehicle speed, etc. are received from the vehicle body controller 40, and the judgment is made based on the signal. Here, the signal indicating whether the hydraulic excavator 100 is in a stationary state can be, for example, a signal indicating that the locking lever of the operating device has been operated, a signal indicating that all the operating levers are in a neutral state, etc.
[0047] In addition, the correction value calculation unit 315 may also determine whether the inclination angle detected by the inclination sensor 34, which is a non-mechanical acceleration sensor, is below a predetermined value, and calculate the acceleration correction value when it is determined to be below the predetermined value. Here, below the predetermined value means, for example, below ±5 degrees or below ±10 degrees. The inclination sensor 34 may include a sensor that can detect acceleration with particularly good accuracy near the horizontal, and when such an inclination sensor 34 is used, the acceleration correction value can be calculated with even better accuracy.
[0048] In addition, the correction value calculation unit 315 may also determine whether the temperature change detected by the temperature sensor 35 for a predetermined time is below a predetermined value, and calculate the acceleration correction value if it is determined to be below the predetermined value. When the temperature change is large, the acceleration output by the acceleration sensor 33 and the tilt sensor 34 may change slightly. Therefore, by limiting the temperature change to a small time, the acceleration correction value can be calculated with better accuracy. The predetermined value is, for example, 1 minute.
[0049] It should be noted that, when a sealed housing is used, it is possible to suppress variations in temperature changes within the housing, and thus it is possible to increase the accuracy of the output value of the thermal tilt sensor 34 .
[0050] In addition, the correction value calculation unit 315 can determine whether a certain time has passed after the start of the IMU 30 or the hydraulic excavator 100, and calculate the acceleration correction value when it is determined that the certain time has passed. At the time of startup, the temperature change may become relatively large. By performing the calculation after a predetermined time has passed after the startup, the acceleration correction value can be calculated with better accuracy.
[0051] In addition, the correction value calculation unit 315 may store the acceleration correction value only once in the nonvolatile memory 36 in one startup. The acceleration correction value does not change frequently, and the number of writes to the nonvolatile memory 36 is usually limited. Therefore, by setting the number of writes to once in one startup, the writing frequency can be made appropriate. However, the correction value calculation unit 315 may store the newly calculated acceleration correction value in the nonvolatile memory 36 without limiting the number of storages when receiving a prescribed correction instruction from the vehicle body controller 40 or the like.
[0052] The acceleration correction unit 316 reads the acceleration correction value 361 stored last time from the nonvolatile memory 36 and stores it in the main memory 31a or the specified storage area of the storage unit 318, for example, during initialization after the CPU 31 is started, or after receiving a correction instruction, and corrects the value of the first acceleration obtained by the first acceleration acquisition unit 312 based on the acceleration correction value 361 stored in the main memory 31a or the storage unit 318, and outputs it to the attitude angle calculation unit 317. The value of the first acceleration refers to, for example, the component in the X-axis direction and the component in the Y-axis direction of the first acceleration. According to this structure, in the absence of a correction instruction, there is no situation where the correction value is changed during the start-up of the hydraulic excavator 100, and it is reflected at most at the next start-up. However, as a modified example, it can also be a method reflected in the start-up. It should be noted that the timing of correcting the value of the first acceleration can also be corrected according to a specific timing such as a stationary state.
[0053] The attitude angle calculation unit 317 calculates the attitude angle based on, for example, the angular velocity obtained by the angular velocity acquisition unit 311, the first acceleration corrected by the acceleration correction unit 316, and the value of the first acceleration obtained by the first acceleration acquisition unit 312, and sends information indicating the calculated attitude angle to the vehicle body controller 40. The first acceleration corrected by the acceleration correction unit 316 is, for example, the component in the X-axis direction and the component in the Y-axis direction of the first acceleration, and the value of the first acceleration obtained by the first acceleration acquisition unit 312 is, for example, the component in the Z-axis direction of the first acceleration. The method of calculating the attitude angle is not limited, and for example, the method described in Patent Document 1 may also be used.
[0054] Furthermore, the nonvolatile memory 36 stores data such as the acceleration correction value 361 in a rewritable manner.
[0055] Furthermore, the communication unit 37 communicates with the vehicle body controller 40 via an in-vehicle signal line 41 based on standards such as CAN (Controller Area Network).
[0056] Next, refer to Figure 3 ,right Figure 2 The operation example of the correction value calculation unit 315 shown in FIG. Figure 3 It is shown Figure 2 Flowchart of an example of the operation of the correction value calculation unit 315 shown in FIG. Figure 3 The processing shown is started when the CPU 31 is activated.
[0057] At the beginning Figure 3 In the process shown, first, the correction value calculation unit 315 determines whether a certain time has passed after startup (step S11). If a certain time has passed, the correction value calculation unit 315 determines that a certain time has passed after startup ("Yes" in step S11), and then determines whether it has been stationary for a predetermined time (step S12).
[0058] When the predetermined time has passed in the static state, the correction value calculation unit 315 determines that the static state has continued for the predetermined time ("Yes" in step S12), and then determines whether the tilt angle is less than the predetermined value (step S13). When the tilt angle is not less than the predetermined value ("No" in step S13), the correction value calculation unit 315 returns to step S12 and waits again until the static state continues for the predetermined time ("No" in step S12 is repeated). On the other hand, when the tilt angle is less than the predetermined value ("Yes" in step S13), the correction value calculation unit 315 then determines whether the temperature change is less than the predetermined value (step S14).
[0059] When the temperature change is not less than the specified value (in the case of "No" in step S14), the correction value calculation unit 315 returns to step S12 and waits again until the static state lasts for a specified time (repeated "No" in step S12). On the other hand, when the temperature change is less than the specified value (in the case of "Yes" in step S14), the correction value calculation unit 315 then calculates the average value of the first acceleration within the specified time (step S15). Then, the correction value calculation unit 315 calculates the average value of the second acceleration within the specified time (step S16). Then, the correction value calculation unit 315 calculates the difference between the average value of the first acceleration within the specified time and the average value of the second acceleration within the specified time for each axis (step S17). It should be noted that in step S17, upper and lower limits can also be set for the difference, and when the difference exceeds the upper and lower limits, the value of the difference is limited by the upper limit value or the lower limit value.
[0060] Next, the correction value calculation unit 315 stores the calculated difference as the acceleration correction value 361 in the nonvolatile memory 36 for each axis (step S18 ), and ends the process.
[0061] In addition, after the correction value calculation unit 315 stores the calculated difference in the non-volatile memory 36, when the communication unit 37 receives a correction instruction from the body controller 40, the correction value calculation unit 315 returns to step S12 and waits again until the static state lasts for a specified time (repeated "No" in step S12).
[0062] Through the above processing, when a certain time has passed since the start-up, the stationary state continues for a predetermined time, the inclination angle during this period is less than a predetermined value, and the temperature change within the predetermined time is less than a predetermined value, the correction value calculation unit 315 calculates the acceleration correction value and stores the calculation result in the non-volatile memory 36. Here, the predetermined time and the time used in the judgment of the stationary state may be the same or different.
[0063] As described above, according to this embodiment, the output of the acceleration sensor 33, which is a mechanical acceleration sensor, can be corrected using the tilt sensor 34, which is a non-mechanical acceleration sensor that is not prone to aging changes. Therefore, the change in the acceleration detection characteristics can be reduced compared to the case where no correction is performed.
[0064] It should be noted that Figure 3 The reference values of the determinations such as the threshold values in the respective determinations shown may be arbitrarily changed according to instructions from the vehicle body controller 40 , for example.
[0065] It should be noted that the above-mentioned mechanical acceleration sensor is, for example, a sensor having a mechanical movable part such as MEMS (Micro ElectroMechanical Systems), and has excellent responsiveness. However, due to the movable part, it is prone to aging, that is, changes in characteristics over the years. On the other hand, a non-mechanical acceleration sensor is, for example, a thermal inclinometer, which does not have a mechanical movable part. Therefore, aging is less, but rapid movement cannot be detected. It should be noted that the tilt sensor 34 can also be set as a mechanical acceleration sensor with a smaller measurement range, for example.
[0066] In addition, Figure 1 In the embodiment, an IMU 30 is provided below the driver's seat 40 of the upper rotating body 3, but the IMU may be provided in addition to the upper rotating body 3, for example, in each of the boom 6, the arm 7, the bucket 8, or a part of them. In addition, when multiple IMUs are provided, the above-mentioned calibration instructions may be sent to all the IMUs at once, or may be sent individually.
[0067] In addition, Figure 2 In the embodiment, the main memory 31 a and the nonvolatile memory 36 are configured to be separate from the CPU 31 . However, either or both of the main memory 31 a and the nonvolatile memory 36 may be included in the CPU 31 .
[0068] In addition, in the above-mentioned embodiment, IMU 30 is one form of the acceleration detection device of the present disclosure. However, the present disclosure is not limited thereto. For example, the gyro sensor 32 may not be included, and a device for detecting acceleration including an acceleration sensor 33, a tilt sensor 34, a CPU 31, etc. may be used, or an IMU including a gyro sensor 32 may be used instead of an acceleration detection device. Figure 2 In the illustrated IMU 30 , the temperature sensor 35 may be omitted. Alternatively, when the gyro sensor 32 , the acceleration sensor 33 , the tilt sensor 34 , etc. include a temperature sensor, the temperature sensor may be used instead of the temperature sensor 35 .
[0069] It should be noted that the working machine may be, for example, a bulldozer, a dump truck, or the like.
[0070] It should be noted that in the above embodiment, the acceleration correction value is set to the difference between the first acceleration and the second acceleration, but it is not limited to this. For example, it can also be a value calculated based on the differences between multiple first accelerations and multiple second accelerations measured by multiple different inclination sensors.
[0071] The embodiments of the present invention are described above with reference to the accompanying drawings, but the specific structure is not limited to the above embodiments, and also includes design changes within the scope of the gist of the present invention. In addition, part or all of the program executed by CPU31 can be distributed via a computer-readable recording medium, communication line, etc.
[0072] Industrial Applicability
[0073] According to each aspect of the present disclosure, it is possible to reduce the variation in the performance of the mechanical acceleration sensor in detecting acceleration.
[0074] Description of reference numerals:
[0075] 1... vehicle body; 2... working device; 3... upper rotating body; 4... cab; 5... traveling device; 6... boom; 7... arm; 8... bucket; 20, 21... antenna; 30... IMU; 31... CPU; 31a... main memory; 32... gyro sensor; 33... acceleration sensor; 34... tilt sensor; 35... temperature sensor; 36... non-volatile memory; 37... communication unit; 311... angular velocity acquisition unit; 312... first acceleration acquisition unit; 313... second acceleration acquisition unit; 314... temperature acquisition unit; 315... correction value calculation unit; 316... acceleration correction unit; 317... attitude angle calculation unit; 318... storage unit; 100... hydraulic excavator.
Claims
1. An acceleration detection device, wherein: The acceleration detection device comprises: A first acceleration acquisition unit that acquires a first acceleration from a mechanical acceleration sensor having a mechanical movable portion; a second acceleration acquisition unit that acquires a second acceleration from a non-mechanical acceleration sensor that does not have a mechanically movable part; and a correction value calculation unit that calculates a correction value for correcting the first acceleration using the second acceleration, The correction value calculation unit determines whether the stationary state continues for a specified time. If it is determined that it has continued for the specified time, it determines whether the inclination angle detected by the non-mechanical acceleration sensor is below a specified value. If it is determined that it is below the specified value, it determines whether the temperature change is below the specified value. If it is determined that it is below the specified value, it calculates the correction value.
2. The acceleration detection device according to claim 1, wherein: The correction value calculation unit calculates a difference between the first acceleration and the second acceleration as the correction value.
3. The acceleration detection device according to claim 1 or 2, wherein: The correction value calculation unit determines whether a certain period of time has elapsed after activation, and calculates the correction value if it is determined that the certain period of time has elapsed.
4. A working machine, wherein: The working machine includes the acceleration detection device according to claim 1 .
5. A method for detecting acceleration, wherein: The acceleration detection method comprises the following steps: Obtaining a first acceleration from a mechanical acceleration sensor having a mechanical movable portion; Obtaining a second acceleration from a non-mechanical acceleration sensor having no mechanically movable part; and using the second acceleration, calculating a correction value for correcting the first acceleration, In the step of calculating the correction value, it is determined whether the stationary state has continued for a specified time. If it is determined that it has continued for the specified time, it is determined whether the inclination angle detected by the non-mechanical acceleration sensor is below a specified value. If it is determined that it is below the specified value, it is determined whether the temperature change is below the specified value. If it is determined that it is below the specified value, the correction value is calculated.
