A method and system for assisting the driving of a three-way forklift
By using a magnetic navigation-assisted driving method and system for three-way forklifts, deviation analysis is performed using walking and lifting encoders to achieve automatic walking and lifting. This solves the problems of high operation difficulty and training costs of three-way forklifts, reduces the operator's burden, and ensures safety.
Patent Information
- Application Number
- CN202611594333.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-10-15
- Publication Date
- 2026-11-10
Smart Images

Figure CN123067486A_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of warehousing and logistics technology, and in particular to an auxiliary driving method and system for a three-way forklift. Background Technology
[0002] Three-way forklifts (also known as three-way stacker trucks) are special forklifts capable of high-level rack storage and retrieval operations in narrow aisles (typically 1.5m to 2.0m wide). Unlike traditional forklifts, three-way forklifts have forks with lateral rotation and lateral extension functions, allowing them to perform storage and retrieval operations on both sides of the rack without rotating the vehicle body. Therefore, they are particularly suitable for high-density warehouse scenarios in narrow aisles.
[0003] However, operating a three-way forklift is far more difficult than operating a regular forklift. It requires extremely high precision in turning and positioning within narrow aisles, where the distance between shelves on both sides of the aisle is typically only 10cm to 20cm, requiring extensive training for operators to master. Furthermore, when accessing high-level racks, the forks must be precisely aligned with the pallet slots in the target location, with longitudinal deviation controlled within a narrow range of ±2cm, demanding exceptional spatial awareness from the operator. Simultaneously, lifting height and travel positioning must be coordinated, requiring the operator to simultaneously control multiple actions such as walking, turning, lifting, and lateral movement, leading to high workload, fatigue, and safety risks. Additionally, the training period for three-way forklifts is long; a qualified driver typically requires 2-3 months of practical training, and retraining after staff turnover is costly. Summary of the Invention
[0004] This invention provides an auxiliary driving method and system for a three-way forklift to solve the technical problems of existing three-way forklifts, such as high operating difficulty, high training cost, small operating margin between shelves on both sides of the aisle, long training time required for operators to master the skills, need to control longitudinal deviation within a small precision range when storing and retrieving high-level shelves, extremely high requirements for the operator's spatial perception ability, need to synchronize and coordinate lifting height and walking positioning, high workload and easy fatigue of operators, and thus safety risks.
[0005] To achieve the above and other related objectives, this invention provides an assisted driving method for a three-way forklift, applied to a three-way forklift controller, comprising: acquiring a task instruction; parsing the task instruction to obtain a task aisle number, a task storage location number, a task storage location height, and a task type; when a first magnetic landmark signal corresponding to the task aisle number is detected, entering a magnetic navigation assisted driving mode, wherein the first magnetic landmark signal is obtained from the origin magnetic landmark of the magnetic strip path corresponding to the task aisle number; in the magnetic navigation assisted driving mode, performing storage location positioning and multiple... Multi-dimensional storage location deviation analysis generates a forklift enable signal corresponding to the task type. This analysis includes zeroing and re-accumulating the pulses corresponding to the travel distance of the travel encoder configured on the target three-way forklift's travel drive based on the first and second magnetic landmark signals, and analyzing the longitudinal storage location deviation between this pulse and the baseline distance corresponding to the task storage location number. It also includes analyzing the vertical storage location deviation between the lifting height of the lifting encoder configured on the target three-way forklift's lifting drive and the height of the task storage location. Based on the forklift enable signal, the forklift permission corresponding to the task type is unlocked, and a forklift-ready signal is output to perform the corresponding forklift action, thus completing the assisted driving corresponding to the task instruction.
[0006] In one embodiment of the present invention, obtaining a task instruction includes: obtaining a task issued by a corresponding issuing system, the issuing system including a warehouse management system or a three-way forklift host; verifying the issued task; when the task verification passes, using the issued task as a task instruction to obtain the task instruction; and when the task verification fails, issuing an invalid task alarm.
[0007] In one embodiment of the present invention, task verification of the issued task includes: determining whether the issued task simultaneously meets the following conditions: the frame header and frame tail identifiers of the received data frame of the issued task conform to the preset format of the protocol, and the length of the received data of the issued task is consistent with the length specified in the protocol; the check value of the received data frame after CRC (cyclic redundancy check) is consistent with the check field carried by the data frame; the task location number of the issued task is within the service range of the target three-way forklift, the task type of the issued task matches the status of the target three-way forklift, and the task lane number of the issued task meets the current lane operation requirements; the current target three-way forklift is in an idle state, the emergency stop signal and safety relay of the current target three-way forklift are normal, and all key modules of the current target three-way forklift are online and normal, including the navigation system, encoder and hydraulic station; if so, the task verification passes; if not, the task verification fails.
[0008] In one embodiment of the present invention, storage location positioning and multi-dimensional storage location deviation analysis are performed based on the magnetic strip path, the first magnetic landmark signal, the second magnetic landmark signal corresponding to each side magnetic landmark on the magnetic strip path, the task storage location number, and the task storage location height to generate a forklift enable signal corresponding to the task type. This includes: controlling the historical pulse accumulation value of the travel encoder to be cleared to zero based on the first magnetic landmark signal; after the historical pulse accumulation value is cleared to zero, performing magnetic navigation assisted driving on the magnetic strip path based on the real-time pulse accumulation value of the travel encoder, the second magnetic landmark signal, the task storage location number, and the reference distance corresponding to the task storage location number to obtain the longitudinal storage location deviation; when the longitudinal storage location deviation is less than a first preset threshold, performing parking control; after parking is completed, controlling the forks to perform a lifting action based on the task storage location height to obtain the lifting height corresponding to the lifting encoder; obtaining the vertical storage location deviation based on the lifting height and the task storage location height; when the vertical storage location deviation is less than a second preset threshold, stopping the fork lifting action and generating a forklift enable signal corresponding to the task type.
[0009] In one embodiment of the present invention, magnetic navigation-assisted driving of the magnetic strip path is performed based on the real-time pulse accumulation value of the walking encoder, the second magnetic landmark signal, the task storage location number, and the reference distance corresponding to the task storage location number, to obtain the longitudinal storage location deviation. This includes: detecting each second magnetic landmark signal passed in sequence; when a second magnetic landmark signal is detected, clearing the real-time pulse accumulation value to obtain the absolute position distance corresponding to the second magnetic landmark signal; obtaining the current travel distance based on the absolute position distance corresponding to each second magnetic landmark signal and the last real-time pulse accumulation value obtained after clearing the pulse accumulation value based on the last second magnetic landmark signal; and determining whether the target three-way forklift has traveled to the preset deceleration zone corresponding to the task storage location number based on the current travel distance. If yes, the target three-way forklift is controlled to enter a low-speed crawling mode, and the difference between the current travel distance in the low-speed crawling mode and the reference distance is calculated to obtain the longitudinal storage location deviation. If no, the forklift continues to travel at the rated operating speed.
[0010] In one embodiment of the present invention, the current travel distance is obtained based on the absolute position distance corresponding to each second magnetic landmark signal and the last real-time pulse accumulation value obtained after clearing the pulse accumulation value based on the last second magnetic landmark signal. This includes: obtaining a cumulative corrected distance based on the absolute position distance corresponding to each second magnetic landmark signal; obtaining the last travel distance based on the last real-time pulse accumulation value, the wheel diameter of the three-way forklift corresponding to the travel encoder, and the number of pulses per revolution; and obtaining the current travel distance based on the cumulative corrected distance and the last travel distance.
[0011] In one embodiment of the present invention, the formula for calculating the current travel distance is: ;in, Indicates the current distance traveled. Indicates the first The absolute position distance corresponding to the second magnetic landmark signal This represents the cumulative value of the last real-time pulse. Indicates the number of pulses per revolution. Indicates the wheel diameter of a three-way forklift. It represents pi (π).
[0012] In one embodiment of the present invention, determining whether the target three-way forklift has traveled to the preset deceleration zone corresponding to the task storage location number based on the current travel distance includes: calculating the difference between the current travel distance and the reference distance to obtain the storage location distance difference; determining whether the storage location distance difference is less than the maximum deceleration distance value corresponding to the preset deceleration zone; if so, the target three-way forklift has traveled to the preset deceleration zone corresponding to the task storage location number; if not, the target three-way forklift has not traveled to the preset deceleration zone corresponding to the task storage location number.
[0013] In one embodiment of the present invention, the method further includes: after completing the assisted driving corresponding to the task instruction, determining whether there is a task in the same lane corresponding to the task lane number; if so, continuing the assisted driving of the task in the same lane; if not, controlling the target three-way forklift to leave the lane, and performing magnetic landmark stop detection when leaving the lane; when the magnetic strip signal after the detection of the target magnetic landmark signal is interrupted, exiting the magnetic navigation assisted driving mode and prompting to switch to manual driving mode.
[0014] To achieve the above and other related objectives, the present invention also provides an assisted driving system for a three-way forklift, applied to a three-way forklift controller, comprising: an instruction acquisition unit for acquiring task instructions; an instruction parsing unit for parsing the task instructions to obtain the task aisle number, task storage location number, task storage location height, and task type; a mode switching unit for entering a magnetic navigation assisted driving mode when a first magnetic landmark signal corresponding to the task aisle number is detected, the first magnetic landmark signal being obtained from the origin magnetic landmark of the magnetic strip path corresponding to the task aisle number; and a deviation analysis unit for, in the magnetic navigation assisted driving mode, analyzing the deviation based on the magnetic strip path, the first magnetic landmark signal, the second magnetic landmark signals corresponding to each adjacent magnetic landmark on the magnetic strip path, the task storage location number, and the task type. The system performs warehouse location positioning and multi-dimensional warehouse location deviation analysis at the warehouse location height, generating a forklift enable signal corresponding to the task type. The multi-dimensional warehouse location deviation analysis includes zeroing and re-accumulating the pulses corresponding to the travel distance of the travel encoder configured on the target three-way forklift's travel drive based on the first and second magnetic landmark signals, and analyzing the longitudinal warehouse location deviation between this pulse and the reference distance corresponding to the task warehouse location number; and analyzing the vertical warehouse location deviation between the lifting height of the lifting encoder configured on the target three-way forklift's lifting drive and the task warehouse location height. It also includes a permission configuration unit, used to unlock the forklift permission corresponding to the task type based on the forklift enable signal, output a forklift-ready signal to perform the corresponding forklift action, and complete the assisted driving corresponding to the task instruction.
[0015] The beneficial effects of this invention are as follows: The assisted driving method and system for a three-way forklift proposed in this invention establishes communication with a warehouse management system or a three-way forklift host system, enabling the automatic distribution of task information to the three-way forklift controller. The three-way forklift controller then automatically receives the task and parses the corresponding aisle and storage location information. When the target three-way forklift enters the aisle entrance corresponding to the aisle number, it automatically switches to magnetic navigation assisted driving mode based on magnetic landmark signals. Simultaneously, in magnetic navigation assisted driving mode, longitudinal storage location deviation analysis is performed using the pulse accumulation value of the walking encoder combined with the magnetic landmark within the aisle, and vertical storage location deviation analysis is performed using the lifting encoder. After accurately determining the storage location, a forklift enable signal is generated to unlock the forklift permission for manual forklifting. After the forklift is completed and there are no other tasks in the same aisle, the forklift automatically exits the aisle and switches back to manual driving mode. The above method enables automatic walking and lifting within the aisle. The operator only needs to complete the final forklift action, which greatly reduces the difficulty of operation and thus reduces the driving difficulty and training cost of three-way forklift operators. At the same time, the safety interlock mechanism based on longitudinal and vertical storage position deviations ensures that manual forklifting is only allowed after precise positioning, preventing collision accidents and avoiding the high modification costs and safety risks of high-position forklifting required for full automation. Attached Figure Description
[0016] The accompanying drawings, which are incorporated in and form part of this specification, illustrate embodiments consistent with this application and, together with the description, serve to explain the principles of this application. It is obvious that the drawings described below are merely some embodiments of this application, and those skilled in the art can obtain other drawings based on these drawings without any inventive effort.
[0017] In the attached diagram: Figure 1 This is a flowchart illustrating the assisted driving method for a three-way forklift provided in an embodiment of the present invention.
[0018] Figure 2 The diagram shown is an architecture diagram of a forklift assisted driving system provided in an embodiment of the present invention.
[0019] Figure 3 The diagram shown is a schematic diagram of the data flow processing of each functional module in a three-way forklift controller provided in an embodiment of the present invention.
[0020] Figure 4 The diagram shown is a timing diagram of the communication protocol interaction of a WMS (Warehouse Management System) provided in an embodiment of the present invention.
[0021] Figure 5 The diagram shows the signal flow of each hardware module provided in an embodiment of the present invention.
[0022] Figure 6 The diagram shows a tunnel layout and the laying of magnetic strips and magnetic markers according to an embodiment of the present invention.
[0023] Figure 7 The diagram shown is a schematic diagram of the dual encoder closed-loop positioning principle provided in an embodiment of the present invention.
[0024] Figure 8 The diagram shown is a schematic diagram of the safety interlock logic for encoder deviation and fork enable provided in an embodiment of the present invention.
[0025] Figure 9 The diagram shown is a schematic diagram of an assisted driving control process provided in an embodiment of the present invention.
[0026] Figure 10 The diagram shown is a structural block diagram of an auxiliary driving system for a three-way forklift provided in an embodiment of the present invention.
[0027] Figure 11 The diagram shown is a structural schematic of an electronic device according to an embodiment of the present invention.
[0028] The attached figures are labeled as follows: Electronic device 1; assisted driving system 11 for a three-way forklift; memory 12; processor 13; instruction acquisition unit 111; instruction parsing unit 112; mode switching unit 113; deviation analysis unit 114; permission configuration unit 115. Detailed Implementation
[0029] The following specific examples illustrate the implementation of the present invention. Those skilled in the art can easily understand other advantages and effects of the present invention from the content disclosed in this specification. The present invention can also be implemented or applied through other different specific embodiments. Various details in this specification can also be modified or changed based on different viewpoints and applications without departing from the spirit of the present invention. In the absence of conflict, the following embodiments and features in the embodiments can be combined with each other.
[0030] It should be noted that the illustrations provided in the following embodiments are only schematic representations of the basic concept of the present invention. The drawings only show the components related to the present invention and are not drawn according to the actual number, shape and size of the components in the actual implementation. In the actual implementation, the form, quantity and proportion of each component can be arbitrarily changed, and the layout of the components may also be more complex.
[0031] In the following description, numerous details are explored to provide a more thorough explanation of embodiments of the invention. However, it will be apparent to those skilled in the art that embodiments of the invention may be practiced without these specific details. In other embodiments, well-known structures and devices are shown in block diagram form rather than in detail to avoid obscuring embodiments of the invention.
[0032] This invention provides an assisted driving method for a three-way forklift. By establishing communication with a warehouse management system or a three-way forklift host system, task information can be automatically sent to the three-way forklift controller. The three-way forklift controller automatically receives the task and parses the corresponding aisle and storage location information. When the target three-way forklift enters the aisle entrance corresponding to the aisle number, it automatically switches to magnetic navigation assisted driving mode based on magnetic landmark signals. In magnetic navigation assisted driving mode, longitudinal storage location deviation analysis is performed by combining the pulse accumulation value of the travel encoder with the magnetic landmark in the aisle, and vertical storage location deviation analysis is performed by the lifting encoder. After accurately determining the storage location, a forklift enable signal is generated to unlock the forklift permission for manual forklifting. After the forklift is completed and there are no other tasks in the same aisle, it automatically exits the aisle and switches back to manual driving mode. The above method enables automatic walking and lifting within the aisle. The operator only needs to complete the final forklift action, which greatly reduces the difficulty of operation and thus reduces the driving difficulty and training cost of three-way forklift operators. At the same time, the safety interlock mechanism based on longitudinal and vertical storage position deviations ensures that manual forklifting is only allowed after precise positioning, preventing collision accidents and avoiding the high modification costs and safety risks of high-position forklifting required for full automation.
[0033] Figure 1 A flowchart of an assisted driving method for a three-way forklift according to an exemplary embodiment of this application is shown. The assisted driving system is applied to a three-way forklift and includes a three-way forklift controller, a magnetic navigation sensor, a travel encoder, a lifting encoder, a wireless communication module, and a human-machine interface. Magnetic navigation sensors can be installed on the front and rear bottom of the three-way forklift body to monitor the magnetic strip and magnetic landmark signals laid on the ground and send them to the three-way forklift controller. The travel encoder can be installed on the travel drive of the three-way forklift, such as on the travel drive motor, drive wheel axle, or load-bearing wheel, to collect the wheel rotation pulse count in real time and send it to the three-way forklift controller. The lifting encoder can be installed on the lifting drive of the three-way forklift, such as on the forklift lifting drive motor or drive mechanism, and send it to the three-way forklift controller. The wireless communication module is electrically connected to the three-way forklift controller to enable data interaction between the three-way forklift controller and the WMS (Wireless Management System). The human-machine interface is electrically connected to the three-way forklift controller to display the current working mode, task information, and system status to the operator, and can send relevant control information to the three-way forklift controller. Figure 2In the example of the forklift assisted driving system provided, a communication connection can be established with the WMS (Warehouse Management System) through the onboard wireless communication WiFi gateway at the scheduling layer, enabling the issuance of tasks such as warehousing and handling through the WMS. At the safety layer, interaction with the PLC (Programmable Logic Controller) can be achieved through the HMI (Human-Machine Interface) on the touchscreen. Simultaneously, an emergency button connected to the PLC via a hardware safety loop can be used for emergency stop control. For the PLC at the control core layer, data exchange with the WMS can occur through the WiFi gateway. Furthermore, it can connect to various vehicle sensors at the perception layer via a CAN (Controller Area Network) gateway using the CANopen protocol (a high-level industrial communication protocol based on Controller Area Networks) via the CAN bus. These vehicle sensors may include a front magnetic navigation sensor, a rear magnetic navigation sensor, a lifting encoder, and a travel encoder, enabling navigation, travel, lifting, and task interaction via the PLC. During magnetic navigation, magnetic navigation sensors can collect path deviations based on ground magnetic strips to provide path correction for the PLC. The travel encoder can collect drive wheel pulses to calculate travel distance, speed, and position. The lifting encoder can collect fork lifting height to achieve precise arrival at the target storage location. The origin position can be confirmed by setting a magnetic landmark at the aisle entrance (hereinafter referred to as the origin magnetic landmark), and the position of the magnetic landmark within the aisle (hereinafter referred to as the side magnetic landmark) can be compared and corrected. The touchscreen can realize local task assignment and monitoring, monitoring automatic / manual modes, and alarm viewing through a local human-machine interface. In addition, the assisted driving system also includes a three-way forklift body, which includes travel, steering, and lifting actuators, all of which can communicate and interact with the PLC. The assisted driving method of the three-way forklift of this invention includes steps S10-S50. The following will be combined with... Figure 1 The technical solution of this application will be described in detail below.
[0034] First, execute step S10 to obtain the task instructions.
[0035] The three-way forklift controller can accept corresponding task instructions based on the task requirements of each issuing system, and then perform assisted driving control of the three-way forklift based on the task instructions. The three-way forklift controller can be a logic controller, or it can be other controllers used to receive signals from various sensors and perform data logic processing.
[0036] In step S10, obtaining the task instruction may further include: Obtain the task from the corresponding distribution system, which may include a warehouse management system or a three-way forklift host. Perform task verification on the issued tasks; When the task verification passes, the task will be issued as a task instruction to obtain the task instruction; An invalid task alert will be issued when the task verification fails.
[0037] When the three-way forklift controller receives a task instruction, the issuing system can be a WMS (Warehouse Management System) or the three-way forklift host. For example, in offline mode, the task can be selected and issued via the touchscreen of the three-way forklift host. Other issuing systems are also possible. This invention, through direct interface with the WMS, enables automatic task information issuance, eliminating manual transmission. After the three-way forklift controller receives the task from the corresponding issuing system, it performs task verification. If the verification passes, the issued task is treated as a corresponding task instruction for further instruction parsing to determine information such as the task aisle number, task storage location number, task storage location height, and task type. This information is then used to detect the corresponding origin magnetic landmark and trigger entry into the magnetic navigation assisted driving mode. If the task verification fails, the three-way forklift controller does not execute the issued task and outputs an invalid task alarm message.
[0038] Specifically, task verification of issued tasks may further include: Determine whether the task being issued simultaneously meets the following conditions: The header and trailer identifiers of the received data frames of the task being sent conform to the preset format of the protocol, and the length of the received data of the task being sent is consistent with the length specified in the protocol. The CRC checksum of the received data frame is consistent with the checksum field carried in the data frame; The task location number of the issued task is within the service range of the target three-way forklift, the task type of the issued task matches the status of the target three-way forklift, and the task lane number of the issued task meets the current lane operation requirements. The target three-way forklift is currently idle. The emergency stop signal and safety relay of the target three-way forklift are normal. All key modules of the target three-way forklift are online and normal. Key modules include the navigation system, encoder and hydraulic station. If so, the task verification is successful; If not, the task verification fails.
[0039] When the three-way forklift controller verifies the issued task, it can include verification of communication frame format, data integrity, task parameter validity, and execution condition status. If all verifications pass, the task verification is considered successful; otherwise, the task verification fails.
[0040] Specifically, during communication frame format verification, the three-way forklift controller can determine whether the header and trailer identifiers of the received data frames of the issued task conform to the preset protocol format, and simultaneously determine whether the length of the received data of the issued task is consistent with the length specified in the protocol. If both match, other verification methods are then performed. If the header and trailer identifiers of the received data frames do not conform to the preset protocol format and / or the length of the received data of the issued task is inconsistent with the length specified in the protocol, the task verification fails.
[0041] When performing data integrity verification, the three-way forklift controller can first perform CRC checksum calculation on the received data frame of the task and compare the calculated checksum with the check field carried in the data frame. If they are inconsistent, it indicates that the data transmission is incorrect and the task verification fails. Otherwise, the task verification passes and other verification methods are performed.
[0042] When performing task parameter validity verification, the three-way forklift controller first parses the task location number, task type, and task aisle number in the task frame of the issued task. It then determines whether the task location number is within the service range of the current target three-way forklift, whether the task type matches the current status of the target three-way forklift, and whether the task aisle number matches the current aisle or whether cross-aisle operation is allowed. If all conditions are met, the task verification passes, and other verification methods are then performed. Conversely, if any conditions are not met, the parameters are invalid, the task is deemed invalid, and the task verification fails.
[0043] When performing execution condition status verification, the three-way forklift controller checks whether the current target three-way forklift is in an idle (unfinished task) state, whether the emergency stop signal and safety relays are normal (e.g., whether there is no alarm trigger), and whether key modules such as the navigation system, encoder, and hydraulic station are online and functioning normally. If any execution conditions are not met, the task verification will fail, and the cause of the fault will be explained. Otherwise, the task verification will pass, and other verification methods will be performed.
[0044] like Figure 3The given example of data flow processing for each functional module within a three-way forklift controller includes a communication parameter acquisition area, a motion control area, and a functional logic area. The communication parameter acquisition area has the highest priority and is used for communication and parameter acquisition, including PROFINET (an automation bus standard based on industrial Ethernet technology) PN (short for PROFINET) communication parameters, CAN master / slave magnetic navigation parameters, gyroscope / encoder angle parameters, steering motor parameters fed back from the driver, travel motor parameters fed back from the driver, and lifting encoder parameters acquired via CAN / IO (input / output). It can also include additional RFID (Radio Frequency Identification) parameters for use with RFID cards in storage locations. When communication anomalies or parameter over-limit alarms occur in the communication parameter acquisition area, they can be handled through global alarm aggregation. The motion control area has a medium priority and can implement motion control including debugging steering (one-way) in debugging mode, debugging travel (one-way) in debugging mode, error calculation using magnetic navigation algorithms, attitude calculation using angle algorithms, manual control in manual driving mode, automatic control in automatic operation mode, and speed / position closed-loop control using PID (Proportional-Integral-Derivative) control algorithms. When motion control alarms such as overcurrent, overload, out-of-tolerance, or fault alarms occur, they can be handled through global alarm aggregation. The functional logic area includes function block programs, local function presets, WMS system communication, WMS system coding, WMS system functions, and task flow management. It can perform global alarm aggregation and processing when object alarm information, including WMS alarms and task failures, occurs.
[0045] During data interaction between the three-way forklift controller and the WMS remote station, the configured WMS docking function block can be used to receive task data streams from the WMS remote station and, through the same block, feed back relevant status information of the three-way forklift controller to the WMS remote station. Specifically, such as... Figure 4In the given example, both the WMS remote station and the WMS docking function block of the three-way forklift controller mutually check signal stability. If both are stable, when the WMS remote station receives a task that can be sent and the AGV (Automated Guided Vehicle) is idle, it sends the corresponding task information to the WMS docking function block. After receiving the WMS task information, the WMS docking function block verifies it through the three-way forklift controller. If the verification fails, it sends an AGV verification failure feedback message to the WMS remote station stating "Task information decoding verification failed, please resend." If the verification succeeds, it also sends a corresponding AGV verification success feedback message and confirms successful AGV task decoding and reception to execute the assisted driving task. Simultaneously, the WMS docking function block sends feedback to the WMS remote station that the AGV is executing a task. When the AGV's three-way forklift controller completes the task, it also sends a successful task feedback message to the WMS remote station. After receiving the success feedback, the WMS remote station initializes the AGV's three-way forklift controller. When the three-way forklift controller sends a task cancellation request to the WMS remote station through the WMS docking function program block, the WMS remote station, upon receiving the AGV's forced task cancellation, confirms whether to clear the issued task information. When the WMS remote station receives the task clearing information, it sends it to the WMS docking function program block to clear the WMS task. Then, the WMS remote station continues to monitor the received task information fed back by the AGV, while the WMS docking function program block continuously feeds back to the WMS remote station after receiving the AGV task information.
[0046] Next, step S20 is executed to parse the task instruction and obtain the task lane number, task storage location number, task storage location height, and task type.
[0047] After receiving a task instruction, the three-way forklift controller can parse it to obtain information such as the task aisle number, storage location number, storage location height, and task type. Based on these parameters, it can control the forklift's positioning at the storage location. It also determines whether to generate a forklift enable signal to unlock forklift access based on the storage location deviation, and outputs a forklift-ready signal to perform the corresponding forklift action. This effectively prevents collisions and ensures the safety of three-way forklift operation. It's worth noting that storage location types can include first-in-first-out (FIFO), FIFO-last-out (FIFO), inbound, and outbound tasks. FIFO-last-out and FIFO-last-out tasks are composite tasks, while inbound and outbound tasks are single tasks.
[0048] Next, step S30 is executed. When the first magnetic landmark signal corresponding to the task lane number is detected, the magnetic navigation assisted driving mode is entered. The first magnetic landmark signal is obtained from the origin magnetic landmark of the magnetic strip path corresponding to the task lane number.
[0049] After the three-way forklift controller parses the task command, the operator can freely control the target three-way forklift to move to the vicinity of the aisle corresponding to the task aisle number. Magnetic navigation sensors installed at the front and rear bottom of the forklift body detect the first magnetic landmark signal corresponding to the task aisle number. When the first magnetic landmark signal is detected, it is sent to the three-way forklift controller, or the controller actively acquires it. The controller then automatically enters the magnetic navigation assisted driving mode based on this signal, performing magnetic navigation assisted driving according to the magnetic strip path corresponding to the task aisle number. The first magnetic landmark signal along the magnetic strip path corresponding to the task aisle number can be obtained by the magnetic navigation sensor from the origin magnetic landmark of the path and then sent to the three-way forklift controller, or actively acquired by the controller, enabling the three-way forklift controller to monitor this first magnetic landmark signal. Figure 5 In the example of the assisted driving system provided, during manual driving by the manual driving unit, operation commands can be input to the driving unit via the panel unit to achieve manual driving control. When the assisted driving controller receives the task command via the WiFi gateway, it enters the magnetic navigation assisted driving mode after detecting the first magnetic landmark signal corresponding to the task lane number through the forward and reverse navigation sensors. After entering the magnetic navigation assisted driving mode, the forward and reverse navigation sensors communicate with the PLC via the CAN gateway. The PLC then sends control signals to the driving unit via the CAN bus to drive the travel motor and steering motor. The steering encoder records the steering status of the three-way forklift, and the travel encoder performs real-time pulse accumulation and collection, feeding back to the PLC. Once the PLC confirms that the current storage location number corresponds to the task storage location number, it will continue to control the forks by driving the hydraulic mechanism, fork mechanism, and traverse mechanism through the driving unit, based on the task storage location height. The lifting encoder monitors the lifting height of the forks, and once the lifting height matches the task storage location height, the fork-picking permission is unlocked. Fork-picking operation commands can be input via the panel unit to perform the fork-picking action. Additionally, the driver assistance system is equipped with a common power system, which can connect to both the manual driving unit and the driver assistance controller via the main vehicle's lithium battery pack to power both. An external charging interface is also provided.
[0050] In addition, an origin magnetic marker is set at the starting position of the magnetic strip path. Before reaching the task storage location number, several side magnetic markers can also be included to calibrate the real-time pulse accumulation value of the walking encoder through the second magnetic marker signal corresponding to the side magnetic marker, thereby improving the accuracy of the calculated travel distance. Figure 6 In the example of the provided tunnel magnetic strip and geomagnetic strip laying, an origin magnetic marker is set at the origin position of the longitudinal magnetic strip, and a side magnetic marker can be set at every 10m interval. Multiple storage location numbers are present between the origin magnetic marker and the side magnetic marker, or between two adjacent side magnetic markers. For example, in the diagram, the storage location numbers for the upper-level three-dimensional storage location (Area A) on one side between the origin magnetic marker and the side magnetic marker include A01, A05, A10, A15, A20, A25, A30, A32, etc., while the storage location numbers for the lower-level three-dimensional storage location (Area B) on the other side include B01, B05, B10, B15, B20, B25, B30, B32, etc. After detecting the first magnetic landmark signal at the origin magnetic landmark at the aisle entrance, the AGV three-way forklift switches from manual to automatic driving mode. It uses the origin magnetic landmark for initial positioning at the entrance and runs along the longitudinal magnetic strips. The magnetic navigation sensor corrects deviations in real time. When it detects the second magnetic landmark signal corresponding to the adjacent magnetic landmark, it can trigger positioning again. During the laying of the magnetic strips and magnetic landmarks, the longitudinal magnetic strips can be 30mm wide and laid along the entire length of the aisle. Each magnetic landmark can be laid crosswise on the longitudinal magnetic strip with dimensions of 30mm wide × 150mm long. If the AGV three-way forklift is 1400mm wide, it can maintain a 100mm gap from the two sides of the automated storage and retrieval system, thus ensuring an aisle width of 1600mm.
[0051] Next, step S40 is executed. In the magnetic navigation assisted driving mode, the storage location and multi-dimensional storage location deviation analysis are performed based on the magnetic strip path, the first magnetic landmark signal, the second magnetic landmark signal corresponding to each side magnetic landmark on the magnetic strip path, the task storage location number, and the task storage location height. A forklift enable signal corresponding to the task type is generated. The multi-dimensional storage location deviation analysis includes zeroing and re-accumulating the pulses corresponding to the travel distance of the travel encoder configured on the target three-way forklift travel drive based on the first magnetic landmark signal and the second magnetic landmark signal, and analyzing the longitudinal storage location deviation between the pulses and the reference distance corresponding to the task storage location number, and analyzing the vertical storage location deviation between the lifting height of the lifting encoder configured on the target three-way forklift lifting drive and the task storage location height.
[0052] The forklift enable signal is designed to be disconnected by default, and will automatically return to the locked state when the three-way forklift controller loses power, communication is interrupted, or the program malfunctions. In addition, when the three-way forklift controller enters the magnetic navigation assisted driving mode, it will automatically control the three-way forklift to locate the storage location based on the magnetic strip path, the first magnetic landmark signal, the second magnetic landmark signals corresponding to the magnetic landmarks on each side of the magnetic strip path, the task storage location number, and the task storage location height. During storage location, a multi-dimensional storage location deviation analysis is performed on the longitudinal storage location deviation and the vertical storage location deviation. Only when the storage location deviation meets the accuracy requirements will the forklift enable signal corresponding to the task type be generated.
[0053] In step S40, storage location and multi-dimensional storage location deviation analysis are performed based on the magnetic strip path, the first magnetic landmark signal, the second magnetic landmark signal corresponding to each side magnetic landmark on the magnetic strip path, the task storage location number, and the task storage location height, generating a fork-out enable signal corresponding to the task type, which may further include: The historical pulse accumulation value of the walking encoder is cleared to zero according to the first magnetic landmark signal control. After the historical pulse accumulation value is cleared to zero, magnetic navigation assisted driving of the magnetic strip path is performed based on the real-time pulse accumulation value of the walking encoder, the second magnetic landmark signal, the task storage location number, and the reference distance corresponding to the task storage location number. The longitudinal storage location deviation is obtained. The walking encoder is configured on the walking drive of the target three-way forklift. The reference distance can be the measured distance from the origin magnetic landmark to each storage location number pre-marked based on the aisle storage location layout map. The reference distance is stored in the three-way forklift controller for direct acquisition based on the task storage location number. When the longitudinal storage location deviation is less than the first preset threshold, parking control is activated; After parking is completed, the forks are controlled to lift according to the height of the task storage location, and the lifting height corresponding to the lifting encoder is obtained. The lifting encoder is configured on the lifting drive of the target three-way forklift. The vertical storage location deviation is obtained based on the lifting height and the height of the task storage location; When the vertical storage location deviation is less than the second preset threshold, the fork lifting action is stopped, and a fork pick-up enable signal corresponding to the task type is generated.
[0054] During the storage location positioning and storage deviation analysis process, the three-way forklift controller can, upon entering the magnetic navigation assisted driving mode, first reset the historical pulse accumulation value collected by the travel encoder to zero based on the monitored first magnetic landmark signal. After resetting, it further performs magnetic navigation assisted driving and longitudinal storage deviation monitoring based on the real-time pulse accumulation value of the travel encoder, the second magnetic landmark signal, the task storage location number, and the corresponding reference distance, thereby determining the longitudinal storage deviation formed during the magnetic navigation assisted driving process. Then, by comparing the longitudinal storage deviation with a first preset threshold, if the longitudinal storage deviation is less than the first preset threshold, it indicates that the current target three-way forklift has reached the task storage location number. After parking, based on the task storage location height parsed from the task instruction, it can control the lifting forks and simultaneously obtain the lifting height of the forks in real time through the lifting encoder. The lifting height obtained by the lifting encoder is sent to the three-way forklift controller, or the three-way forklift controller actively collects the lifting height obtained by the lifting encoder. After the three-way forklift controller obtains the lifting height, it calculates the difference between the lifting height and the task storage location height to obtain the vertical storage location deviation. Then, the three-way forklift controller compares the vertical storage location deviation with a second preset threshold. When the vertical storage location deviation is greater than the second preset threshold, a PID control quantity is generated based on the vertical storage location deviation to continue driving the lifting motor, which lifts the forks through the lifting mechanism. When the vertical storage location deviation is less than the second preset threshold, it indicates that the forks have reached the task storage location height, and the forklift lifting action can be stopped. At this point, since the target three-way forklift has accurately reached the task storage location number and the forks have accurately reached the task storage location height, meeting the multi-dimensional storage location deviation requirements, a forklift enable signal corresponding to the task type is generated. Based on this forklift enable signal, forklift access can be unlocked to notify the operator to perform the corresponding forklift action. Furthermore, by utilizing the travel encoder and lifting encoder for corresponding deviation monitoring, the three-way forklift controller can trigger emergency braking when the longitudinal or vertical storage location deviation exceeds the emergency braking threshold, or when the travel encoder or lifting encoder experiences a communication malfunction. This simultaneously stops the three-way forklift's travel and lifting, and exits the assisted driving mode to handle emergencies. Through automatic travel based on the task storage location number and automatic lifting based on the task storage location height within the aisle, the operator only needs to complete the final forklift action, significantly reducing operational difficulty. Moreover, through precise closed-loop control using dual encoders based on the travel and lifting encoders, storage location control can be achieved without needing to lay RFID cards at each storage location.
[0055] like Figure 7The given closed-loop control example mainly includes travel position closed-loop control and lifting height closed-loop control. In the travel position closed-loop control process, by inputting the travel target position command, the travel drive controller performs speed and current closed-loop control. The travel motor drives the wheel mechanism to enable the AGV three-way forklift to travel to the target position. The travel encoder, using an incremental encoder, performs pulse counting and relative position calculation, then returns its actual position parameters and compares them with the target value corresponding to the travel target position using an absolute position algorithm. If the station corresponding to the actual position parameters corresponds to the travel target position, a position output is generated; otherwise, the travel drive controller continues to control the AGV three-way forklift to continue traveling to the target position. Similarly, in the closed-loop control of lifting height, the lifting hydraulic station controls the pump flow and regulates the pressure according to the lifting target height command, and the hydraulic solenoid valve or proportional valve controls the flow and direction, thereby driving the hydraulic cylinder mechanism to lift the forks. The lifting encoder, which is an absolute encoder, collects the actual height parameters and returns them. These parameters are compared with the target height corresponding to the lifting target height command. If the actual height parameters correspond to the target height, the height is output. Otherwise, the lifting hydraulic station continues to control the lifting forks.
[0056] like Figure 8 In the example of fork safety position interlock control given, after the AGV three-way forklift arrives at the task storage location, the fork position encoder (also known as the lifting encoder) collects the lifting height and inputs it into the deviation calculation module to calculate the deviation from the target height. This deviation is then compared with the allowable deviation threshold to determine if the deviation is within the allowable range. If it is, the deviation is normal, the safety condition is met, the interlock is released, and the mechanism is enabled, allowing the forklift mechanism to operate. The forklift or rotating mechanism can then perform receiving, rotating, and lifting actions. If the deviation is outside the allowable range, a deviation alarm is triggered, and the mechanism is immediately prohibited from operation. The alarm information is output to the HMI display and reported to the WMS, while an audible and visual alarm is triggered on the AGV three-way forklift. The cause of the fault is manually investigated, and after the deviation returns to normal and is manually reset and confirmed, the forklift mechanism is allowed to operate again, working through the forklift or rotating mechanism. Alarm records are saved for maintenance and analysis. If the deviation never returns to normal, a continuous alarm output is maintained. Furthermore, the allowable deviation threshold can be modified through the human-machine interface.
[0057] The magnetic navigation-assisted driving of the magnetic strip path, based on the real-time pulse accumulation value of the walking encoder, the second magnetic landmark signal, the task storage location number, and the reference distance corresponding to the task storage location number, and obtaining the longitudinal storage location deviation, may further include: The signals of each of the second magnetic landmarks that pass through in sequence are detected; When the second magnetic landmark signal is detected, the real-time pulse accumulation value is cleared to zero, and the absolute position distance corresponding to the second magnetic landmark signal is obtained. The current travel distance is obtained based on the absolute position distance corresponding to each second magnetic landmark signal and the last real-time pulse accumulation value obtained after clearing the pulse accumulation value based on the last second magnetic landmark signal; Based on the current travel distance, determine whether the target three-way forklift has traveled to the preset deceleration zone corresponding to the task storage location number: If so, the target three-way forklift is controlled to enter low-speed crawling mode, and the difference between the current travel distance and the reference distance in low-speed crawling mode is calculated to obtain the longitudinal storage position deviation. If not, continue operating at the rated speed.
[0058] During the calculation of longitudinal storage location deviation, while the travel encoder accumulates the real-time pulse accumulation value, the magnetic navigation sensor collects the second magnetic landmark signals corresponding to each of the adjacent magnetic landmarks along the route. When the second magnetic landmark signal is acquired, it is further sent to the three-way forklift controller. When the three-way forklift controller detects the second magnetic landmark signal, it controls the real-time pulse accumulation value between the current second magnetic landmark signal and the previous second magnetic landmark signal to be cleared to zero, and uses the absolute positional distance between the current second magnetic landmark signal and the previous second magnetic landmark signal to calibrate the real-time pulse accumulation value between the current second magnetic landmark signal and the previous second magnetic landmark signal, which is then used as the corresponding segment travel distance. By continuously accumulating the absolute position distance between multiple second magnetic landmark signals, and after the last second magnetic landmark signal is detected and the real-time pulse accumulation value of the travel encoder is cleared to zero, the pulses are accumulated again by the travel encoder until the real-time pulse accumulation value of the task storage position number is taken as the last real-time pulse accumulation value. Thus, based on the absolute position distance and the last real-time pulse accumulation value after the last second magnetic landmark signal is generated, the current travel distance of the three-way forklift from the origin magnetic landmark to the task storage position number can be calculated. Furthermore, after obtaining the current travel distance, the system further determines whether the target three-way forklift has reached the preset deceleration zone corresponding to the task storage location number. If it has reached the preset deceleration zone, the target three-way forklift needs to be decelerated to continue crawling towards the task storage location number in low-speed crawling mode. During the crawling process, the difference between the current travel distance in low-speed crawling mode and the baseline distance is calculated in real time to obtain the longitudinal storage location deviation. This longitudinal storage location deviation is then compared in real time with a first preset threshold. If the longitudinal storage location deviation is less than or equal to the first preset threshold, the system will promptly stop the forklift, thereby ensuring the accurate correspondence between the longitudinal position of the target three-way forklift and the task storage location number. If the preset deceleration zone has not been reached, it means that the target three-way forklift does not need to be decelerated and can continue to travel towards the task storage location number at its original rated operating speed. It is worth noting that the crawling speed corresponding to the low-speed crawling mode is less than the rated operating speed.
[0059] Specifically, the current travel distance is obtained based on the absolute position distance corresponding to each second magnetic landmark signal and the last real-time pulse accumulation value obtained after clearing the pulse accumulation value based on the last second magnetic landmark signal, including: The cumulative corrected distance is obtained based on the absolute position distance corresponding to each second magnetic landmark signal; The final travel distance is obtained based on the cumulative value of the last real-time pulse, the wheel diameter of the three-way fork corresponding to the travel encoder, and the number of pulses per revolution. The current distance is obtained based on the cumulative corrected distance and the last traveled distance.
[0060] In calculating the current travel distance, the absolute positional distances between adjacent second magnetic landmark signals can be accumulated to obtain the cumulative correction distance. Then, based on the last real-time pulse accumulation value corresponding to the last second magnetic landmark signal, and by combining the three-way forklift wheel diameter and pulses per revolution corresponding to the travel encoder, the last travel distance corresponding to the last real-time pulse accumulation value can be calculated. Thus, the cumulative correction distance can be added to this last travel distance to calculate the current travel distance from the origin magnetic landmark.
[0061] Preferably, the formula for calculating the current travel distance can be expressed as: ; in, Indicates the current distance traveled. Indicates the first The absolute position distance corresponding to the second magnetic landmark signal, this absolute position distance represents the first The second magnetic landmark and the first The measured distance between the two second magnetic landmarks This represents the cumulative value of the last real-time pulse. This indicates the number of pulses per revolution, which is the encoder resolution (unit: pulses / revolution). Indicates the wheel diameter of a three-way forklift. It represents pi (π).
[0062] Additionally, after determining the current driving distance... Then, based on the storage location interval, it is also possible to realize the current storage location sequence number. The calculation can be used to further determine the current storage location number. Does it correspond to the task location number? In other words, can the formula be expressed as...? ,in, It is an integer. Indicates the storage location pitch. Indicates less than the storage location pitch And can make the current travel distance Storage location pitch The minuend that is divisible.
[0063] Based on the current travel distance, determine whether the target three-way forklift has traveled to the preset deceleration zone corresponding to the task storage location number, which may further include: The difference between the current driving distance and the reference distance is calculated to obtain the parking space distance difference; Determine whether the distance difference between the storage locations is less than the maximum deceleration distance value corresponding to the preset deceleration interval; If so, the target three-way forklift will travel to the preset deceleration zone corresponding to the task storage location number; If not, the target three-way forklift has not traveled to the preset deceleration zone corresponding to the task storage location number.
[0064] After calculating the current travel distance, to determine whether the target three-way forklift has reached the preset deceleration zone corresponding to the task storage location number, the difference between the current travel distance and the baseline distance can be calculated to obtain the storage location distance difference at different times before reaching the task storage location number. Then, the storage location distance difference is compared with the maximum deceleration distance value corresponding to the preset deceleration zone. If the storage location distance difference is less than the maximum deceleration distance value, it means that the target three-way forklift has reached the preset deceleration zone corresponding to the task storage location number, and the target three-way forklift needs to be controlled to decelerate and enter low-speed crawling mode. If the storage location distance difference is greater than the maximum deceleration distance value, it means that no deceleration is required, and the forklift can continue to travel towards the task storage location number at its original rated operating speed.
[0065] Next, step S50 is executed, and according to the fork enable signal, the fork permission corresponding to the task type is unlocked, and a fork signal is output to perform the corresponding fork action to complete the assisted driving corresponding to the task instruction.
[0066] After generating a forklift enable signal, the three-way forklift controller can unlock the forklift permission corresponding to the task type based on this signal. It then outputs a forklift-ready signal corresponding to the task type, allowing the operator to execute the final forklift action. After the forklift is completed, the operator can confirm the task completion via the three-way forklift's human-machine interface (HMI), which sends the confirmation information to the three-way forklift controller. Upon receiving the confirmation, the three-way forklift controller then completes the assisted driving corresponding to the task instruction. Alternatively, the three-way forklift controller can automatically confirm the completion of the assisted driving corresponding to the task instruction each time it detects a forklift action.
[0067] Following step S50, the following is also included: After completing the assisted driving corresponding to the task instruction, determine whether there is a task in the same tunnel as the task tunnel number; If so, continue with assisted driving for the same lane mission; If not, the target three-way forklift will be controlled to leave the aisle, and a magnetic landmark stop detection will be performed when it leaves the aisle. When the magnetic strip signal after the detection of the target magnetic landmark signal is interrupted, the magnetic navigation assisted driving mode will be exited and a prompt will be made to switch to manual driving mode.
[0068] After completing the assisted driving corresponding to the task instruction, the three-way forklift controller will continue to determine whether there are other tasks in the same aisle within the task instruction. In other words, it will determine whether there are tasks in the same aisle that have a composite task relationship with the task instruction. For example, if the task type of the task instruction is an outbound task, and after judgment, it is determined that there is also an inbound task of a corresponding target three-way forklift in the same aisle, the composite task relationship is outbound first, then inbound. Alternatively, if the task type of the task instruction is an inbound task, and after judgment, it is determined that there is also an outbound task of a corresponding target three-way forklift in the same aisle, the composite task relationship is inbound first, then outbound. Therefore, when a task in the same aisle is determined to exist, the controller can continue to complete the assisted driving of that task without immediately exiting the magnetic navigation assisted driving mode. When no task in the same aisle exists, such as only an inbound or outbound task, the three-way forklift controller will control the target three-way forklift to continue driving away from the aisle. Furthermore, it will continue to perform magnetic landmark stop detection during the departure process. In other words, when the magnetic strip signal is interrupted after the target magnetic landmark signal appears, it indicates that the target three-way forklift has left the magnetic strip and magnetic landmark area. At this time, the magnetic navigation assisted driving mode can be exited, and a prompt will appear to switch to manual driving mode. Figure 9In the provided assisted driving example, the task standby station selects a task issuance mode: either through the WMS (Work Management System) or via the touchscreen. WMS task issuance can be automatic from the host system, while touchscreen task issuance can be selected via the offline AGV's three-way forklift touchscreen. After receiving the issued task, the three-way forklift controller verifies the task to determine its validity. If verification fails, an invalid task alarm is triggered, and the AGV three-way forklift controller rejects the task. If the task is valid, the system parses the task aisle number, storage location number, storage location height, and task type. Task types can include first-in-first-out (FIFO), first-out-first-out (FIFO), inbound, and outbound tasks. FIFO and FIFO-first-out tasks are composite tasks, while inbound and outbound tasks are single tasks. After determining the task type, the AGV three-way forklift is manually driven to the corresponding task aisle. Upon recognizing the origin magnetic marker, it follows the magnetic strip path and, monitored by the walking encoder, stops at the corresponding task storage location after reaching the designated workstation. Simultaneously, based on the lifting information monitored by the lifting encoder, it unlocks the forklift access upon reaching the designated position, prompting the manual operator to perform either an inbound or outbound operation based on the task type. After the corresponding inbound or outbound forklift action is completed, the operation is confirmed. Subsequently, the AGV three-way forklift operates automatically. If there are other tasks in the same aisle for the same task type, it proceeds according to those tasks, reaching the corresponding task station to complete the other task in the same aisle. Upon completion, it reaches the manual switch station and displays the endpoint notification. If the prompt is to proceed to another aisle workstation or if the task type is a single task, the task is directly confirmed as completed, and the AGV stops at the manual switch station with an endpoint notification. After the task completion indicator is displayed, task completion information is sent to the WMS, and the magnetic navigation assisted driving mode is switched back to manual driving mode, ending the task. The target magnetic landmark signal can include the origin magnetic landmark or the endpoint magnetic landmark corresponding to the end of the magnetic strip path. This can be achieved by first detecting the first distance between the origin magnetic landmark and the target three-way forklift and the second distance between the endpoint magnetic landmark and the target three-way forklift, then comparing the magnitudes of the first and second distances, and selecting the magnetic landmark corresponding to the smaller distance as the target magnetic landmark.
[0069] This invention also provides a complete inbound task execution process for an assisted driving system: Step 1: WMS issues an inbound task, which includes: task lane number A03, task storage location number 12 (the 12th storage location on the left), task storage location height 4.5m, and task type inbound task.
[0070] Step 2: The operator confirms the task through the human-machine interface and drives the vehicle from its current location to the entrance of lane A03 in manual driving mode. During this stage, the magnetic navigation sensor is in standby mode, and steering and speed are entirely controlled manually.
[0071] Step 3: When the vehicle detects the position of the lateral magnetic positioning point, the three-way forklift controller performs the following operations: (a) Verify the transverse magnetic positioning point corresponding to the origin magnetic landmark; (b) Based on the lateral magnetic positioning point, clear the cumulative pulse value of the walking encoder to zero; (c) Automatically switch to magnetic navigation assisted driving mode, lock manual steering input, but retain manual emergency braking function; (d) Automatically travel along the magnetic strip path of the tunnel.
[0072] Step 4: The three-way forklift controller calculates the current storage location number in real time. Assuming a storage location pitch of 1.5m, a drive wheel diameter of 350mm, and an encoder resolution of 2048ppr, the travel distance corresponding to each pulse is approximately π×350 / 2048≈0.537mm. When the cumulative pulse value reaches 12×1500 / 0.537≈33520 pulses, it can be determined that the 12th storage location has been reached, triggering deceleration and stopping. Of course, if there are side magnetic markers along this magnetic strip path, this process will continuously be zeroed and recalibrated by each of the passed side magnetic markers, and pulse accumulation will be recalculated.
[0073] Step 5: After parking, start the lifting closed-loop control module of the three-way forklift controller, convert the task storage height of 4.5m into the target pulse number of the lifting encoder, control the lifting motor to drive the forks to rise and fine-tune through PID closed loop until the vertical storage position deviation between the lifting encoder feedback height and the task storage position height is ≤ the second preset threshold ±1cm.
[0074] Step 6: After confirming that the longitudinal storage position deviation is ≤1.05% ±2cm and the vertical storage position deviation is ≤1.05% ±2cm, the safety interlock module of the three-way forklift controller outputs a green "forklift ready" indicator signal to the operator through the human-machine interface, and simultaneously unlocks the forklift control lever. The operator then performs actions such as lateral fork extension, fork insertion into the pallet, and lateral fine-tuning to complete the storage.
[0075] Step 7: The operator clicks the "Task Complete" button on the touchscreen. The three-way forklift controller sends a task completion confirmation to the WMS via the wireless communication module, and the WMS updates the inventory database.
[0076] Step 8: AGV automatically drives to the lane entrance. When the magnetic navigation sensor detects the magnetic landmark position at the lane exit, the three-way forklift controller automatically stops, prompts a switch back to manual driving mode, unlocks all automatic control permissions, and the task ends.
[0077] Please see Figure 10 The present invention also provides an auxiliary driving system 11 for a three-way forklift, applied to a three-way forklift controller, comprising: an instruction acquisition unit 111 for acquiring task instructions; an instruction parsing unit 112 for parsing the task instructions to obtain the task aisle number, task storage location number, task storage location height, and task type; a mode switching unit 113 for entering a magnetic navigation assisted driving mode when a first magnetic landmark signal corresponding to the task aisle number is detected, wherein the first magnetic landmark signal is obtained from the origin magnetic landmark of the magnetic strip path corresponding to the task aisle number; and a deviation analysis unit 114 for, in the magnetic navigation assisted driving mode, analyzing the magnetic strip path, the first magnetic landmark signal, the second magnetic landmark signals corresponding to each side magnetic landmark on the magnetic strip path, the task storage location number, and the task type. The system performs warehouse location positioning and multi-dimensional warehouse location deviation analysis at the warehouse height, generating a forklift enable signal corresponding to the task type. The multi-dimensional warehouse location deviation analysis includes zeroing and re-accumulating the pulses corresponding to the travel distance of the travel encoder configured on the target three-way forklift's travel drive based on the first and second magnetic landmark signals, and analyzing the longitudinal warehouse location deviation between the pulses and the reference distance corresponding to the task warehouse location number; and analyzing the vertical warehouse location deviation between the lifting height of the lifting encoder configured on the target three-way forklift's lifting drive and the task warehouse location height. The system also includes an access control unit 115, which unlocks the forklift permission corresponding to the task type based on the forklift enable signal, outputs a forklift-ready signal to perform the corresponding forklift action, and completes the assisted driving corresponding to the task instruction.
[0078] It should be noted that the three-way forklift assisted driving system 11 provided in the above embodiments and the three-way forklift assisted driving method provided in the above embodiments belong to the same concept. The specific operation methods of each module and unit have been described in detail in the method embodiments and will not be repeated here. In practical applications, the three-way forklift assisted driving system 11 provided in the above embodiments can be assigned to different functional modules as needed, that is, the internal structure of the device can be divided into different functional modules to complete all or part of the functions described above. This is not a limitation here.
[0079] Please see Figure 11 The electronic device 1 may include a memory 12, a processor 13 and a bus, and may also include a computer program stored in the memory 12 and executable on the processor 13, such as an auxiliary driving program for a three-way forklift.
[0080] The memory 12 includes at least one type of readable storage medium, such as flash memory, portable hard drive, multimedia card, card-type memory (e.g., SD or DX memory), magnetic memory, magnetic disk, optical disk, etc. In some embodiments, the memory 12 can be an internal storage unit of the electronic device 1, such as the portable hard drive of the electronic device 1. In other embodiments, the memory 12 can be an external storage device of the electronic device 1, such as a plug-in portable hard drive, smart media card (SMC), secure digital (SD) card, flash card, etc., equipped on the electronic device 1. Furthermore, the memory 12 can include both internal and external storage units of the electronic device 1. The memory 12 can be used not only to store application software and various types of data installed on the electronic device 1, such as the code for assisted driving of a three-way forklift, but also to temporarily store data that has been output or will be output.
[0081] In some embodiments, the processor 13 may be composed of integrated circuits, such as a single packaged integrated circuit or multiple integrated circuits packaged with the same or different functions, including combinations of one or more central processing units (CPUs), microprocessors, digital processing chips, graphics processors, and various control chips. The processor 13 is the control unit of the electronic device 1, connecting various components of the electronic device 1 via various interfaces and lines. It executes programs or modules stored in the memory 12 (e.g., the auxiliary driving program for a three-way forklift) and calls data stored in the memory 12 to perform various functions and process data of the electronic device 1.
[0082] The processor 13 executes the operating system of the electronic device 1 and various installed applications. The processor 13 executes the applications to implement the steps in the above-described assisted driving method for the three-way forklift.
[0083] For example, the computer program may be divided into one or more modules, which are stored in the memory 12 and executed by the processor 13 to complete this application. The one or more modules may be a series of computer program instruction segments capable of performing specific functions, which describe the execution process of the computer program in the electronic device 1. For example, the computer program may be divided into units in an assisted driving system for a three-way forklift.
[0084] The integrated unit implemented as a software functional module can be stored in a computer-readable storage medium, which can be non-volatile or volatile. The software functional module, stored in the storage medium, includes several instructions to cause a computer device (which may be a personal computer, computer equipment, or network device, etc.) or processor to execute some functions of the assisted driving method for the three-way forklift described in the various embodiments of this application.
[0085] In summary, the assisted driving method and system for a three-way forklift disclosed in this invention establishes communication with a warehouse management system or a three-way forklift host system, enabling the automatic distribution of task information to the three-way forklift controller. The controller then automatically receives the task and parses the corresponding aisle and storage location information. When the target three-way forklift enters the aisle corresponding to its aisle number, it automatically switches to magnetic navigation assisted driving mode based on magnetic landmark signals. Simultaneously, in magnetic navigation assisted driving mode, longitudinal storage location deviation analysis is performed using the pulse accumulation value of the travel encoder combined with the magnetic landmark within the aisle, while vertical storage location deviation analysis is performed using the lifting encoder. After accurately determining the storage location, a forklift enable signal is generated to unlock the forklift permission for manual forklifting. After the forklift is completed and there are no other tasks in the same aisle, the forklift automatically exits the aisle and switches back to manual driving mode. The above method enables automatic movement and lifting within the aisle, requiring only the operator to perform the final forklift action, significantly reducing operational difficulty and consequently lowering the driving difficulty and training costs for three-way forklift operators. Simultaneously, a safety interlock mechanism based on longitudinal and vertical storage position deviations ensures that manual forklift handling is only permitted after precise positioning, preventing collisions and avoiding the high modification costs and safety risks associated with high-level forklift handling required for full automation. Therefore, this invention effectively overcomes the various shortcomings of existing technologies and possesses high industrial application value.
[0086] The above embodiments are merely illustrative of the principles and effects of the present invention and are not intended to limit the invention. Any person skilled in the art can modify or alter the above embodiments without departing from the spirit and scope of the present invention. Therefore, all equivalent modifications or alterations made by those skilled in the art without departing from the spirit and technical concept disclosed in the present invention should still be covered by the claims of the present invention.
Claims
1. A method for assisting the driving of a three-way forklift, characterized in that, Applications in three-way forklift controllers include: Get task instructions; The task instruction is parsed to obtain the task lane number, task storage location number, task storage location height, and task type; When the first magnetic landmark signal corresponding to the task lane number is detected, the magnetic navigation assisted driving mode is entered. The first magnetic landmark signal is obtained from the origin magnetic landmark of the magnetic strip path corresponding to the task lane number. In the magnetic navigation assisted driving mode, the storage location and multi-dimensional storage location deviation analysis are performed based on the magnetic strip path, the first magnetic landmark signal, the second magnetic landmark signal corresponding to each side magnetic landmark on the magnetic strip path, the task storage location number, and the task storage location height. A forklift enable signal corresponding to the task type is generated. The multi-dimensional storage location deviation analysis includes zeroing and re-accumulating the pulses corresponding to the travel distance of the travel encoder configured on the target three-way forklift travel drive based on the first magnetic landmark signal and the second magnetic landmark signal, and analyzing the longitudinal storage location deviation between the pulses and the reference distance corresponding to the task storage location number, and analyzing the vertical storage location deviation between the lifting height of the lifting encoder configured on the target three-way forklift lifting drive and the task storage location height. Based on the fork enable signal, the fork permission corresponding to the task type is unlocked, and a fork signal is output to perform the corresponding fork action to complete the assisted driving corresponding to the task instruction.
2. The assisted driving method for a three-way forklift according to claim 1, characterized in that, Obtain task instructions, including: Obtain the task from the corresponding distribution system, which includes a warehouse management system or a three-way forklift host. Perform task verification on the issued tasks; When the task verification passes, the issued task is used as the task instruction to obtain the task instruction; An invalid task alert will be issued when the task verification fails.
3. The assisted driving method for a three-way forklift according to claim 2, characterized in that, Perform task verification on the issued task, including: Determine whether the issued task simultaneously meets the following conditions: The header and trailer identifiers of the received data frames of the task being sent conform to the preset format of the protocol, and the length of the received data of the task being sent is consistent with the length specified in the protocol. The CRC check value of the received data frame is consistent with the check field carried in the data frame; The task location number of the issued task is within the service range of the target three-way forklift, the task type of the issued task matches the status of the target three-way forklift, and the task lane number of the issued task meets the current lane operation requirements. The target three-way forklift is currently in an idle state. The emergency stop signal and safety relay of the target three-way forklift are normal. All key modules of the target three-way forklift are online and normal. The key modules include the navigation system, encoder and hydraulic station. If so, the task verification is successful; If not, the task verification fails.
4. The assisted driving method for a three-way forklift according to claim 1, characterized in that, Based on the magnetic stripe path, the first magnetic landmark signal, the second magnetic landmark signals corresponding to each adjacent magnetic landmark on the magnetic stripe path, the task storage location number, and the task storage location height, storage location positioning and multi-dimensional storage location deviation analysis are performed to generate a forklift enable signal corresponding to the task type, including: The historical pulse accumulation value of the walking encoder is cleared to zero according to the first magnetic landmark signal; After the historical pulse accumulation value is cleared to zero, magnetic navigation assisted driving of the magnetic strip path is performed based on the real-time pulse accumulation value of the walking encoder, the second magnetic landmark signal, the task storage location number and the reference distance corresponding to the task storage location number, and the longitudinal storage location deviation is obtained. When the longitudinal storage location deviation is less than a first preset threshold, parking control is performed; After parking is completed, the forks are controlled to lift according to the height of the task storage location, and the lifting height corresponding to the lifting encoder is obtained. The vertical storage location deviation is obtained based on the lifting height and the task storage location height. When the vertical storage location deviation is less than the second preset threshold, the fork lifting action is stopped, and a fork pick-up enable signal corresponding to the task type is generated.
5. The assisted driving method for a three-way forklift according to claim 4, characterized in that, Based on the real-time pulse accumulation value of the walking encoder, the second magnetic landmark signal, the task storage location number, and the reference distance corresponding to the task storage location number, magnetic navigation assisted driving is performed on the magnetic strip path to obtain the longitudinal storage location deviation, including: The signals of each of the second magnetic landmarks that pass through in sequence are detected; When the second magnetic landmark signal is detected, the real-time pulse accumulation value is cleared to obtain the absolute position distance corresponding to the second magnetic landmark signal; The current driving distance is obtained based on the absolute position distance corresponding to each of the second magnetic landmark signals and the last real-time pulse accumulation value obtained after clearing the pulse accumulation value based on the last second magnetic landmark signal; Based on the current travel distance, determine whether the target three-way forklift has traveled to the preset deceleration zone corresponding to the task storage location number: If so, the target three-way forklift is controlled to enter a low-speed crawling mode, and the difference between the current travel distance and the reference distance in the low-speed crawling mode is calculated to obtain the longitudinal storage position deviation; If not, continue operating at the rated speed.
6. The assisted driving method for a three-way forklift according to claim 5, characterized in that, The current travel distance is obtained based on the absolute position distance corresponding to each of the second magnetic landmark signals and the last real-time pulse accumulation value obtained after clearing the pulse accumulation value based on the last second magnetic landmark signal, including: The cumulative corrected distance is obtained based on the absolute position distance corresponding to each of the second magnetic landmark signals; The final travel distance is obtained based on the cumulative value of the last real-time pulse, the wheel diameter of the three-way forklift corresponding to the travel encoder, and the number of pulses per revolution. The current driving distance is obtained based on the cumulative corrected distance and the last driving distance.
7. The assisted driving method for a three-way forklift according to claim 6, characterized in that, The formula for calculating the current travel distance is: ; in, Indicates the current distance traveled. Indicates the first The absolute position distance corresponding to the second magnetic landmark signal This represents the cumulative value of the last real-time pulse. Indicates the number of pulses per revolution. Indicates the wheel diameter of a three-way forklift. It represents pi (π).
8. The assisted driving method for a three-way forklift according to claim 5, characterized in that, Based on the current travel distance, determine whether the target three-way forklift has traveled to the preset deceleration zone corresponding to the task location number, including: The difference between the current driving distance and the reference distance is calculated to obtain the parking space distance difference. Determine whether the distance difference between the storage locations is less than the maximum deceleration distance value corresponding to the preset deceleration interval; If so, the target three-way forklift will travel to the preset deceleration zone corresponding to the task storage location number; If not, the target three-way forklift has not traveled to the preset deceleration zone corresponding to the task storage location number.
9. The assisted driving method for a three-way forklift according to claim 1, characterized in that, Also includes: After completing the assisted driving corresponding to the task instruction, determine whether there is a task in the same lane corresponding to the task lane number; If so, continue with the assisted driving for the same tunnel mission; If not, the target three-way forklift is controlled to leave the aisle, and a magnetic landmark stop detection is performed when it leaves the aisle. When the magnetic strip signal after the detection of the target magnetic landmark signal is interrupted, the magnetic navigation assisted driving mode is exited and a prompt is made to switch to manual driving mode.
10. A driver assistance system for a three-way forklift, characterized in that, Applications in three-way forklift controllers include: The instruction acquisition unit is used to acquire task instructions; The instruction parsing unit is used to parse the task instruction to obtain the task lane number, task storage location number, task storage location height and task type. The mode switching unit is used to enter the magnetic navigation assisted driving mode when the first magnetic landmark signal corresponding to the task lane number is detected. The first magnetic landmark signal is obtained from the origin magnetic landmark of the magnetic strip path corresponding to the task lane number. A deviation analysis unit is used in the magnetic navigation assisted driving mode to perform warehouse location positioning and multi-dimensional warehouse deviation analysis based on the magnetic strip path, the first magnetic landmark signal, the second magnetic landmark signal corresponding to each side magnetic landmark on the magnetic strip path, the task warehouse position number, and the task warehouse position height, and to generate a forklift enable signal corresponding to the task type. The multi-dimensional warehouse deviation analysis includes zeroing and re-accumulating the pulses corresponding to the travel distance of the travel encoder configured on the target three-way forklift's travel drive based on the first and second magnetic landmark signals, and analyzing the longitudinal warehouse deviation between this longitudinal deviation and the reference distance corresponding to the task warehouse position number; and analyzing the vertical warehouse deviation between the lifting height of the lifting encoder configured on the target three-way forklift's lifting drive and the task warehouse position height. The permission configuration unit is used to unlock the forklift permission corresponding to the task type according to the forklift enable signal, output a forklift signal to perform the corresponding forklift action, so as to complete the assisted driving corresponding to the task instruction.
