This application is a National Stage of International Application No. PCT/JP2020/042232 filed on Nov. 12, 2020, claiming priorities based on Japanese Patent Application No. 2019-219036 filed on Dec. 3, 2019, and Japanese Patent Application No. 2020-132987 filed on Aug. 5, 2020, the contents of all of which are incorporated herein by reference in their entirety.
The present disclosure relates to an industrial vehicle.
A vehicle disclosed in Patent Literature 1 has been known as an industrial vehicle used in workplaces such as a factory, a commercial facility, and a harbor. An industrial vehicle includes an accelerator operated by an operator, an accelerator sensor detecting an operation amount of the accelerator, and a controller configured to control a vehicle speed depending on a detection result of the accelerator sensor. The operator of the industrial vehicle can adjust the vehicle speed by adjusting the operation amount of the accelerator.
Patent Literature 1: Japanese Patent Application Publication No. H08-256401
The operator of the industrial vehicle may lower the vehicle speed by adjusting the operation amount of the accelerator when the industrial vehicle approaches a person and an obstacle. When the industrial vehicle is used in a place where many objects such as a person and an obstacle are present, the operator of the industrial vehicle needs to frequently adjust the operation amount of the accelerator, which may reduce operability.
An object of the present disclosure is to provide an industrial vehicle capable of improving operability.
An industrial vehicle for solving the above-described problem includes: a drive device; a drive controller configured to control the drive device; and a main controller configured to transmit a command to the drive controller, the drive controller controlling the drive device in response to the command of the main controller to cause the industrial vehicle to travel, wherein the industrial vehicle further includes: an object detector configured to detect a position of an object being present in a traveling direction of the industrial vehicle; an expected trajectory derivation unit configured to derive an expected trajectory as a trajectory on which the industrial vehicle is expected to pass; and a vehicle speed upper limit setting unit configured to impose a speed limit on the industrial vehicle by setting a vehicle speed upper limit when the object detected by the object detector is positioned within the expected trajectory and when the industrial vehicle travels in a direction approaching the object, and the main controller transmits the command to the drive controller so that the vehicle speed of the industrial vehicle does not exceed the vehicle speed upper limit.
The vehicle speed upper limit is set when an object is present within the expected trajectory. The main controller controls the industrial vehicle so as not to exceed the vehicle speed upper limit. The vehicle speed of the industrial vehicle is adjusted so as not to exceed the vehicle speed upper limit even when the operator of the industrial vehicle does not perform a deceleration operation. Thus, operability of the operator of the industrial vehicle can be improved.
In the above-described industrial vehicle, in a state in which an automatic deceleration area is set within an object detectable range of the object detector, the vehicle speed upper limit setting unit may set the vehicle speed upper limit at a lower value when the object is present within the automatic deceleration area and within the expected trajectory, as compared with the vehicle speed upper limit when the object is present within the automatic deceleration area and outside the expected trajectory.
Operability is reduced when an object is present within the automatic deceleration area and the vehicle speed upper limit when an object is present within the expected trajectory is always set. Even when an object is present within the automatic deceleration area, when the object is not present within the expected trajectory, the industrial vehicle allows the vehicle speed higher than the vehicle speed upper limit when the object is present within the expected trajectory, which further improves operability.
In the above-described industrial vehicle, the object detector includes a determiner configured to determine whether the object is a person or an obstacle other than the person, and the vehicle speed upper limit setting unit may set, when the object is determined as a person, the vehicle speed upper limit at a lower value as compared with the vehicle speed upper limit when the object is determined as an obstacle.
When the object detected by the object detector is the obstacle, the vehicle speed upper limit is set at a higher value than the vehicle speed upper limit when the person as the object is present. Thus, the industrial vehicle allows a high vehicle speed, which further improves operability.
In the above-described industrial vehicle, a travel start limitation area is set within the object detectable range of the object detector, the vehicle speed upper limit setting unit may set the vehicle speed upper limit at zero when the object is present within the travel start limitation area and within the expected trajectory, in a stop state of the industrial vehicle.
The vehicle speed upper limit is set at zero, so that the start of traveling of the industrial vehicle is prohibited. When an object is present within the travel start limitation area and within the expected trajectory, the traveling of the industrial vehicle may be blocked. In this case, the start of traveling of the industrial vehicle is prohibited, which prompts the operator to change the traveling direction or operate turning of the industrial vehicle. This prevents blocking of the start of traveling of the industrial vehicle and further improves operability.
In the above-described industrial vehicle, the expected trajectory derivation unit may extend the dimension of the expected trajectory in the traveling direction as the vehicle speed increases.
A time to reach the object becomes short as the vehicle speed of the industrial vehicle increases. Thus, the dimension of the expected trajectory is extended in the traveling direction as the vehicle speed of the industrial vehicle increases, which can appropriately limit the vehicle speed depending on the vehicle speed of the industrial vehicle.
The expected trajectory derivation unit may derive the expected trajectory from a steering angle of the industrial vehicle.
When the industrial vehicle turns, the expected trajectory derivation unit derives the expected trajectory in line with the turning direction of the industrial vehicle due to derivation of the expected trajectory from the steering angle. Accuracy of the expected trajectory to be derived can be improved.
The above-described industrial vehicle may include a cargo handling apparatus on which a cargo is loaded.
For loading the cargo, stability is required for the industrial vehicle on which the cargo is loaded. The stability of the industrial vehicle can be improved by the vehicle speed upper limit being set.
The above-described industrial vehicle may include a weight sensor that detects weight of the cargo loaded on the cargo handling apparatus, and the vehicle speed upper limit setting unit may lower a value of the vehicle speed upper limit as the weight of the cargo increases.
The above-described industrial vehicle may include a lifting height sensor that detects a lifting height of the cargo handling apparatus, and the vehicle speed upper limit setting unit may lower a value of the vehicle speed upper limit as the lifting height of the cargo handling apparatus increases.
According to the present disclosure, operability can be improved.
Hereinafter, an embodiment of an industrial vehicle will be described.
As illustrated in
The cargo handling apparatus 20 has a mast 21 provided in a standing manner at a front part of the vehicle body 11, a pair of forks 22 being movable up and down with the mast 21, and a lift cylinder 23 causing the mast 21 to move up and down. A cargo is loaded on the forks 22. The lift cylinder 23 is a hydraulic cylinder. When the mast 21 moves up and down due to extension and retraction of the lift cylinder 23, the forks 22 move up and down accordingly. In the forklift truck 10 of the present embodiment, an operator performs a traveling operation and a cargo handling operation.
As illustrated in
The main controller 31 has a processor 32 such as a CPU and a GPU, and a memory 33 including a RAM, a ROM, and the like. The memory 33 stores programs for operating the forklift truck 10. The memory 33 stores program codes or commands configured to cause the processor 32 to execute processes. The memory 33, that is, a computer-readable medium, includes any available medium that is accessible by a general-purpose computer or a dedicated computer. The main controller 31 may include a hardware circuit such as an ASIC (Application Specific Integrated Circuit) or an FPGA (Field Programmable Gate Array). The main controller 31, which is a processing circuit, may include one or more processors for operating in accordance with a computer program, one or more hardware circuits such as the ASIC and the FPGA, or a combination thereof.
The accelerator sensor 34 detects an operation amount of the accelerator 16, that is, an accelerator opening degree. The accelerator sensor 34 outputs an electric signal depending on the accelerator opening degree to the main controller 31. The main controller 31 can recognize the accelerator opening degree based on the electric signal from the accelerator sensor 34.
The direction sensor 35 detects an operation direction of a direction lever 17 instructing a traveling direction. The direction sensor 35 detects whether the direction lever 17 is operated in a direction indicating a forward travel or a direction indicating a reverse travel, with respect to a neutral as a reference position. The direction sensor 35 outputs an electric signal in response to the operation direction of the direction lever 17 to the main controller 31. The main controller 31 can recognize the operation direction of the direction lever 17 based on the electric signal from the direction sensor 35. The main controller 31 can recognize whether the operator instructs the forward travel or the reverse travel, or does not instruct the forward travel or the reverse travel.
The steering angle sensor 36 detects a steering angle of the set of the steering wheels 14. The steering angle sensor 36 outputs an electric signal depending on the steering angle to the main controller 31. The main controller 31 can recognize the steering angle based on the electric signal from the steering angle sensor 36.
The lifting height sensor 37 detects a lifting height of the cargo handling apparatus 20. The lifting height of the cargo handling apparatus 20 is the height of the forks 22 from a road surface. The lifting height sensor 37 is a reel sensor, for example. The lifting height sensor 37 outputs an electric signal depending on the lifting height to the main controller 31. The main controller 31 can recognize the lifting height of the cargo handling apparatus 20 based on the electric signal from the lifting height sensor 37.
The weight sensor 38 detects a weight of a cargo loaded on the cargo handling apparatus 20. The weight sensor 38 is, for example, a pressure sensor detecting a hydraulic pressure of the lift cylinder 23. The weight sensor 38 outputs an electric signal depending on the weight of the cargo to the main controller 31. The main controller 31 can recognize the weight of the cargo based on the electric signal from the weight sensor 38.
The driving motor 41 is a drive device for driving the forklift truck 10 to travel. The driving motor 41 is driven to rotate the driving wheels 12 and 13, which allows the forklift truck 10 to travel.
The rotational speed sensor 42 detects a rotational speed of the driving motor 41. For example, a rotary encoder may be used as the rotational speed sensor 42. The rotational speed sensor 42 outputs an electric signal based on the rotational speed of the driving motor 41 to the drive controller 43.
The drive controller 43 is a motor driver that controls the rotational speed of the driving motor 41. The drive controller 43 can recognize the rotational speed and a rotational direction of the driving motor 41 based on the electric signal of the rotational speed sensor 42. The rotational direction of the driving motor 41 is represented by a sign “+” or “−”. The “+” rotational speed indicates a forward rotation, and the “−” rotational speed indicates a reverse rotation.
Each of the two driving wheels 12 and 13 is provided with the driving motor 41, the rotational speed sensor 42, and the drive controller 43. The rotational speed and the rotational direction of each of the two driving wheels 12 and 13 may be independently controllable by controlling the rotational speed and the rotational direction of the driving motor 41 provided independently for each of the two driving wheels 12 and 13 with the drive controller 43. The rotational speed sensor 42 can individually detect the rotational speed of the driving motor 41 provided for each of the two driving wheels 12 and 13.
The object detector 51 includes a stereo camera 52, an obstacle detector 55 detecting an object from an image captured by the stereo camera 52, and an alarm 58. As illustrated in
As illustrated in
The obstacle detector 55 has a processor 56 such as a CPU and a GPU, and a memory 57 including a RAM and a ROM. The memory 57 stores various programs for detecting an object from images captured by the stereo camera 52. The memory 57 stores program codes or commands configured to cause the processor 56 to execute processes. The memory 57, that is, a computer-readable medium, includes any available medium that is accessible by a general-purpose computer or a dedicated computer. The obstacle detector 55 may include a hardware circuit such as an ASIC (Application Specific Integrated Circuit) or an FPGA (Field Programmable Gate Array). The obstacle detector 55, which is a processing circuit, may include one or more processors for operating in accordance with a computer program, one or more hardware circuits such as the ASIC and the FPGA, or a combination thereof.
The obstacle detector 55 detects an object being present around the forklift truck 10 by repeating the following process in a predetermined control cycle. The obstacle detector 55 derives a position of the detected object. The position of the object is a relative position between the forklift truck 10 and the object.
As illustrated in
Next, in Step S110, the obstacle detector 55 acquires a parallax image by performing a stereo process. The parallax image is an image in which a parallax [px] is associated with a pixel. The parallax image indicates data in which parallaxes are associated with pixels in the parallax image, and need not be displayed. A parallax is acquired by comparing the images captured by the two cameras 53 and 54 of the stereo camera 52 and calculating a difference in pixel counts between the images for an identical particular point in the images. The obstacle detector 55 uses one of the images captured by the two cameras 53 and 54 as a reference image and the other of the images as a comparison image, and extracts a pixel of the comparison image that is most similar to one of pixels of the reference image for each pixel of the reference image. The obstacle detector 55 calculates differences in pixel counts between the reference image and the comparison image as parallaxes. This can acquire the parallax image in which the parallaxes are associated with the pixels of the reference image. The particular point means a point that can be visually recognized as a border such as an edge of an object. The particular point can be detected from information of brightness, and the like.
Next, in Step S120, the obstacle detector 55 derives coordinates of particular points in a world coordinate system which is a coordinate system in a real space. In the world coordinate system, in a state where the forklift truck 10 is positioned on a horizontal direction, an X-axis corresponds to an axis that extends in a horizontal direction, specifically a vehicle width direction of the forklift truck 10, a Y-axis corresponds to an axis that extends in in the horizontal direction and is perpendicular to the X-axis, and a Z-axis corresponds to an axis that extends in a vertical direction. After the coordinates of the particular points in a camera coordinate system are derived from a baseline length of the stereo camera 52, a focal length of the stereo camera 52, and the parallax image acquired in Step S110, the coordinates derived in the camera coordinate system is converted into the coordinates in the world coordinate system to derive the coordinates of the particular points. As illustrated in
As illustrated in
Next, in Step S140, the obstacle detector 55 derives the coordinates of the object in the world coordinate system. The coordinates of the object can be derived from the coordinates of the particular points forming the point group. The coordinates of the object in the world coordinate system represent a relative position between the forklift truck 10 and the object. Specifically, in the coordinates of the object in the world coordinate system, an X-coordinate represents a distance from an original point to the object in the right-left direction, and a Y-coordinate represents a distance from the original point to the object in the front-rear direction. The original point corresponds to, for example, coordinates in which the X-coordinate and the Y-coordinate represent a position of the stereo camera 52 and a Z-coordinate represents the road surface. Euclidean distance from the position of the stereo camera 52 to the object may be derived from the X-coordinate and the Y-coordinate. The Z-coordinate of the coordinates of the object in the world coordinate system represents a height of the object from the road surface.
Next, in Step S150, the obstacle detector 55 determines whether the object is a person or an obstacle other than a person. Various methods can be used to determine whether the object is a person or not. In the present embodiment, the obstacle detector 55 executes a person detection process for an image captured by one of the two cameras 53 and 54 of the stereo camera 52. The obstacle detector 55 converts the coordinates of the object in the world coordinate system acquired in Step S140 into camera coordinates, and converts the camera coordinates into coordinates in the image captured by the cameras 53 and 54. In the present embodiment, the obstacle detector 55 converts the coordinates of the object in the world coordinate system into coordinates in the reference image. The obstacle detector 55 executes the person detection process for the coordinates of the object of the reference image. The person detection process is executed by, for example, feature extraction and a person determiner in which a machine learning is provided in advance. The extraction of features is executed by methods for the feature extraction of an image in a local area, such as HOG (Histogram of Oriented Gradients) features, and Haar-Like features. For example, a machine to which a machine learning is provided by a supervised learning model is used as the person determiner. The supervised learning model may use a support vector machine, a neural network, a Naive Bayes, a deep learning, or a decision tree, for example. Training data used for the machine learning includes unique image components such as shape elements of a person extracted from an image and appearance elements. The shape elements include, for example a size and an outline of a person. The appearance elements include light source information, texture information, and camera information, for example. The light source information includes information regarding reflectance, shading, and the like. The texture information includes color information, and the like. The camera information includes information regarding an image quality, an image resolution, an angle of view, and the like. Through the process of Step S150, the obstacle detector 55 functions as a determiner that determines whether an object is a person or an obstacle other than a person.
The alarm 58 is a device that issues an alarm to the operator of the forklift truck 10. The alarm 58 includes, for example, a buzzer that issues an alarm with sounds, a lamp that issues an alarm with lights, or combination thereof.
The main controller 31, the drive controller 43, and the object detector 51 can acquire information from each other through the bus 60. The main controller 31, the drive controller 43, and the object detector 51 acquire the information from each other through communication in accordance with a communication protocol for the vehicle, such as CAN (Controller Area Network) or LIN (Local Interconnect Network).
The main controller 31 acquires the rotational speed and the rotational direction of the driving motor 41 from the drive controller 43, and acquires the steering angle from the steering angle sensor 36, thereby deriving the vehicle speed of the forklift truck 10. The vehicle speed of the forklift truck 10 can be derived from the rotational speed and the rotational direction of the driving motor 41 provided in each of the driving wheels 12 and 13, a gear ratio, an outer diameter of each of the driving wheels 12 and 13, the steering angle detected by the steering angle sensor 36, and the like. The main controller 31 derives a traveling direction of the forklift truck 10 as well as the vehicle speed. The traveling direction of the forklift truck 10 is one of a forward direction and a reverse direction. The traveling direction of the forklift truck 10 is indicated by a sign “+” or “−” accompanying with the vehicle speed. The vehicle speed with “+” indicates the forward direction, and the vehicle speed with “−” indicates the reverse direction. The vehicle speed of the present embodiment indicates the vehicle speed without the sign “+” or “−”. That is, the vehicle speed of the present embodiment indicates an absolute value of the vehicle speed.
The main controller 31 activates the alarm 58 by transmitting an alarm command through the bus 60. Specifically, the object detector 51 includes an activation portion that activates the alarm 58 upon reception of the alarm command.
Next, a vehicle speed control executed in the forklift truck 10 will be described.
The vehicle speed of the forklift truck 10 is controlled by the main controller 31 depending on a position of an object and a type of the object detected by the object detector 51. The type of the object means that the object is a person or an obstacle other than a person. In the following description, the obstacle corresponds to an object other than a person. The vehicle speed control includes an automatic deceleration control and a travel start limitation control.
As illustrated in
In the present embodiment, the travel start limitation area AA1 is divided into three areas which are a central area N, a left area NL positioned on the left of the central area N, and a right area NR positioned on the right of the central area N. The central area N is an area facing the forklift truck 10 in the front-rear direction. The dimension of the central area N in the right-left direction coincides with that of the forklift truck 10 in the vehicle width direction. It can be said that the central area N is an area on which the forklift truck 10 passes while traveling straight in the reverse direction. It can be said that the left area NL is an area on which the forklift truck 10 passes while turning to left in the reverse direction. It can be said that the right area NR is an area on which the forklift truck 10 passes while turning to right in the reverse direction.
As illustrated in
The expected trajectory T can be derived from the steering angle of the steering wheels 14 and dimensional information of the forklift truck 10. The dimensional information of the forklift truck 10 includes the dimension [mm] of the forklift truck 10 from a central axis of the driving wheels 12 and 13 to a rear end of the vehicle body 11, a wheelbase [mm], and a vehicle width [mm]. The dimensional information of the forklift truck 10 can be prestored in, for example, the memory 33 of the main controller 31 because the dimensional information is the known information. The expected trajectory T is a trajectory between a trajectory LT on which a left end LE of the vehicle body 11 passes and a trajectory RT on which a right end RE of the vehicle body 11 passes. The main controller 31 derives the X-coordinate and the Y-coordinate of the expected trajectory T extending in the rear of the forklift truck 10 in the world coordinate system.
As illustrated in
The vehicle speed of the forklift truck 10 illustrated in
The expected trajectory T is derived within the automatic deceleration area AA2. The minimum value of the trajectory derivation threshold YT may correspond to a Y-coordinate in the travel start limitation area AA1 at the farthest position away from the forklift truck 10. That is, the trajectory derivation threshold YT is set so as to derive the expected trajectory T at least within the travel start limitation area AA1 even when the forklift truck 10 stops and the vehicle speed of the forklift truck 10 is zero [km/h]. In the present embodiment, the main controller 31 functions as an expected trajectory derivation unit.
The travel start limitation control will be described. The X-coordinate and the Y-coordinate in the following description indicate those in the world coordinate system.
As illustrated in
As illustrated in
The state in which a vehicle speed limit is not imposed includes an aspect in which a vehicle speed upper limit that does not substantially function as the upper limit is set, such as a case where the vehicle speed upper limit is higher than the maximum vehicle speed that is a reachable by the forklift truck 10, in addition to an aspect in which a vehicle speed upper limit is not set. Similarly, the state in which an acceleration limit is not imposed includes an aspect in which an acceleration upper limit that does not substantially function as the upper limit is set, such as a case where the acceleration is higher than the maximum acceleration that is a reachable vehicle speed of the forklift truck 10, in addition to an aspect in which an acceleration upper limit is not set. The deceleration limit is imposed as with the above-described acceleration limit.
As illustrated in
Condition A1 . . . An object is present in the travel start limitation area AA1.
Condition A2 . . . A detection result of the direction sensor 35 indicates a neutral, or the detection result of the direction sensor 35 indicates a reverse travel and the areas N, NL, and NR where the object is present matches an extending direction of the expected trajectory T.
Condition A3 . . . The forklift truck 10 stops.
The object in the condition A1 may be a person, or an obstacle other than a person. As described above, after the obstacle detector 55 derives the position of the object, the obstacle detector 55 determines whether the object is a person or an obstacle. Since it takes a long time to determine whether the object is a person or not, the obstacle detector 55 may be configured to transmit information on whether the object is a person or not after transmitting information indicative of the position of the object to the main controller 31. Since the main controller 31 can determine that the condition A1 is satisfied at a time of recognition of the position of the object, a determination speed can be improved, as compared with determination of whether or not the condition A1 is satisfied after determination of whether the object is a person or an obstacle. Whether or not the condition A1 is satisfied can be determined based on the X-coordinate and the Y-coordinate of the object. Since the travel start limitation area AA1 is defined by the X-coordinate and the Y-coordinate, presence or absence of the object in the travel start limitation area AA1 can be determined based on the X-coordinate and the Y-coordinate of the object.
A state in which the areas N, NL, and NR where the object is present matches the extending direction of the expected trajectory T may be rephrased as a state in which among the central area N, the left area NL, and the right area NR obtained by dividing the travel start limitation area AA1, an area in which the object is present overlaps the expected trajectory T. That is, this overlapping can be considered as a state in which the object is present within the expected trajectory T. When one object is positioned across the areas N, NL, and NR, or when a plurality of objects is positioned in the different areas N, NL, and NR, the main controller 31 determines that objects are present in the respective areas N, NL, and NR. In this case, when any of the areas N, NL, and NR where the object is present matches the extending direction of the expected trajectory T, the main controller 31 determines that the condition A2 is satisfied.
The condition A1 and the condition A2 can be represented by a table of
Whether or not the condition A3 is satisfied can be determined by the vehicle speed calculated by the main controller 31. The main controller 31 determines that the forklift truck 10 stops when the vehicle speed is equal to or less than a stop determination threshold [km/h]. The stop determination threshold may be set at a value considered that the forklift truck 10 stops, for example, any value from zero [km/h] to 0.5 [km/h].
As shown in
As illustrated in
Condition B1 . . . No object is present in the travel start limitation area AA1.
Condition B2 . . . The detection result of the direction sensor 35 indicates the forward travel.
Condition B3 . . . The detection result of the direction sensor 35 indicates the reverse travel, and the areas N, NL, and NR where the object is present do not match the extending direction of the expected trajectory T.
The conditions B1, B2, and B3 can be represented by a table in
As illustrated in
Condition C1 . . . The detection result of the direction sensor 35 indicates a position other than the neutral.
Condition C2 . . . The accelerator is ON.
The condition C1 is satisfied when the detection result of the direction sensor 35 indicates the forward travel or the reverse travel. When the detection result of the direction sensor 35 indicates the forward travel in the travel start limitation state S2, which satisfies the condition B2, the state of the main controller 31 is shifted to the normal control state S10. Therefore, it can be said that the condition C1 is satisfied substantially when the detection result of the direction sensor 35 indicates the reverse travel.
“The accelerator is ON” in the condition C2 means that the accelerator 16 has been operated by the operator of the forklift truck 10. The operation of the accelerator 16 is determined by the detection result of the accelerator sensor 34. “The accelerator is ON” includes a play of the accelerator 16, that is, the operation of the accelerator 16 in a dead zone.
As illustrated in
As illustrated in
Condition D1 . . . The accelerator is OFF.
“The accelerator is OFF” means that the accelerator 16 is not operated by the operator of the forklift truck 10. It is determined that the accelerator 16 is not operated, based on the detection result of the accelerator sensor 34. It can be said that the condition D1 is satisfied by failure in satisfying the condition C2.
As illustrated in
As illustrated in
Condition E1 . . . At least one of the conditions B1, B2, and B3 is satisfied.
Condition E2 . . . The detection result of the direction sensor 35 is different from the previous value.
Condition E3 . . . The forklift truck 10 is traveling.
It can be said that the condition E1 is the same as the travel start limitation release condition. The condition E2 is satisfied when the direction lever 17 is operated and the detection result of the direction sensor 35 is changed from the forward travel to the neutral, from the forward travel to the reverse travel, from the neutral to the forward travel, from the neutral to the reverse travel, from the reverse travel to the neutral, or from the reverse travel to the forward travel. The condition E3 can be determined from the vehicle speed. When the vehicle speed is higher than the stop determination threshold [km/h], the main controller 31 determines that the forklift truck 10 is traveling.
When the main controller 31 is in the forced operation state S4 and a forced operation pre-release condition is satisfied, the main controller 31 is shifted from the forced operation state S4 to the forced operation pre-release state S5. The forced operation pre-release condition being satisfied means that the following condition F1 is satisfied. When both the forced operation release condition and the forced operation pre-release condition are satisfied, the main controller 31 prioritizes the forced operation release condition and is shifted to the normal control state S10.
Condition F1 . . . At least one of the conditions B1, B2, and B3 is satisfied. It can be said that the forced operation pre-release condition is the same as the travel start limitation release condition.
As illustrated in
As illustrated in
Condition G1 . . . The vehicle speed of the forklift truck 10 reaches a value obtained by subtracting a first predetermined value from the target vehicle speed.
Condition G2 . . . The accelerator is OFF.
The condition G1 indicates that a speed deviation as a difference between the target vehicle speed and the vehicle speed of the forklift truck 10 is less than the first predetermined value. Since the acceleration limitation in the forced operation pre-release state S5 deteriorates the speed followability of the forklift truck 10, the forklift truck 10 is less likely to reach the target vehicle speed. The first predetermined value is set in order to determine that the vehicle speed of the forklift truck 10 whose acceleration is limited has reached the target vehicle speed intended by the operator. The first predetermined value may be any value, for example, from 0.5 [km/h] to 2.0 [km/h].
When the main controller 31 is in the forced operation pre-release state S5 and the travel start limitation condition is satisfied, the main controller 31 is shifted to the travel start limitation state S2.
Next, the automatic deceleration control will be described.
The automatic deceleration control includes a travel limitation control that causes the forklift truck 10 to stop and a vehicle speed limitation control that allows the forklift truck 10 to travel at the vehicle speed upper limit or less. The travel limitation control will be firstly described.
As illustrated in
The normal control state S10 is the same as the normal control state S10 in the travel start limitation control.
When the main controller 31 is in the normal control state S10 and the pre-travel limitation condition is satisfied, the main controller 31 is shifted to the pre-travel limitation state S11. The pre-travel limitation condition being satisfied means that both the following conditions H1 and H2 are satisfied.
Condition H1 . . . A person is present in an alarm area.
Condition H2 . . . The forklift truck 10 is traveling in the reverse direction.
The alarm area is different from a part of the automatic deceleration area AA2 in which the speed limit is imposed on the forklift truck 10. The alarm area is set so that the alarm 58 issues an alarm before an entry of the person into the expected trajectory T. The alarm area in the condition H1 may be the entire automatic deceleration area AA2 excluding the expected trajectory T, or may be a predetermined range outwardly extending from the expected trajectory T.
The vehicle speed and the traveling direction calculated by the main controller 31 may determine whether or not the forklift truck 10 is traveling in the reverse direction. When the traveling direction of the forklift truck 10 is oriented in the reverse direction and the vehicle speed is higher than the stop determination threshold, the main controller 31 determines that the forklift truck 10 is traveling in the reverse direction.
The pre-travel limitation state S11 is a state in which the alarm 58 issues the alarm. In the pre-travel limitation state S11, the vehicle speed limitation, the acceleration limitation, and the deceleration limitation are not imposed on the forklift truck 10. The alarm is not issued in the pre-travel limitation state S11 at a time of switchback of the forklift truck 10. The switchback is an operation in which the direction lever 17 is operated so as to switch the traveling direction of the forklift truck 10 from the forward travel to the reverse travel or from the reverse travel to the forward travel. The main controller 31 turns a switchback flag on when the detection result of the direction sensor 35 does not match the traveling direction of the forklift truck 10. The alarm 58 does not issue an alarm even when the main controller 31 is shifted to the pre-travel limitation state S11 with the switchback flag turned on. The switchback flag is released when the main controller 31 is shifted from the pre-travel limitation state S11 to another state, for example.
When the main controller 31 is in the pre-travel limitation state S11 and the pre-travel limitation release condition is satisfied, the main controller 31 is shifted to the normal control state S10. The pre-travel limitation release condition being satisfied means that at least one of the following conditions I1 and I2 is satisfied.
Condition I1 . . . No person is present within the expected trajectory T and the alarm area.
Condition I2 . . . The traveling in the reverse direction is stopped and is not operated.
The stop of the traveling in the reverse direction means that the vehicle speed of the forklift truck 10 is changed from the vehicle speed higher than the stop determination threshold to the stop determination threshold or less. That is, the stop of the traveling in the reverse direction means that the traveling of the forklift truck 10 is stopped. The state in which the traveling in the reverse direction is not operated means that at least one of a state of the accelerator opening degree of 0%, that is, a state in which the accelerator 16 is not operated and a state in which the detection result of the direction sensor 35 indicates any position other than the reverse travel are satisfied. A state in which the detection result of the direction sensor 35 indicates any position other than the reverse travel means that the detection result of the direction sensor 35 indicates the neutral or the forward travel.
When the main controller 31 is in the pre-travel limitation state S11 and the travel limitation condition is satisfied, the main controller 31 is shifted to the travel limitation state S12. The travel limitation condition being satisfied means that all the following conditions J1 and J2 are satisfied.
Condition J1 . . . A person is present within the expected trajectory T.
Condition J2 . . . The forklift truck 10 is traveling in the reverse direction.
Whether or not the condition J1 is satisfied may be determined by the X-coordinate and the Y-coordinate of the person. Since the expected trajectory T is defined by the X-coordinate and the Y-coordinate, the presence or absence of the person within the expected trajectory T can be determined by the X-coordinate and the Y-coordinate of the person. The expected trajectory T is derived within the automatic deceleration area AA2. Thus, when a person is present within the expected trajectory T, it can be said that the person is present within the automatic deceleration area AA2 and the expected trajectory T. The condition J2 is the same as the condition H2.
As illustrated in
As illustrated in
Condition K1 . . . The traveling in the reverse direction is stopped and not operated.
The condition K1 is the same as the condition I2.
When the main controller 31 is in the travel limitation state S12 and a travel limitation pre-release condition is satisfied, the main controller 31 is shifted to the travel limitation pre-release state S13. The travel limitation pre-release condition being satisfied means that all the following conditions L1 and L2 are satisfied.
Condition L1 . . . No person is present within the expected trajectory T.
Condition L2 . . . The forklift truck 10 is traveling in the reverse direction.
It can be said that the condition L1 is satisfied by failure in satisfying the condition J1. The condition L2 is the same as the condition H2.
As illustrated in
As illustrated in
Condition M1 . . . The vehicle speed of the forklift truck 10 reaches a value obtained by subtracting a second predetermined value from the target vehicle speed.
Condition M2 . . . The reverse travel is not operated.
It can be said that the condition M1 indicates that the speed deviation as the difference between the target vehicle speed and the vehicle speed of the forklift truck 10 is less than the second predetermined value. Since the acceleration limitation in the travel limitation pre-release state S13 deteriorates the speed followability of the forklift truck 10, the vehicle speed of the forklift truck 10 is less likely to reach the target vehicle speed. The second predetermined value is set in order to determine that the vehicle speed of the forklift truck 10 whose acceleration is limited has reached the target vehicle speed intended by the operator. The second predetermined value may be any value, for example, from 0.5 [km/h] to 2.0 [km/h]. The second predetermined value may be the same as or different from the first predetermined value.
When the main controller 31 is in the travel limitation pre-release state S13 and the travel limitation condition is satisfied, the main controller 31 is shifted to the travel limitation state S12. Similarly, when the main controller 31 is in the normal control state S10 and the travel limitation condition is satisfied, the main controller 31 is shifted to the travel limitation state S12.
As described above, the main controller 31 extends the expected trajectory T in the travel direction as the vehicle speed of the forklift truck 10 increases. When the main controller 31 is shifted to the travel limitation state S12 and the expected trajectory T is shortened in the travel direction as the vehicle speed of the forklift truck 10 decreases, the person may be positioned outside the expected trajectory T. In this case, although the forklift truck 10 is approaching the person, the main controller 31 is shifted alternately between the travel limitation state S12 and the travel limitation pre-release state S13. For the purpose of preventing such situation, when the main controller 31 detects the person being present within the expected trajectory T, the main controller 31 keeps the length of the expected trajectory T in the travel direction regardless of the vehicle speed of the forklift truck 10, that is, keeps the trajectory derivation threshold YT. Keeping of the trajectory derivation threshold YT is released when the person disappears within the expected trajectory T, for example.
Next, the vehicle speed limitation control will be described. The vehicle speed limitation control includes different controls depending on a case where an object is a person and a case where an object is an obstacle. With reference to
As illustrated in
As illustrated in
As illustrated in
Condition N1 . . . A person is present in a pre-alarm area of the automatic deceleration area AA2.
Condition N2 . . . The forklift truck 10 is traveling in the reverse direction.
The pre-alarm area is farther than a vehicle speed limitation area in which the speed limit is imposed on the forklift truck 10. The vehicle speed limitation area is an area in which the speed limit is imposed on the forklift truck 10, within the automatic deceleration area AA2 excluding the expected trajectory T. The speed limit need not be imposed at a position within the automatic deceleration area AA2, away from the forklift truck 10. That is, the automatic deceleration area AA2 includes both the vehicle speed limitation area in which the speed limit is imposed, and an area in which the speed limit is not imposed, the area being away from the forklift truck 10 farther than the vehicle speed limitation area. The vehicle speed limitation area is an area extending rearward, leftward and rightward, from the expected trajectory T. The vehicle speed limitation area is determined by the vehicle speed of the forklift truck 10 and the expected trajectory T. The pre-alarm area is an area in which the vehicle speed upper limit higher than the vehicle speed of the forklift truck 10 is set. The pre-alarm area is derived from the vehicle speed of the forklift truck 10 and the vehicle speed upper limit that is set depending on a position of the person, so that a time from an entry of the person into the pre-alarm area to an entry of the person into the vehicle speed limitation area becomes a predetermined time. The predetermined time is one second to three seconds, for example.
The pre-limitation start state S22 is a state in which the alarm 58 issues the alarm. The pre-limitation start state S22 is a state for warning the possibility of the vehicle speed limitation to the operator before the vehicle speed is limited. The vehicle speed limitation, the acceleration limitation, and the deceleration limitation are not imposed on the forklift truck 10 in the pre-limitation start state S22. The alarm is not issued in the pre-limitation start state S22 at a time of switchback of the forklift truck 10, as with the pre-travel limitation state S11.
When the main controller 31 is in the pre-limitation start state S22 and a pre-limitation start release condition is satisfied, the main controller 31 is shifted to the limitation release state S21. The pre-limitation start release condition corresponds to at least one of the following conditions O1 and O2 being satisfied.
Condition O1 . . . No person is present in the vehicle speed limitation area and the pre-alarm area.
Condition O2 . . . The traveling in the reverse direction is stopped and not operated.
When the main controller 31 is in the pre-limitation start state S22 and a first limitation start condition is satisfied, the main controller 31 is shifted to the limitation start state S23. The first limitation start condition being satisfied means that all the following conditions P1 and P2 are satisfied.
Condition P1 . . . A person is present in the vehicle speed limitation area of the automatic deceleration area AA2.
Condition P2 . . . The forklift truck 10 is traveling in the reverse direction.
As illustrated in
The deceleration is limited in the limitation start state S23. In the limitation start state S23, the deceleration upper limit is set at DS2 [m/s2]. The DS2 is higher than zero, and lower than the maximum deceleration speed of the forklift truck 10. The DS2 may be the same as or different from the DS1. As with the travel limitation state S12, during the deceleration operation by the operator, the main controller 31 may prioritize such deceleration operation by the operator and need not limit the deceleration.
As illustrated in
Condition Q1 . . . The traveling in the reverse direction is stopped and not operated.
When the main controller 31 is in the limitation start state S23 and a limitation pre-release condition is satisfied, the main controller 31 is shifted to the limitation pre-release state S24. The limitation pre-release condition being satisfied means that the following condition R1 is satisfied.
Condition R1 . . . No person is present in the vehicle speed limitation area of the automatic deceleration area AA2.
As illustrated in
As illustrated in
Condition S1 . . . A person is present in the vehicle speed limitation area of the automatic deceleration area AA2.
When the main controller 31 is in the limitation pre-release state S24 and a limitation actual-release condition is satisfied, the main controller 31 is shifted to the limitation release state S21. The limitation actual-release condition being satisfied means that at least one of the following conditions T1 and T2 is satisfied.
Condition T1 . . . The vehicle speed of the forklift truck 10 reaches a value obtained by subtracting a third predetermined value from the target vehicle speed.
Condition T2 . . . The reverse travel is not operated.
The condition T1 indicates that the speed deviation as the difference between the target vehicle speed and the vehicle speed of the forklift truck 10 is less than the third predetermined value. Since the acceleration limitation in the limitation pre-release state S24 deteriorates the speed followability of the forklift truck 10, the forklift truck 10 is less likely to reach the target vehicle speed. The third predetermined value is set in order to determine that the vehicle speed of the forklift truck 10 whose acceleration is limited has reached the target vehicle speed intended by the operator. The third predetermined value may be any value, for example, from 0.5 [km/h] to 2.0 [km/h]. The third predetermined value may be the same as or different from the first predetermined value or the second predetermined value.
As with the travel limitation control, the main controller 31 may keep the trajectory derivation threshold YT when detecting a person being present in the vehicle speed limitation area.
Next, the vehicle speed limitation control when an obstacle as the object is present will be described. Hereinafter, differences from the vehicle speed limitation control when the person as the object is present will be described, and the same description as the vehicle speed control when the person as the object is present will be omitted.
The pre-limitation start condition being satisfied when the obstacle as the object is present means that both the following conditions U1 and U2 are satisfied.
Condition U1 . . . An obstacle is present in the pre-alarm area of the automatic deceleration area AA2.
Condition U2 . . . The forklift truck 10 is traveling in the reverse direction.
The vehicle speed limitation area when the object is the obstacle is an area within the expected trajectory T of the automatic deceleration area AA2. When the object is the obstacle, the vehicle speed limitation area is set within the expected trajectory T, unlike the case where the object is the obstacle. The pre-alarm area is farther than the vehicle speed limitation area. The pre-alarm area is derived from the vehicle speed of the forklift truck 10 and the vehicle speed upper limit that is set depending on a position of the obstacle, so that a time from an entry of the obstacle into the pre-alarm area to an entry of the obstacle into the vehicle speed limitation area becomes a predetermined time. The predetermined time is one second to three seconds, for example. When the object is the obstacle, the pre-alarm area is, for example, one of an area farther than the vehicle speed limitation area within the expected trajectory T, an area excluding the expected trajectory T and being on an extended line of the expected trajectory T, and an area including both these areas.
When the object is an obstacle, the object is changed from the person to the obstacle for each condition of the pre-limitation start release condition, the first limitation start condition, the limitation start release condition, the limitation pre-release condition, the second limitation start condition, and the limitation actual-release condition.
When the object is the obstacle, the vehicle speed upper limit of the forklift truck 10 is lowered as the distance from the forklift truck 10 to the obstacle becomes short. A map in which the distance from the forklift truck 10 to the obstacle is associated with the vehicle speed upper limit is stored in the memory 33 of the main controller 31 or a storage medium such as an external storage device. The main controller 31 sets the vehicle speed upper limit in accordance with the map. The vehicle speed upper limit need not be lowered as the distance from the forklift truck 10 to the obstacle becomes short. A configuration is simply required to have a correlation in which the vehicle speed upper limit is lowered as the distance from the forklift truck 10 to the obstacle becomes short. A value of the vehicle speed upper limit when the obstacle as the object is present is higher than that when the person as the object is present. Specifically, when the distance from the forklift truck 10 to the obstacle is same as the distance from the forklift truck 10 to the person, the vehicle speed upper limit when the obstacle as the object is present is set at a higher value as compared with the vehicle speed upper limit when the person as the object is present.
As described above, the main controller 31 sets the vehicle speed upper limit depending on the states. In the present embodiment, it can be said that the main controller 31 functions as a vehicle speed upper limit setting unit.
Operations of the present embodiment will be described.
When the forklift truck 10 stops and the relationship represented by the table in
When the relationship represented by the table in
In the travel start limitation state S2, when the operator operates the accelerator 16 and attempts to start driving the forklift truck 10 to travel in the reverse direction, the main controller 31 is shifted to the travel start prohibition state S3. When the main controller 31 is shifted to the travel start prohibition state S3, it is determined that the operator of the forklift truck 10 does not recognize the presence of the object within the expected trajectory T, and the alarm 58 accordingly intensifies the alarm. This alarm notifies the operator of the forklift truck 10 that the object is present in the expected trajectory T.
When the operator's operation of the accelerator 16 is released after the main controller 31 is shifted to the travel start prohibition state S3, it is determined that the operator of the forklift truck 10 recognizes the presence of the object within the expected trajectory T because of the release of the operation of the accelerator 16. Accordingly, the main controller 31 is shifted to the forced operation state S4.
In the forced operation state S4, the start of traveling of the forklift truck 10 is allowed even when the object is present in the travel start limitation area AA1. That is, after it is determined that the operator of the forklift truck 10 recognizes the presence of the object within the travel start limitation area AA1, it is determined that the operator of the forklift truck 10 can start while avoiding the object, which allows the start of traveling of the forklift truck 10.
When the object disappears within the travel start limitation area AA1 by at least one of movements of the forklift truck 10 and the object, the main controller 31 is shifted to the forced operation pre-release state S5. The acceleration is limited in the forced operation pre-release state S5. Since the speed limit is imposed on the forklift truck 10 in the forced operation state S4, the speed deviation may increase. Thus, the forklift truck 10 gradually accelerates by interposing the forced operation pre-release state S5 before the shift from the forced operation state S4 to the normal control state S10. In the forced operation state S4, when the operator operates the direction lever 17 and the detection result of the direction sensor 35 indicates a value different from the previous value, the main controller 31 is shifted to the normal control state S10.
In the forced operation pre-release state S5, when the forklift truck 10 accelerates and the speed deviation decreases, the main controller 31 is shifted to the normal control state S10. Since the acceleration is limited in the forced operation pre-release state S5, the acceleration cannot be efficiently performed. When the efficient acceleration is desired, the accelerator is turned off to release the forced operation pre-release state S5, which improves operability. When the travel start limitation condition is satisfied again before the shift of the forced operation pre-release state S5 to the normal control state S10, the main controller 31 is shifted to the travel start limitation state S2.
As described above, the travel start limitation control works when the forklift truck 10 starts from the stop state. In the travel start limitation control, when the forklift truck 10 stops and the object is present within the travel start limitation area AA1 and the expected trajectory T, the start of traveling of the forklift truck 10 is limited by the vehicle speed upper limit being set at zero. The speed limit is imposed on the forklift truck 10 when the forklift truck 10 is traveling in a direction approaching the object, which prevents the forklift truck 10 from approaching the object.
When a person enters the pre-alarm area during the traveling of the forklift truck 10, the main controller 31 is shifted to the pre-limitation start state S22. The main controller 31 causes the alarm 58 to issue an alarm and thus causes the operator to recognize that the person may enter the expected trajectory T. When the operator operates the forklift truck 10 so that the forklift truck 10 turns in a direction away from the person or the forklift truck 10 stops and does not travel rearward, the main controller 31 is shifted to the limitation release state S21. When the person enters the vehicle speed limitation area with the main controller 31 shifted to the pre-limitation start state S22, the main controller 31 is shifted to the limitation start state S23. The main controller 31 sets the vehicle speed upper limit at a value in accordance with the map. At this time, the deceleration upper limit DS2 is set, so that the deceleration is also limited. Thus, the forklift truck 10 gradually decelerates.
In the limitation start state S23, although the vehicle speed upper limit is set, the traveling of the forklift truck 10 is allowed at the vehicle speed upper limit or less. The operator can cause the forklift truck 10 to travel while avoiding the person. When the main controller 31 is in the limitation start state S23 and the limitation start release condition is satisfied, the main controller 31 is shifted to the limitation release state S21, which releases the vehicle speed limitation.
In the limitation start state S23, when the operator continues to operate the traveling of the forklift truck 10 and the person disappears in the vehicle speed limitation area, the main controller 31 is shifted to the limitation pre-release state S24. Accordingly, the vehicle speed limitation is released. The acceleration is limited in the limitation pre-release state S24. Since the speed limit is imposed on the forklift truck 10 in the limitation start state S23, the speed deviation may increase. Thus, the forklift truck 10 gradually accelerates by interposing the limitation pre-release state S24 before the shift from the limitation start state S23 to the limitation release state S21.
In the limitation pre-release state S24, when the forklift truck 10 accelerates and the speed deviation decreases, the main controller 31 is shifted to the limitation release state S21. Since the acceleration is limited in the limitation pre-release state S24, the acceleration is not efficiently performed. When the efficient acceleration is desired, the accelerator is turned off to release the limitation pre-release state S24, which improves operability. When the operator changes the traveling direction to the forward direction in the limitation pre-release state S24, the main controller 31 is shifted to the limitation release state S21. When the person enters the vehicle speed limitation area again before the main controller 31 is shifted from the limitation pre-release state S24 to the limitation release state S21, the main controller 31 is shifted to the limitation start state S23.
When a person enters the alarm area during the traveling of the forklift truck 10, the main controller 31 is shifted to the pre-travel limitation state S11. The main controller 31 causes the alarm 58 to issue an alarm, thereby causing the operator to recognize that the person may enter the expected trajectory T. When the operator operates the forklift truck 10 so that the forklift truck 10 turns in a direction away from the person or the forklift truck 10 stops and does not travel rearward, the main controller 31 is shifted to the normal control state S10. When the person enters the expected trajectory T with the main controller 31 shifted to the pre-travel limitation state S11, the main controller 31 is shifted to the travel limitation state S12. The main controller 31 sets the vehicle speed upper limit at zero, which stops the forklift truck 10. At this time, the deceleration upper limit DS1 is set, so that the deceleration is also limited. Thus, the forklift truck 10 gradually stops.
When the forklift truck 10 stops and the reverse traveling is not operated by the operator after the shift of the main controller 31 to the travel limitation state S12, the main controller 31 is shifted to the normal control state S10. When the main controller 31 is in the normal control state S10 and the travel limitation condition is satisfied, the main controller 31 is shifted to the travel limitation state S12 without interposing the pre-travel limitation state S11. A state in which the travel limitation condition is satisfied without satisfying the pre-travel limitation condition is assumed to be, for example, a state in which the vehicle speed of the forklift truck 10 is high or a state in which the object enters the expected trajectory T from a blind spot of the object detectable range of the object detector 51.
In the travel limitation state S12 of the main controller 31, when the person disappears in the expected trajectory T before the stop of the forklift truck 10, the main controller 31 is shifted to the travel limitation pre-release state S13. When the person enters the expected trajectory T again after the shift to the travel limitation pre-release state S13, the main controller 31 is shifted to the travel limitation state S12. The acceleration is limited in the travel limitation pre-release state S13. Since the speed limit is imposed on the forklift truck 10 in the travel limitation state S12, the speed deviation may increase. Thus, the forklift truck 10 gradually accelerates by interposing the travel limitation pre-release state S13 before the shift from the travel limitation state S12 to the normal control state S10.
In the travel limitation pre-release state S13, when the forklift truck 10 accelerates and the speed deviation decreases, the main controller 31 is shifted to the normal control state S10. Since the acceleration is limited in the travel limitation pre-release state S13, the acceleration cannot be efficiently performed. When the efficient acceleration is desired, the accelerator is turned off to release the travel limitation pre-release state S13, which improves operability.
As described above, when a person is detected by the object detector 51 with the forklift truck 10 traveling, the forklift truck 10 is decelerated by working the vehicle speed limitation control on the person within the automatic deceleration area AA2 and outside the expected trajectory T. Furthermore, when the person enters the expected trajectory T, the travel limitation control works, which stops the forklift truck 10. It can be said that the speed limit is imposed on the forklift truck 10 when the forklift truck 10 is traveling in a direction approaching the person.
When the obstacle enters the pre-alarm area during the traveling of the forklift truck 10, the main controller 31 is shifted to the pre-limitation start state S22. The main controller 31 causes the alarm 58 to issue an alarm and thus causes the operator to recognize that the obstacle is present nearby. When the operator operates the forklift truck 10 so that the forklift truck 10 turns in a direction away from the obstacle or the forklift truck 10 stops and does not travel rearward, the main controller 31 is shifted to the limitation release state S21. When the obstacle enters the vehicle speed limitation area with the main controller 31 shifted to the pre-limitation start state S22, the main controller 31 is shifted to the limitation start state S23. The main controller 31 sets the vehicle speed upper limit at a value in accordance with the map. At this time, the deceleration upper limit DS2 is set, so that the deceleration is also limited. Thus, the forklift truck 10 gradually decelerates.
In the limitation start state S23, although the vehicle speed upper limit is set, the traveling of the forklift truck 10 is allowed at the vehicle speed upper limit or less. The operator can cause the forklift truck 10 to travel while avoiding the obstacle. When the main controller 31 is in the limitation start state S23 and the limitation start release condition is satisfied, the main controller 31 is shifted to the limitation release state S21, which releases the vehicle speed limitation. When the object is the obstacle, the vehicle speed limitation area is set within the expected trajectory T, so that the limitation start release condition can be satisfied more easily than a case of the person as the object. In the limitation pre-release state S24, the same operation as a case of the person as the object can be obtained.
As described above, when the obstacle is detected by the object detector 51 with the forklift truck 10 traveling, the vehicle speed limitation control works on the obstacle. Accordingly, the speed limit is imposed on the forklift truck 10 when the obstacle enters the automatic deceleration area AA2 and the expected trajectory T. On the other hand, the speed limit is not imposed on the forklift truck 10 when the obstacle is present outside the expected trajectory T.
In the automatic deceleration control, when the person is present in the expected trajectory T, the vehicle speed upper limit is set at zero. On the other hand, when the obstacle is present in the expected trajectory T, the vehicle speed upper limit is set at a value higher than zero. When the person is present outside the expected trajectory T, the vehicle speed upper limit is set at a value higher than zero. On the other hand, when the obstacle is present outside the expected trajectory T, the speed limit is not imposed on the forklift truck 10. Therefore, when the object is determined as the person, the main controller 31 sets the vehicle speed upper limit at a lower value as compared with the vehicle speed upper limit when the object is determined as the obstacle. When the object is present in the automatic deceleration area AA2 and the expected trajectory T, the main controller 31 sets the vehicle speed upper limit at a lower value as compared with the case in which the object is present within the automatic deceleration area AA2 and outside the expected trajectory T. “Setting of the vehicle speed upper limit at a lower value” includes a setting from a state without a setting of the vehicle speed upper limit. The speed limit need not be imposed on the forklift truck 10 even when the object is present within or outside the expected trajectory T. As in the present embodiment, the speed limit need not be imposed on the forklift truck 10 when the object is present outside the expected trajectory T.
In the present embodiment, state shifts in the travel start limitation control, the travel limitation control, the vehicle speed limitation control for a person, and the vehicle speed limitation control for an obstacle are performed in parallel. Thus, various vehicle speed upper limits and alarm modes may be set for each state shift. In this case, a control corresponding to one of the states only need be performed based on a preset priority. For example, the main controller 31 performs a predetermined control at the lowest vehicle speed upper limit.
Effects of the present embodiment will be described.
(1) The main controller 31 sets the vehicle speed upper limit when an object is present within the expected trajectory T. Specifically, in each of the travel start limitation control, the travel limitation control, the vehicle speed limitation control for the person, and the vehicle speed limitation control for the obstacle, the vehicle speed upper limit is set when the object is present within the expected trajectory T. The main controller 31 controls the forklift truck 10 so as not to exceed the vehicle speed upper limit. The vehicle speed of the forklift truck 10 is set at the vehicle speed upper limit or less even when the operator of the forklift truck 10 does not perform the deceleration operation. Therefore, operability of the operator of the forklift truck 10 can be improved.
(2) When an object is present within the automatic deceleration area AA2 and the expected trajectory T, the main controller 31 sets the vehicle speed upper limit at a lower value as compared with the vehicle speed upper limit when the object is present within the automatic deceleration area AA2 and outside the expected trajectory T. In the present embodiment, the vehicle speed upper limit is set at zero when a person as the object is present in the expected trajectory T. On the other hand, the vehicle speed upper limit is set at a value higher than zero when the person is present outside the expected trajectory T. The vehicle speed upper limit is set at a value higher than zero when an obstacle as the object is present within the expected trajectory T. On the other hand, the vehicle speed upper limit is not set when the obstacle is present outside the expected trajectory T.
Operability may be reduced when the vehicle speed upper limit in a case in which the object is present within the expected trajectory T is always set. For example, when the person is present within the automatic deceleration area AA2 regardless of the expected trajectory T and the main controller 31 sets the vehicle speed upper limit at zero, the forklift truck 10 stops even when the person is at a position that does not block the traveling of the forklift truck 10. In this case, the forklift truck 10 stops frequently, resulting in reduction of operability. Operability may be also reduced even when the object is the obstacle. The forklift truck 10 is often used in an environment where a plurality of objects is present around the forklift truck 10. In addition, frequency of a sharp turning of the forklift truck 10 is higher than that of passenger cars, and the forklift truck 10 is often equipped with a stereo camera having a field of view wider than a stereo camera mounted on the passenger cars. Therefore, in the forklift truck 10, operability is significantly reduced when the vehicle speed upper limit in a case in which the object is present within the expected trajectory T is always set.
In contrast, in the forklift truck 10 of the present embodiment, a vehicle speed upper limit higher than that when the object is present within the expected trajectory T is allowed when the object is not present within the expected trajectory T regardless of the presence of the object within the automatic deceleration area AA2. The object being present within the expected trajectory T is more likely to block the traveling of the forklift truck 10 as compared with the object being present outside the expected trajectory T. Therefore, the vehicle speed limitation is relaxed when no object is present in the expected trajectory T, which improves operability.
(3) When an object detected by the object detector 51 is an obstacle, the vehicle speed upper limit is set at a higher value as compared with the vehicle speed upper limit when the person as the object is present. The forklift truck 10 is often used in an environment where a plurality of objects is present around the forklift truck 10. Therefore, when the object is the obstacle, an allowable vehicle speed of the forklift truck 10 increases, which further improves operability. In particular, the speed limit is not imposed on the forklift truck 10 when the obstacle as the object is not present within the expected trajectory T, which can further improve operability.
(4) The obstacle detector 55 can determine whether an object is a person or an obstacle. When the main controller 31 performs the automatic deceleration control, the main controller 31 sets the vehicle speed upper limit at a lower value when the person as the object is present, as compared with the vehicle speed upper limit when the obstacle as the object is present. In the present embodiment, the vehicle speed upper limit is set at zero when the person is present within the expected trajectory T. On the other hand, the vehicle speed upper limit is set at a value higher than zero when the obstacle is present within the expected trajectory T. Similarly, the vehicle speed upper limit when the person is present outside the expected trajectory T is set at a lower value as compared with the vehicle speed upper limit when the obstacle is present outside the expected trajectory T. The person is more likely to move as compared with the obstacle, and may approach the forklift truck 10. Thus, the vehicle speed upper limit when the object is the person is set at a lower value as compared with the vehicle speed upper limit when the object is the obstacle, which prompts the operator of the forklift truck 10 to avoid the object.
(5) When a person as the object is present outside the expected trajectory T, the main controller 31 sets the vehicle speed upper limit at a value higher than zero. When the person as the object is present within the expected trajectory T, the main controller 31 sets the vehicle speed upper limit at zero. When the person as the object is present outside the expected trajectory T, the main controller 31 lowers a value of the vehicle speed upper limit as the distance from the forklift truck 10 to the person becomes short. The vehicle speed of the forklift truck 10 is lowered as the person approaches the forklift truck 10. Thus, the forklift truck 10 can gradually stop when the vehicle speed upper limit is set at zero after entry of the person into the expected trajectory T.
(6) When an object is present within the travel start limitation area AA1 and within the expected trajectory T, the main controller 31 sets the vehicle speed upper limit at zero. The vehicle speed upper limit is set at zero, so that the start of traveling of the forklift truck 10 is prohibited. When the object is present within the travel start limitation area AA1 and within the expected trajectory T, the traveling of the forklift truck 10 may be blocked. In this case, the start of traveling of the forklift truck 10 is prohibited, which prompts the operator to change the traveling direction and to operate turning of the forklift truck 10. This prevents blocking of the start of traveling of the forklift truck 10 and further improves operability.
(7) The main controller 31 extends the expected trajectory T in the traveling direction as the vehicle speed of the forklift truck 10 increases. A time to reach the object becomes short as the vehicle speed of the forklift truck 10 increases. Thus, the expected trajectory T is extended as the vehicle speed of the forklift truck 10 increases, which can appropriately limit the vehicle speed depending on the vehicle speed of the forklift truck 10.
(8) The main controller 31 derives the expected trajectory T from the steering angle. When the forklift truck 10 turns, the main controller 31 derives the expected trajectory T in line with the turning direction of the forklift truck 10. Therefore, accuracy of the derived expected trajectory T can be improved.
(9) The forklift truck 10 includes the cargo handling apparatus 20 on which a cargo is loaded. For loading the cargo, stability is required for the forklift truck 10 on which the cargo is loaded. The stability of the forklift truck 10 can be improved by the vehicle speed upper limit being set.
(10) The forced operation state S4 is set for the travel start limitation control. When the main controller 31 is shifted to the forced operation state S4, the main controller 31 allows the start of traveling of the forklift truck 10 even when an object is present within the travel start limitation area AA1 and the expected trajectory T. If the object is present in the travel start limitation area AA1 and the expected trajectory T and the start of traveling of the forklift truck 10 is always prohibited, the start of traveling of the forklift truck 10 is prohibited even in a state of the forklift truck 10 capable of starting while avoiding the object. In the forced operation state S4, the vehicle speed upper limit is set and the forklift truck 10 is allowed to start at a low vehicle speed, which can further improve operability.
(11) In the travel start limitation control, the alarm 58 issues an alarm when an object is present within the expected trajectory T, and the alarm 58 does not issue the alarm when the object is present outside the expected trajectory T. In the travel limitation control, the alarm 58 issues an alarm when a person is present within the warning area, and the alarm 58 does not issue the alarm when the person is present farther than the warning area. In the vehicle speed limitation control for a person and the vehicle speed limitation control for an obstacle, the alarm 58 issues an alarm when the object is present in the pre-alarm area, and the alarm 58 does not issue the alarm when the object is present farther than the pre-alarm area. As such, it can be said that the main controller 31 limits an area where the alarm 58 issues the alarm, within the object detectable range of the object detector 51. When the alarm 58 always issues an alarm upon detection of the object by the object detector 51, the alarm is issued regardless of the object that does not block the traveling of the forklift truck 10. In this case, the operator frequently receives the alarm and cannot recognize the object even when the object actually blocks the traveling of the forklift truck 10. Limitation of the alarm by the alarm 58 can prevent the operator from frequently receiving the alarm.
The embodiment can be modified and implemented as follows. The embodiment and the following modified embodiments can be implemented in combination with each other to the extent that there is no technical contradiction.
The vehicle speed upper limit that is set in the forced operation state S4 may be lowered as the lifting height of the cargo handling apparatus 20 increases. In this case, it is unnecessary to lower the vehicle speed upper limit as the lifting height of the cargo handling apparatus 20 increases. When the mast 21 is lifted from the lowest position to the highest position, it is simply required to have at least one point at which the vehicle speed upper limit is lowered and have no point exceeding this vehicle speed upper limit. For example, the lifting height that is lower than a preset threshold of the lifting height is defined as a low lifting height, and the lifting height that is higher than the preset threshold of the lifting height is defined as a high lifting height. In a case of the high lifting height, the main controller 31 sets the vehicle speed upper limit at a lower value as compared with the vehicle speed upper limit in a case of the low lifting height.
Similarly, the vehicle speed upper limit that is set in the limitation start state S23 may be lowered as the lifting height of the cargo handling apparatus 20 increases. The vehicle speed upper limit that is set in the limitation start state S23 is set depending on the distance to the object and the lifting height. The value of the vehicle speed upper limit is lowered as the distance to the object becomes short. The value of the vehicle speed upper limit is lowered as the lifting height of the cargo handling apparatus 20 increases. For the vehicle speed upper limit when the person is present outside the expected trajectory T and within the automatic deceleration area AA2 and the vehicle speed upper limit when the obstacle is present within the expected trajectory T, one of these vehicle speed upper limits may be lowered as the lifting height of the cargo handling apparatus 20 increases, or both the vehicle speed upper limits may be lowered as the lifting height of the cargo handling apparatus 20 increases. The vehicle speed upper limit that is set in the limitation start state S23 may be a value changing depending on only the lifting height of the cargo handling apparatus 20 without changing depending on the distance to the object.
The vehicle speed upper limit that is set in the forced operation state S4 may be lowered as the weight of the cargo loaded on the cargo handling apparatus 20 increases. In this case, it is unnecessary to lower the vehicle speed upper limit in proportion to the heavier weight of the cargo. When the weight of the cargo is changed from the weight without the cargo to the maximum weight of the cargo, it is simply required to have at least one point at which the vehicle speed upper limit is lowered and have no point exceeding the vehicle speed upper limit. For example, the weight of the cargo that is smaller than a preset threshold of the weight is defined as a light weight, and the weight of the cargo that is larger than the preset threshold of the weight of the cargo is defined as a heavy weight. In a case of the heavy weight, the main controller 31 sets the vehicle speed upper limit at a lower value as compared with the vehicle speed upper limit in a case of the light weight.
Similarly, the vehicle speed upper limit that is set in the limitation start state S23 may be lowered as the weight of the cargo increases. The vehicle speed upper limit that is set in the limitation start state S23 is set depending on the distance to the object and the weight of the cargo. The value of the vehicle speed upper limit is lowered as the distance to the object becomes short. The value of the vehicle speed upper limit is lowered as the weight of the cargo increases. For the vehicle speed upper limit when the person is present outside the expected trajectory T and within the automatic deceleration area AA2 and the vehicle speed upper limit when the obstacle is present within the expected trajectory T, one of these vehicle speed upper limits may be lowered as the weight of the cargo increases, or both the vehicle speed upper limits may be lowered as the weight of the cargo increases. The vehicle speed upper limit that is set in the limitation start state S23 may be a value changing depending on only the weight of the cargo without changing depending on the distance to the object.
At least one of the vehicle speed upper limit that is set in the forced operation state S4 and the vehicle speed upper limit that is set in the limitation start state S23 may be lowered as the lifting height of the cargo handling apparatus 20 increases and as the weight of the cargo increases. That is, the above-described two modified embodiments described for the vehicle speed upper limit may be combined with each other.
The acceleration upper limit that is set in at least one of the forced operation pre-release state S5, the limitation pre-release state S24 when the person is present outside the expected trajectory T, and the limitation pre-release state S24 when the obstacle is present outside the expected trajectory T may be lowered as the lifting height of the cargo handling apparatus 20 increases. In this case, the forklift truck 10 gradually accelerates as the lifting height of the cargo handling apparatus 20 increases.
The acceleration upper limit that is set in at least one of the forced operation pre-release state S5, the limitation pre-release state S24 when the person is present outside the expected trajectory T, and the limitation pre-release state S24 when the obstacle is present outside the expected trajectory T may be lowered as the weight of the cargo increases. In this case, the forklift truck 10 gradually accelerates as the weight of the cargo increases.
The acceleration upper limit that is set in at least one of the forced operation pre-release state S5, the limitation pre-release state S24 when the person is present outside the expected trajectory T, and the limitation pre-release state S24 when the obstacle is present outside the expected trajectory T may be lowered as the lifting height of the cargo handling apparatus 20 increases and as the weight of the cargo increases. That is, the above-described two modified embodiments described for the acceleration upper limit may be combined with each other.
The deceleration upper limit that is set in at least one of the travel limitation state S12, the limitation start state S23 when the person is present outside the expected trajectory T, and the limitation start state S23 when the obstacle is present within the expected trajectory T may be lowered as the lifting height of the cargo handling apparatus 20 increases. In this case, the forklift truck 10 gradually decelerates as the lifting height of the cargo handling apparatus 20 increases.
The deceleration upper limit that is set in at least one of the travel limitation state S12, the limitation start state S23 when the person is present outside the expected trajectory T, and the limitation start state S23 when the obstacle is present inside the expected trajectory T may be lowered as the weight of the cargo increases. In this case, the forklift truck 10 gradually decelerates as the weight of the cargo increases.
The deceleration upper limit that is set in at least one of the travel limitation state S12, the limitation start state S23 when the person is present outside the expected trajectory T, and the limitation start state S23 when the obstacle is present inside the expected trajectory T may be lowered as the lifting height of the cargo handling apparatus 20 increases and as the weight of the cargo increases. That is, the above-described two modified embodiments described for the deceleration upper limit may be combined with each other.
The forklift truck 10 need not have the lifting height sensor 37 when none of the vehicle speed upper limit, the acceleration upper limit, and the deceleration upper limit is changed depending on the lifting height of the cargo handling apparatus 20.
The forklift truck 10 need not have the weight sensor 38 when none of the vehicle speed upper limit, the acceleration upper limit, and the deceleration upper limit is changed depending on the weight of the cargo.
The vehicle speed upper limit that is set in the limitation start state S23 need not be changed depending on the distance to the object. That is, the vehicle speed upper limit that is set in the limitation start state S23 may be a fixed value. In this case, the vehicle speed upper limit when the person is present outside the expected trajectory T and within the automatic deceleration area AA2 is preferably set at a lower value than that when the obstacle is present within the expected trajectory T.
The main controller 31 need not extend the expected trajectory T in the traveling direction as the vehicle speed of the forklift truck 10 increases. In this case, the expected trajectory T in the traveling direction has a predetermined fixed length.
The main controller 31 need not change the expected trajectory T depending on the steering angle of the steering wheels 14. That is, the expected trajectory T may correspond to that when the forklift truck 10 is traveling straight in the reverse direction regardless of turning of the forklift truck 10.
The main controller 31 may define an area between the trajectory LT on which the left end LE of the vehicle body 11 passes and the trajectory RT on which the right end RE of the vehicle body 11 passes, and an area that is positioned outside the aforementioned area and extends along the trajectory LT and the trajectory RT, as the expected trajectory T. That is, the expected trajectory T may be an area adding a margin extending in the vehicle width direction of the forklift truck 10 to an area on which the forklift truck 10 is expected to pass.
The main controller 31 may derive the expected trajectory T depending on the steering angle when deriving the expected trajectory T of the forklift truck 10. For example, a threshold capable of determining the turning to the right and a threshold capable of determining the turning to the left are set in the steering angle, and the steering angle is used to determine whether the forklift truck 10 travels straight, turns to the right, or turns to the left. In the travel start limitation control, the main controller 31 determines, by using the steering angle, which areas N, NL, or NR the forklift truck 10 passes. In this case, each of the areas N, NL, and NR can be considered as an expected trajectory.
The main controller 31 may derive the expected trajectory T from the map in which the vehicle speed of the forklift truck 10 and the steering angle are associated with the X-coordinate and the Y-coordinate.
The main controller 31 performs the travel start limitation control and need not perform the automatic deceleration control. In this case, the travel start limitation area AA1 is set within the object detectable range of the object detector 51, but the automatic deceleration area AA2 is not set. The obstacle detector 55 need not determine whether the object is a person or not.
The main controller 31 performs the automatic deceleration control and need not perform the travel start limitation control. In this case, the automatic deceleration area AA2 is set within the object detectable range of the object detector 51, but the travel start limitation area AA1 is not set.
The main controller 31 need not perform different control depending on whether the object is a person or an obstacle. Specifically, in the automatic deceleration control, the main controller 31 stops the traveling of the forklift truck 10 when the object is present within the expected trajectory T. The main controller 31 need not limit the vehicle speed when no object is present within the expected trajectory T. In the automatic deceleration control, the main controller 31 may set the vehicle speed upper limit at a lower value when the object is present within the expected trajectory T as compared with vehicle speed upper limit when the object is present outside the expected trajectory T. In this case, the obstacle detector 55 need not determine whether the object is a person or not.
The travel start limitation control is simply required to shift a state of the main controller 31 to at least two states, the normal control state S10 and the travel start limitation state S2. In this case, when the travel start limitation condition is satisfied, the main controller 31 is shifted to the travel start limitation state S2. When the travel start limitation release condition is satisfied, the main controller 31 is shifted to the normal control state S10. That is, when the object is present within the expected trajectory T, the main controller 31 is simply required to prohibit the forklift truck 10 from starting to travel in the direction approaching the object.
The travel limitation control is simply required to shift the state of the main controller 31 to at least two states, the normal control state S10 and the travel limitation state S12. In this case, when the travel limitation condition is satisfied, the main controller 31 is shifted to the travel limitation state S12. When the travel limitation release condition is satisfied, the main controller 31 is shifted to the normal control state S10. That is, when the person is present within the expected trajectory T, the main controller 31 is simply required to set the vehicle speed upper limit at zero.
The vehicle speed limit control is simply required to shift the state of the main controller 31 to at least two states, the limitation release state S21 and the limitation start state S23. In this case, when the first limitation start condition is satisfied, the main controller 31 is shifted to the limitation start state S23. When the limitation start release condition is satisfied, the main controller 31 is shifted to the limitation release state S21. That is, when the object is present within the vehicle speed limitation area, the main controller 31 is simply required to set the vehicle speed upper limit.
The forced operation pre-release state S5 of the travel start limitation control may be omitted. In this case, when the main controller 31 is in the forced operation state S4 and the condition F1 is satisfied, the main controller 31 is shifted to the normal control state S10.
The main controller 31 is simply required to set at least the vehicle speed upper limit, and need not set the acceleration upper limit and the deceleration upper limit in each of the automatic deceleration control and the travel start limitation control.
The automatic deceleration area AA2 may be an area narrower than the object detectable range of the object detector 51.
The acceleration upper limit and the deceleration upper limit may be set in each state in which the acceleration upper limit and the deceleration upper limit are not set.
In the shift of the states in the travel start limitation control, each condition may be changed as follows.
The travel start limitation condition being satisfied may mean that all of the following conditions A11, A12, and A13 are satisfied.
Condition A11 . . . An object is present within the travel start limitation area AA1 and the expected trajectory T.
Condition A12 . . . The forklift truck 10 stops.
Condition A13 . . . The detection result of the direction sensor 35 does not indicate the forward travel.
Whether or not the condition A11 is satisfied can be determined from the X-coordinate and the Y-coordinate of the object. Since the travel start limitation area AA1 and the expected trajectory T are defined by the X-coordinate and the Y-coordinate, the presence of an object within the travel start limitation area AA1 and the expected trajectory T can be determined from the X-coordinate and the Y-coordinate of the object. The condition A12 is the same condition as the condition A3. The condition A13 indicates the reverse travel or the neutral as the detection result of the direction sensor 35.
The travel start limitation release condition may satisfy at least one of the following conditions B11 and B12.
Condition B11 . . . No object is present within the travel start limitation area AA1 and the expected trajectory T.
Condition B12 . . . The detection result of the direction sensor 35 indicates the forward travel.
It can be said that the condition B11 indicates the failure in satisfying the condition A11. It can be said that the condition B12 indicates the failure in satisfying the condition A13.
When the travel start limitation condition and the travel start limitation release condition are set as described above, it is unnecessary to divide the travel start limitation area AA1 into the areas N, NL, and NR.
The forced operation pre-release condition being satisfied may correspond to the condition B11 being satisfied.
The forced operation actual-release condition being satisfied may correspond to any of the conditions G1 and G2 of the embodiment and the following condition G11 being satisfied.
Condition G11 . . . The detection result of the direction sensor 35 indicates the forward travel.
The condition G11 is added to the forced operation actual-release condition, which shifts the state of the main controller 31 to the normal control state S10 when the operator changes the traveling direction to the forward direction during the forced operation pre-release state S5. The operator can intentionally shift the main controller 31 to the normal control state S10 by changing the traveling direction to the forward direction.
The forced operation actual-release condition being satisfied may correspond to one of the conditions G1, G2, and G11 and the following condition G12 being satisfied.
Condition G12 . . . Both the following conditions G21 and the condition G22 are satisfied.
Condition G21 . . . A state in which the detection result of the direction sensor 35 indicates the reverse direction and the areas N, NL, and NR where the object is present does not match the extending direction of the expected trajectory T has been continued for a specified time.
Condition G22 . . . The forklift truck 10 is traveling.
When the condition G21 is satisfied, it is considered that the operator of the forklift truck 10 operates the steering wheel and changes the turning direction to a direction where no object is present. That is, it is considered that the operator of the forklift truck 10 recognizes the presence of an object by receiving one of the vehicle speed limitation, the acceleration limitation, and the alarm, and performs an avoidance operation for avoiding the object. The specified time in the condition G21 may be set at any value. The specified time is set for a time required for determining that the operator of the forklift truck 10 is performing the avoidance operation. Even when the steering wheel operation changes the turning direction to the direction where no object is present, when the turning direction is returned to the direction where the object is present before the lapse of the specified time, it is determined that the avoidance operation is not performed. The specified time can be arbitrarily set within a range of one second to three seconds, for example.
The condition G22 is the same condition as the condition E3. When the vehicle speed is higher than the stop determination threshold [km/h], the main controller 31 determines that the forklift truck 10 is traveling.
The condition G21 is defined as one of conditions for satisfying the condition G12, which shifts from the forced operation pre-release state S5 to the normal control state S10 when the operator performs the avoidance operation for avoiding the object. When the main controller 31 is in the forced operation pre-release state S5, the operator may recognize an object that blocks the traveling of the forklift truck 10, and perform the avoidance operation for avoiding the object. In this case, the acceleration of the forklift truck 10 is limited by the acceleration limitation, so that the forklift truck 10 cannot travel smoothly, which may reduce operability. When the condition G12 is satisfied, the acceleration limitation can be released by the shift of the main controller 31 to the normal control state S10. This can relax the acceleration limitation of the forklift truck 10 that is traveling during or after the avoidance operation, and prevent reduction of operability.
The condition G22 is defined as one of conditions for satisfying the condition G12, which prevents the main controller 31 from being shifted to the travel start limitation state S2 immediately after the shift of the main controller 31 to the normal control state S10 due to the condition G12 being satisfied. When only the condition G21 is defined as a condition for satisfying the condition G12, the condition G12 can be satisfied even in a stop state of the forklift truck 10. In this case, the state of the main controller 31 may be shifted to the travel start limitation state S2 immediately after the shift of the main controller 31 to the normal control state S10 due to the condition G12 being satisfied. For example, even though the forklift truck 10 stops and changes its turning direction to a direction where no object is present, when the turning direction is returned to the direction where an object is present, the main controller 31 may be shifted to the travel start limitation state S2. In this case, even though the operator is to perform the avoidance operation, this operation may be blocked by the shift to the travel start limitation state S2. The condition G22 is defined as one of conditions for satisfying the condition G12, which satisfies the condition G12 when the forklift truck 10 is traveling. When the main controller 31 is shifted to the normal control state S10 due to the condition G12 being satisfied, there is difficulty in satisfying the travel start limitation condition due to prevention of the condition A3 from being satisfied. This can prevent the avoidance operation from being blocked.
The forced operation actual-release condition being satisfied may correspond to one of the conditions G1, G2, G11, and G21 being satisfied. Even in this case, when the operator is performing the avoidance operation, the forced operation pre-release state S5 is shifted to the normal control state S10 due to the condition G21, which can prevent reduction of operability. Even when the condition G22 is not satisfied, the main controller 31 is shifted to the normal control state S10 due to the condition G21 being satisfied, so that the state of the main controller 31 is shifted to the travel start limitation state S2 immediately after the shift to the normal control state S10. The condition A1 and the condition A2 may be satisfied when the main controller 31 is shifted from the forced operation pre-release state S5 to the normal control state S10 by an approach of the object to the forklift truck 10, for example. At this time, when the forced operation actual-release condition is satisfied by both the condition G21 and the condition G22 being satisfied, the condition A3 being satisfied may be prevented and the travel start limitation with respect to a newly detected object may not work. In contrast, when the condition G21 is satisfied even in the failure in satisfying the condition G22, the main controller 31 is shifted to the normal control state S10, which causes the travel start limitation with respect to the newly detected object to easily work.
The forced operation actual-release condition being satisfied may correspond to one of the conditions G1, G2, G12 and the following condition G13 being satisfied.
Condition G13 . . . Both the condition G22 and the following condition G23 are satisfied.
Condition G23 . . . A state in which the detection result of the direction sensor 35 indicates the forward travel has been continued for a specified time.
The specified time in the condition G23 is the same as that in the condition G21. The forced operation actual-release condition is satisfied when one of the condition G12 and the condition G13 is satisfied, which shifts the state of the main controller 31 to the normal control state S10 with the same operation regardless of the traveling direction of the forklift truck 10 in the forward direction or the reverse direction. Specifically, the main controller 31 is shifted to the normal control state S10 regardless of whether the avoidance operation in the forward direction or the reverse direction has continued for the specified time. The operator is simply required to perform the same operation in order to shift the state of the main controller 31 to the normal control state S10 regardless of whether the forklift truck 10 travels in the forward direction or the reverse direction, which improves operability.
The forced operation actual-release condition being satisfied may correspond to one of the conditions G1, G2, G21, and G23 being satisfied. In this case, when one of the condition G21 and the condition G23 is satisfied even in failure in satisfying the condition G22, the main controller 31 is shifted to the normal control state S10. Accordingly, the travel start limitation with respect to the newly detected object easily works. The operator is simply required to perform the same operation in order to shift the state of the main controller 31 to the normal control state S10 regardless of whether the forklift truck 10 travels in the forward direction or the reverse direction, which improves operability.
The forced operation actual-release condition being satisfied may correspond to one of the conditions G1, G2, and G12 being satisfied, or one of the conditions G1, G2, and G21 being satisfied.
The forced operation actual-release condition being satisfied may correspond to one of the conditions G1, G2, G11, G12, and G13 being satisfied. In this case, the condition G11 is satisfied when the condition G13 is satisfied, and the condition G13 is substantially unfunctional. This case can obtain the same effect as a case where the forced operation actual-release condition being satisfied corresponds to one of the conditions G1, G2, G11, and G12 being satisfied.
The forced operation condition may be the steering wheel operation by the operator. Whether or not the steering wheel has been operated can be determined from the detection result of a steering wheel angle sensor that detects the angle of the steering wheel or the steering angle sensor 36. That is, any forced operation condition is allowable as long as it can be determined that the operator has recognized the presence of an object in the travel start limitation area AA1.
Determination of the stop or the traveling of the forklift truck 10, such as the condition A3 of the travel start limitation condition, may be made by information other than the vehicle speed calculated by the main controller 31. For example, after the object detector 51 determines whether or not the forklift truck 10 stops, the main controller 31 may acquire such determination result of the object detector 51 and determine whether the forklift truck 10 stops or is traveling. When the object detector 51 determines whether or not the forklift truck 10 stops, the determination is made by determining whether or not a change between consecutive frames occurs in an image captured by the stereo camera 52. When the forklift truck 10 is traveling, a change between consecutive frames occurs in pixels on the image captured by the stereo camera 52. Thus, it is determined whether or not a change between consecutive frames occurs in the image, which can determine whether or not the forklift truck 10 stops. It can be determined whether or not the forklift truck 10 stops based on various factors such as a state in which the accelerator 16 is not operated for a predetermined time or more.
In the travel start limitation state S2, the alarm 58 need not issue an alarm to the operator.
In the travel start prohibition state S3, the alarm 58 need not intensify the alarm, and the same alarm as in the travel start limitation state S2 may be issued. In the travel start prohibition state S3, the alarm 58 need not issue an alarm.
In the forced operation state S4, the alarm 58 need not issue a softer alarm as compared with the travel start prohibition state S3, and the same alarm as the travel start prohibition state S3 may be performed. In the forced operation state S4, the alarm 58 need not issue an alarm.
In the travel limitation control, the pre-travel limitation state S11 may be omitted. In this case, the alarm area need not be set.
The alarms in the pre-travel limitation state S11 and the pre-limitation start state S22 may also be issued at a time of switchback of the forklift truck 10.
In the travel limitation state S12, the alarm 58 need not issue the alarm.
The pre-limitation start state S22 may be omitted in at least one of the vehicle speed limitation control for the person and the vehicle speed limitation control for the obstacle. In this case, the pre-alarm area need not be set.
The alarm 58 need not issue an alarm in all the states of the travel start limitation control, the travel limitation control, the vehicle speed limitation control for the person, and the vehicle speed limitation control for the obstacle. In this case, the forklift truck 10 need not have the alarm 58.
The travel start limitation area AA1 may be divided into four or more areas.
The right-left dimension of the central area N may be slightly longer or shorter than the dimension of the forklift truck 10 in the vehicle width direction.
The steering angle of the set of the steering wheels 14 may be calculated using the detection result of the steering wheel angle sensor. The steering wheel angle sensor detects the angle of the steering wheel and outputs the detection result to the main controller 31. Since the steering angle is controlled depending on the detection result of the steering wheel angle sensor, the steering angle can be detected from the detection result of the steering wheel angle sensor.
The object detector 51 may detect the position of an object being present in the forward direction as the traveling direction of the forklift truck 10. In this case, the stereo camera 52 faces the front of the forklift truck 10. When the object detector 51 detects the position of the object being present in the forward direction of the forklift truck 10, the automatic deceleration area AA2 and the travel start limitation area AA1 correspond to areas extending forward from the forklift truck 10. The travel start limitation control, the travel limitation control, the vehicle speed limitation control for a person, and the vehicle speed limit control for an obstacle may function when the forklift truck 10 is traveling forward. Specifically, a speed limit is imposed on the forklift truck 10 depending on the position of the object by reversing the “rear” and the “front” defined in the embodiment in each of the travel start limitation control, the travel limitation control, the vehicle speed limitation control for the person, and the vehicle speed limitation control for the obstacle when the forklift truck 10 is traveling forward. When the object detector 51 detects the position of the object being present in the forward direction as the traveling direction of the forklift truck 10, the main controller 31 derives the expected trajectory T extending in the forward direction.
The object detector 51 may be a detector capable of detecting the position of an object being present in either the reverse direction or the forward direction as the traveling direction of the forklift truck 10. In this case, one object detector 51 may detect the object being present in either the reverse direction or the forward direction as the traveling direction of the forklift truck 10, and an object detector 51 used for the forward direction and an object detector 51 used for the reverse direction may be provided. In the detection of the position of an object being present in either the reverse direction or the forward direction as the traveling direction of the forklift truck 10, when the forklift truck 10 is traveling forward, the vehicle speed is limited by the object being present in the forward direction. When the forklift truck 10 is traveling rearward, the vehicle speed is limited by the object being present in the reverse direction. That is, it can be said that the main controller 31 sets the vehicle speed upper limit when the forklift truck 10 is traveling in a direction approaching the object detected by the object detector 51.
When the vehicle speed is limited regardless of whether the forklift truck 10 is traveling in the forward direction or the reverse direction, the forced operation actual-release condition being satisfied preferably corresponds to one of the conditions G1, G2, G12, and G13 being satisfied. In this case, the condition G23 may be changed as follows.
Condition G23 . . . A state in which the detection result of the direction sensor 35 indicates the forward direction and an area where an object is present does not match an extending direction of an expected trajectory has been continued for a specified time.
It can be said that the main controller 31 determines whether a state in which an expected trajectory extending toward the front of the forklift truck 10 does not match an area where the object is present in front of the forklift truck 10 has been continued for a specified time.
The object detector 51 may use a Time of Flight camera (ToF), a Laser Imaging Detection and Ranging (LIDAR), a millimeter wave radar, or the like, instead of the stereo camera 52. The ToF camera includes a camera and a light source that emits light, and derives the distance in the depth direction for each pixel of the image captured by the camera, based on a time until reception of the reflected light of the light emitted from the light source. The LIDAR is a rangefinder capable of recognizing a surrounding environment by emitting laser while changing an irradiation angle and receiving the light reflected from an object irradiated with the laser. The millimeter wave radar can recognize the surrounding environment by irradiating surroundings with radio waves in a predetermined frequency band. The stereo camera 52, the ToF camera, the LIDAR, and the millimeter wave radar are sensors capable of measuring three-dimensional coordinates in the world coordinate system. The object detector 51 preferably includes a sensor capable of measuring three-dimensional coordinates. When the object detector 51 has the sensor capable of measuring three-dimensional coordinates, the obstacle detector 55 can determine whether an object is a person or an obstacle using the person determiner in which a machine learning is provided in advance. The object detector 51 may include combination of a plurality of sensors such as the stereo camera 52 and the LIDAR.
The object detector 51 may have, instead of the stereo camera 52, a sensor capable of measuring coordinates of the object on an X-Y plane which is a coordinate surface representing a horizontal plane. That is, a sensor capable of measuring two-dimensional coordinates of the object may be used. This type of sensor may be, for example, a two-dimensional LIDAR that emits laser while changing the irradiation angle in the horizontal direction.
The stereo camera 52 may be equipped with three or more cameras.
The obstacle detector 55 may use a comparison image among images captured by the stereo camera 52 to determine whether the object is a person or an obstacle. Since the coordinates of the object are derived from the reference image, a deviation depending on a baseline length occurs in the derivation of the coordinates of the object on the comparison image from the coordinates of the object. Thus, the obstacle detector 55 corrects the coordinates of the object on the comparison image depending on the baseline length, and performs a person detection process on the corrected coordinates.
The alarm 58 may be provided in a device other than the object detector 51.
The alarm 58 may be operated directly by the main controller 31.
The forklift truck 10 may be driven by an engine which is a drive device. In this case, the drive controller 43 is a device that controls a fuel injection amount for the engine and the like.
The forklift truck 10 may be a four-wheel forklift truck 10. In this case, the main controller 31 derives the expected trajectory T from a formula and a map for deriving the expected trajectory T of the four-wheel forklift truck 10. That is, the formula and the map for deriving the expected trajectory T are changed depending on types of the industrial vehicle.
The operation of the forklift truck 10 may be switched between an automatic operation and a manual operation.
The forklift truck 10 may be remotely controlled by an operator who does not ride the forklift truck 10.
The forklift truck 10 may have a configuration in which two driving wheels 12 and 13 are rotated with one driving motor.
The expected trajectory derivation unit and the vehicle speed upper limit setting unit may be provided separately from the main controller 31. In this case, the expected trajectory derivation unit and the vehicle speed upper limit setting unit, and the main controller 31 are connected through the bus 60, and the main controller 31, the expected trajectory derivation unit and the vehicle speed upper limit setting unit are configured to acquire information from each other.
The main controller 31, the drive controller 43, and the object detector 51 may be configured to acquire information from each other with a wireless device.
The industrial vehicle may be any vehicle that is used for works in a limited area, such as a towing vehicle used for transporting cargos or an order picker used for picking work. That is, the industrial vehicle need not be equipped with the cargo handling apparatus 20 for unloading and loading.
Number | Date | Country | Kind |
---|---|---|---|
2019-219036 | Dec 2019 | JP | national |
2020-132987 | Aug 2020 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2020/042232 | 11/12/2020 | WO |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2021/111839 | 6/10/2021 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
8965561 | Jacobus | Feb 2015 | B2 |
9251598 | Wells | Feb 2016 | B2 |
10108200 | Etoh | Oct 2018 | B2 |
10450001 | Stewart | Oct 2019 | B2 |
11142442 | Gault | Oct 2021 | B2 |
20040154871 | Allerding et al. | Aug 2004 | A1 |
20040159499 | Allerding et al. | Aug 2004 | A1 |
20040226776 | Allerding et al. | Nov 2004 | A1 |
20120078471 | Siefring et al. | Mar 2012 | A1 |
20140133944 | Pangrazio et al. | May 2014 | A1 |
20140277691 | Jacobus | Sep 2014 | A1 |
20150294143 | Wells | Oct 2015 | A1 |
20150294483 | Wells | Oct 2015 | A1 |
20150294496 | Medasani | Oct 2015 | A1 |
20160272244 | Imai et al. | Sep 2016 | A1 |
20170315559 | Etoh | Nov 2017 | A1 |
20180057049 | Stewart | Mar 2018 | A1 |
20190197738 | Kishita et al. | Jun 2019 | A1 |
20210237719 | Chen et al. | Aug 2021 | A1 |
20220185171 | Kubotani | Jun 2022 | A1 |
20220411246 | Kubotani | Dec 2022 | A1 |
20230229178 | Kubotani | Jul 2023 | A1 |
Number | Date | Country |
---|---|---|
2020394957 | Jun 2022 | AU |
2021266218 | Jun 2022 | AU |
2021336178 | Mar 2023 | AU |
3159403 | Nov 2020 | CA |
3129132 | Feb 2022 | CA |
3138158 | Jun 2022 | CA |
3209773 | Sep 2022 | CA |
3138158 | Oct 2023 | CA |
104136269 | Nov 2014 | CN |
107650912 | Feb 2018 | CN |
109933063 | Jun 2019 | CN |
110304584 | Oct 2019 | CN |
114620038 | Jun 2022 | CN |
114787073 | Jul 2022 | CN |
116018629 | Apr 2023 | CN |
102019007001 | Apr 2020 | DE |
1447377 | Aug 2004 | EP |
1447377 | Jul 2008 | EP |
2 500 871 | Sep 2012 | EP |
3048021 | Jul 2016 | EP |
4011818 | Jun 2022 | EP |
2603002 | Feb 2017 | ES |
08-256401 | Oct 1996 | JP |
11-043299 | Feb 1999 | JP |
2002-329298 | Nov 2002 | JP |
2015-81022 | Apr 2015 | JP |
2015-170284 | Sep 2015 | JP |
2016-095703 | May 2016 | JP |
2016-139163 | Aug 2016 | JP |
2017-128277 | Jul 2017 | JP |
2018-036937 | Mar 2018 | JP |
2019105995 | Jun 2019 | JP |
2019-143484 | Aug 2019 | JP |
6866839 | Apr 2021 | JP |
2021093124 | Jun 2021 | JP |
2022041629 | Mar 2022 | JP |
2022094177 | Jun 2022 | JP |
2022094178 | Jun 2022 | JP |
7439703 | Feb 2024 | JP |
7459716 | Apr 2024 | JP |
WO-2016076148 | May 2016 | WO |
WO-2019011522 | Jan 2019 | WO |
WO-2021111839 | Jun 2021 | WO |
WO-2022050036 | Mar 2022 | WO |
Entry |
---|
Examination Search Report issued Sep. 11, 2023 in Canadian App. No. 3,159,403. |
Extended European Search Report dated Feb. 7, 2023, issued in European Application No. 20896652.3. |
Communication dated Jul. 14, 2022, issued in Indian Application No. 202247030872. |
Communication dated Jul. 31, 2024 issued by the Indian Patent Office in application No. 202247030872. |
Number | Date | Country | |
---|---|---|---|
20220411246 A1 | Dec 2022 | US |