Industrial vehicles
The industrial vehicle's gradient detection system uses three-axis inertia-based sensors and a controller to calculate gradients, overcoming orientation adjustment issues and reducing installation complexity and costs.
Patent Information
- Application Number
- JP2025077241
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2025-05-07
- Publication Date
- 2026-11-19
Smart Images

Figure 2026181702000001_ABST
Abstract
Description
[Technical Field]
[0001] This disclosure relates to industrial vehicles. [Background technology]
[0002] The industrial vehicle disclosed in Patent Document 1 comprises a gradient detection sensor for detecting the gradient of the road surface, a drive unit, and a controller. The controller controls the output of the drive unit to increase when the gradient of the road surface is greater than or equal to a set gradient value. The gradient detection sensor is, for example, a sensor that detects acceleration acting on a detection axis. When the industrial vehicle travels on a road surface, the acceleration acting on the detection axis changes as the industrial vehicle tilts due to the gradient of the road surface. The gradient of the road surface can be detected using this change. [Prior art documents] [Patent Documents]
[0003] [Patent Document 1] Japanese Patent Publication No. 2018-196265 [Overview of the Initiative] [Problems that the invention aims to solve]
[0004] In order for a gradient detection sensor to detect a gradient, it is necessary to adjust the orientation of the detection axis so that it tilts according to the gradient of the road surface. However, due to placement constraints, it may be difficult to adjust the orientation of the detection axis. [Means for solving the problem]
[0005] An industrial vehicle that solves the above problems comprises a gradient detection sensor that uses inertia to detect forces acting on three mutually orthogonal detection axes, a controller that acquires the forces detected by the three detection axes, and a common case that houses the gradient detection sensor and the controller, wherein the controller calculates the gradient of the road surface on which the industrial vehicle is located from the forces detected by the three detection axes and controls the industrial vehicle according to the gradient.
[0006] The gradient detection sensor has three detection axes. When the gradient of the road surface changes, the inclination of the three detection axes changes, and therefore the magnitude of the force detected by the three detection axes changes. For this reason, the gradient of the road surface can be calculated from the force acting on the three detection axes. Consequently, the gradient can be detected without adjusting the orientation of the detection axes.
[0007] The above-mentioned industrial vehicle may be equipped with a common circuit board on which the gradient detection sensor and the controller are mounted. In the industrial vehicle described above, the gradient detection sensor is an acceleration sensor, and the force may be acceleration.
[0008] With respect to the above-mentioned industrial vehicle, if the vehicle coordinate system is defined as a coordinate system in which the vertical direction of the industrial vehicle is the X-axis, the left-right direction of the industrial vehicle is the Y-axis, and the front-rear direction of the industrial vehicle is the Z-axis, the controller may include a gradient sensor coordinate transformation unit that converts the acceleration detection values detected by the three detection axes into accelerations acting in the direction in which the coordinate axes of the vehicle coordinate system extend, and a gradient detection value correction unit that corrects the gradient detection value, which is the acceleration acting in the direction in which the Z-axis extends.
[0009] In the case of the industrial vehicle described above, the control may be a control that increases the driving torque of the travel motor when the controller determines that the gradient is equal to or greater than the gradient set value. [Effects of the Invention]
[0010] According to the present invention, gradient can be detected without adjusting the orientation of the detection axis. [Brief explanation of the drawing]
[0011] [Figure 1] Figure 1 is a perspective view of an industrial vehicle. [Figure 2] Figure 2 is a schematic diagram of an industrial vehicle. [Figure 3] Figure 3 is a perspective view of the control unit. [Modes for carrying out the invention]
[0012] An embodiment of an industrial vehicle will be described. As shown in Figure 1, the industrial vehicle 10 is, for example, a forklift. The industrial vehicle 10 may also be a towing tractor. The industrial vehicle 10 has front wheels 11 and rear wheels 12. The front wheels 11 are drive wheels. The rear wheels 12 are steering wheels.
[0013] The coordinate system based on the industrial vehicle 10 is defined as the vehicle coordinate system. In the vehicle coordinate system, the vertical direction of the industrial vehicle 10 is defined as the X axis. v The left and right directions of the industrial vehicle 10 are controlled by the Y axis Y v The Z axis of the industrial vehicle 10 in the front-rear direction v This is a three-axis orthogonal coordinate system.
[0014] As shown in Figure 2, the industrial vehicle 10 is equipped with a drive motor 13. The drive motor 13 is a motor for rotating the front wheels 11. The industrial vehicle 10 moves by the drive of the drive motor 13.
[0015] The industrial vehicle 10 is equipped with a drive circuit 14. The drive circuit 14 drives the travel motor 13. The drive circuit 14 is, for example, a motor driver. The industrial vehicle 10 is equipped with a motor rotation speed detection unit 15. The motor rotation speed detection unit 15 detects the rotation speed of the travel motor 13. The motor rotation speed detection unit 15 is, for example, an encoder.
[0016] The industrial vehicle 10 is equipped with a control unit 20. The control unit 20 is a control system that controls the industrial vehicle 10. <Control Unit> As shown in Figure 3, the control unit 20 comprises a circuit board 21, a gradient detection sensor 22 mounted on the circuit board 21, a controller 23, and a case 28. The circuit board 21 is a common circuit board on which the gradient detection sensor 22 and the controller 23 are mounted. The gradient detection sensor 22 has three detection axes X s ,Y s ,Z sis provided. Three detection axes X s , Y s , Z s include an X axis X s , a Y axis Y s , and a Z axis Z s . The X axis X s , the Y axis Y s , and the Z axis Z s are orthogonal to each other. In Figure 3, the detection axes X s , Y s , Z s are represented as coordinate axes.
[0017] The inclination detection sensor 22 is an inertial sensor that detects forces acting on the three detection axes X s , Y s , Z s using inertia. The inclination detection sensor 22 of the present embodiment is an acceleration sensor that detects components in the directions along the detection axes X s , Y s , Z s among the accelerations acting on the three detection axes X s , Y s , Z s . The inclination detection sensor 22 outputs a detection value corresponding to the acceleration acting on the three detection axes X s , Y s , Z s . The detection value is a voltage value [V] corresponding to the acceleration. The inclination detection sensor 22 may be a gyro sensor that detects angular velocities acting on the three detection axes X s , Y s , Z s .
[0018] The inclination detection sensor 22 and the controller 23 are connected by wiring. For example, the inclination detection sensor 22 and the controller 23 are connected by a pattern on the substrate 21.
[0019] The controller 23 may consist of one or more processors that perform various processes according to a computer program. The controller 23 may consist of one or more dedicated hardware circuits, such as ASICs, that perform at least some of the various processes. The controller 23 may consist of a circuit that includes a combination of processors and hardware circuits. The controller 23 includes memory such as RAM and ROM. The memory stores program code or instructions configured to cause the processor to perform processes. Memory, i.e., computer-readable media, includes any readable media that can be accessed by a general-purpose or dedicated computer.
[0020] Case 28 is a common case that houses the circuit board 21, the gradient detection sensor 22, and the controller 23. Thus, the circuit board 21, the gradient detection sensor 22, and the controller 23 are unitized. Case 28 is mounted on the industrial vehicle 10. In this embodiment, Case 28 is located on the detection axis X s ,Y s ,Z s The orientation corresponds to the X axis of the vehicle coordinate system. v ,Y v ,Z v Assume that it is mounted on industrial vehicle 10 in a manner that does not match.
[0021] As shown in Figure 2, the controller 23 includes a gradient sensor coordinate transformation unit 24. The gradient sensor coordinate transformation unit 24 is a functional unit that operates, for example, when the controller 23 performs a predetermined process. The gradient sensor coordinate transformation unit 24 has three detection axes X s ,Y s ,Z s The acceleration detected by the gradient sensor is obtained. The gradient sensor coordinate transformation unit 24 uses three detection axes X s ,Y s ,Z s The detected acceleration values are assigned to the X coordinate axis of the vehicle coordinate system. v ,Y v ,Z v Converts to acceleration acting in the direction of extension. Coordinate axis X v ,Y v ,Zv The acceleration acting in the direction of extension is expressed by the voltage value.
[0022] X axis of the vehicle coordinate system v A is the acceleration acting in the direction of extension. x Let the Y-axis of the vehicle coordinate system be Y v A is the acceleration acting in the direction of extension. y The Z axis of the vehicle coordinate system v A is the acceleration acting in the direction of extension. z Let's assume that the X-axis of the gradient detection sensor 22 is X s The acceleration detected by [the device] is the detected value A. x 'The Y axis of the gradient detection sensor 22 s The acceleration detected by [the device] is the detected value A. y 'The Z axis of the gradient detection sensor 22 s The acceleration detected by [the device] is the detected value A. z The gradient sensor coordinate transformation unit 24 uses the following equation (1) to determine the three detection axes X s ,Y s ,Z s The acceleration detected is converted to the X coordinate axis of the vehicle coordinate system. v ,Y v ,Z v It is converted into an acceleration that acts in the direction of extension.
[0023]
number
[0024] Angle θ x This is the X-axis of the vehicle coordinate system. v and the X axis of the gradient detection sensor 22 s This is the angle of deviation from θ. y This is the Y-axis of the vehicle coordinate system. v and the Y axis of the gradient detection sensor 22 s This is the angle of deviation from θ. z This is the vehicle coordinate system Z axis Z v and the Z axis of the gradient detection sensor 22 s This is the angle of deviation.
[0025] Angle θ x , angle θ y, and angle θ z are grasped in advance, the inclination sensor coordinate conversion unit 24 can convert the accelerations detected by the three detection axes X s , Y s , Z s into accelerations acting in the directions in which the coordinate axes X v , Y v , Z v of the vehicle coordinate system extend. In other words, it is possible to obtain the acceleration detected by the inclination detection sensor 22 when the orientation of the detection axis X s is made to coincide with the X axis X v , the orientation of the detection axis Y s is made to coincide with the Y axis Y v , and the orientation of the detection axis Z s is made to coincide with the Z axis Z v respectively. The angle θ x , the angle θ y , and the angle θ z are stored in, for example, a memory of the controller 23.
[0026] Among the coordinate axes X v , Y v , Z v of the vehicle coordinate system, the acceleration A v acting in the direction in which the Z axis Z z extends represents the inclination. The Z axis Z v is an axis extending in the front-rear direction of the industrial vehicle 10. When the industrial vehicle 10 is positioned on a road surface with no inclination, the direction in which gravitational acceleration acts is orthogonal to the Z axis Z v , so if only gravitational acceleration is considered, the acceleration A v acting in the direction in which the Z axis Z z extends is zero. When the industrial vehicle 10 is positioned on an inclined road surface, the industrial vehicle 10 tilts due to the inclination of the road surface, so that the Z axis Z v also tilts with respect to the horizontal direction. As a result, the Z axis Z v detects the component force of gravitational acceleration according to the inclination of the road surface. Therefore, the larger the inclination of the road surface, the larger the acceleration A v acting in the direction in which the Z axis Z z extends. In the following description, the acceleration A v acting in the direction in which the Z axis Z zThis is referred to as the gradient detection value S[V].
[0027] The controller 23 includes a gradient detection value correction unit 25. The gradient detection value correction unit 25 is a functional unit that operates, for example, when the controller 23 performs a predetermined process. The gradient detection value correction unit 25 corrects the gradient detection value S. When acceleration occurs in the industrial vehicle 10 due to acceleration or deceleration of the industrial vehicle 10, the gradient detection sensor 22 is affected by the acceleration. This causes an error in the gradient detection value S. The gradient detection value correction unit 25 corrects the gradient detection value S to reduce this error and obtains a gradient correction value B. The gradient correction value B is calculated by the following equations (2) and (3).
[0028] (Vp-Vn)×α=A…(2) S + A = B ... (3) Vn is the current speed [km / h] of industrial vehicle 10. Vp is the most recent speed [km / h] of the current speed Vn. α is the correction coefficient. A is the correction sum.
[0029] The vehicle speed of the industrial vehicle 10 can be calculated from the rotational speed of the drive motor 13. The controller 23 acquires the rotational speed of the drive motor 13 from the motor rotational speed detection unit 15 at predetermined intervals. The controller 23 then calculates the vehicle speed of the industrial vehicle 10 from the rotational speed of the drive motor 13.
[0030] (Vp-Vn) is the difference in vehicle speed between the current vehicle speed Vn and the most recent vehicle speed Vp. The interval at which the gradient detection value correction unit 25 calculates the vehicle speed difference (Vp-Vn) may be the same as or different from the interval at which the controller 23 calculates the vehicle speed of the industrial vehicle 10. The gradient detection value correction unit 25 calculates the vehicle speed difference (Vp-Vn) at relatively short intervals of fractions of a second.
[0031] The correction coefficient α is a constant empirically determined through tests and experiments involving the measurement of vehicle speeds Vn and Vp and gradient detection value S. The correction sum A is the value obtained by multiplying the vehicle speed difference (Vp-Vn) by the correction coefficient α, and will be a positive or negative value when the vehicle speed difference (Vp-Vn) is not zero.
[0032] The gradient detection value S, which indicates the gradient, is shown as a voltage value and is a positive value. The gradient correction value B is a voltage value that indicates the correct road surface gradient, excluding the effect of acceleration from the gradient detection sensor 22. When the vehicle speed difference (Vp-Vn) is a positive value, the industrial vehicle 10 is decelerating. When the vehicle speed difference (Vp-Vn) is a negative value, the industrial vehicle 10 is accelerating. When the vehicle speed difference (Vp-Vn) is 0, the industrial vehicle 10 is traveling at a constant speed. Therefore, in the case of deceleration where the vehicle speed difference (Vp-Vn) is a positive value, the gradient detection value correction unit 25 sets the correction addition value A to a positive value and corrects the gradient detection value S so that the gradient correction value B becomes greater than the gradient detection value S. In the case of acceleration where the vehicle speed difference (Vp-Vn) is a negative value, the gradient detection value correction unit 25 sets the correction addition value A to a negative value and corrects the gradient detection value S so that the gradient correction value B becomes less than the gradient detection value S.
[0033] The controller 23 includes a gradient correction value comparison unit 26. The gradient correction value comparison unit 26 is a functional unit that operates, for example, when the controller 23 performs a predetermined process. The gradient correction value comparison unit 26 compares the gradient set value T with the gradient correction value B. If the gradient correction value B is greater than or equal to the gradient set value T, the controller 23 commands the drive circuit 14 to increase the drive torque of the travel motor 13 based on the gradient correction value B. If the gradient correction value B is less than the gradient set value T, the controller 23 does not issue an output control command. Upon receiving an output control command, the drive circuit 14 increases the drive torque of the travel motor 13. Output control is an example of controlling the industrial vehicle 10 according to the gradient.
[0034] The controller 23 includes a timer unit 27 for measuring time. The controller 23 releases output control according to the time measured by the timer unit 27, for example. For example, the controller 23 may release output control after a set time has elapsed, when the gradient correction value B changes from a state where it is equal to or greater than the gradient set value T to a state where it is less than the gradient set value T.
[0035] The industrial vehicle 10 is equipped with an operation button 30. The operation button 30 is connected to the controller 23. The operation button 30 accepts input from the operator. By operating the operation button 30, the operator can input the gradient setting value T into the memory of the controller 23. By operating the operation button 30, the operator can input the setting time into the memory of the controller 23. By operating the operation button 30, the operator can input the angle θ x , angle θ y , and angle θ z This can be input into the memory of controller 23.
[0036] [Operation of this embodiment] In order for the gradient detection sensor 22 to directly detect the gradient, the detection axis X follows the gradient of the road surface. s ,Y s ,Z s The detection axis X is tilted s ,Y s ,Z s The orientation needs to be adjusted. For example, the Z axis of the gradient detection sensor 22 s The orientation of the vehicle coordinate system is the Z axis Z v By aligning it with the Z axis, s Detected value A z ' becomes the gradient detection value S.
[0037] If the gradient detection sensor 22 is not housed in case 28, there are fewer constraints on the placement of the gradient detection sensor 22, and the Z axis of the gradient detection sensor 22 s The orientation of the vehicle coordinate system is the Z axis Z v It is easy to adjust. When the gradient detection sensor 22 is housed in the case 28, the Z axis of the gradient detection sensor 22 s To adjust the orientation, the orientation of case 28 itself needs to be changed. Since case 28 is larger than the gradient detection sensor 22, it is susceptible to placement constraints when mounted on the industrial vehicle 10. For this reason, if the gradient detection sensor 22 is made part of the control unit 20, the Z-axis of the gradient detection sensor 22 s The orientation of the vehicle coordinate system is the Z axis Z v It's difficult to match.
[0038] In this embodiment, the Z axis of the vehicle coordinate system is given by equation (1). v Acceleration A acting on z It is possible to calculate acceleration A. z This is the Z axis of the gradient detection sensor 22. s The orientation of the vehicle coordinate system is the Z axis Z v Detected value A when adjusted to this setting z It can be considered identical to '. Therefore, the three detection axes X of the gradient detection sensor 22 s ,Y s ,Z s The gradient detection value S can be calculated from the acceleration detected by this method.
[0039] [Effects of this embodiment] (1) The gradient detection sensor 22 has three detection axes X s ,Y s ,Z s It is equipped with three detection axes X when the road surface gradient changes. s ,Y s ,Z s Because the tilt of the three detection axes X changes s ,Y s ,Z s The magnitude of the force detected changes. Therefore, the three detection axes X s ,Y s ,Z s The road surface gradient can be calculated from the force acting on it. Therefore, detection axis X s ,Y s ,Z s The gradient can be detected without adjusting the orientation. Detection axis X s ,Y s ,Z s Since it is not necessary to adjust the orientation, there are fewer constraints on the placement of the control unit 20.
[0040] (2) The gradient detection sensor 22 and the controller 23 are mounted on the same circuit board 21. Therefore, there is no need to secure space for installing the gradient detection sensor 22. In addition, a wire harness for connecting the gradient detection sensor 22 and the controller 23 is not required. As a result, costs can be reduced by the amount of the wire harness.
[0041] (3) If the gradient correction value B is equal to or greater than the gradient setting value T, the controller 23 commands the drive circuit 14 to increase the drive torque of the travel motor 13 based on the gradient correction value B. This prevents the travel motor 13 from becoming insufficient when climbing a slope.
[0042] [Example of changes] The embodiment can be implemented with the following modifications. The embodiment and the following modifications can be combined with each other to the extent that they do not contradict each other technically.
[0043] ○Angle θ x , angle θ y , and angle θ z The controller 23 may acquire this automatically. For example, when the industrial vehicle 10 is turned off, the controller 23 considers the position where the vehicle was turned off as a flat road surface and uses the three detection axes X s ,Y s ,Z s Obtain the detected values. Three detection axes X s ,Y s ,Z s It detects the component force of gravitational acceleration according to the tilt relative to the horizontal. Controller 23 has three detection axes X s ,Y s ,Z s Detection axis X from detected value s ,Y s ,Z s The angle can be calculated. And the detection axis X s ,Y s ,Z s and the X coordinate axis of the vehicle coordinate system v ,Y v ,Z v The angle of deviation from is angle θ x ,θ y ,θ z Store it in memory as such.
[0044] Controller 23 is angle θ x , angle θ y , and angle θ zThe timing for obtaining the angle θ may be the timing when the operation button 30 is operated. For example, after moving the industrial vehicle 10 on a flat road surface, operating the operation button 30 will send an angle θ to the controller 23. x , angle θ y , and angle θ z You may also allow it to be obtained.
[0045] ○The controller 23 does not necessarily have to include a gradient detection value correction unit 25. In this case, the gradient correction value comparison unit 26 only needs to compare the gradient detection value S with the gradient set value T. ○The control of the industrial vehicle 10 according to the gradient may be, for example, a control that applies braking force to prevent the industrial vehicle 10 from rolling down the road surface when the industrial vehicle 10 is stopped, or a control that increases the output of the travel motor 13.
[0046] ○The industrial vehicle 10 may be powered by an engine. [Explanation of Symbols]
[0047] 10...Industrial vehicle, 21...Circuit board, 22...Gradient detection sensor, 23...Controller, 24...Gradient sensor coordinate transformation unit, 25...Gradient detection value correction unit, 28...Case.
Claims
1. A gradient detection sensor that uses inertia to detect forces acting on three mutually orthogonal detection axes, A controller that acquires the force detected by the three detection axes, An industrial vehicle comprising a common case housing the gradient detection sensor and the controller, The aforementioned controller, The gradient of the road surface on which the industrial vehicle is located is calculated from the forces detected by the three detection axes. An industrial vehicle that controls the industrial vehicle in accordance with the aforementioned gradient.
2. The industrial vehicle according to claim 1, comprising a common circuit board on which the gradient detection sensor and the controller are mounted.
3. The industrial vehicle according to claim 1 or claim 2, wherein the gradient detection sensor is an acceleration sensor, and the force is acceleration.
4. If we define the vehicle coordinate system as a coordinate system where the vertical direction of the industrial vehicle is the X-axis, the horizontal direction of the industrial vehicle is the Y-axis, and the longitudinal direction of the industrial vehicle is the Z-axis, then The aforementioned controller, A gradient sensor coordinate transformation unit converts the detected acceleration values detected by the three detection axes into acceleration acting in the direction in which the coordinate axes of the vehicle coordinate system extend. The industrial vehicle according to claim 3, further comprising: a gradient detection value correction unit that corrects the gradient detection value, which is the acceleration acting in the direction in which the Z axis extends.
5. The industrial vehicle according to claim 4, wherein the control is a control that increases the driving torque of the travel motor when the controller determines that the gradient is equal to or greater than a gradient set value.
Citation Information
Patent Citations
Tow tractor
JP2018196265A
