Real-time position calculation method of four-way shuttle vehicle
Through the combination of three-point positioning control system and servo motor, the accurate position calculation of the four-way shuttle vehicle in the multi-cargo warehouse is achieved, solving the problems of high cost and inaccurate positioning in the existing technology, and reducing the risk of equipment damage .
Patent Information
- Application Number
- CN202411209700.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-30
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-08-30
AI Technical Summary
The existing four-way shuttle vehicle real-time position calculation method mainly relies on RFID chips or barcodes, resulting in increased costs and equipment damage, and the positioning in multi-cargo warehouses is not accurate enough.
A three-point positioning control system is adopted, including a controller and two sets of positioning sensors. By calculating the row and sequence numerical difference, the traveling motor is controlled forward or reverse, and combined with a servo motor and a diffuse reflection photoelectric switch, the accurate position calculation of the shuttle vehicle is realized.
There is no need to paste barcodes or install RFID chips, which reduces costs, ensures the accuracy of shuttle vehicle position and real-time updates, and avoids the impact of barcode dust falling and RFID chip damage.
Smart Images

Figure CN119079352A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of warehousing logistics equipment, and in particular to a real-time position calculation method for a four-way shuttle vehicle. Background Art
[0002] In the existing technology, the real-time position calculation of the four-way shuttle vehicle on the market is mainly achieved by reading RFID chips or barcodes, and the current position of the shuttle vehicle is obtained by reading the carrier information; warehouses generally have many cargo spaces, and if RFID chips or barcodes are used, brackets need to be made and chips need to be purchased, which will increase the overall cost. Summary of the invention
[0003] According to an embodiment of the present invention, a method for calculating the real-time position of a four-way shuttle is provided. The four-way shuttle travels in a shelf, and a plurality of cargo positions arranged in a matrix are provided in the shelf. The method is implemented by a three-point positioning control system, and the three-point positioning system includes a controller and two groups of positioning sensors; the controller is arranged on the four-way shuttle, and the controller is connected to the two groups of positioning sensors and a travel motor signal for driving the four-way shuttle to travel; the number of each group of positioning sensors is three, one group of positioning sensors is respectively arranged on two opposite sides of the four-way shuttle, and the other group of positioning sensors is respectively arranged on the remaining two sides of the four-way shuttle; the method includes the following steps: Determine the current row position of the four-way shuttle in the rack; Set the target row position of the four-way shuttle; Calculate the row and column numerical difference between the current row and column position and the target row and column position; According to the difference between the row and column values, the travel motor is controlled to rotate forward or reverse, driving the four-way shuttle to move; The controller collects the signal from the positioning sensor and performs logic operations according to the rotation direction of the travel motor to calculate the position of the four-way shuttle.
[0004] Further, determining the current row and column position of the four-way shuttle in the shelf includes the following sub-steps: Set any cargo location in the shelf as the origin cargo location, and set the position of the row and column of the origin cargo location to the first row and first column; Taking the origin as the reference point, add numbers from left to right and from top to bottom to determine the row and column values of all the shelves. Determine the row and column values of the cargo location where the four-way shuttle is currently located.
[0005] Further, calculating the row and column numerical difference between the current row and column position and the target row and column position includes the following steps: Subtract the row value of the target row and column position from the row value of the current row and column position to obtain the row value difference; Subtract the column value at the target row and column position from the column value at the current row and column position to obtain the column value difference.
[0006] Further, controlling the travel motor to rotate forward or reverse according to the row and column numerical difference to drive the four-way shuttle to move includes the following steps: The positive and negative values of the row value difference and the column value difference are judged respectively. If they are positive, the travel motor is controlled to rotate forward. If they are negative, the travel motor is controlled to rotate reversely.
[0007] Furthermore, the controller collects the signal of the positioning sensor and performs logic operations according to the rotation direction of the travel motor. The calculation of the position of the four-way shuttle includes the following steps: The travel motor drives the four-way shuttle to move the cargo space, triggering the positioning sensor, and the positioning sensor signal is transmitted to the controller for counting; Taking the current row and column position as the reference point, the value is added or subtracted according to the number of cargo spaces passed by the four-way shuttle, and the position of the four-way shuttle is calculated in real time.
[0008] Furthermore, taking the current row position as a reference point, adding or subtracting value according to the number of cargo positions passed by the four-way shuttle, and calculating the position of the four-way shuttle in real time includes the following steps: Taking the row value of the current row and column position as the base, if the travel motor rotates forward, the row value is added according to the number of cargo positions passed by the four-way shuttle. If the travel motor rotates reversely, the row value is subtracted according to the number of cargo positions passed by the four-way shuttle. Taking the column value of the current row and column position as the base, if the travel motor rotates forward, the column value is added according to the number of cargo positions passed by the four-way shuttle. If the travel motor rotates reversely, the column value is subtracted according to the number of cargo positions passed by the four-way shuttle.
[0009] Furthermore, the following steps are included: The controller reads the pulses fed back by the travel motor and calculates the real-time position value of the travel motor; Compare the real-time position value of the travel motor with the row and column value of the cargo position in the shelf to determine the real-time row and column position of the four-way shuttle vehicle; The position of the four-way shuttle is determined by combining the pulses fed back by the travel motor and the signals of the two sets of positioning sensors.
[0010] According to the real-time position calculation method of the four-way shuttle vehicle in the embodiment of the present invention, a dual calculation method is used to calculate the current position of the shuttle vehicle, which can ensure the accurate position of the shuttle vehicle; there is no need to stick barcodes or install RFID chips, which can avoid the influence of barcode dust and RFID chip damage, thereby reducing costs.
[0011] It is to be understood that both the foregoing general description and the following detailed description are exemplary, and are intended to provide further explanation of the technology as claimed. BRIEF DESCRIPTION OF THE DRAWINGS
[0012] Figure 1 This is a flow chart of a first embodiment of a method for calculating a real-time position of a four-way shuttle vehicle according to an embodiment of the present invention; Figure 2 This is a flow chart of a second embodiment of a method for calculating a real-time position of a four-way shuttle vehicle according to an embodiment of the present invention; Figure 3 This is a flow chart of Embodiment 3 of a method for calculating the real-time position of a four-way shuttle vehicle according to Embodiment 1 of the present invention. DETAILED DESCRIPTION
[0013] The preferred embodiments of the present invention will be described in detail below in conjunction with the accompanying drawings to further illustrate the present invention.
[0014] First, combine Figures 1 to 3 The real-time position calculation method according to an embodiment of the present invention is described, which is used to calculate the real-time position of a four-way shuttle vehicle, and has a wide range of application scenarios.
[0015] like Figures 1 to 3As shown, a real-time position calculation method of a four-way shuttle vehicle according to an embodiment of the present invention is provided. The four-way shuttle vehicle moves in a shelf, and a plurality of cargo positions arranged in a matrix are provided in the shelf. The method is implemented by a three-point positioning control system, and the three-point positioning system includes a controller and two groups of positioning sensors; the controller is arranged on the four-way shuttle vehicle, and the controller is connected with the two groups of positioning sensors and the signal of the travel motor for driving the four-way shuttle vehicle to move. The travel motor adopts a servo motor, and the four-way travel of the four-way shuttle vehicle adopts the same servo motor; the number of each group of positioning sensors is three, one group of positioning sensors is respectively arranged on the opposite sides of the four-way shuttle vehicle, and the other group of positioning sensors is respectively arranged on the remaining two sides of the four-way shuttle vehicle; the method includes the following steps: determining the current row and column position of the four-way shuttle vehicle in the shelf; setting the target row and column position of the four-way shuttle vehicle; calculating the row and column value difference between the current row and column position and the target row and column position; controlling the travel motor to rotate forward or reverse according to the row and column value difference to drive the four-way shuttle vehicle to move; the controller collects the signal of the positioning sensor and performs logical operation according to the rotation direction of the travel motor to calculate the position of the four-way shuttle vehicle. In this embodiment, taking the row direction as an example, the working process of the three-point positioning system is as follows: the positioning sensor adopts a diffuse reflection type photoelectric switch, and the four-way shuttle moves along the row direction. At this time, a group of positioning sensors located in the row direction are blocked by the lanes on the shelf, and the positioning sensors located in the column direction are blocked once every time they pass a cargo position. The number of cargo positions passed by the four-way shuttle in the row direction is determined by the number of signal conversions of the positioning sensor, and the accuracy of the final complete stop in the cargo position can be guaranteed by the three-point positioning method. Specifically, the two positioning sensors in the relative column direction respectively detect the position of the relative column lanes, and the other positioning sensor in the column direction is used as a stop trigger point. When the positioning sensor changes its signal, it means that the four-way shuttle has completely entered the cargo position and stopped the movement of the four-way shuttle. The positioning principle of the column direction is consistent with the positioning principle of the row direction. Through this three-point positioning system and combined with the calculation method, the position of the shuttle can be guaranteed to be accurate without adding additional hardware equipment to the shelf, and the real-time position calculation of the shuttle during the movement process can be realized, which greatly reduces the warehouse cost; it can also avoid the position positioning error caused by the shuttle slipping.
[0016] Further, if Figures 1 to 3 As shown, in this embodiment, determining the current row and column position of the four-way shuttle in the shelf includes the following sub-steps: setting any cargo location in the shelf as the origin cargo location, and setting the position of the row and column of the origin cargo location as the first row and first column, preferably the cargo location in the corner of the shelf is the origin cargo location; taking the origin cargo location as the reference point, adding numbers in order from left to right and from top to bottom, and subtracting numbers in order from right to left and from bottom to bottom, to determine the row and column values of all cargo locations in the shelf; determining the row and column values of the cargo location where the four-way shuttle is currently located.
[0017] Further, if Figures 1 to 3 As shown, in this embodiment, calculating the row and column value difference between the current row and column position and the target row and column position includes the following steps: subtracting the row value of the target row and column position from the row value of the current row and column position to obtain the row value difference; subtracting the column value of the current row and column position from the column value of the target row and column position to obtain the column value difference, which is simple to calculate and convenient to locate.
[0018] Further, if Figures 1 to 3 As shown, in this embodiment, the walking motor is controlled to rotate forward or reverse according to the difference between the row and column values, and the four-way shuttle is driven to move, which includes the following steps: judging the positive and negative values of the row value difference and the column value difference respectively, if it is a positive number, the walking motor is controlled to rotate forward, and if it is a negative number, the walking motor is controlled to rotate reversely.
[0019] Further, if Figures 1 to 3 As shown, in this embodiment, the controller collects the signal of the positioning sensor and performs logical operations according to the rotation direction of the travel motor. The calculation of the position of the four-way shuttle includes the following steps: the travel motor drives the four-way shuttle to move the cargo position, triggers the positioning sensor, and the positioning sensor signal is transmitted to the controller for counting, and a count is performed each time a cargo position is moved; taking the current row and column position as a reference point, the value is added or subtracted according to the number of cargo positions passed by the four-way shuttle, and the position of the shuttle is calculated in real time.
[0020] Further, if Figures 1 to 3 As shown, in this embodiment, the current row and column position is used as a reference point, and the value is added or subtracted according to the number of cargo positions passed by the four-way shuttle. The real-time calculation of the position of the four-way shuttle includes the following steps: taking the row value of the current row and column position as the base number, if the travel motor rotates forward, the row value is added according to the number of cargo positions passed by the four-way shuttle, and if the travel motor rotates reversely, the row value is subtracted according to the number of cargo positions passed by the four-way shuttle; taking the column value of the current row and column position as the base number, if the travel motor rotates forward, the column value is added according to the number of cargo positions passed by the four-way shuttle, and if the travel motor rotates reversely, the column value is subtracted according to the number of cargo positions passed by the four-way shuttle. This positioning sensor calculation method combines the counting of the controller, the triggering mechanism of the positioning sensor, and the forward and reverse rotation of the travel motor to accurately calculate the real-time position of the four-way shuttle, ensuring the accurate position of the shuttle and convenient and quick use.
[0021] Further, if Figures 1 to 3As shown, in this embodiment, the following steps are also included: the controller reads the pulses fed back by the travel motor and calculates the real-time position value of the travel motor; since the physical position of the shelf has a direct correspondence with the number of pulses of the servo motor or the encoder position, the real-time position of the four-way shuttle is determined by comparing the real-time position value of the travel motor with the row and column values of the cargo positions in the shelf; the position of the four-way shuttle is determined by combining the pulses fed back by the travel motor and the signals of the two sets of positioning sensors. This servo position calculation method adopts closed-loop control and pulse positioning technology, and the servo motor can achieve high-precision position control.
[0022] Embodiment 1: Determine the current row and column position of the four-way shuttle in the shelf; set the target row and column position of the four-way shuttle; calculate the row and column numerical difference between the current row and column position and the target row and column position; control the travel motor to rotate forward or reverse according to the row and column numerical difference to drive the four-way shuttle to move; the controller collects the signal of the positioning sensor and performs logical operations according to the rotation direction of the travel motor to calculate the position of the four-way shuttle. After the initial position column and row of the shuttle are set, the shuttle starts to run after receiving the task; judge according to the difference between the target column or row of the task and the current column or row of the trolley, if the difference is greater than 0, the running direction is forward, and if the difference is less than 0, the running direction is reverse; when the shuttle passes the cargo position, the row direction positioning sensor or the column direction positioning sensor is triggered, the forward direction is counted up, and the reverse direction is counted down. The PLC controller performs logical operations according to the collected positioning sensor signals to calculate the position of the shuttle. For example, the target position of the shuttle task is 4th column and 1st row, and the current position of the shuttle is 1st column and 1st row; from 1st column to 4th column, the shuttle runs forward, and when passing through the cargo grid, the PLC collects the trigger of the row direction positioning sensor, performs logical operations, and adds 1 to the current column value; and so on, when the trolley is in place, the trolley position value is updated.
[0023] Embodiment 2: Determine the current row and column position of the four-way shuttle in the shelf; set the target row and column position of the four-way shuttle; calculate the row and column numerical difference between the current row and column position and the target row and column position; control the travel motor to rotate forward or reverse according to the row and column numerical difference to drive the four-way shuttle to move; the controller reads the pulse fed back by the travel motor and calculates the real-time position value of the travel motor; compares the real-time position value of the travel motor with the row and column numerical value of the cargo position in the shelf to determine the real-time row and column position of the four-way shuttle. After the initial position column and row of the shuttle are set, the shuttle starts to run after receiving the task; the PLC controller reads the real-time position value of the servo and calculates the position of the shuttle by comparing it with the physical position data of the cargo position. For example, the target position of the shuttle task is 4 columns and 1 row, and the current position of the shuttle is 1 column and 1 row; when the shuttle starts to run, the PLC controller reads the real-time position value of the servo and calculates the current position of the shuttle by comparing it with the position value of each cargo position in the data storage area of the PLC.
[0024] Embodiment 3: Determine the current row position of the four-way shuttle in the shelf; set the target row position of the four-way shuttle; calculate the row value difference between the current row position and the target row position; control the travel motor to rotate forward or reverse according to the row value difference to drive the four-way shuttle to move; the controller collects the signal of the positioning sensor and performs logical operations according to the rotation direction of the travel motor to calculate the position of the four-way shuttle; the controller reads the pulse feedback from the travel motor and calculates the real-time position value of the travel motor; compares the real-time position value of the travel motor with the row value of the cargo position in the shelf to determine the real-time row position of the four-way shuttle, and combines the pulse feedback from the travel motor and the signals of the two sets of positioning sensors to determine the position of the four-way shuttle. According to the position calculated by the calculation method of the positioning sensor and the calculation method of the servo pulse feedback, and combined with the final stop position of the trolley, the PLC controller determines the current position of the shuttle by calculation and comparison, and updates and uploads it.
[0025] Above, refer to Figures 1 to 3 The present invention describes a real-time position calculation method for a four-way shuttle according to an embodiment of the present invention. A dual calculation method is used to calculate the current position of the shuttle, which can ensure the accurate position of the shuttle. There is no need to stick a barcode or install an RFID chip, which can avoid the influence of barcode dust and RFID chip damage, thereby reducing costs.
[0026] It should be noted that, in this specification, the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprises..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.
[0027] Although the content of the present invention has been described in detail through the above preferred embodiments, it should be appreciated that the above description should not be considered as a limitation of the present invention. After reading the above content, it will be apparent to those skilled in the art that various modifications and substitutions of the present invention will occur. Therefore, the protection scope of the present invention should be limited by the appended claims.
Claims
1. A method for calculating the real-time position of a four-way shuttle, wherein the four-way shuttle travels in a shelf, wherein the shelf is provided with a plurality of cargo spaces arranged in a matrix, and the method is implemented by a three-point positioning control system, wherein the three-point positioning system comprises a controller and two groups of positioning sensors; the controller is arranged on the four-way shuttle, and the controller is connected to the two groups of positioning sensors and a travel motor signal for driving the four-way shuttle to travel; the number of each group of positioning sensors is three, wherein one group of positioning sensors is respectively arranged on two opposite sides of the four-way shuttle, and another group of positioning sensors is respectively arranged on the remaining two sides of the four-way shuttle; the characteristic is that The method comprises the following steps: Determine the current row position of the four-way shuttle in the rack; Set the target row position of the four-way shuttle; Calculate the row and column numerical difference between the current row and column position and the target row and column position; According to the difference between the row and column values, the travel motor is controlled to rotate forward or reverse, driving the four-way shuttle to move; The controller collects the signal from the positioning sensor and performs logic operations according to the rotation direction of the travel motor to calculate the position of the four-way shuttle.
2. The real-time position calculation method of the four-way shuttle vehicle according to claim 1, characterized in that: Determining the current row and column position of the four-way shuttle in the shelf comprises the following sub-steps: Set any cargo location in the shelf as the origin cargo location, and set the position of the row and column of the origin cargo location to the first row and first column; Taking the origin as the reference point, add numbers from left to right and from top to bottom to determine the row and column values of all the shelves. Determine the row and column values of the cargo location where the four-way shuttle is currently located.
3. The real-time position calculation method of the four-way shuttle vehicle as claimed in claim 1 or 2, characterized in that: Calculating the difference between the current row and column position and the target row and column position includes the following steps: Subtract the row value of the target row and column position from the row value of the current row and column position to obtain the row value difference; Subtract the column value at the target row and column position from the column value at the current row and column position to obtain the column value difference.
4. The real-time position calculation method of the four-way shuttle vehicle as claimed in claim 3 is characterized in that: The method of controlling the travel motor to rotate forward or reverse according to the row and column numerical difference to drive the four-way shuttle to travel comprises the following steps: The positive and negative values of the row value difference and the column value difference are judged respectively. If they are positive, the travel motor is controlled to rotate forward. If they are negative, the travel motor is controlled to rotate reversely.
5. The real-time position calculation method of the four-way shuttle vehicle according to claim 1, characterized in that: The controller collects the signal of the positioning sensor and performs logic operation according to the rotation direction of the travel motor to calculate the position of the four-way shuttle vehicle, which includes the following steps: The travel motor drives the four-way shuttle to move the cargo space, triggering the positioning sensor, and the positioning sensor signal is transmitted to the controller for counting; Taking the current row and column position as the reference point, the value is added or subtracted according to the number of cargo spaces passed by the four-way shuttle, and the position of the four-way shuttle is calculated in real time.
6. The method for calculating the real-time position of a four-way shuttle as claimed in claim 5, characterized in that: The method of taking the current row and column position as a reference point and adding or subtracting the number of cargo spaces passed by the four-way shuttle to calculate the position of the four-way shuttle in real time includes the following steps: Taking the row value of the current row and column position as the base, if the travel motor rotates forward, the row value is increased according to the number of cargo positions passed by the four-way shuttle. If the travel motor rotates reversely, the row value is decreased according to the number of cargo positions passed by the four-way shuttle. Taking the column value of the current row and column position as the base, if the travel motor rotates forward, the column value is added according to the number of cargo positions passed by the four-way shuttle. If the travel motor rotates reversely, the column value is subtracted according to the number of cargo positions passed by the four-way shuttle.
7. The real-time position calculation method of the four-way shuttle vehicle according to claim 1, characterized in that: It also includes the following steps: The controller reads the pulses fed back by the travel motor and calculates the real-time position value of the travel motor; Compare the real-time position value of the travel motor with the row and column value of the cargo position in the shelf to determine the real-time row and column position of the four-way shuttle vehicle; The position of the four-way shuttle is determined by combining the pulses fed back by the travel motor and the signals of the two sets of positioning sensors.
Citation Information
Patent Citations
RFID recognizing and locating method and system applied to traveling of shuttle vehicle
CN105600250A
Novel logistics shuttle vehicle
CN107745908A
Tray alignment method of logistics shuttle vehicle and logistics shuttle vehicle
CN113023276A
Positioning calibration system and method for four-way shuttle vehicle
CN113716254A
Photoelectric positioning system applied to warehouse four-way shuttle vehicle
CN114212432A
Cited By
Operation positioning control method for four-way shuttle vehicle of workbin
CN122186584A
