Automated guided vehicle, control method thereof, warehousing system and computer readable storage medium
By combining RFID, magnetic sensor and inertial measurement unit technology, the precise position and attitude detection of the automatic guide vehicle is realized, and the problems of low accuracy and insufficient reliability of the rail riding detection in the existing technology are solved, and the automatic guide vehicle is improved track replacement success rate and delivery accuracy.
Patent Information
- Application Number
- CN202411038579.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2024-06-13
- Filing Date
- 2024-07-30
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2044-07-30
AI Technical Summary
The existing automatic guided vehicles have problems of low accuracy and insufficient reliability in rail riding inspection, which may cause the vehicle to derail, causing accidents or inaccurate delivery.
A control method is adopted to read the position information stored in RFID electronic tags and the magnetic field intensity information sensed by magnetic sensors through RFID antennas, and combine the inertial measurement unit and inertial guide short-term algorithm to determine the position and attitude information of the automatic guide vehicle to determine whether it is Successfully switched tracks and return to the original track if they fail to try again.
Improve the accuracy and reliability of automatic guided vehicle riding rail detection to ensure the efficiency and accuracy of distribution.
Smart Images

Figure CN118977948A_ABST
Abstract
Description
Technical Field
[0001] The present invention generally relates to the field of warehousing technology, and more particularly to a control method for an automatic guided vehicle, an automatic guided vehicle, a warehousing system, and a computer-readable storage medium. Background Art
[0002] In the existing automatic guided vehicles, either no riding track detection is performed, or the riding track detection is performed relying on the navigation system. For one method, it relies on the guidance function of the track or the wheel, and automatically recovers when riding the track. The problem with this method is that the guidance capacity of the track or the wheel has an upper limit, and if the capacity limit is exceeded, the vehicle will derail and cause an accident. For the second method, the problem with this method is that the navigation system has uncertainty, and there is a probability that the vehicle will pass or fail to reach the position, resulting in the vehicle derailing when the vehicle rides the track seriously. How to perform riding track detection on the automatic guided vehicle, how to improve the accuracy of riding track detection, and how to improve the reliability of the automatic guided vehicle are technical problems that need to be solved in this application.
[0003] The contents of the background technology section are merely the technologies known to the inventors and do not necessarily represent the prior art in the field. Summary of the invention
[0004] In view of one or more of the problems in the prior art, the present invention provides a control method for an automatic guided vehicle, comprising:
[0005] S11: controlling the automatic guided vehicle to move along the first track;
[0006] S12: Determine the position information of the automatic guided vehicle;
[0007] S13: Based on the position information, determining whether the automatic guided vehicle has reached a preset track switching position;
[0008] S14: When it is determined that the automatic guided vehicle reaches the preset track switching position, controlling the automatic guided vehicle to switch to the second track;
[0009] S15: Determine the posture information of the automatic guided vehicle; and
[0010] S16: Based on the posture information, determine whether the automatic guided vehicle has successfully changed tracks.
[0011] Optionally, the first track and the second track are arranged in a cross shape on the same plane, and the preset track change position is located at the center of the intersection area of the first track and the second track.
[0012] Optionally, the automatic guided vehicle includes a first wheel set, and the first wheel set is arranged below the body of the automatic guided vehicle; the operation S11 includes: controlling the first wheel set to move along the first track.
[0013] Optionally, the operation S12 includes: reading the location information stored in the RFID electronic tag through the RFID antenna, sensing the magnetic field strength information through the magnetic sensor, and determining the location information of the automatic guided vehicle based on the location information stored in the RFID electronic tag and the magnetic field strength information.
[0014] Optionally, the automatic guided vehicle includes a second wheel group, which is arranged below the body of the automatic guided vehicle; wherein the operation S14 includes: controlling the first wheel group to be lifted to a first preset height, and controlling the second wheel group to be lowered to a second preset height, so as to control the automatic guided vehicle to switch to the second track.
[0015] Optionally, the operation S15 includes: determining the attitude information of the automatic guided vehicle by using an inertial measurement unit and an inertial navigation strapdown algorithm, wherein the attitude information includes a roll angle and / or a pitch angle.
[0016] Optionally, the operation S16 includes: comparing the change in posture information of the automatic guided vehicle before and after switching tracks, and determining whether the automatic guided vehicle has successfully switched tracks based on the change in posture information.
[0017] Optionally, the operation of determining whether the automatic guided vehicle has successfully changed tracks based on the change in posture information includes: when the change in the roll angle before and after the automatic guided vehicle switches tracks is less than a first threshold, and / or the change in the pitch angle is less than a second threshold, determining that the automatic guided vehicle has successfully changed tracks.
[0018] Optionally, the operation of determining whether the automatic guided vehicle has successfully changed tracks based on the change in posture information includes: when the change in the roll angle before and after the automatic guided vehicle switches tracks is not less than a first threshold, and / or the change in the pitch angle is not less than a second threshold, determining that the automatic guided vehicle has failed to change tracks.
[0019] Optionally, it also includes: when it is determined that the automatic guided vehicle fails to change tracks, determining the type of the automatic guided vehicle track change failure, the type including a first type and a second type, wherein the first type includes a track change failure when the automatic guided vehicle does not reach the preset track change position, and the second type includes a track change failure when the automatic guided vehicle exceeds the preset track change position.
[0020] Optionally, the operation of determining the type of failure of the automated guided vehicle to change tracks comprises: determining the type of failure of the automated guided vehicle to change tracks based on the movement direction and posture of the automated guided vehicle when switching to the second track.
[0021] Optionally, the method further includes: when it is determined that the automatic guided vehicle fails to change tracks, controlling the automatic guided vehicle to return to a preset recovery position of the first track, and repeating at least part of the operations S11-S16 until it is determined that the automatic guided vehicle succeeds in changing tracks.
[0022] The present invention also provides an automatic guided vehicle, comprising:
[0023] A positioning module configured to determine the position information of the automatic guided vehicle;
[0024] a posture detection module configured to determine posture information of the automatic guided vehicle;
[0025] A control module is coupled to the positioning module and the posture detection module, and is configured to perform the following operations:
[0026] S11: controlling the automatic guided vehicle to move along the first track;
[0027] S12: Determine the position information of the automatic guided vehicle;
[0028] S13: Based on the position information, determining whether the automatic guided vehicle has reached a preset track switching position;
[0029] S14: When it is determined that the automatic guided vehicle reaches the preset track switching position, controlling the automatic guided vehicle to switch to the second track;
[0030] S15: Determine the posture information of the automatic guided vehicle; and
[0031] S16: Based on the posture information, determine whether the automatic guided vehicle has successfully changed tracks.
[0032] Optionally, the first track and the second track are arranged in a cross shape on the same plane, and the preset track change position is located at the center of the intersection area of the first track and the second track.
[0033] Optionally, the automatic guided vehicle comprises a first wheel set, and the first wheel set is arranged below the body of the automatic guided vehicle; the control module is configured to: control the first wheel set to move along the first track.
[0034] Optionally, the positioning module includes an RFID antenna and a magnetic sensor, and the control module is configured to: read the location information stored in the RFID electronic tag through the RFID antenna, sense the magnetic field strength information through the magnetic sensor, and determine the location information of the automatic guided vehicle based on the location information stored in the RFID electronic tag and the magnetic field strength information.
[0035] Optionally, the automatic guided vehicle includes a second wheel group, which is arranged below the body of the automatic guided vehicle; the control module is configured to: control the first wheel group to be lifted to a first preset height, and control the second wheel group to be lowered to a second preset height, so as to control the automatic guided vehicle to switch to the second track.
[0036] Optionally, the attitude detection module includes an inertial measurement unit, and the attitude detection module is configured to: determine the attitude information of the automatic guided vehicle through the inertial measurement unit and an inertial navigation strapdown algorithm, wherein the attitude information includes a roll angle and / or a pitch angle.
[0037] Optionally, the control module is configured to compare the change in posture information of the automatic guided vehicle before and after switching tracks, and determine whether the automatic guided vehicle has successfully switched tracks based on the change in posture information.
[0038] Optionally, when the roll angle change before and after the automatic guided vehicle switches tracks is less than a first threshold, and / or the pitch angle change is less than a second threshold, the control module is configured to: determine that the automatic guided vehicle has successfully changed tracks.
[0039] Optionally, when the roll angle change before and after the automatic guided vehicle switches tracks is not less than a first threshold, and / or the pitch angle change is not less than a second threshold, the control module is configured to determine that the automatic guided vehicle fails to change tracks.
[0040] Optionally, the control module is configured to: when it is determined that the automatic guided vehicle has failed to change tracks, determine the type of the automatic guided vehicle's track change failure, the type including a first type and a second type, wherein the first type includes a track change failure when the automatic guided vehicle has not reached the preset track change position, and the second type includes a track change failure when the automatic guided vehicle exceeds the preset track change position.
[0041] Optionally, the control module is configured to determine the type of failure of the automatic guided vehicle to change tracks based on the movement direction and posture of the automatic guided vehicle when switching to the second track.
[0042] Optionally, the control module is configured to: when it is determined that the automatic guided vehicle has failed to change tracks, control the automatic guided vehicle to return to a preset recovery position on the first track, and repeat at least part of the operations S11-S16 until it is determined that the automatic guided vehicle has successfully changed tracks.
[0043] The present invention also provides a storage system, comprising:
[0044] An automated guided vehicle as described above;
[0045] The track includes a first track and a second track, on which an RFID electronic tag is arranged;
[0046] a shelf having a magnetic member disposed thereon; and
[0047] A server, communicatively connected to the automatic guided vehicle;
[0048] The automated guided vehicle is configured to perform the control method as described above.
[0049] The present invention also provides a computer-readable storage medium, comprising computer-executable instructions stored thereon, wherein the executable instructions implement the control method as described above when executed by a processor.
[0050] The control method of the present invention can improve the accuracy of the automatic guided vehicle's track detection and the reliability of the automatic guided vehicle, which is beneficial to improving the distribution efficiency and accuracy. BRIEF DESCRIPTION OF THE DRAWINGS
[0051] The accompanying drawings are used to provide a further understanding of the present invention and constitute a part of the specification. Together with the embodiments of the present invention, they are used to explain the present invention and do not constitute a limitation of the present invention. In the accompanying drawings:
[0052] Figure 1 A flow chart of a control method for an automatic guided vehicle according to some embodiments of the present invention is shown.
[0053] Figure 2a A schematic diagram of a track for an automated guided vehicle according to some embodiments of the present invention is shown.
[0054] Figure 2b Schematic diagrams of tracks of automatic guided vehicles according to other embodiments of the present invention are shown.
[0055] Figure 3a A partial schematic diagram of an automatic guided vehicle according to some embodiments of the present invention is shown.
[0056] Figure 3b A partial schematic diagram of an automatic guided vehicle according to some other embodiments of the present invention is shown.
[0057] Figure 4 A schematic diagram of an automated guided vehicle according to some embodiments of the present invention is shown.
[0058] Figure 5 A schematic diagram of a positioning module according to some embodiments of the present invention is shown.
[0059] Figure 6a A partial schematic diagram of a positioning module according to some embodiments of the present invention is shown.
[0060] Figure 6b A partial schematic diagram of a positioning module according to some other embodiments of the present invention is shown.
[0061] Figure 6c A partial schematic diagram of a positioning module according to some further embodiments of the present invention is shown.
[0062] Figure 7 Schematic diagrams of positioning modules according to other embodiments of the present invention are shown.
[0063] Figure 8a and Figure 8b A schematic diagram showing a track change failure of an automatic guided vehicle according to some embodiments of the present invention is shown.
[0064] Figure 9a and Figure 9b Schematic diagrams showing track change failure of an automatic guided vehicle according to other embodiments of the present invention are shown.
[0065] Fig.10a and Fig.10b Schematic diagrams showing track change failure of an automatic guided vehicle according to yet other embodiments of the present invention.
[0066] Fig.11a and Fig.11b Schematic diagrams showing track change failure of an automatic guided vehicle according to yet other embodiments of the present invention.
[0067] Fig.12 A schematic diagram of a storage system according to some embodiments of the present invention is shown. DETAILED DESCRIPTION
[0068] In the following, only some exemplary embodiments are briefly described. As those skilled in the art will appreciate, the described embodiments may be modified in various ways without departing from the spirit or scope of the present invention. Therefore, the drawings and descriptions are considered to be exemplary and non-restrictive in nature.
[0069] In the description of the present invention, it should be understood that the terms "center", "longitudinal", "lateral", "length", "width", "thickness", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside", "clockwise", "counterclockwise" and the like indicate positions or positional relationships based on the positions or positional relationships shown in the accompanying drawings, which are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first" and "second" are only used for descriptive purposes, and cannot be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Thus, the features defined as "first" and "second" may explicitly or implicitly include one or more of the features. In the description of the present invention, the meaning of "multiple" is two or more, unless otherwise clearly and specifically defined.
[0070] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", "connected", and "coupled" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection, an electrical connection, or can communicate with each other; it can be a direct connection, or an indirect connection through an intermediate medium, it can be the internal connection of two elements or the interaction relationship between two elements. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0071] In the present invention, unless otherwise clearly specified and limited, a first feature being "above" or "below" a second feature may include that the first and second features are in direct contact, or may include that the first and second features are not in direct contact but are in contact through another feature between them. Moreover, a first feature being "above", "above" and "above" a second feature includes that the first feature is directly above and obliquely above the second feature, or simply means that the first feature is higher in level than the second feature. A first feature being "below", "below" and "below" a second feature includes that the first feature is directly below and obliquely below the second feature, or simply means that the first feature is lower in level than the second feature.
[0072] Many different embodiments or examples are provided below to realize different structures of the present invention. In order to simplify the present invention, the parts and settings of specific examples are described below. Of course, they are only examples, and the purpose is not to limit the present invention. In addition, the present invention can repeat reference numbers and / or reference letters in different examples, and this repetition is for the purpose of simplicity and clarity, which itself does not indicate the relationship between the various embodiments and / or settings discussed. In addition, the present invention provides various specific processes and examples of materials, but those of ordinary skill in the art can be aware of the application of other processes and / or the use of other materials.
[0073] The preferred embodiments of the present invention are described below in conjunction with the accompanying drawings. It should be understood that the preferred embodiments described herein are only used to illustrate and explain the present invention, and are not used to limit the present invention.
[0074] The invention provides a control method for an automatic guided vehicle. Figure 1 FIG. 1 is a flow chart showing a control method 10 for an automatic guided vehicle according to some embodiments of the present invention. Figure 1 As shown, the control method 10 includes operations S11 to S16. In operation S11, the automatic guided vehicle is controlled to move along the first track. In operation S12, the position information of the automatic guided vehicle is determined. In operation S13, based on the position information, it is determined whether the automatic guided vehicle has reached the preset track-changing position. In operation S14, when it is determined that the automatic guided vehicle has reached the preset track-changing position, the automatic guided vehicle is controlled to switch to the second track. In operation S15, the posture information of the automatic guided vehicle is determined. In operation S16, based on the posture information, it is determined whether the automatic guided vehicle has successfully changed tracks. The control method of the present invention can improve the accuracy of the automatic guided vehicle riding track detection, improve the reliability of the automatic guided vehicle, and help improve the distribution efficiency and accuracy. The following is a detailed introduction.
[0075] Figure 2a Schematic diagram of the track of an automatic guided vehicle according to some embodiments of the present invention is shown. Figure 2a As shown, the track includes a first track R1 and a second track R2. The first track R1 and the second track R2 are arranged in a cross-shaped manner on the same plane. The first track R1 is arranged along the X-axis direction, and the second track R2 is arranged along the Y-axis direction. The first track R1 includes a first sub-track R11 and a second sub-track R12. The second track R2 includes a third sub-track R21 and a fourth sub-track R22. The preset track change position M is located at the center of the intersection area of the first track R1 and the second track R2.
[0076] Figure 2b Schematic diagrams of tracks of automatic guided vehicles according to other embodiments of the present invention are shown. Figure 2b As shown, Figure 2b The track shown is Figure 2aThe tracks shown are essentially the same, except that Figure 2b In the embodiment, the first track R1 is arranged along the Y-axis direction, and the second track R2 is arranged along the X-axis direction.
[0077] Figure 3a FIG. 2 shows a partial schematic diagram of an automatic guided vehicle according to some embodiments of the present invention. Figure 3a As shown, the automatic guided vehicle includes a first wheel set W1 and a second wheel set W2. The first wheel set W1 and the second wheel set W2 are arranged below the body of the automatic guided vehicle. The first wheel set W1 includes wheels W11, W12, W13 and W14. The first wheel set W1 is arranged along the X-axis direction. The second wheel set W2 includes wheels W21, W22, W23 and W24. The second wheel set W2 is arranged along the Y-axis direction. The X-axis and the Y-axis are perpendicular to each other.
[0078] Figure 3b FIG. 2 shows a partial schematic diagram of an automatic guided vehicle according to some other embodiments of the present invention. Figure 3b As shown, Figure 3b and Figure 3a The situation shown is basically the same, except that Figure 3b In the embodiment, the first wheel set W1 is arranged along the Y-axis direction, and the second wheel set W2 is arranged along the X-axis direction.
[0079] When one of the first wheel set W1 and the second wheel set W2 is moving, the other is in an idle state, the one in the idle state is raised to a first preset height, and the other in the moving state is lowered to a second preset height, and the first preset height is greater than the second preset height. For example, when the first wheel set W1 of the automated guided vehicle moves along the first track R1, the second wheel set W2 is in an idle state, the wheels W21, W22, W23 and W24 of the second wheel set W2 are raised to the first preset height, and the wheels W11, W12, W13 and W14 of the first wheel set W1 are lowered to the second preset height.
[0080] In operation S11, the first wheel set W1 of the automatic guided vehicle is controlled to move along the first track R1. Figure 2a and Figure 3a As shown, the wheels W11 to W14 are controlled to move along the X-axis direction on the first track R1. Among them, the wheels W11 and W13 move along the first sub-track R11, and the wheels W12 and W14 move along the second sub-track R12. For another example, Figure 2b and Figure 3b As shown, the wheels W11 to W14 are controlled to move along the Y-axis direction on the first track R1, wherein the wheels W11 and W12 move along the first sub-track R11, and the wheels W13 and W14 move along the second sub-track R12.
[0081] In operation S12, the position information stored in the RFID electronic tag is read by the RFID antenna, the magnetic field strength information is sensed by the magnetic sensor, and the position information of the automatic guided vehicle is determined based on the position information and the magnetic field strength information stored in the RFID electronic tag. Figure 4 Schematic diagram of an automatic guided vehicle 20 according to some embodiments of the present invention is shown. Figure 4 As shown, the automatic guided vehicle 20 includes a positioning module 210, and the positioning module 210 includes an RFID antenna 211 and a magnetic sensor 212, and the RFID antenna 211 and the magnetic sensor 212 are coupled to the control module 230. Operation S12 can be performed by the positioning module 210, which is described in detail below.
[0082] Figure 5 Schematic diagram of a positioning module 210 according to some embodiments of the present invention is shown. The positioning module 210 may be at least partially mounted on the automatic guided vehicle 20. Figure 5 As shown, the positioning module 210 includes a sensor module P1, a positioning control module P2 and a connector L. The connector L connects the sensor module P1 and the positioning control module P2. The sensor module P1 includes an RFID antenna 211 and a magnetic sensor 212. A plurality of magnetic sensors 212 constitute a magnetic sensor group G. The magnetic sensor can sense the magnetic field strength. The positioning control module P2 is connected to the RFID antenna 211 for communication, and is configured to read the first position information stored in the RFID electronic tag through the RFID antenna 211. The positioning control module P2 is also connected to the magnetic sensor 212 for communication, so as to receive the magnetic field strength information output by the magnetic sensor 212 and determine the second position information, and is configured to determine the position of the automatic guided vehicle according to the first position information and the second position information.
[0083] According to one embodiment of the present invention, the positioning control module P2 includes a plurality of sub-control modules, such as the first control module P21, the second control module P22 and the third control module P23 described below. The first control module P21 (for example, through a connector L) is connected to the RFID antenna 211 for communication, and the first control module P21 can read the information of the RFID electronic tag through the RFID antenna 211 (the RFID electronic tag is, for example, fixedly set in the warehouse, such as set on the ground, on the track, on the shelf, etc.), and is configured to read the first position information stored in the RFID electronic tag through the RFID antenna. The second control module P22 (for example, through a connector L) is connected to the magnetic sensor 212 for communication to receive the magnetic field strength information output by the magnetic sensor and determine the second position information. The third control module P23 is connected to the first control module P21 and the second control module P22, and the third control module P23 can be configured to determine the position of the automatic guided vehicle according to the first position information and the second position information, so as to realize the positioning of the automatic guided vehicle.
[0084] In addition, it is easy for those skilled in the art to understand that the connector L is not necessary, and the sensor module P1 and the positioning control module P2 can be directly connected, or the corresponding connection conversion module can be integrated into the sensor module P1 or the positioning control module P2 to achieve communication connection between the two. In addition, the positioning control module P2 can also be integrated into the control module 230. All of these are within the scope of protection of the present invention.
[0085] In the present invention, the positioning control module P2 reads the first position information stored in the RFID electronic tag through the RFID antenna 211, which can be implemented in different ways. For example, according to one embodiment of the present invention, the RFID electronic tag directly encodes and stores the position coordinate information. According to another embodiment of the present invention, the RFID electronic tag stores a unique identification code, and the positioning control module P2 stores a matching table, which contains position coordinates uniquely corresponding to each identification code. Therefore, after the positioning control module P2 reads the identification code stored in the RFID electronic tag, the corresponding position information can be obtained from the matching table as the first position information. These are all within the scope of the present invention.
[0086] like Figure 5 As shown, the connector L includes a coaxial cable L1 and an IIC bus (integrated circuit bus). The coaxial cable L1 connects the RFID antenna 211 and the first control module P21 to transmit the RFID analog signal. The IIC bus connects the magnetic sensor 212 and the second control module P22. The positioning module 210 also includes a first circuit board B1 and a second circuit board B2, the sensor module P1 is arranged on the first circuit board B1, and the positioning control module P2 is arranged on the second circuit board B2. The first circuit board B1 is not copper-coated, which can reduce radio frequency interference and reduce RFID radio frequency signal absorption, which is conducive to improving the accuracy and reliability of the positioning result. The positioning module 210 also includes a non-metallic housing H, and the sensor module P1, the positioning control module P2 and the connector L are located in the non-metallic housing H, which can improve the integration of the positioning module, reduce costs, and improve convenience of use. Although not shown in the figure, it should be understood that the posture detection module 220 can also be integrated with the positioning module 210, and both are arranged in the non-metallic housing H.
[0087] In some embodiments, the RFID antenna 211 includes one or more of a circular shape or a polygonal shape. The magnetic sensor 212 may be disposed inside or outside the RFID antenna 211 . Figure 6a FIG. 2 shows a partial schematic diagram of a positioning module according to some embodiments of the present invention. Figure 6a As shown, the RFID antenna 211 is circular and the magnetic sensor 212 is arranged inside the RFID antenna 211 . Figure 6b FIG. 2 shows a partial schematic diagram of a positioning module according to some other embodiments of the present invention. Figure 6b As shown, the RFID antenna 211 is polygonal, for example, rectangular. The magnetic sensor 212 is disposed inside the RFID antenna 211 . Figure 6c FIG. 2 shows a partial schematic diagram of a positioning module according to some other embodiments of the present invention. Figure 6c As shown, the RFID antenna 211 is a polygon, for example, a rectangle. The magnetic sensor 212 is arranged outside the RFID antenna 211. Although not shown in the figure, the RFID antenna can also be in other shapes such as a triangle, a pentagon, a hexagon, etc.
[0088] like Figures 6a to 6c As shown, the magnetic sensor 212 includes multiple groups of magnetic sensors. For example, the multiple groups of magnetic sensors include a first group of magnetic sensors G1 (central sensor group), a second group of magnetic sensors G2 (second outer magnetic sensor group) and a third group of magnetic sensors G3 (outermost magnetic sensor group). The second group of magnetic sensors 123 are distributed around the outside of the first group of magnetic sensors G1. The third group of magnetic sensors G3 are distributed around the outside of the second group of magnetic sensors G2.
[0089] like Figures 6a to 6c As shown, the magnetic sensor 212 includes nine magnetic sensors. The first group of magnetic sensors G1 includes the first magnetic sensor S1 (magnetic sensor 212). The second group of magnetic sensors G2 includes the second magnetic sensor S2 (magnetic sensor 212), the third magnetic sensor S3 (magnetic sensor 212), the fourth magnetic sensor S4 (magnetic sensor 212) and the fifth magnetic sensor S5 (magnetic sensor 212). The second magnetic sensor S2 and the third magnetic sensor S3 are symmetrically distributed on both sides of the first magnetic sensor S1 along the X axis. For example, the second magnetic sensor S2 is distributed along the positive direction of the X axis, and the third magnetic sensor S3 is distributed along the negative direction of the X axis. The fourth magnetic sensor S4 and the fifth magnetic sensor S5 are symmetrically distributed on both sides of the first magnetic sensor S1 along the Y axis. For example, the fourth magnetic sensor S4 is distributed along the positive direction of the Y axis, and the fifth magnetic sensor S5 is distributed along the negative direction of the Y axis. The third group of magnetic sensors G3 includes the sixth magnetic sensor S6 (magnetic sensor 212), the seventh magnetic sensor S7 (magnetic sensor 212), the eighth magnetic sensor S8 (magnetic sensor 212) and the ninth magnetic sensor S9 (magnetic sensor 212). The sixth magnetic sensor S6 and the seventh magnetic sensor S7 are symmetrically distributed on both sides of the first magnetic sensor S1 along the X axis. For example, the sixth magnetic sensor S6 is distributed along the positive direction of the X axis, and the seventh magnetic sensor S7 is distributed along the negative direction of the X axis. The eighth magnetic sensor S8 and the ninth magnetic sensor S9 are symmetrically distributed on both sides of the first magnetic sensor S1 along the Y axis. For example, the eighth magnetic sensor S8 is distributed along the positive direction of the Y axis, and the ninth magnetic sensor S9 is distributed along the negative direction of the Y axis. The X axis is perpendicular to the Y axis and is the same as the XY coordinate axis of the shelf track.
[0090] like Figure 6a and Figure 6bAs shown, the magnetic sensor 212 is arranged inside the RFID antenna 211, and the first magnetic sensor S1 is distributed at the center of the RFID antenna 211, which is beneficial to improving the accuracy of the positioning result.
[0091] Preferably, a material such as a ferrite film may be attached to the back of the RFID antenna, which is beneficial to improving the RFID signal recognition strength, thereby improving the reliability of the positioning result.
[0092] It should be noted that Figures 6a to 6c The three groups of magnetic sensors, the three groups of magnetic sensors including nine magnetic sensors, and the distribution of the nine magnetic sensors are exemplarily introduced, but the present invention is not limited thereto. In practical applications, the magnetic sensor group may include more or fewer groups of magnetic sensors, each group of magnetic sensors may have other numbers, and each group of magnetic sensors and the distribution of the magnetic sensors in each group may be set according to requirements, all of which are within the protection scope of the present invention.
[0093] According to one embodiment of the present invention, the magnetic sensor group is two groups of magnetic sensors, for example Figures 6a to 6c The first group of magnetic sensors G1 (including the first magnetic sensor S1) and the second group of magnetic sensors G2 (including the second magnetic sensor S2, the third magnetic sensor S3, the fourth magnetic sensor S4 and the fifth magnetic sensor S5) are shown.
[0094] Figure 7 Schematic diagrams of positioning modules 210' according to some other embodiments of the present invention are shown. Some of the same parts of positioning modules 210' and positioning modules 210 are not described here. The following focuses on the differences between positioning modules 210' and positioning modules 210.
[0095] like Figure 7 As shown, the first control module P21 includes an RFID radio unit P211 and an RFID processing unit P212. The RFID radio unit P211 is connected to the RFID antenna 211 through a coaxial cable L1, and is connected to the RFID processing unit P212 through an SPI bus. The RFID processing unit P212 can control the RFID radio unit P211 to read the first location information stored in the RFID electronic tag through the RFID antenna 211.
[0096] In some embodiments, the automatic guided vehicle operates in a storage environment. The RFID electronic tag is, for example, fixedly set in the warehouse, such as set on the ground, on a shelf or on a track. The automatic guided vehicle can move along the track to carry goods. The RFID electronic tag can be set along the track of the automatic guided vehicle, and the RFID electronic tag can store location information (for example, coordinate information or map information, etc.). In addition, the RFID electronic tag can also be set at the center position of the track (not shown in the figure). The RFID processing unit P212 can send a read command (for example, a digital signal and digital logic), and the read command is transmitted to the RFID radio frequency unit P211 via the SPI bus. The RFID radio frequency unit P211 can convert the read command (for example, a digital signal and digital logic) into an RFID analog radio frequency signal. The RFID radio frequency unit P211 can send the read command (for example, an RFID analog radio frequency signal) to the RFID antenna 211 via the coaxial cable L1, and then send it to the RFID electronic tag via the RFID antenna 211. The RFID electronic tag receives a read command (e.g., an RFID analog radio frequency signal), and sends the information stored therein (e.g., location coordinate information, etc., as the first location information) to the RFID radio frequency unit P211 via the RFID antenna 211 and the coaxial cable L1. The RFID radio frequency unit P211 receives (e.g., an RFID analog radio frequency signal) and processes the information (e.g., converts the RFID analog radio frequency signal into a digital signal and digital logic), and sends the processed information (e.g., a digital signal and digital logic) to the RFID processing unit P212 via the SPI bus. The RFID processing unit P212 determines the first location information based on the processed information (e.g., coordinate information). In other words, the RFID radio frequency unit P211 can convert the RFID analog radio frequency signal into a digital signal and digital logic, but is not limited thereto, and can also perform processing operations such as demodulation and encryption, all of which are within the scope of protection of the present invention.
[0097] like Figure 7 As shown, the IIC bus includes a first IIC bus, denoted as IIC1 bus, the second control module P22 includes a magnetic sensor processing unit P222, and the first IIC bus (IIC1 bus) connects the first magnetic sensor S1 and the magnetic sensor processing unit P222.
[0098] like Figure 7As shown, the IIC bus also includes a second IIC bus and a third IIC bus, which are respectively recorded as IIC2 bus and IIC3 bus. The second control module P22 also includes a first switching module T1 and a second switching module T2. The first switching module T1 is connected to the second group of magnetic sensors G2 and the magnetic sensor processing unit P222 through the second IIC bus (IIC2 bus). The second switching module T2 is connected to the third group of magnetic sensors G3 and the magnetic sensor processing unit P222 through the third IIC bus (IIC3 bus). The first switching module T1 can select a magnetic sensor that communicates with the magnetic sensor processing unit P222 from the second group of magnetic sensors G2, and one or more magnetic sensors can be selected. Similarly, the second switching module T2 can select a magnetic sensor that communicates with the magnetic sensor processing unit P222 from the third group of magnetic sensors G3, and one or more magnetic sensors can also be selected. In other words, the first switching module T1 can select a magnetic sensor that communicates with the magnetic sensor processing unit P222 from the second magnetic sensor S2, the third magnetic sensor S3, the fourth magnetic sensor S4 and the fifth magnetic sensor S5. The second switching module T2 can select a magnetic sensor from among the sixth magnetic sensor S6, the seventh magnetic sensor S7, the eighth magnetic sensor S8 and the ninth magnetic sensor S9 to communicate with the magnetic sensor processing unit P222.
[0099] Figure 7 2 shows that the second control module P22 includes a first switching module T1 and a second switching module T2, wherein the number of the switching modules corresponds to the number of magnetic sensor groups minus 1. Figure 7 As shown, the magnetic sensor group G includes three groups of magnetic sensors (a first group of magnetic sensors G1, a second group of magnetic sensors G2, and a third group of magnetic sensors G3), and the second control module P22 includes two switching modules, namely a first switching module T1 and a second switching module T2. For another example, when the magnetic sensor 212 includes only two groups of magnetic sensors (a first group of magnetic sensors G1 and a second group of magnetic sensors G2), the second control module P22 only includes the first switching module T1, and does not need to include the second switching module T2. It is easy for those skilled in the art to understand that the first switching module T1 and the second switching module T2 can also be integrated into a switching module to realize the gating of one or more magnetic sensors in the second group of magnetic sensors G2 and the third group of magnetic sensors G3. This is particularly advantageous when it is not necessary to simultaneously gate the second group of magnetic sensors G2 and the third group of magnetic sensors G3.
[0100] In some embodiments, the first switching module T1 and the second switching module T2 may include a switch, which may be a mechanical switch or a semiconductor switch, and the present invention is not limited thereto. The magnetic sensor processing unit P222 realizes the gating of the magnetic sensor by controlling the on or off of the switch of the first switching module T1 and / or the second switching module T2.
[0101] In some embodiments, the positioning module further includes a magnetic member (eg, Fig.12 The magnetic member 41 in the figure). The magnetic member can be arranged on a shelf, on the ground or on a track in the surrounding environment of the automatic guided vehicle. For example, the magnetic member can be arranged on a side close to the automatic guided vehicle. The present invention does not limit the number of magnetic members. One shelf can be provided with one or more magnetic members. The magnetic members include but are not limited to magnets, magnetic sheets, magnetic strips, magnetic blocks, magnetic nails, etc. The magnetic member can be stacked with the RFID electronic tag and placed in one place (for example, on a track). The magnetic sensor can be arranged on the side of the body of the automatic guided vehicle close to the shelf to facilitate sensing the magnetic field strength of the magnetic member, which is conducive to accurate positioning.
[0102] Each magnetic sensor can sense the magnetic field strength and send the sensed value to the magnetic sensor processing unit. For example, the first magnetic sensor S1 can sense the first magnetic field strength M1 of the magnetic part, and send the first magnetic field strength M1 to the magnetic sensor processing unit P222 through the IIC1 bus. The first switching module T1 can select one of the magnetic sensors in the second group of magnetic sensors G2 to communicate with the magnetic sensor processing unit P222, and the magnetic sensor can sense the second magnetic field strength M2 of the magnetic part. For example, the first switching module T1 selects the second magnetic sensor S2 to communicate with the magnetic sensor processing unit P222, and the second magnetic sensor S2 can sense the second magnetic field strength M2 of the magnetic part, and can send the second magnetic field strength M2 to the magnetic sensor processing unit P222 through the IIC2 bus. Similarly, the second switching module T2 can select one of the magnetic sensors in the third group of magnetic sensors G3 to communicate with the magnetic sensor processing unit P222, and the magnetic sensor can sense the third magnetic field strength M3 of the magnetic part. For example, the second switching module T2 selects the seventh magnetic sensor S7 to communicate with the magnetic sensor processing unit P222. The seventh magnetic sensor S7 can sense the third magnetic field strength M3 of the magnetic component and send the third magnetic field strength M3 to the magnetic sensor processing unit P222 through the IIC3 bus.
[0103] In some embodiments, the posture detection module 220 and the positioning module 210 can be integrated into one. The IMU can be coupled to the magnetic sensor processing unit P222 and installed at the center of gravity of the automatic guided vehicle to measure the motion data (e.g., angular velocity and acceleration) of the automatic guided vehicle. The magnetic sensor processing unit P222 can determine the motion posture and motion direction of the automatic guided vehicle based on the motion data measured by the IMU. The magnetic sensor processing unit P222 can control the operation of the first switching module T1 and / or the second switching module T2 based on the motion direction of the automatic guided vehicle. For example, Figures 6a to 6cAs shown, the automatic guided vehicle moves along the positive direction of X, and the magnetic sensor processing unit P222 can control the first switching module T1 to select the second magnetic sensor S2 to sense the second magnetic field strength M2, control the second switching module T2 to select the sixth magnetic sensor S6 to sense the third magnetic field strength M3, and control the second magnetic sensor S2 to send the measured second magnetic field strength M2 to the magnetic sensor processing unit P222 through the IIC2 bus, and control the sixth magnetic sensor S6 to send the measured third magnetic field strength M3 to the magnetic sensor processing unit P222 through the IIC3 bus.
[0104] According to one embodiment of the present invention, the positioning control module P2 is configured to: select a magnetic sensor located in front of the first group of magnetic sensors (along the direction of travel) from the second group or the third group of magnetic sensors; detect the magnetic field strength information output by the selected magnetic sensor; when the output magnetic field strength information reaches a peak value, determine the second position information, wherein the second position information includes the alignment of the selected magnetic sensor with the magnetic part; determine the position of the automatic guided vehicle based on the first position information and the position of the selected magnetic sensor on the automatic guided vehicle.
[0105] Preferably, the third control module P23 is connected to the RFID processing unit P212 and the magnetic sensor processing unit P222, for example, by an RS422 bus, but not limited thereto. The third control module P23 can control the RFID processing unit P212 and the magnetic sensor processing unit P222 to work simultaneously to determine the first position information and the second position information, and determine the position of the automatic guided vehicle according to the first position information and the second position information, which is conducive to improving the real-time positioning and the accuracy of the positioning result.
[0106] Specifically, the magnetic sensor processing unit P222 is configured to: control the first switching module T1 to select a magnetic sensor located in front of the first group of magnetic sensors G1 from the second group of magnetic sensors 122 and / or control the second switching module T2 to select a magnetic sensor located in front of the first group of magnetic sensors G1 from the third group of magnetic sensors 123; detect whether the magnetic field strength information output by the selected magnetic sensor reaches a peak value; when it is determined that the output magnetic field strength information reaches a peak value, determine the second position information, and the second position information includes the alignment of the selected magnetic sensor with the magnetic member. The third control module P23 is configured to: determine the position of the automatic guided vehicle according to the first position information and the position of the selected magnetic sensor on the automatic guided vehicle.
[0107] According to an embodiment of the present invention, the magnetic sensor processing unit P222 selects a magnetic sensor in the second group of magnetic sensors G2 through the first switching module T1, and determines the second position information according to the magnetic field strength information output by the selected magnetic sensor, which is described in detail below.
[0108] Preferably, the first position information stored in the RFID antenna 211 is the coordinate position of the magnetic component. When it is determined that the automatic guided vehicle moves in the positive direction of X, the second magnetic sensor S2 can be selected (because the second magnetic sensor S2 is located in front of the first magnetic sensor S1 along the forward direction), and the magnetic field strength signal output by the second magnetic sensor S2 is continuously monitored. When the magnetic field strength signal output by the second magnetic sensor S2 reaches a maximum value, it can be determined that the second magnetic sensor S2 is basically aligned with the magnetic component (aligned in the Y direction), that is, the second position information is determined. Since the second magnetic sensor S2 is fixedly arranged on the automatic guided vehicle, the third control module P23 can determine the position of any point on the automatic guided vehicle according to the coordinate position of the magnetic component (from the RFID antenna 211) and the position of the second magnetic sensor S2 on the automatic guided vehicle. For example, assuming that the position of the first magnetic sensor S1 is used as the position of the automatic guided vehicle, the coordinate position of the magnetic part is (x1, y1), and the position (or distance) of the second magnetic sensor S2 relative to the first magnetic sensor is d (along the X direction), then the coordinate of the first magnetic sensor S1 along the X direction is (x1-d) (when the automatic guided vehicle runs on the track, its y coordinate is limited by the track, so the Y coordinate is not concerned).
[0109] The positioning module of the present invention determines the first position information by reading the information of the RFID electronic tag through the RFID antenna, determines the second position information through the magnetic field strength, and determines the position of the automatic guided vehicle through the first position information and the second position information, thereby realizing the positioning of the automatic guided vehicle. Compared with the prior art, the recognition speed is faster, the anti-interference ability is stronger, it is not easy to be dirty and damaged, and the recognition result is more accurate, which can improve the effectiveness, accuracy and reliability of the positioning result, and is conducive to the automatic guided vehicle to perform the distribution task more accurately and efficiently.
[0110] Next, the control method 10 will be described.
[0111] In some embodiments, in operation S13, the position coordinate information of the automatic guided vehicle can be compared with the coordinate information of the preset track switching position. When the two match (for example, the position coordinate information of the automatic guided vehicle is the same as the coordinate information of the preset track switching position, or is substantially the same within an allowable error range), it is determined that the automatic guided vehicle has reached the preset track switching position. Conversely, when the two do not match, it is determined that the automatic guided vehicle has not reached the preset track switching position.
[0112] In operation S14, when it is determined that the automatic guided vehicle reaches the preset track switching position M, the automatic guided vehicle can be controlled to switch from the first track R1 to the second track R2. Figures 2a to 3bAs shown, the first wheel group W1 (for example, wheels W11, W12, W13 and W14) can be controlled to be lifted to a first preset height, and the second wheel group W2 (for example, W21, W22, W23 and W24) can be controlled to be lowered to a second preset height to control the automatic guided vehicle to switch to the second track R2. It should be understood that since the automatic guided vehicle has a certain jitter when moving along the track, there may be a certain error in the result of determining whether the automatic guided vehicle has reached the preset track switching position. For example, the automatic guided vehicle may misjudge that it has not reached the preset track switching position as reaching the preset track switching position, and it may also misjudge that it has exceeded the preset track switching position as reaching the preset track switching position, which will cause the automatic guided vehicle to ride abnormally after switching tracks. The abnormal riding of the track is the phenomenon that the wheels that should be along the track step on empty air.
[0113] In operation S15, the attitude information of the automatic guided vehicle can be determined by an inertial measurement unit (IMU) and an inertial navigation strapdown algorithm. In operation S16, the attitude information change before and after the automatic guided vehicle switches tracks is compared, and based on the attitude information change, it is determined whether the automatic guided vehicle has successfully changed tracks. The attitude information includes a roll angle and / or a pitch angle. When the roll angle change before and after the automatic guided vehicle switches tracks is less than a first threshold, and / or the pitch angle change is less than a second threshold, it is determined that the automatic guided vehicle has successfully changed tracks. In other words, when the roll angle change before and after the automatic guided vehicle switches tracks is less than the first threshold, it is determined that the automatic guided vehicle has successfully changed tracks. Or when the pitch angle change before and after the automatic guided vehicle switches tracks is less than the second threshold, it is determined that the automatic guided vehicle has successfully changed tracks. Or when the roll angle change before and after the automatic guided vehicle switches tracks is less than the first threshold, and the pitch angle change is less than the second threshold, it is determined that the automatic guided vehicle has successfully changed tracks.
[0114] When the automatic guided vehicle successfully changes tracks, the second wheel set can move along the second track. Figure 2a and Figure 3a As shown, when the automatic guided vehicle successfully switches from the first track R1 (i.e., the X direction) to the second track R2 (i.e., the Y direction), the second wheel set W2 can move along the second track R2 on the Y axis. Specifically, wheels W21 and W22 move along the third sub-track R21, and wheels W23 and W24 move along the fourth sub-track R22.
[0115] For example, Figure 2b and Figure 3b As shown, when the automatic guided vehicle successfully switches from the first track R1 (i.e., the Y direction) to the second track R2 (i.e., the X direction), the second wheel set W2 can move along the second track R2 on the X axis. Specifically, wheels W21 and W23 move along the third sub-track R21, and wheels W22 and W24 move along the fourth sub-track R22.
[0116] When the change in the roll angle before and after the automatic guided vehicle switches tracks is not less than a first threshold, and / or the change in the pitch angle is not less than a second threshold, it is determined that the automatic guided vehicle has failed to change tracks. In other words, when the change in the roll angle before and after the automatic guided vehicle switches tracks is not less than the first threshold, it is determined that the automatic guided vehicle has failed to change tracks. When the change in the pitch angle before and after the automatic guided vehicle switches tracks is not less than the second threshold, it is determined that the automatic guided vehicle has failed to change tracks. When the change in the roll angle before and after the automatic guided vehicle switches tracks is not less than the first threshold, and the change in the pitch angle is not less than the second threshold, it is determined that the automatic guided vehicle has failed to change tracks.
[0117] In some embodiments, the control method further includes: when determining that the automatic guided vehicle fails to change tracks, determining the type of the automatic guided vehicle failure to change tracks. The type includes a first type and a second type. The first type includes the automatic guided vehicle failing to change tracks when it does not reach the preset track change position (for example, Figure 8a , Figure 8b , Fig.10a , Fig.10b The second type includes failure of the automatic guided vehicle to change track when it exceeds the preset track change position (for example, Figure 9a , Figure 9b , Fig.11a , Fig.11b indicative).
[0118] An embodiment of the failure of the automatic guided vehicle to change track is described in detail below.
[0119] Figure 8a and Figure 8b Schematic diagram of track change failure of an automatic guided vehicle according to some embodiments of the present invention is shown. Figure 2a , Figure 3a , Figure 4 , Figure 8a and Figure 8b As shown, when the automatic guided vehicle 20 does not reach the preset track changing position M, it switches from the first track R1 (X direction) to the second track R2 (Y direction). The automatic guided vehicle 20 will move along the negative direction of the Y axis in the future. The wheels W23 and W24 can switch to the fourth sub-track R22. The wheels W21 and W22 (step on air) cannot switch to the third sub-track R21, and the automatic guided vehicle 20 deflects to the positive direction of X.
[0120] Figure 9a and Figure 9b Schematic diagrams showing failure of track change of an automatic guided vehicle according to other embodiments of the present invention are shown. Figure 2a , Figure 3a , Figure 4 , Figure 9a and Figure 9bAs shown, when the automatic guided vehicle 20 exceeds the preset track changing position M, it switches from the first track R1 (X direction) to the second track R2 (Y direction), and the automatic guided vehicle 20 will move along the negative direction of the Y axis in the future. The wheels W23 and W24 (stepping on air) cannot switch to the fourth sub-track R22, and the wheels W21 and W22 can switch to the third sub-track R21, and the automatic guided vehicle 20 deflects to the negative direction of the X axis.
[0121] Fig.10a and Fig.10b Schematic diagram of track change failure of an automatic guided vehicle according to some embodiments of the present invention is shown. Figure 2b , Figure 3b , Figure 4 , Fig.10a and Fig.10b As shown, when the automatic guided vehicle 20 has not reached the preset track changing position M, it switches from the first track R1 (Y direction) to the second track R2 (X direction). The automatic guided vehicle 20 will move along the negative direction of the X-axis in the future. The wheels W21 and W23 can switch to the third sub-track R21, and the wheels W22 and W24 (stepping on air) cannot switch to the fourth sub-track R22. The automatic guided vehicle 20 deflects to the negative direction of the Y-axis.
[0122] Fig.11a and Fig.11b Schematic diagrams showing failure of track change of an automatic guided vehicle according to other embodiments of the present invention are shown. Figure 2b , Figure 3b , Figure 4 , Fig.11a and Fig.11b As shown, when the automatic guided vehicle 20 exceeds the preset track changing position M, it switches from the first track R1 (Y direction) to the second track R2 (X direction), and the automatic guided vehicle 20 will move along the negative direction of the X-axis in the future. The wheels W22 and W24 can switch to the fourth sub-track R22, and the wheels W21 and W23 (stepping on air) cannot switch to the third sub-track R21, and the automatic guided vehicle 20 deflects to the positive direction of the Y-axis.
[0123] In some embodiments, the operation of determining the type of failure of the automated guided vehicle to change tracks includes: determining the type of failure of the automated guided vehicle to change tracks based on the movement direction and posture of the automated guided vehicle when switching to the second track.
[0124] For example, Figure 8a and Figure 8b As shown, the automatic guided vehicle 20 switches to the second track R2 and moves along the negative direction of the Y axis, and the automatic guided vehicle 20 deflects to the positive direction of the X axis. It can be seen that the automatic guided vehicle 20 fails to reach the preset track change position, resulting in a track change failure, that is, the track change failure type is the first type.
[0125] For example, Fig.10a and Fig.10b As shown, the automatic guided vehicle 20 switches to the second track R2 and moves along the negative direction of the X-axis, and the automatic guided vehicle 20 deflects toward the negative direction of the Y-axis. It can be seen that the type of track change failure of the automatic guided vehicle 20 is the first type.
[0126] For example, Figure 9a and Figure 9b As shown, the automatic guided vehicle 20 switches to the second track R2 and moves along the negative direction of the Y axis, and the automatic guided vehicle 20 deflects to the negative direction of the X axis. It can be seen that the automatic guided vehicle 20 exceeds the preset track change position, resulting in track change failure, that is, the track change failure type is the second type.
[0127] For example, Fig.11a and Fig.11b As shown, the automatic guided vehicle 20 switches to the second track R2 and moves along the negative direction of the X-axis, and the automatic guided vehicle 20 deflects toward the positive direction of the Y-axis. It can be seen that the automatic guided vehicle 20 exceeds the preset track change position, resulting in track change failure, that is, the track change failure type is the second type.
[0128] Based on the movement direction and posture of the automatic guided vehicle switching to the second track, the type of failure of the automatic guided vehicle switching track can be determined, which is conducive to the recovery of the posture of the automatic guided vehicle.
[0129] In some embodiments, the control method further includes: when it is determined that the automatic guided vehicle fails to change tracks, controlling the automatic guided vehicle to return to a preset recovery position of the first track, and repeating at least part of the operations S11-S16 until it is determined that the automatic guided vehicle succeeds in changing tracks.
[0130] For example, Figure 2a , Figure 3a , Figure 4 , Figure 8a and Figure 8bAs shown, when the automatic guided vehicle 20 fails to change tracks (X to Y), the wheels W21 and W22 in the second wheel group W2 are empty, and the second wheel group W2 cannot be switched to the second track R2 normally. However, since the automatic guided vehicle 20 moves normally along the first track R1 before changing tracks, that is, the first wheel group W1 moves normally along the first track R1 before changing tracks. Preferably, the automatic guided vehicle 20 can restore its posture by the first wheel group W1 that moves normally on the first track R1 before changing tracks. It should be understood that before switching to the second track R2, the first wheel group W1 can move normally along the first track R1, that is, the first wheel group W1 is aligned with the first track R1, so the posture of the automatic guided vehicle can be restored with the help of the first wheel group W1 and the first track R1. Specifically, the second wheel group W2 can be controlled to be lifted to a first preset height, and the first wheel group W1 can be controlled to be lowered to a second preset height, so that the first wheel group W1 is switched to the first track R1, and the first wheel group W1 is controlled to move along the first track R1 to move in the negative direction of the X axis (operation S11). The position information of the automatic guided vehicle 20 is determined by the positioning module 210 (operation S12) until it is determined that the automatic guided vehicle 20 has returned to the preset recovery position of the first track R1. When the automatic guided vehicle 20 returns to the preset recovery position, the posture of the automatic guided vehicle 20 can be determined to be restored to normal. Preferably, the posture of the automatic guided vehicle 20 can also be detected, and when the roll angle of the automatic guided vehicle is less than the third threshold, and / or the pitch angle is less than the fourth threshold, it is determined that the posture of the automatic guided vehicle has been successfully restored. It should be noted that the present invention does not limit the specific values and size relationships of the first threshold, the second threshold, the third threshold and the fourth threshold, and can be set according to needs. Here only Figure 8a and Figure 8b The example of track change failure shown in the figure is used as an example to introduce how to restore the posture of the automatic guided vehicle. It should be understood that for Figures 9a to 11b The example of track change failure described is similar and will not be repeated here.
[0131] After the posture of the automatic guided vehicle is restored, operations S11-S16 may be repeatedly performed until the automatic guided vehicle successfully changes tracks.
[0132] In some embodiments, the automatic guided vehicle can be provided with a track-changing switch (not shown), and the track-changing switch can be coupled to the control module 230. The track-changing switch can be provided separately or integrated into the control module 230 to turn on or off the track-changing function. Preferably, when the automatic guided vehicle reaches the preset track-changing position, the control module 230 can control the track-changing switch to be turned on so as to turn on the track-changing function. When the automatic guided vehicle leaves the preset track-changing position, the control module 230 can control the track-changing switch to be turned off so as to turn off the track-changing function. The track-changing switch can include a mechanical switch or a semiconductor switch. It should be understood that the track-changing switch is not necessary, and the turning on or off of the track-changing function can also be performed by the control module 230. These are all within the protection scope of the present invention.
[0133] The control method of the present invention can not only control the track changing of the automatic guided vehicle, but also detect whether the track changing is successful. When the track changing fails, the automatic guided vehicle can be controlled to restore its posture, which can improve the accuracy of the automatic guided vehicle's track riding detection and the reliability of the automatic guided vehicle, which is beneficial to improving the distribution efficiency and accuracy.
[0134] The invention also provides an automatic guided vehicle. Figure 4 Schematic diagram of an automatic guided vehicle 20 according to some embodiments of the present invention is shown. Figure 4 As shown, the automatic guided vehicle includes a positioning module 210, a posture detection module 220 and a control module 230. The positioning module 210 can determine the position information of the automatic guided vehicle. The posture detection module 220 can determine the posture information of the automatic guided vehicle. The control module 230 is coupled to the positioning module 210 and the posture detection module 220, and can execute the control method 10 and any operation thereof.
[0135] In some embodiments, the first track and the second track are arranged in a cross shape on the same plane, and the preset track change position is located at the center of the intersection area of the first track and the second track.
[0136] In some embodiments, the automatic guided vehicle includes a first wheel set, and the first wheel set is disposed below the body of the automatic guided vehicle; the control module is configured to: control the first wheel set to move along the first track.
[0137] In some embodiments, the positioning module includes an RFID antenna and a magnetic sensor, and the control module is configured to: read the location information stored in the RFID electronic tag through the RFID antenna, sense the magnetic field strength information through the magnetic sensor, and determine the location information of the automatic guided vehicle based on the location information stored in the RFID electronic tag and the magnetic field strength information.
[0138] In some embodiments, the automatic guided vehicle includes a second wheel group, and the second wheel group is arranged below the body of the automatic guided vehicle; the control module is configured to: control the first wheel group to be lifted to a first preset height, and control the second wheel group to be lowered to a second preset height, so as to control the automatic guided vehicle to switch to the second track.
[0139] In some embodiments, the attitude detection module includes an inertial measurement unit, and the attitude detection module is configured to: determine the attitude information of the automatic guided vehicle through the inertial measurement unit and an inertial navigation strapdown algorithm, wherein the attitude information includes a roll angle and / or a pitch angle.
[0140] In some embodiments, the control module is configured to compare the change in posture information of the automatic guided vehicle before and after switching tracks, and determine whether the automatic guided vehicle has successfully switched tracks based on the change in posture information.
[0141] In some embodiments, when the roll angle change before and after the automatic guided vehicle switches tracks is less than a first threshold, and / or the pitch angle change is less than a second threshold, the control module is configured to determine that the automatic guided vehicle has successfully changed tracks.
[0142] In some embodiments, when the roll angle change before and after the automatic guided vehicle switches tracks is not less than a first threshold, and / or the pitch angle change is not less than a second threshold, the control module is configured to: determine that the automatic guided vehicle has failed to change tracks.
[0143] In some embodiments, the control module is configured to: when determining that the automated guided vehicle has failed to change tracks, determine the type of the automated guided vehicle's track change failure, the type including a first type and a second type, wherein the first type includes a track change failure when the automated guided vehicle has not reached the preset track change position, and the second type includes a track change failure when the automated guided vehicle exceeds the preset track change position.
[0144] In some embodiments, the control module is configured to determine the type of track switching failure of the automated guided vehicle based on the movement direction and posture of the automated guided vehicle when switching to the second track.
[0145] In some embodiments, the control module is configured to: when it is determined that the automatic guided vehicle has failed to change tracks, control the automatic guided vehicle to return to a preset recovery position on the first track, and repeat at least part of the operations S11-S16 until it is determined that the automatic guided vehicle has successfully changed tracks.
[0146] The present invention also provides a storage system 30. Fig.12 Schematic diagram of a storage system 30 according to some embodiments of the present invention is shown. Fig.12As shown, the storage system 30 includes an automatic guided vehicle 20, a track, a shelf 40 and a server 50. The automatic guided vehicle 20 can execute the control method 10. The track includes a first track R1 and a second track R2, on which an RFID electronic tag T is arranged to determine the first position of the automatic guided vehicle 20. The first track R1 includes a first sub-track R11 and a second sub-track R12. The second track R2 includes a third sub-track R21 and a fourth sub-track R22. A magnetic member 41 is arranged on the shelf 40 to determine the second position of the automatic guided vehicle 20. It should be noted that the magnetic member 41 can be stacked with the RFID electronic tag T on the track. The shelf 40 can be set close to the track. The server 50 is connected to the automatic guided vehicle 20 in communication and can serve as the dispatching center of the entire storage system 30 to control the work of the automatic guided vehicle 20. The server 50 can be a physical server or a cloud server. The present invention does not limit the number of tracks, shelves, RFID electronic tags, and magnetic members in the storage system. In practical applications, they can be set according to needs.
[0147] It should be noted that any embodiments or combinations of the control method, automated guided vehicle, and storage system of the present invention can be applied to each other. The automated guided vehicle and storage system of the present invention can achieve the same or similar technical effects as the control method, which will not be described in detail here.
[0148] The present invention also provides a computer-readable storage medium, comprising computer-executable instructions stored thereon, wherein the executable instructions implement the control method as described above when executed by a processor.
[0149] In some embodiments, a computer readable storage medium may be any tangible medium containing or storing a program that may be used by or in combination with an instruction execution system, apparatus, or device. Computer readable storage media include, but are not limited to, electrical, magnetic, optical, or semiconductor forms or devices, more specific examples (a non-exhaustive list) include: an electrical connection with one or more conductors, a portable computer hard disk, a hard disk, a random access memory (RAM), a non-volatile random access memory (NVRAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above.
[0150] In some embodiments, the control method of the present disclosure may exist in the form of program code. The program code may be contained in a physical medium, such as a floppy disk, a CD, a hard disk, or any other machine-readable (such as computer-readable) storage medium, or a computer program product not limited to an external form, wherein when the program code is loaded and executed by a machine, such as a computer, the machine becomes a device for participating in the present disclosure. The program code may also be transmitted through some transmission media, such as wires or cables, optical fibers, or any transmission type, wherein when the program code is received, loaded and executed by a machine, such as a computer, the machine becomes a device for participating in the present disclosure. When actually operated on a general-purpose processing unit, the program code combines with the processing unit to provide a unique device that operates similarly to an application-specific logic circuit.
[0151] In some embodiments, the control module / processor / processing unit / server may include a central processing unit (CPU), a microprocessing unit (MCU), and may also include other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components and other similar devices.
[0152] It should be noted that this specification provides method operation steps as described in the embodiments or schematic diagrams, but more or fewer operation steps may be included based on conventional or non-creative labor. The order of steps listed in the embodiments is only one way of executing the order of many steps and does not represent the only execution order. When the actual system or device product is executed, it can be executed in the order or in parallel according to the method shown in the embodiments or flowcharts.
[0153] It should be noted that, although several modules of the positioning module / automatic guided vehicle are mentioned in the above detailed description, this division is not mandatory. In fact, according to the embodiments of the present disclosure, the features and functions of two or more modules described above can be implemented in one module. Conversely, the features and functions of one module described above can be further divided into multiple modules to be embodied.
[0154] Finally, it should be noted that the above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art can still modify the technical solutions described in the aforementioned embodiments or replace some of the technical features therein by equivalents. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.
Claims
1. A control method for an automatic guided vehicle, include: S11: controlling the automatic guided vehicle to move along the first track; S12: Determine the position information of the automatic guided vehicle; S13: Based on the position information, determining whether the automatic guided vehicle has reached a preset track switching position; S14: When it is determined that the automatic guided vehicle reaches the preset track switching position, controlling the automatic guided vehicle to switch to the second track; S15: Determine the posture information of the automatic guided vehicle; and S16: Based on the posture information, determine whether the automatic guided vehicle has successfully changed tracks.
2. The control method according to claim 1, wherein the first track and the second track are arranged in a cross shape on the same plane, and the preset track change position is located at the center of the intersection area of the first track and the second track.
3. The control method according to claim 1 or 2, wherein the automatic guided vehicle comprises a first wheel set, and the first wheel set is arranged below the body of the automatic guided vehicle; the operation S11 include: The first wheel set is controlled to move along the first track.
4. The control method according to claim 1 or 2, wherein the operation S12 include: The position information stored in the RFID electronic tag is read by the RFID antenna, the magnetic field strength information is sensed by the magnetic sensor, and the position information of the automatic guided vehicle is determined based on the position information stored in the RFID electronic tag and the magnetic field strength information.
5. The control method according to claim 3, wherein the automatic guided vehicle comprises a second wheel set, and the second wheel set is arranged below the body of the automatic guided vehicle; wherein the operation S14 include: The first wheel set is controlled to be raised to a first preset height, and the second wheel set is controlled to be lowered to a second preset height, so as to control the automatic guided vehicle to switch to the second track.
6. The control method according to claim 5, wherein the operation S15 include: The attitude information of the automatic guided vehicle is determined by an inertial measurement unit and an inertial navigation strapdown algorithm, wherein the attitude information includes a roll angle and / or a pitch angle.
7. The control method according to claim 6, wherein the operation S16 include: Compare the amount of change in posture information of the automatic guided vehicle before and after switching tracks, and determine whether the automatic guided vehicle has successfully switched tracks based on the amount of change in posture information.
8. The control method according to claim 7, wherein the operation of determining whether the automatic guided vehicle has successfully changed tracks is based on the change amount of the posture information. include: When the roll angle change before and after the automatic guided vehicle switches tracks is less than a first threshold, and / or the pitch angle change is less than a second threshold, it is determined that the automatic guided vehicle has successfully switched tracks.
9. The control method according to claim 7, wherein the operation of determining whether the automatic guided vehicle has successfully changed tracks is based on the change amount of the posture information. include: When the roll angle change before and after the automatic guided vehicle switches tracks is not less than a first threshold, and / or the pitch angle change is not less than a second threshold, it is determined that the automatic guided vehicle has failed to switch tracks.
10. The control method according to claim 7, further comprising: include: When it is determined that the automatic guided vehicle has failed to change tracks, the type of the automatic guided vehicle's track change failure is determined, the type including a first type and a second type, wherein the first type includes a track change failure when the automatic guided vehicle has not reached the preset track change position, and the second type includes a track change failure when the automatic guided vehicle exceeds the preset track change position.
11. The control method according to claim 10, wherein the operation of determining the type of failure of the automatic guided vehicle to change tracks is include: The type of failure of the automatic guided vehicle in switching tracks is determined based on the movement direction and posture of the automatic guided vehicle when switching to the second track.
12. The control method according to claim 7, further comprising: include: When it is determined that the automatic guided vehicle fails to change tracks, the automatic guided vehicle is controlled to return to a preset recovery position of the first track, and at least part of the operations S11-S16 are repeatedly performed until it is determined that the automatic guided vehicle succeeds in changing tracks.
13. An automatic guided vehicle, include: A positioning module configured to determine the position information of the automatic guided vehicle; a posture detection module configured to determine posture information of the automatic guided vehicle; A control module is coupled to the positioning module and the posture detection module, and is configured to perform the following operations: S11: controlling the automatic guided vehicle to move along the first track; S12: Determine the position information of the automatic guided vehicle; S13: Based on the position information, determining whether the automatic guided vehicle has reached a preset track switching position; S14: When it is determined that the automatic guided vehicle reaches the preset track switching position, controlling the automatic guided vehicle to switch to the second track; S15: Determine the posture information of the automatic guided vehicle; and S16: Based on the posture information, determine whether the automatic guided vehicle has successfully changed tracks.
14. The automatic guided vehicle according to claim 13, wherein the first track and the second track are arranged in a cross shape on the same plane, and the preset track change position is located at the center of the intersection area of the first track and the second track.
15. The automatic guided vehicle according to claim 13 or 14, wherein the automatic guided vehicle comprises a first wheel set, and the first wheel set is arranged below the body of the automatic guided vehicle; the control module is configured to: control the first wheel set to move along the first track.
16. The automatic guided vehicle according to claim 13 or 14, wherein the positioning module comprises an RFID antenna and a magnetic sensor, and the control module is configured to: read the location information stored in the RFID electronic tag through the RFID antenna, sense the magnetic field strength information through the magnetic sensor, and determine the location information of the automatic guided vehicle based on the location information stored in the RFID electronic tag and the magnetic field strength information.
17. The automatic guided vehicle according to claim 15, wherein the automatic guided vehicle comprises a second wheel group, and the second wheel group is arranged below the body of the automatic guided vehicle; the control module is configured to: control the first wheel group to be lifted to a first preset height, and control the second wheel group to be lowered to a second preset height, so as to control the automatic guided vehicle to switch to the second track.
18. The automatic guided vehicle according to claim 17, wherein the attitude detection module comprises an inertial measurement unit, and the attitude detection module is configured to: determine the attitude information of the automatic guided vehicle through the inertial measurement unit and an inertial navigation strapdown algorithm, wherein the attitude information comprises a roll angle and / or a pitch angle.
19. The automatic guided vehicle according to claim 18, wherein the control module is configured to compare the change in posture information of the automatic guided vehicle before and after switching tracks, and determine whether the automatic guided vehicle has successfully switched tracks based on the change in posture information.
20. The automated guided vehicle according to claim 19, wherein when the roll angle change before and after the automated guided vehicle switches tracks is less than a first threshold, and / or the pitch angle change is less than a second threshold, the control module is configured to: determine that the automated guided vehicle has successfully changed tracks.
21. The automated guided vehicle according to claim 19, wherein when the roll angle change before and after the automated guided vehicle switches tracks is not less than a first threshold, and / or the pitch angle change is not less than a second threshold, the control module is configured to: determine that the automated guided vehicle has failed to change tracks.
22. The automated guided vehicle according to claim 19, wherein the control module is configured to: when determining that the automated guided vehicle has failed to change tracks, determine the type of the automated guided vehicle's track change failure, the type comprising a first type and a second type, wherein the first type comprises a track change failure when the automated guided vehicle has not reached the preset track change position, and the second type comprises a track change failure when the automated guided vehicle exceeds the preset track change position.
23. The automated guided vehicle of claim 22, wherein the control module is configured to determine the type of track switching failure of the automated guided vehicle based on the movement direction and posture of the automated guided vehicle when switching to the second track.
24. The automated guided vehicle according to claim 19, wherein the control module is configured to: when it is determined that the automated guided vehicle has failed to change tracks, control the automated guided vehicle to return to a preset recovery position on the first track, and repeat at least part of the operations S11-S16 until it is determined that the automated guided vehicle has successfully changed tracks.
25. A storage system, include: The automatic guided vehicle according to any one of claims 13 to 24; The track includes a first track and a second track, on which an RFID electronic tag is arranged; a shelf having a magnetic member disposed thereon; and A server, communicatively connected to the automatic guided vehicle; The automated guided vehicle is configured to execute the control method according to any one of claims 1-12. 26 . A computer-readable storage medium, comprising computer-executable instructions stored thereon, wherein the executable instructions implement the control method according to any one of claims 1 to 12 when executed by a processor.
Citation Information
Patent Citations
AGV (Automatic Guided Vehicle) laser navigation system with inertia compensation
CN107272008A
Derailment predictor detection system, control device, derailment predictor detection method, and derailment predictor detection program
CN110740920A
Inertial navigation automatic guided vehicle and track determination method thereof
CN111474938A
Method and device for automatic recovery after AGV derailment
CN112445216A
Mesh inspection module
CN116888057A
