Method for controlling travel of autonomous guided vehicle, autonomous guided vehicle, and transport system

Abstract

This travel control method for an autonomous carrier vehicle (20) is for controlling traveling of an autonomous carrier vehicle that autonomously travels while towing a carriage (30), said method comprising: a step for acquiring a state of the carriage; a step for detecting a relative attitude of the carriage with respect to a carrier vehicle body (27) on the basis of the state of the carriage; and a step for controlling traveling speed of the carrier vehicle body on the basis of the relative attitude of the carriage with respect to the carrier vehicle body.

Description

[Technical field]

[0001] The present invention relates to a driving control method for an autonomous guided vehicle, an autonomous guided vehicle, and a transport system, and more particularly to a driving control method for an autonomous guided vehicle that drives autonomously by towing a cart, an autonomous guided vehicle, and a transport system thereof. [Background technology]

[0002] An autonomous guided vehicle that autonomously travels by towing a cart is known in the art. Such a method is disclosed in, for example, Japanese Patent No. 6362418.

[0003] The above-mentioned Japanese Patent Publication No. 6362418 discloses an autonomous guided vehicle that travels autonomously by towing a cart. This autonomous guided vehicle is configured to efficiently travel around corners and other curved sections by disconnecting and reconnecting the cart when traveling around curved sections such as corners. [Prior art documents] [Patent documents]

[0004] [Patent Document 1] Patent No. 6362418 Summary of the Invention [Problem to be solved by the invention]

[0005] However, in the autonomous guided vehicle described in the above-mentioned Patent Publication No. 6362418, since the cart is detached and reattached at curved sections such as corners, it takes time to move around the curved section, which reduces productivity when used in a manufacturing plant, etc. Therefore, it is conceivable to travel around the curved section while towing the cart by the autonomous guided vehicle without detaching the cart from the autonomous guided vehicle.

[0006] However, in this case, if the autonomous guided vehicle towing the cart travels around a curved section at the same high travel speed as when the cart is not being towed, the cart may swing significantly at the curved section and tip over. Therefore, when the autonomous guided vehicle is towing the cart, it is possible to uniformly reduce the travel speed of the autonomous guided vehicle.

[0007] However, in this case, while it is possible to prevent the cart from tipping over at the bend, the productivity decreases due to a decrease in the running speed of the autonomous guided vehicle. Therefore, there is a problem that it is difficult to increase productivity while preventing the cart from tipping over at the bend when towing the cart by the autonomous guided vehicle (carriage vehicle body).

[0008] The present invention has been made to solve the above-mentioned problems, and one object of the present invention is to provide a driving control method for an autonomous guided vehicle, an autonomous guided vehicle, and a guided vehicle system that can increase productivity while preventing the cart from tipping over at bending points when the cart is towed by the guided vehicle body. [Means for solving the problem]

[0009] A travel control method for an autonomous guided vehicle according to a first aspect of the present invention is a travel control method for an autonomous guided vehicle which travels autonomously by towing a cart, comprising the steps of acquiring a state of the cart, detecting a relative attitude of the cart with respect to the guided vehicle body based on the state of the cart, and controlling the travel speed of the guided vehicle body based on the relative attitude of the cart with respect to the guided vehicle body, wherein the guided vehicle body or the cart includes a coupling section which couples the guided vehicle body and the cart, and the guided vehicle body includes a drive section which drives the coupling section, and when the cart is towed by the guided vehicle body, the drive section drives the coupling section, thereby To counteract the inertial motion of the cart, The method further includes a step of controlling the relative attitude of the dolly with respect to the transport vehicle body in a horizontal plane.

[0010] In the method for controlling the travel of an autonomous transport vehicle according to the first aspect of the present invention, as described above, a step of detecting the relative attitude of the dolly with respect to the transport vehicle body based on the state of the dolly, and a step of controlling the travel speed of the transport vehicle body based on the relative attitude of the dolly with respect to the transport vehicle body are provided. In this way, when a change in the relative attitude of the dolly with respect to the transport vehicle body occurs when moving around a curved portion such as a corner, the travel speed of the transport vehicle body can be appropriately changed according to the change in the relative attitude of the dolly with respect to the transport vehicle body. As a result, unlike the case where the travel speed of the transport vehicle body is uniformly reduced when the dolly is towed by the transport vehicle body, an unnecessary reduction in the travel speed does not occur. In this way, when the dolly is towed by the transport vehicle body, it is possible to increase productivity while suppressing the dolly from tipping over at a curved portion. In addition, when an abnormality occurs in the attitude of the dolly when the dolly is towed by the transport vehicle body, the travel speed of the transport vehicle body can also be appropriately changed. This also makes it possible to suppress the dolly from tipping over when the dolly is towed by the transport vehicle body. In addition, in the method for controlling travel of an autonomous guided vehicle according to the first aspect, the vehicle body or the carriage includes a coupling part that couples the vehicle body and the carriage, the vehicle body includes a drive part that drives the coupling part, and the method further includes a step of controlling the relative attitude of the carriage to the vehicle body in a horizontal plane by driving the coupling part with the drive part when the carriage is towed by the vehicle body. With this configuration, the vehicle body can be made to travel while controlling the relative attitude of the carriage to the vehicle body in the horizontal plane. As a result, the stability of travel of the vehicle body can be improved compared to a case where the relative attitude of the carriage to the vehicle body in the horizontal plane cannot be controlled.

[0011] In the method for controlling travel of an autonomous guided vehicle according to the first aspect, the step of acquiring the state of the dolly preferably includes a step of acquiring the state of a characteristic point of the dolly, and the step of detecting the relative attitude of the dolly with respect to the guided vehicle body includes a step of detecting the relative attitude of the dolly with respect to the guided vehicle body based on the state of the characteristic point of the dolly. With this configuration, the relative attitude of the dolly with respect to the guided vehicle body can be easily detected simply by acquiring the state of the characteristic point of the dolly. In addition, since there is no need to provide a sensor for detecting the attitude on the dolly, the relative attitude of the dolly can be detected while the structure of the dolly is simplified.

[0012] In this case, the feature points of the dolly preferably include markers provided on the dolly. With this configuration, unlike the case where the shape of the dolly's corners or the like is used as the feature points, the relative orientation of the dolly with respect to the transport vehicle body can be detected using dedicated markers. As a result, the relative orientation of the dolly with respect to the transport vehicle body can be detected with high accuracy.

[0013] In the method for controlling travel of an autonomous guided vehicle according to the first aspect, the relative attitude of the dolly with respect to the guided vehicle body preferably includes information on the inclination angle of the dolly with respect to the guided vehicle body, and the step of controlling the travel speed of the guided vehicle body includes a step of controlling the travel speed of the guided vehicle body based on the information on the inclination angle of the dolly with respect to the guided vehicle body. With this configuration, the travel speed of the guided vehicle body can be accurately controlled based on the information on the inclination angle of the dolly with respect to the guided vehicle body.

[0014] In this case, the step of controlling the travel speed of the transport vehicle body preferably includes a step of controlling the travel speed of the transport vehicle body so that the transport vehicle body is decelerated based on information on the inclination angle of the dolly relative to the transport vehicle body in a horizontal plane. With this configuration, when the inclination angle of the dolly relative to the transport vehicle body in a horizontal plane changes when moving around a curved portion such as a corner, the travel speed of the transport vehicle body can be appropriately decelerated in accordance with the change in the inclination angle of the dolly relative to the transport vehicle body in the horizontal plane. As a result, the travel speed of the transport vehicle body can be accurately controlled when moving around a curved portion.

[0015] In the above-mentioned configuration in which the relative attitude of the dolly with respect to the transport vehicle body includes information on the inclination angle of the dolly with respect to the transport vehicle body, preferably, the step of controlling the travel speed of the transport vehicle body includes a step of controlling the travel speed of the transport vehicle body so that the transport vehicle body stops based on information on the inclination angle of the dolly with respect to the transport vehicle body in a vertical plane. With this configuration, for example, when an abnormality occurs in the attitude of the dolly due to an abnormality in the wheels of the dolly and a change occurs in the inclination angle of the dolly with respect to the transport vehicle body in a vertical plane, the transport vehicle body can be stopped. This makes it possible to suppress the dolly from tipping over when towing the dolly by the transport vehicle body.

[0016] In this case, preferably, the method further includes a step of acquiring information on the inclination angle of the transport vehicle body in the vertical plane, and the step of controlling the travel speed of the transport vehicle body includes a step of controlling the travel speed of the transport vehicle body so that the transport vehicle body stops based on information on the inclination angle of the dolly relative to the transport vehicle body in the vertical plane and information on the inclination angle of the transport vehicle body in the vertical plane. With this configuration, the transport vehicle body can be controlled to stop based not only on the inclination angle of the dolly relative to the transport vehicle body in the vertical plane, but also on the inclination angle of the transport vehicle body in the vertical plane. As a result, the transport vehicle body can be controlled to stop with high accuracy.

[0017] In the method for controlling the travel of the autonomous guided vehicle according to the first aspect, the step of controlling the travel speed of the guided vehicle body preferably includes a step of controlling the travel speed of the guided vehicle body in consideration of at least one of the shape of the carriage, the weight of the carriage, and the position of the center of gravity of the carriage. With this configuration, the travel speed of the guided vehicle body can be controlled in consideration of at least one of the shape of the carriage, the weight of the carriage, and the position of the center of gravity of the carriage, which differ depending on the type of the carriage. As a result, the travel speed of the guided vehicle body can be appropriately controlled depending on the type of the carriage.

[0019] In the method for controlling travel of an autonomous guided vehicle according to the first aspect, Preferably, the step of controlling the relative attitude of the dolly with respect to the transport vehicle body in the horizontal plane includes a step of controlling the relative attitude of the dolly with respect to the transport vehicle body in the horizontal plane by driving the coupling part with the drive part when the transport vehicle body turns so as to cancel the movement of the dolly due to inertia. With this configuration, it is possible to suppress the dolly from moving like a swing due to inertia when the transport vehicle body turns. As a result, it is possible to move the dolly compactly when the transport vehicle body turns. This makes it easy to perform traveling operations such as turning and turning around at narrow bends.

[0020] the above Method for controlling travel of autonomous guided vehicle according to a first aspectIn the method, preferably, the transport vehicle body further includes a stopper for limiting the movement of the coupling part, and the step of controlling the relative attitude of the cart with respect to the transport vehicle body in the horizontal plane includes a step of controlling the relative attitude of the cart with respect to the transport vehicle body in the horizontal plane by driving the coupling part with the drive part within an angle range limited by the stopper. With this configuration, when the coupling part is driven by the drive part, the coupling part can be driven so as not to come into contact with the stopper. As a result, when the coupling part is driven by the drive part, it is possible to suppress a load being applied to both the coupling part and the stopper due to the coupling part and the stopper coming into contact with each other. Furthermore, by providing the stopper, the movement of the coupling part can be limited. As a result, by limiting the movement of the coupling part, the movement of the cart can be limited to a predetermined range.

[0021] In the method for controlling the travel of an autonomous guided vehicle according to the first aspect, the step of controlling the travel speed of the guided vehicle body preferably includes a step of acquiring a correction time required to correct the relative attitude of the carriage with respect to the guided vehicle body by controlling the travel speed of the guided vehicle body, and a step of detecting a travel abnormality based on a comparison between the correction time and a reference correction time. With this configuration, it is possible to detect a travel abnormality caused by an abnormality such as an abnormality in the floor surface or an abnormality in the wheels of the carriage. As a result, when a travel abnormality is detected, the travel abnormality can be quickly eliminated.

[0022] In this case, preferably, the step of controlling the traveling speed of the transport vehicle body further includes a step of learning a reference correction time based on the correction time. With this configuration, the reference correction time can be updated by learning. As a result, the updated reference correction time can be used to more accurately detect abnormalities in traveling.

[0023] In the above-mentioned configuration for learning the reference correction time, the step of learning the reference correction time preferably includes a step of learning the reference correction time for each of the relative posture of the carriage with respect to the transport vehicle body, the travel speed of the transport vehicle body, the weight of the carriage, or the traveling direction of the transport vehicle body. With this configuration, the reference correction time can be learned by dividing the cases. As a result, the divided reference correction time can be used to more accurately detect abnormalities in the travel according to each individual case.

[0024] In the method for controlling travel of the autonomous guided vehicle according to the first aspect, the method preferably further comprises a step of moving the guided vehicle body to a coupling position with the cart when coupling the guided vehicle body and the cart based on the state of the cart. With this configuration, the guided vehicle body and the cart can be automatically coupled. As a result, it is possible to automate the process from coupling the guided vehicle body and the cart to towing the cart by the guided vehicle body.

[0025] An autonomous guided vehicle according to a second aspect of the present invention is an autonomous guided vehicle that travels autonomously by towing a cart, and includes a status acquisition unit that acquires a status of the cart, and a control unit that detects the relative attitude of the cart with respect to the guided vehicle body based on the status of the cart acquired by the status acquisition unit, and controls the traveling speed of the guided vehicle body based on the relative attitude of the cart with respect to the guided vehicle body, wherein the guided vehicle body or the cart includes a coupling unit that couples the guided vehicle body and the cart, and the guided vehicle body includes a drive unit that drives the coupling unit, and when the cart is towed by the guided vehicle body, the control unit drives the coupling unit with the drive unit, thereby To counteract the inertial motion of the cart, The relative position of the dolly with respect to the transport vehicle body in the horizontal plane is controlled.

[0026] In the autonomous transport vehicle according to the second aspect of the present invention, as described above, a control unit is provided that detects the relative attitude of the dolly with respect to the transport vehicle body based on the state of the dolly acquired by the state acquisition unit, and controls the travel speed of the transport vehicle body based on the relative attitude of the dolly with respect to the transport vehicle body. This allows the travel speed of the transport vehicle body to be appropriately changed in response to the change in the relative attitude of the dolly with respect to the transport vehicle body when the dolly changes relative to the transport vehicle body during movement around a curved portion such as a corner. As a result, unlike the case where the travel speed of the transport vehicle body is uniformly reduced when the dolly is towed by the transport vehicle body, no unnecessary reduction in the travel speed occurs. This makes it possible to provide an autonomous transport vehicle that can increase productivity while suppressing the dolly from tipping over at a curved portion when the dolly is towed by the transport vehicle body. In addition, when an abnormality occurs in the attitude of the dolly when the dolly is towed by the transport vehicle body, the travel speed of the transport vehicle body can also be appropriately changed in response to the change in the relative attitude of the dolly with respect to the transport vehicle body caused by the abnormality in the attitude of the dolly. This also allows the dolly to be suppressed from tipping over when the dolly is towed by the transport vehicle body.

[0027] In the autonomous guided vehicle according to the second aspect, the state acquisition unit is preferably configured to acquire the state of the feature points of the cart, and the control unit is configured to detect the relative attitude of the cart with respect to the cart body based on the state of the feature points of the cart acquired by the state acquisition unit. With this configuration, the relative attitude of the cart with respect to the cart body can be easily detected simply by acquiring the state of the feature points of the cart. In addition, since there is no need to provide a sensor for detecting the attitude on the cart, the relative attitude of the cart can be detected while the cart has a simple structure.

[0028] A transport system according to a third aspect of the present invention comprises a cart, an autonomous transport vehicle which travels autonomously by towing the cart, and a control device which transmits commands to the autonomous transport vehicle, wherein the autonomous transport vehicle includes a status acquisition unit which acquires a status of the cart, and a transport vehicle control unit which detects a relative attitude of the cart with respect to the transport vehicle body based on the status of the cart acquired by the status acquisition unit, and controls the travel speed of the transport vehicle body based on the relative attitude of the cart with respect to the transport vehicle body, wherein the transport vehicle body or the cart includes a coupling unit which connects the transport vehicle body and the cart, the transport vehicle body includes a drive unit which drives the coupling unit, and wherein when the cart is towed by the transport vehicle body, the transport vehicle control unit drives the coupling unit with the drive unit, thereby To counteract the inertial motion of the cart, The relative position of the dolly with respect to the transport vehicle body in the horizontal plane is controlled.

[0029] In the transport system according to the third aspect of the present invention, as described above, a transport vehicle control unit is provided that detects the relative attitude of the carriage with respect to the transport vehicle body based on the state of the carriage acquired by the state acquisition unit, and controls the travel speed of the transport vehicle body based on the relative attitude of the carriage with respect to the transport vehicle body. This allows the travel speed of the transport vehicle body to be appropriately changed in response to the change in the relative attitude of the carriage with respect to the transport vehicle body when the carriage changes its relative attitude with respect to the transport vehicle body during movement around a curved portion such as a corner. As a result, unlike the case where the travel speed of the transport vehicle body is uniformly reduced when the carriage is towed by the transport vehicle body, no unnecessary reduction in the travel speed occurs. This allows the transport system to be provided that can increase productivity while suppressing the carriage from tipping over at a curved portion when the carriage is towed by the transport vehicle body. In addition, when an abnormality occurs in the attitude of the carriage when the carriage is towed by the transport vehicle body, the travel speed of the transport vehicle body can also be appropriately changed in response to the change in the relative attitude of the carriage with respect to the transport vehicle body caused by the abnormality in the attitude of the carriage. This also allows the carriage to be suppressed from tipping over when the carriage is towed by the transport vehicle body.

[0030] In the transport system according to the third aspect, the state acquisition unit is preferably configured to acquire the state of the feature points of the cart, and the transport vehicle control unit is configured to detect the relative attitude of the cart with respect to the transport vehicle body based on the state of the feature points of the cart acquired by the state acquisition unit. With this configuration, the relative attitude of the cart with respect to the transport vehicle body can be easily detected simply by acquiring the state of the feature points of the cart. In addition, since there is no need to provide a sensor for detecting the attitude on the cart, the relative attitude of the cart can be detected while the cart has a simple structure. Effect of the Invention

[0031] According to the present invention, as described above, it is possible to provide a driving control method for an autonomous guided vehicle, an autonomous guided vehicle, and a guided vehicle system that can increase productivity while preventing the cart from tipping over at bending points when the cart is towed by the guided vehicle body. [Brief description of the drawings]

[0032] [Figure 1] FIG. 1 is a block diagram illustrating a transport system according to one embodiment. [Diagram 2] FIG. 2 is a block diagram illustrating a server according to one embodiment. [Diagram 3] FIG. 1 is a block diagram illustrating an autonomous guided vehicle according to one embodiment. [Figure 4] 10 is a schematic diagram for explaining acquisition of a state of a feature point of a cart according to an embodiment; FIG. [Diagram 5] FIG. 2 is a schematic diagram illustrating characteristic points of a cart according to an embodiment. [Figure 6] 1A to 1C are schematic diagrams illustrating a state in which a trolley is towed straight, a state in which the trolley is towed tilted in a horizontal plane, and a state in which the trolley is towed tilted in a circular plane in one embodiment. [Figure 7] 5A and 5B are schematic diagrams for explaining drive control of a connecting portion according to one embodiment. [Figure 8] 5 is a schematic diagram for explaining a correction time during travel speed control according to an embodiment. FIG. [Figure 9] FIG. 4 is a schematic diagram for explaining an area during travel speed control according to one embodiment. [Figure 10] FIG. 1 is a diagram for explaining automatic coupling control of an autonomous guided vehicle according to an embodiment. [Figure 11] 11 is a flowchart for explaining an automatic coupling process of an autonomous guided vehicle according to an embodiment. [Figure 12] 11 is a flowchart for explaining a speed control process for an autonomous guided vehicle according to an embodiment. [Figure 13] This is a continuation of the flowchart in FIG. 12. [Figure 14] 11 is a flowchart for explaining a process for stopping travel of an autonomous guided vehicle according to an embodiment. [Figure 15] 11 is a flowchart for explaining a joint control process for an autonomous guided vehicle according to an embodiment. [Figure 16] 13 is a schematic diagram for explaining acquisition of a state of a feature point of a cart according to a modified example of an embodiment. FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0033] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, preferred embodiments of the present invention will be described with reference to the accompanying drawings.

[0034] (Configuration of circuit board manufacturing system) The configuration of a transport system 100 according to an embodiment of the present invention will be described with reference to FIG.

[0035] The conveying system 100 according to the present embodiment is a system used in a manufacturing factory. The manufacturing factory in which the conveying system 100 is used is not particularly limited, and may be, for example, a board manufacturing factory that manufactures boards by mounting electronic components on printed circuit boards. As shown in FIG. 1, the conveying system 100 includes a server 10, an autonomous guided vehicle 20, and a cart 30. Although FIG. 1 illustrates one autonomous guided vehicle 20 and one cart 30, in an actual manufacturing factory, multiple autonomous guided vehicles 20 and multiple carts 30 are provided. The server 10 is an example of a "control device" in the claims.

[0036] (Server configuration) As shown in Fig. 1, the server 10 is configured to transmit commands to the autonomous guided vehicle 20. The server 10 is configured, for example, by a personal computer. As shown in Fig. 2, the server 10 includes a control unit 11, a storage unit 12, a display unit 13, an operation unit 14, and a communication unit 15.

[0037] The control unit 11 is a control circuit that controls each part of the server 10. The control unit 11 includes a CPU (Central Processing Unit) and a memory. The control unit 11 is configured to perform control to transmit commands to the autonomous guided vehicle 20 based on a manufacturing plan, user input, and the like. The storage unit 12 includes a rewritable storage medium such as a flash memory, and is configured to be able to store various information. The storage unit 12 stores information on the manufacturing plan, information on the autonomous guided vehicle 20, information on the cart 30, and the like.

[0038] The display unit 13 includes, for example, a liquid crystal display unit, and is configured to be capable of displaying various types of information. The operation unit 14 includes input units such as a mouse and a keyboard, and is configured to be capable of receiving input operations from a user. The communication unit 15 is configured to be capable of transmitting and receiving information to and from the autonomous guided vehicle 20. The communication unit 15 is a wireless communication unit for wireless communication. The server 10 is connected to the autonomous guided vehicle 20 via a network so as to be capable of communicating with the autonomous guided vehicle 20.

[0039] (Configuration of autonomous guided vehicles) Next, the configuration of the autonomous guided vehicle 20 will be described.

[0040] The autonomous guided vehicle 20 is configured to travel autonomously while towing the cart 30. Specifically, the autonomous guided vehicle 20 is configured to transport articles used in a manufacturing plant by traveling autonomously while towing the cart 30.

[0041] As shown in FIG. 3 and FIG. 4, the autonomous guided vehicle 20 includes a plurality of (four) drive wheels 20a, a plurality of (four) drive wheel motors 20b, a drive wheel control unit 20c, a coupling unit 20d, a coupling unit motor 20e, and a pair of stoppers 20f. The autonomous guided vehicle 20 also includes a control unit 21, an imaging unit 22, a communication unit 23, a battery 24, a tilt sensor 25, and a storage unit 26. These components are provided in a guided vehicle body 27. For convenience, FIG. 3 illustrates the plurality of (four) drive wheels 20a and the plurality of (four) drive wheel motors 20b one by one. The control unit 21 is an example of a "guided vehicle control unit" in the claims. The coupling unit motor 20e is an example of a "drive unit" in the claims. The imaging unit 22 is an example of a "state acquisition unit" in the claims.

[0042] The multiple drive wheels 20a are configured to drive the transport vehicle body 27. The multiple drive wheels 20a are configured to be able to drive the transport vehicle body 27 straight or turn. The multiple drive wheels 20a are provided on the left and right sides of the transport vehicle body 27, two on each side. The multiple drive wheel motors 20b are configured to drive the multiple drive wheels 20a. The multiple drive wheel motors 20b are provided corresponding to the multiple drive wheels 20a. The drive wheel control unit 20c is configured to control the multiple drive wheel motors 20b based on a command from the control unit 21, and to control the travel direction and travel speed of the transport vehicle body 27 driven by the multiple drive wheels 20a.

[0043] The connecting portion 20d is a connecting member that connects the transport vehicle body 27 and the dolly 30. The connecting portion 20d is configured to connect the transport vehicle body 27 and the dolly 30 so as to be rotatable around a rotation axis C extending in the vertical direction (Z direction) with the connecting point on the transport vehicle body 27 side as the rotation center. The connecting portion motor 20e is configured to drive the connecting portion 20d. The connecting portion motor 20e is configured to rotate the connecting portion 20d around the rotation axis C based on a command from the control unit 21. The pair of stoppers 20f is configured to limit the movement of the connecting portion 20d. The pair of stoppers 20f are provided on both sides of the connecting portion 20d. The pair of stoppers 20f are provided in a V-shape, sandwiching the connecting portion 20d.

[0044] The control unit 21 is configured to control each part of the autonomous guided vehicle 20. The control unit 21 includes a CPU (Central Processing Unit) and a memory. The control unit 21 is configured to control the autonomous traveling of the autonomous guided vehicle 20 by controlling the drive wheel motor 20b via the drive wheel control unit 20c.

[0045] The control unit 21 is also configured to autonomously drive the autonomous guided vehicle 20 to the destination based on a command from the server 10. For example, the control unit 21 autonomously drives the autonomous guided vehicle 20 to a waiting position for the dolly 30 based on a command from the server 10. For example, the control unit 21 autonomously drives the autonomous guided vehicle 20 to a warehouse in which the items to be transported are stored, while towing the dolly 30, based on a command from the server 10. For example, the control unit 21 autonomously drives the autonomous guided vehicle 20 to a transport position for the items, while towing the dolly 30 that contains the items to be transported, based on a command from the server 10.

[0046] The imaging unit 22 is configured to acquire the state of the dolly 30. Specifically, the imaging unit 22 is configured to acquire the state of the feature point 31 of the dolly 30. The imaging unit 22 is configured to acquire the state of the feature point 31 of the dolly 30 as an imaging result by imaging the feature point 31 of the dolly 30. The imaging unit 22 includes a camera. The imaging unit 22 is provided at a position where the imaging unit 22 can image the feature point 31 of the dolly 30. The imaging unit 22 is provided on the dolly 30 side of the transport vehicle body 27.

[0047] The communication unit 23 is configured to be able to transmit and receive information to and from the server 10. The communication unit 23 is a wireless communication unit for wireless communication. The autonomous guided vehicle 20 is connected to the server 10 via a network so as to be able to communicate with the server 10. The battery 24 is configured to supply power to each unit of the autonomous guided vehicle 20. The battery 24 includes a rechargeable battery. The autonomous guided vehicle 20 travels autonomously using the power of the battery 24. The tilt sensor 25 is configured to obtain the tilt angle of the autonomous guided vehicle 20 in a vertical plane and transmit it to the control unit 21. The tilt sensor 25 includes, for example, a gyro sensor. The storage unit 26 includes a rewritable storage medium such as a flash memory, and is configured to be able to store various information. The storage unit 26 stores information on the autonomous guided vehicle 20, information on the dolly 30, and the like.

[0048] (Truck configuration) Next, the configuration of the carriage 30 will be described.

[0049] The dolly 30 is configured to accommodate items used in a manufacturing plant. As shown in FIG. 4, the dolly 30 includes a feature 31, a storage section 32, and a plurality of (four) wheels 33.

[0050] The feature point 31 includes a marker provided on the cart 30. The marker is not particularly limited, but can be formed, for example, by sheet metal. The feature point 31 is provided at a position where it can be imaged by the imaging unit 22 of the autonomous guided vehicle 20. The feature point 31 is provided on the part of the cart 30 on the autonomous guided vehicle 20 side. As shown in FIG. 5, the feature point 31 is patterned. When the feature point 31 is made of sheet metal, the pattern of the feature point 31 can be formed by a laser. The pattern of the feature point 31 is configured so that the shape seen from the autonomous guided vehicle 20 changes according to the change in the relative attitude of the cart 30 with respect to the carrier body 27. The pattern of the feature point 31 is configured by a two-dimensional code including the identification information of the cart 30. The control unit 21 of the autonomous guided vehicle 20 can acquire the identification information of the cart 30 based on the imaging result of the feature point 31 by the imaging unit 22. In addition, the control unit 21 of the autonomous guided vehicle 20 can obtain information about the cart 30, such as the shape of the cart 30, the weight of the cart 30, and the position of the center of gravity of the cart 30, from the server 10 based on the identification information of the cart 30.

[0051] As shown in Fig. 4, the storage section 32 is configured to be able to store an article. The storage section 32 is formed in a concave shape. The multiple wheels 33 are configured to move the cart 30 by being towed by the autonomous guided vehicle 20. The multiple wheels 33 are provided as swivel wheels. The multiple wheels 33 are provided on the left and right sides of the cart 30, two on each side.

[0052] (Control of the travel speed of the transport vehicle body) Next, the control of the traveling speed of the transport vehicle body 27 will be described.

[0053] 6, in this embodiment, the control unit 21 is configured to detect the relative attitude of the cart 30 with respect to the transport vehicle body 27 based on the state of the cart 30 acquired by the imaging unit 22, and to control the traveling speed of the transport vehicle body 27 based on the relative attitude of the cart 30 with respect to the transport vehicle body 27. Specifically, the control unit 21 is configured to detect the relative attitude of the cart 30 with respect to the transport vehicle body 27 based on the state of the feature point 31 of the cart 30 acquired by the imaging unit 22.

[0054] When the carriage 30 is towed straight by the carriage body 27, the feature point 31 is located at the center in the image capture result and is not tilted. When the carriage 30 is towed by the carriage body 27 in a tilted state in the horizontal plane, the feature point 31 is located at a position shifted from the center in the image capture result and is tilted in the depth direction. When the carriage 30 is towed by the carriage body 27 in a tilted state in the vertical plane, the feature point 31 is located at the center in the image capture result and is tilted in the plane perpendicular to the depth direction. By utilizing the change in the state of the feature point 31, the relative attitude of the carriage 30 with respect to the carriage body 27 can be detected. In FIG. 6, the carriage 30 is exaggerated in the tilted state in the vertical plane for ease of understanding.

[0055] The relative attitude of the dolly 30 with respect to the transport vehicle body 27 includes information on the inclination angle of the dolly 30 with respect to the transport vehicle body 27. Specifically, the relative attitude of the dolly 30 with respect to the transport vehicle body 27 includes information on the inclination angle γ of the dolly 30 with respect to the transport vehicle body 27 in a horizontal plane, and information on the inclination angle θ of the dolly 30 with respect to the transport vehicle body 27 in a vertical plane.

[0056] The control unit 21 is configured to control the traveling speed of the transport vehicle body 27 based on information on the inclination angle of the dolly 30 relative to the transport vehicle body 27. Specifically, the control unit 21 is configured to control the traveling speed of the transport vehicle body 27 based on information on the inclination angle γ of the dolly 30 relative to the transport vehicle body 27 in a horizontal plane so that the transport vehicle body 27 decelerates. More specifically, the control unit 21 is configured to control the traveling speed of the transport vehicle body 27 by the following formula (1). The control unit 21 is configured to control the traveling speed of the transport vehicle body 27 by the following formula (1) so that the traveling speed decreases as the inclination angle γ increases. Vc=V×{1-k×sin(γ)} ···(1) Where: Vc: Correction speed V: Normal speed k: correction coefficient γ: Inclination angle of the cart relative to the carrier body in the horizontal plane It is.

[0057] The normal speed V and the correction coefficient k can be determined in advance by experiments or the like. The normal speed V is not particularly limited, but may be, for example, about 2 m / s. The correction coefficient k is not particularly limited, but may be, for example, a value that makes the correction speed Vc equal to or less than 1 m / s. The normal speed V is the traveling speed of the transport vehicle body 27 when the carriage 30 is towed straight by the transport vehicle body 27.

[0058] The control unit 21 is also configured to control the travel speed of the transport vehicle body 27 based on information on the inclination angle θ of the dolly 30 relative to the transport vehicle body 27 in the vertical plane so that the transport vehicle body 27 stops. Specifically, the control unit 21 is configured to control the travel speed of the transport vehicle body 27 based on information on the inclination angle θ of the dolly 30 relative to the transport vehicle body 27 in the vertical plane and information on the inclination angle δ of the transport vehicle body 27 in the vertical plane acquired by the inclination sensor 25 so that the transport vehicle body 27 stops.

[0059] First, the control unit 21 obtains the difference (θ-δ) between the tilt angle θ and the tilt angle δ as the true tilt angle θt of the carriage 30 in the vertical plane. Then, the control unit 21 detects whether the true tilt angle θt exceeds a reference angle (threshold value). When the control unit 21 detects that the true tilt angle θt exceeds the reference angle, the control unit 21 controls the travel speed of the transport vehicle body 27 so that the transport vehicle body 27 stops. At this time, the control unit 21 controls the travel speed of the transport vehicle body 27 so that the transport vehicle body 27 gradually decelerates and stops. Also, when the control unit 21 detects that the true tilt angle θt does not exceed the reference angle, the control unit 21 controls the transport vehicle body 27 to continue traveling. The reference angle can be determined in advance by an experiment or the like.

[0060] Furthermore, in this embodiment, the control unit 21 is configured to control the traveling speed of the transport vehicle body 27, taking into consideration at least one of the shape of the dolly 30, the weight of the dolly 30, and the position of the center of gravity of the dolly 30. For example, the control unit 21 takes into consideration the shape of the dolly 30 and reduces the traveling speed of the transport vehicle body 27 when the dolly 30 is wide, compared to when the dolly 30 is narrow. Similarly, the control unit 21 takes into consideration the shape of the dolly 30 and increases the traveling speed of the transport vehicle body 27 when the dolly 30 is narrow, compared to when the dolly 30 is wide.

[0061] Also, for example, the control unit 21 takes into consideration the weight of the dolly 30 and when the weight of the dolly 30 is large, the control unit 21 reduces the traveling speed of the transport vehicle main body 27 compared to the case of a dolly 30 with a small weight. Similarly, the control unit 21 takes into consideration the weight of the dolly 30 and when the weight of the dolly 30 is small, the control unit 21 increases the traveling speed of the transport vehicle main body 27 compared to the case of a dolly 30 with a large weight.

[0062] Also, for example, the control unit 21 takes into consideration the position of the center of gravity of the cart 30 and when the center of gravity of the cart 30 is on the left side, the control unit 21 reduces the travel speed of the transport vehicle body 27 when turning counterclockwise compared to when turning clockwise. Similarly, the control unit 21 takes into consideration the position of the center of gravity of the cart 30 and when the center of gravity of the cart 30 is on the right side, the control unit 21 reduces the travel speed of the transport vehicle body 27 when turning clockwise compared to when turning counterclockwise.

[0063] (Drive control of the connecting part) Next, the drive control of the connecting portion 20d will be described.

[0064] 7, the control unit 21 is configured to control the relative attitude of the cart 30 to the transport vehicle body 27 in a horizontal plane by driving (rotating) the coupling part 20d by the coupling part motor 20e when the transport vehicle body 27 is towing the cart 30. Specifically, the control unit 21 is configured to control the relative attitude of the cart 30 to the transport vehicle body 27 in a horizontal plane by driving (rotating) the coupling part 20d by the coupling part motor 20e when the transport vehicle body 27 turns so as to cancel the movement of the cart 30 due to inertia.

[0065] Here, the inertial force acting on the carriage 30 when the transporting vehicle body 27 turns can be expressed by the following formula (2). Fj = m × a (2) Where: Fj: Inertial force acting on the cart m: Weight of the cart a: Acceleration in the rotational direction of the cart It is.

[0066] As the weight m, when an article is being transported, the total weight of the weight of the dolly 30 and the weight of the article is used, and when an article is not being transported, the weight of the dolly 30 is used. The weight of the dolly 30 can be obtained from the server 10 based on the identification information of the dolly 30. Also, the weight of the article can be obtained by identifying the article based on the contents of the command (task contents) from the server 10. The acceleration a can be obtained from the rotation speed of the transport vehicle main body 27 by using a conversion table. Alternatively, the acceleration a can be obtained from the time change in the state of the feature point 31 of the dolly 30 acquired by the imaging unit 22.

[0067] Moreover, the kinetic friction force acting on the cart 30 can be expressed by the following formula (3). F = μ × m × g (3) Where: F: Kinetic friction force acting on the cart μ: Coefficient of kinetic friction m: Weight of the cart g:Gravity acceleration It is.

[0068] The dynamic friction coefficient μ can be obtained by the user inputting the dynamic friction coefficient of the floor surface. The weight m can be obtained in the same manner as in the above formula (2). The gravitational acceleration g can be obtained as a known value.

[0069] When the transport vehicle body 27 turns, the cart 30 is swung in the rotation direction by a force determined by the inertial force Fj calculated by the above formula (2) and the kinetic friction force F calculated by the above formula (3). For this reason, the control unit 21 determines a drive direction (opposite to the direction in which inertia acts) and a drive distance (drive angle) of the connecting part 20d that cancels the difference (Fg-F) between the inertial force Fg and the kinetic friction force F. Then, the control unit 21 controls the connecting part motor 20e to drive the connecting part 20d so that the connecting part 20d rotates in the determined drive direction by the determined drive distance (drive angle).

[0070] In this embodiment, the control unit 21 is configured to control the relative attitude of the cart 30 with respect to the transport vehicle main body 27 in the horizontal plane by driving (rotating) the connecting part 20d by the connecting part motor 20e within an angle range limited by the stopper 20f. The control unit 21 is configured to drive (rotate) the connecting part 20d by the connecting part motor 20e within a range in which the connecting part 20d does not come into contact with the stopper 20f.

[0071] (Correction time when controlling driving speed) Next, the correction time when controlling the traveling speed of the transportation vehicle body 27 will be described.

[0072] As shown in Fig. 8, the control unit 21 is configured to acquire a correction time T required to correct the relative attitude of the carriage 30 with respect to the transport vehicle body 27 by controlling the travel speed of the transport vehicle body 27. The control unit 21 is also configured to detect a travel abnormality based on a comparison between the correction time T and a reference correction time. Specifically, the control unit 21 is configured to detect a travel abnormality by the following formula (4). The control unit 21 is configured to detect a travel abnormality when the correction time T is outside (below or above) the normal range determined by the following formula (4). Te-α <T<Te+α ···(4) Where: Te: Reference correction time T: Correction time α: constant It is.

[0073] The reference correction time Te and the correction time T will be described later. The constant α can be determined in advance by experiment or the like.

[0074] 9, a plurality of areas A (four in FIG. 9) are set for correcting the relative posture of the carriage 30 with respect to the transport vehicle main body 27. The plurality of areas A are set as ranges of different inclination angles γ. For example, area 1 is set as a range of inclination angle γ of 0 degrees or more and less than 5 degrees, area 2 is set as a range of inclination angle γ of 5 degrees or more and less than 10 degrees, area 3 is set as a range of inclination angle γ of 10 degrees or more and less than 15 degrees, and area 4 is set as a range of inclination angle γ of 15 degrees or more and less than 20 degrees.

[0075] The control unit 21 is configured to perform control to change the travel speed of the transport vehicle body 27 when the area A transitions from the previous area A to a different area A. The control unit 21 is also configured to obtain the time until the area A transitions from the previous area A to the different area A as a correction time T and store it in the memory unit 26.

[0076] Moreover, in this embodiment, the control unit 21 is configured to learn the reference correction time Te based on the correction time T. Specifically, the control unit 21 is configured to learn and update the reference correction time Te by the following formula (5). The control unit 21 is configured to learn and update the reference correction time Te as an average value of a plurality of correction times T by the following formula (5). The control unit 21 is configured to acquire the reference correction time Te as an expected correction completion time when correction is expected to be completed by the following formula (5). Te = ΣTn / n (5) Where: Te: Reference correction time Tn: The nth correction time n: correction time number It is.

[0077] In this embodiment, the control unit 21 is configured to learn the reference correction time Te for each of the relative posture (area A) of the carriage 30 with respect to the transport vehicle body 27, the travel speed of the carriage 30, the weight of the carriage 30, or the traveling direction of the transport vehicle body 27. For this reason, when the area A moves from the previous area A to a different area A, the control unit 21 is configured to store the area A (tilt angle γ), the travel speed of the carriage body 27, the weight of the carriage 30, and the traveling direction of the transport vehicle body 27 (whether it is a right turn or a left turn) in the memory unit 26 in association with the correction time T. As a result, the correction time T is acquired according to the area A, the travel speed of the carriage body 27, the weight of the carriage 30, or the traveling direction of the transport vehicle body 27. Also, the reference correction time Te is learned according to the area A, the travel speed of the carriage body 27, the weight of the carriage 30, or the traveling direction of the transport vehicle body 27.

[0078] Moreover, the control unit 21 is configured to learn the correction coefficient k in the above formula (1) based on the correction time T. Specifically, the control unit 21 is configured to acquire the correction coefficient k as a random number in a predetermined range. Moreover, the control unit 21 is configured to learn and update the range of the random number of the correction coefficient k, centered on the value of the correction coefficient k that results in a smaller correction time T. This makes it possible to converge the range of the random number of the correction coefficient k to an appropriate range.

[0079] (Automatic coupling control of autonomous guided vehicles) Next, the automatic coupling control of the autonomous guided vehicle 20 will be described.

[0080] 10, the control unit 21 is configured to move the transport vehicle body 27 to a coupling position with the cart 30 when the transport vehicle body 27 and the cart 30 are coupled together, based on the state of the cart 30 acquired by the imaging unit 22. Specifically, the control unit 21 is configured to move the transport vehicle body 27 to a coupling position with the cart 30 when the transport vehicle body 27 and the cart 30 are coupled together, based on the state of the feature point 31 of the cart 30 acquired by the imaging unit 22.

[0081] The control unit 21 is configured to recognize the state of the characteristic point 31 of the dolly 30 by capturing an image by the imaging unit 22. The control unit 21 is configured to move the transport vehicle body 27 closer to the unconnected dolly 30, using the state of the characteristic point 31 of the dolly 30 as a landmark. The control unit 21 is configured to control the transport vehicle body 27 to connect to the dolly 30 by the connecting unit 20d when the transport vehicle body 27 is moved to a connecting position with the dolly 30. The control unit 21 is configured to tow the dolly 30 connected by the connecting unit 20d to travel autonomously.

[0082] (Automatic coupling process for autonomous guided vehicles) Next, the automatic coupling process of the autonomous guided vehicle 20 of this embodiment will be described with reference to a flowchart. Each process in the flowchart is performed by the control unit 21.

[0083] As shown in Fig. 11, first, in step S101, it is detected whether or not a towing command for the dolly 30 has been received from the server 10. The towing command for the dolly 30 includes information on the goods to be loaded on the dolly 30. If it is detected that the towing command for the dolly 30 has not been received, the process of step S101 is repeated. On the other hand, if it is detected that the towing command for the dolly 30 has been received, the process proceeds to step S102.

[0084] Then, in step S102, the transportation vehicle body 27 is moved to the designated position designated by the server 10.

[0085] Then, in step S103, the imaging unit 22 captures an image, and the characteristic points 31 of the dolly 30 are recognized.

[0086] Then, in step S104, information about the dolly 30 (such as the shape, weight, and center of gravity position of the dolly 30) is acquired based on the feature points 31 of the dolly 30. Specifically, in step S104, identification information about the dolly 30 is acquired from the feature points 31 of the dolly 30. Then, based on the identification information about the dolly 30, information about the dolly 30 is acquired from the server 10.

[0087] Then, in step S105, the transport vehicle body 27 approaches the cart 30 using the characteristic point 31 of the cart 30 as a landmark.

[0088] Then, in step S106, it is detected whether or not the transport vehicle body 27 has moved to the coupling position with the dolly 30. If it is detected that the transport vehicle body 27 has not moved to the coupling position with the dolly 30, the process of step S106 is repeated. If it is detected that the transport vehicle body 27 has moved to the coupling position with the dolly 30, the process proceeds to step S107.

[0089] Then, in step S107, the transporting vehicle body 27 and the dolly 30 are coupled by the coupling portion 20d. Then, in step S107, the transporting vehicle body 27 starts towing the dolly 30. Thereafter, the automatic coupling process ends.

[0090] (Speed ​​control processing for autonomous guided vehicles) Next, a speed control process of the autonomous guided vehicle 20 of this embodiment will be described with reference to a flowchart. Each process in the flowchart is performed by the control unit 21.

[0091] As shown in FIG. 12, first, in step S111, an image is captured by the imaging unit 22, and the state of the feature point 31 of the dolly 30 is acquired.

[0092] Then, in step S112, the relative attitude of the cart 30 with respect to the transport vehicle body 27 in the horizontal plane is detected based on the state of the feature point 31 of the cart 30. In step S112, the inclination angle γ of the cart 30 with respect to the transport vehicle body 27 in the horizontal plane is detected based on the state of the feature point 31 of the cart 30.

[0093] Then, in step S113, it is detected whether or not area A is the first area A (area A in a state where the dolly 30 is being towed straight). If it is detected that area A is the first area A, the process proceeds to step S114.

[0094] Then, in step S114, the travel speed of the transportation vehicle body 27 is set to a normal speed.

[0095] Then, in step S115, it is detected whether the transfer is completed. If it is detected that the transfer is completed, the speed control process is terminated. If it is detected that the transfer is not completed, the process returns to step S111.

[0096] Also, if it is detected in step S113 that area A is not the first area A, the process proceeds to step S116.

[0097] Then, in step S116, it is detected whether or not area A is different from the immediately preceding area A. If it is detected that area A is not different from the immediately preceding area A, the process proceeds to step S115, where the same process as above is performed. If it is detected that area A is different from the immediately preceding area A, the process proceeds to step S117.

[0098] 13, in step S117, the traveling speed of the transporting vehicle body 27 is corrected according to the inclination angle γ of the carriage 30 relative to the transporting vehicle body 27 in the horizontal plane. In step S117, the traveling speed of the transporting vehicle body 27 is corrected by the above formula (1).

[0099] Then, in step S118, the correction time T is stored in the storage unit 26. Also, in step S118, the area A (tilt angle γ), the traveling speed of the transporting vehicle body 27, the weight of the dolly 30, and the traveling direction of the transporting vehicle body 27 are stored in the storage unit 26 in association with the correction time T.

[0100] Then, in step S119, the correction time T is compared with the reference correction time Te.

[0101] Then, in step S120, it is detected whether or not the correction time T is within the normal range by the above formula (4). If it is detected that the correction time T is within the normal range, the process proceeds to step S121.

[0102] Then, in step S121, the reference correction time Te is learned and updated by the above formula (5) based on the correction time T. Then, the process proceeds to step S115, where the same processing as above is performed.

[0103] Moreover, if it is detected in step S120 that the correction time T is not within the normal range, the process proceeds to step S122.

[0104] Then, in step S122, an abnormality notification is performed. In step S122, for example, the abnormality notification is performed to the server 10. Then, the abnormality is displayed on the display unit 13 of the server 10. After that, the speed control process is terminated.

[0105] (Autonomous guided vehicle stopping process) Next, a process for stopping the autonomous guided vehicle 20 according to this embodiment will be described with reference to a flowchart. Each process in the flowchart is performed by the control unit 21.

[0106] As shown in FIG. 14, first, in step S131, an image is captured by the imaging unit 22, and the state of the feature point 31 of the dolly 30 is acquired.

[0107] Then, in step S132, the relative attitude of the cart 30 with respect to the transport vehicle body 27 in the vertical plane is detected based on the state of the characteristic point 31 of the cart 30. In step S132, the inclination angle θ of the cart 30 with respect to the transport vehicle body 27 in the vertical plane is detected based on the state of the characteristic point 31 of the cart 30.

[0108] Then, in step S133, the inclination sensor 25 detects the inclination angle δ of the transportation vehicle body 27 in the vertical plane.

[0109] Then, in step S134, it is detected whether or not the true tilt angle θt (=θ-δ) of the cart 30 is abnormal. If it is detected that the true tilt angle θt of the cart 30 is not abnormal, the process proceeds to step S135.

[0110] Then, in step S135, it is detected whether the transport is completed. If it is detected that the transport is completed, the travel stop processing is terminated. If it is detected that the transport is not completed, the process returns to step S131.

[0111] Moreover, in step S134, if it is detected that the true tilt angle θt of the carriage 30 is abnormal, the process proceeds to step S136.

[0112] Then, in step S136, the transportation vehicle body 27 stops traveling. 6 In this state, the transportation vehicle body 27 is gradually decelerated and the transportation vehicle body 27 is stopped.

[0113] Then, in step S137, an abnormality notification is performed. In step S137, for example, the abnormality notification is performed to the server 10. Then, the abnormality is displayed on the display unit 13 of the server 10. Thereafter, the traveling stop processing is terminated.

[0114] (Control processing of the joints of autonomous guided vehicles) Next, a process of controlling a connection portion of the autonomous guided vehicle 20 according to this embodiment will be described with reference to a flowchart. Each process in the flowchart is performed by the control unit 21.

[0115] As shown in FIG. 15, first, in step S141, an image is captured by the imaging unit 22, and the state of the feature point 31 of the dolly 30 is acquired.

[0116] Then, in step S142, the relative attitude of the cart 30 with respect to the transport vehicle body 27 in the horizontal plane is detected based on the state of the feature point 31 of the cart 30. In step S142, the inclination angle γ of the cart 30 with respect to the transport vehicle body 27 in the horizontal plane is detected based on the state of the feature point 31 of the cart 30.

[0117] Then, in step S143, it is detected whether or not area A is the first area A (area A in a state where the dolly 30 is being towed straight). If it is detected that area A is the first area A, the process proceeds to step S144.

[0118] Then, in step S144, it is detected whether or not the transport is completed. If it is detected that the transport is completed, the connection section control process is terminated. If it is detected that the transport is not completed, the process returns to step S141.

[0119] Also, if it is detected in step S143 that area A is not the first area A, the process proceeds to step S145.

[0120] Then, in step S145, the inertial force Fj acting on the carriage 30 is obtained by the above formula (2), and the kinetic friction force F acting on the carriage 30 is obtained by the above formula (3).

[0121] Then, in step S146, the coupling part 20d is driven (rotated) by the coupling part motor 20e so as to cancel the movement of the cart 30 due to inertia, based on the inertial force Fj and the kinetic friction force F. Then, the process proceeds to step S144, where the same processing as described above is performed.

[0122] (Effects of this embodiment) In this embodiment, the following effects can be obtained.

[0123] In this embodiment, as described above, the travel control method for the autonomous transport vehicle 20 includes a step of detecting the relative attitude of the cart 30 with respect to the transport vehicle body 27 based on the state of the cart 30, and a step of controlling the travel speed of the transport vehicle body 27 based on the relative attitude of the cart 30 with respect to the transport vehicle body 27. This allows the travel speed of the transport vehicle body 27 to be appropriately changed in response to the change in the relative attitude of the cart 30 with respect to the transport vehicle body 27 when the relative attitude of the cart 30 with respect to the transport vehicle body 27 changes when the cart 30 moves around a curved portion such as a corner. As a result, unlike the case where the travel speed of the transport vehicle body 27 is uniformly reduced when the cart 30 is towed by the transport vehicle body 27, no unnecessary reduction in the travel speed occurs. This allows productivity to be improved while suppressing the cart 30 from tipping over at a curved portion when the cart 30 is towed by the transport vehicle body 27. In addition, the travel speed of the transport vehicle body 27 can also be appropriately changed when an abnormality occurs in the attitude of the cart 30 when the cart 30 is towed by the transport vehicle body 27. This also makes it possible to prevent the cart 30 from tipping over when the transporting vehicle body 27 is towing the cart 30.

[0124] Moreover, in this embodiment, as described above, the step of acquiring the state of the dolly 30 includes a step of acquiring the state of the feature point 31 of the dolly 30. Moreover, the step of detecting the relative attitude of the dolly 30 with respect to the transport vehicle body 27 includes a step of detecting the relative attitude of the dolly 30 with respect to the transport vehicle body 27 based on the state of the feature point 31 of the dolly 30. In this way, the relative attitude of the dolly 30 with respect to the transport vehicle body 27 can be easily detected simply by acquiring the state of the feature point 31 of the dolly 30. Moreover, since there is no need to provide a sensor for detecting the attitude on the dolly 30, the relative attitude of the dolly 30 can be detected while the dolly 30 has a simple structure.

[0125] In addition, in this embodiment, as described above, the feature points 31 of the dolly 30 include markers provided on the dolly 30. This makes it possible to detect the relative posture of the dolly 30 with respect to the transport vehicle main body 27 by using dedicated markers, unlike the case where the shape of the corners or the like of the dolly 30 is used as the feature points 31. As a result, the relative posture of the dolly 30 with respect to the transport vehicle main body 27 can be detected with high accuracy.

[0126] In the present embodiment, as described above, the relative attitude of the carriage 30 with respect to the transport vehicle main body 27 includes information on the inclination angle of the carriage 30 with respect to the transport vehicle main body 27. Furthermore, the step of controlling the travel speed of the transport vehicle main body 27 includes a step of controlling the travel speed of the transport vehicle main body 27 based on information on the inclination angle of the carriage 30 with respect to the transport vehicle main body 27. This makes it possible to precisely control the travel speed of the transport vehicle main body 27 based on information on the inclination angle of the carriage 30 with respect to the transport vehicle main body 27.

[0127] In this embodiment, as described above, the step of controlling the traveling speed of the transport vehicle body 27 includes a step of controlling the traveling speed of the transport vehicle body 27 so that the transport vehicle body 27 decelerates based on information on the inclination angle γ of the carriage 30 relative to the transport vehicle body 27 in the horizontal plane. Thereby, when the inclination angle γ of the carriage 30 relative to the transport vehicle body 27 in the horizontal plane changes when the transport vehicle body 27 moves around a curved portion such as a corner, the traveling speed of the transport vehicle body 27 can be appropriately decelerated in accordance with the change in the inclination angle γ of the carriage 30 relative to the transport vehicle body 27 in the horizontal plane. As a result, the traveling speed of the transport vehicle body 27 can be accurately controlled when the transport vehicle body 27 moves around a curved portion.

[0128] In this embodiment, as described above, the step of controlling the travel speed of the transport vehicle body 27 includes a step of controlling the travel speed of the transport vehicle body 27 based on information on the inclination angle θ of the dolly 30 relative to the transport vehicle body 27 in the vertical plane so that the transport vehicle body 27 stops. This makes it possible to stop the transport vehicle body 27 when, for example, an abnormality occurs in the posture of the dolly 30 due to an abnormality in the wheel 33 of the dolly 30, causing a change in the inclination angle θ of the dolly 30 relative to the transport vehicle body 27 in the vertical plane. This makes it possible to prevent the dolly 30 from tipping over when towing the dolly 30 by the transport vehicle body 27.

[0129] In addition, in this embodiment, as described above, the travel control method for the autonomous guided vehicle 20 includes a step of acquiring information on the inclination angle δ of the guided vehicle body 27 in a vertical plane. The step of controlling the travel speed of the guided vehicle body 27 includes a step of controlling the travel speed of the guided vehicle body 27 so that the guided vehicle body 27 stops based on information on the inclination angle θ of the carriage 30 relative to the guided vehicle body 27 in the vertical plane and information on the inclination angle δ of the guided vehicle body 27 in the vertical plane. This makes it possible to control the guided vehicle body 27 to stop based on not only the inclination angle θ of the carriage 30 relative to the guided vehicle body 27 in the vertical plane, but also the inclination angle δ of the guided vehicle body 27 in the vertical plane. As a result, it is possible to control the guided vehicle body 27 to stop with high accuracy.

[0130] In this embodiment, as described above, the step of controlling the traveling speed of the transport vehicle body 27 includes a step of controlling the traveling speed of the transport vehicle body 27 in consideration of at least one of the shape of the dolly 30, the weight of the dolly 30, and the position of the center of gravity of the dolly 30. This makes it possible to control the traveling speed of the transport vehicle body 27 in consideration of at least one of the shape of the dolly 30, the weight of the dolly 30, and the position of the center of gravity of the dolly 30, which differ depending on the type of dolly 30. As a result, it is possible to appropriately control the traveling speed of the transport vehicle body 27 in accordance with the type of dolly 30.

[0131] In the present embodiment, as described above, the transport vehicle body 27 includes the coupling portion 20d that couples the transport vehicle body 27 and the dolly 30. The transport vehicle body 27 also includes the coupling portion motor 20e that drives the coupling portion 20d. The travel control method for the autonomous transport vehicle 20 also includes a step of controlling the relative attitude of the dolly 30 with respect to the transport vehicle body 27 in a horizontal plane by driving the coupling portion 20d by the coupling portion motor 20e when the transport vehicle body 27 tows the dolly 30. This allows the transport vehicle body 27 to travel while controlling the relative attitude of the dolly 30 with respect to the transport vehicle body 27 in the horizontal plane. As a result, the stability of travel of the transport vehicle body 27 can be improved compared to a case in which the relative attitude of the dolly 30 with respect to the transport vehicle body 27 in the horizontal plane cannot be controlled.

[0132] In this embodiment, as described above, the step of controlling the relative attitude of the carriage 30 with respect to the transport vehicle body 27 in the horizontal plane includes a step of controlling the relative attitude of the carriage 30 with respect to the transport vehicle body 27 in the horizontal plane by driving the connecting part 20d by the connecting part motor 20e when the transport vehicle body 27 turns so as to cancel the movement of the carriage 30 due to inertia. This makes it possible to suppress the carriage 30 from moving like a swing due to inertia when the transport vehicle body 27 turns. As a result, the carriage 30 can be moved compactly when the transport vehicle body 27 turns. This makes it possible to easily perform traveling operations such as turning and turning around at narrow bends.

[0133] In the present embodiment, as described above, the transport vehicle body 27 includes a stopper 20f that limits the movement of the connecting portion 20d. The step of controlling the relative attitude of the cart 30 with respect to the transport vehicle body 27 in the horizontal plane includes a step of controlling the relative attitude of the cart 30 with respect to the transport vehicle body 27 in the horizontal plane by driving the connecting portion 20d by the connecting portion motor 20e within the angle range limited by the stopper 20f. This allows the connecting portion 20d to be driven so as not to come into contact with the stopper 20f when the connecting portion 20d is driven by the connecting portion motor 20e. As a result, it is possible to suppress the load being applied to both the connecting portion 20d and the stopper 20f due to the connecting portion 20d and the stopper 20f coming into contact with each other when the connecting portion 20d is driven by the connecting portion motor 20e. In addition, by providing the stopper 20f, the movement of the connecting portion 20d can be limited. As a result, by limiting the movement of the connecting portion 20d, the movement of the cart 30 can be limited to a predetermined range.

[0134] In this embodiment, as described above, the step of controlling the traveling speed of the transport vehicle body 27 includes a step of acquiring a correction time T required to correct the relative attitude of the carriage 30 with respect to the transport vehicle body 27 by controlling the traveling speed of the transport vehicle body 27, and a step of detecting a traveling abnormality based on a comparison between the correction time T and a reference correction time Te. This makes it possible to detect a traveling abnormality caused by an abnormality such as an abnormality in the floor surface or an abnormality in the wheels of the carriage 30. As a result, when a traveling abnormality is detected, the traveling abnormality can be quickly eliminated.

[0135] In the present embodiment, as described above, the step of controlling the traveling speed of the transportation vehicle body 27 includes a step of learning the reference correction time Te based on the correction time T. This makes it possible to update the reference correction time Te through learning. As a result, it is possible to more accurately detect abnormalities in traveling using the updated reference correction time Te.

[0136] In this embodiment, as described above, the step of learning the reference correction time Te includes a step of learning the reference correction time Te for each of the relative posture of the carriage 30 with respect to the transport vehicle body 27, the traveling speed of the transport vehicle body 27, the weight of the carriage 30, or the traveling direction of the transport vehicle body 27. This makes it possible to learn the reference correction time Te for each case. As a result, the reference correction time Te for each case can be used to more accurately detect traveling abnormalities according to each individual case.

[0137] Furthermore, in this embodiment, as described above, the travel control method for the autonomous guided vehicle 20 includes a step of moving the guided vehicle body 27 to a coupling position with the cart 30 based on the state of the cart 30 when the guided vehicle body 27 and the cart 30 are coupled together. This allows the guided vehicle body 27 and the cart 30 to be automatically coupled together. As a result, it is possible to automate the process from coupling the guided vehicle body 27 and the cart 30 to towing the cart 30 by the guided vehicle body 27.

[0138] (Modification) The embodiments disclosed herein should be considered to be illustrative and not restrictive in all respects. The scope of the present invention is indicated by the claims, not by the description of the embodiments above, and further includes all modifications (variations) within the meaning and scope of the claims.

[0139] For example, in the above embodiment, an example in which the autonomous guided vehicle has four drive wheels is shown, but the present invention is not limited to this. In the present invention, the autonomous guided vehicle may have a number of drive wheels other than four. Furthermore, the autonomous guided vehicle may have a swivel wheel in addition to the drive wheels.

[0140] In the above embodiment, the autonomous guided vehicle is provided with an imaging unit as the state acquisition unit of the present invention, but the present invention is not limited to this. In the present invention, the autonomous guided vehicle may be provided with a state acquisition unit other than the imaging unit, such as a three-dimensional shape measurement unit using a laser. In this case, the pattern of the feature points may be formed by a three-dimensional shape such as unevenness.

[0141] In the above embodiment, an example in which one imaging unit (state acquisition unit) and one feature point are provided has been shown, but the present invention is not limited to this. In the present invention, a plurality of state acquisition units and a plurality of feature points may be provided. In the modified example shown in FIG. 16, a plurality of (two) imaging units 22 are provided in the autonomous guided vehicle 20. Also, a plurality of (two) feature points 31 are provided in the cart 30. In this case, the states of the plurality of feature points 31 can be obtained, so that the relative attitude of the cart 30 with respect to the carrier body 27 can be detected more accurately based on the states of the plurality of feature points 31.

[0142] In the above embodiment, the feature points include markers provided on the dolly, but the present invention is not limited to this. In the present invention, the feature points may include a characteristic shape part, such as a corner of the dolly.

[0143] In the above embodiment, the travel speed of the transport vehicle body is controlled in response to the inclination angle of the dolly relative to the transport vehicle body in a horizontal plane, and the travel speed of the transport vehicle body is controlled in response to the inclination angle of the dolly relative to the transport vehicle body in a vertical plane. However, the present invention is not limited to this. In the present invention, only one of the travel speed of the transport vehicle body in response to the inclination angle of the dolly relative to the transport vehicle body in a horizontal plane and the travel speed of the transport vehicle body in response to the inclination angle of the dolly relative to the transport vehicle body in a vertical plane may be controlled.

[0144] In the above embodiment, the transport vehicle body is stopped based on the information on the inclination angle of the dolly relative to the transport vehicle body in the vertical plane and the information on the inclination angle of the transport vehicle body in the vertical plane, but the present invention is not limited to this. In the present invention, the transport vehicle body may be stopped based only on the information on the inclination angle of the dolly relative to the transport vehicle body in the vertical plane.

[0145] In the above embodiment, the traveling speed of the transport vehicle body is controlled by taking into consideration at least one of the shape, weight, and center of gravity of the cart, but the present invention is not limited to this. In the present invention, the shape, weight, and center of gravity of the cart do not need to be taken into consideration when controlling the traveling speed of the transport vehicle body.

[0146] In the above embodiment, the autonomous guided vehicle is provided with a coupling portion, but the present invention is not limited to this. In the present invention, the cart may be provided with a coupling portion.

[0147] In the above embodiment, the autonomous guided vehicle is provided with a joint motor, but the present invention is not limited to this. In the present invention, the autonomous guided vehicle does not need to be provided with a joint motor.

[0148] In the above embodiment, the autonomous guided vehicle is provided with a pair (two) of stoppers, but the present invention is not limited to this. In the present invention, the autonomous guided vehicle may be provided with a number of stoppers other than one or two. In addition, the autonomous guided vehicle may not be provided with a stopper.

[0149] In the above embodiment, the correction time is acquired and a driving abnormality is detected based on the correction time, but the present invention is not limited to this. In the present invention, the correction time does not have to be acquired.

[0150] In the above embodiment, the reference correction time is learned based on the correction time, but the present invention is not limited to this. In the present invention, the reference correction time may be a fixed value.

[0151] In the above embodiment, the transport vehicle body is moved to the coupling position with the dolly when the transport vehicle body and the dolly are coupled based on the state of the dolly, but the present invention is not limited to this. In the present invention, the transport vehicle body does not have to be moved to the coupling position with the dolly when the transport vehicle body and the dolly are coupled based on the state of the dolly.

[0152] In the above embodiment, for convenience of explanation, the control process is described using a flow-driven flow in which the control process is performed in order according to the processing flow, but the present invention is not limited to this. In the present invention, the control process may be performed by an event-driven process in which the process is executed on an event-by-event basis. In this case, the control process may be performed completely in an event-driven manner, or may be performed by combining event-driven and flow-driven processes. [Explanation of symbols]

[0153] 10 Server (control device) 20 Autonomous guided vehicles 20d connection part 20e Connection motor (drive unit) 20f Stopper 21 Control unit (transport vehicle control unit) 22 Imaging unit (status acquisition unit) 27 Transport vehicle body 30 Carts 31 Features 100 Transport System T correction time Te Reference correction time γ The inclination angle of the cart relative to the vehicle body in the horizontal plane δ The inclination angle of the carrier body in the vertical plane θ The inclination angle of the cart relative to the vehicle body in the vertical plane

Claims

1. A method for controlling travel of an autonomous guided vehicle that autonomously travels by towing a cart, comprising: acquiring a state of the carriage; detecting a relative attitude of the carriage with respect to a transport vehicle body based on a state of the carriage; and controlling a travel speed of the transport vehicle body based on a relative attitude of the carriage with respect to the transport vehicle body, The transport vehicle body or the dolly includes a connecting portion that connects the transport vehicle body and the dolly, The transport vehicle body includes a drive unit that drives the coupling unit, A method for controlling the travel of an autonomous guided vehicle, further comprising a step of controlling the relative attitude of the cart to the guided vehicle body in a horizontal plane by driving the coupling part with the drive part when the cart is towed by the guided vehicle body, so as to cancel out movement of the cart due to inertia.

2. The step of acquiring a state of the cart includes a step of acquiring a state of a feature point of the cart, 2. The autonomous guided vehicle travel control method according to claim 1, wherein the step of detecting the relative attitude of the carriage with respect to the guided vehicle body includes a step of detecting the relative attitude of the carriage with respect to the guided vehicle body based on a state of a characteristic point of the carriage.

3. The method for controlling travel of an autonomous guided vehicle according to claim 2 , wherein the feature points of the vehicle include markers provided on the vehicle.

4. The relative attitude of the dolly with respect to the transport vehicle body includes information on an inclination angle of the dolly with respect to the transport vehicle body, A driving control method for an autonomous guided vehicle according to any one of claims 1 to 3, wherein the step of controlling the running speed of the guided vehicle body includes a step of controlling the running speed of the guided vehicle body based on information on the inclination angle of the cart relative to the guided vehicle body.

5. The autonomous guided vehicle driving control method of claim 4, wherein the step of controlling the traveling speed of the guided vehicle body includes a step of controlling the traveling speed of the guided vehicle body so that the guided vehicle body decelerates based on information of the inclination angle of the carriage relative to the guided vehicle body in a horizontal plane.

6. The autonomous guided vehicle driving control method of claim 4 or 5, wherein the step of controlling the traveling speed of the guided vehicle body includes a step of controlling the traveling speed of the guided vehicle body so that the guided vehicle body stops based on information of the inclination angle of the carriage relative to the guided vehicle body in a vertical plane.

7. Further comprising a step of acquiring information on an inclination angle of the transport vehicle body in a vertical plane, The autonomous guided vehicle driving control method of claim 6, wherein the step of controlling the traveling speed of the guided vehicle body includes a step of controlling the traveling speed of the guided vehicle body so that the guided vehicle body stops based on information on the inclination angle of the carriage relative to the guided vehicle body in a vertical plane and information on the inclination angle of the guided vehicle body in a vertical plane.

8. A driving control method for an autonomous guided vehicle according to any one of claims 1 to 7, wherein the step of controlling the running speed of the guided vehicle body includes a step of controlling the running speed of the guided vehicle body taking into account at least one of the shape of the cart, the weight of the cart, and the center of gravity position of the cart.

9. A driving control method for an autonomous guided vehicle as described in any one of claims 1 to 8, wherein the step of controlling the relative attitude of the cart to the guided vehicle body in a horizontal plane includes a step of controlling the relative attitude of the cart to the guided vehicle body in a horizontal plane so as to cancel out movement of the cart due to inertia by driving the connecting part with the driving part when the guided vehicle body turns.

10. The transport vehicle body further includes a stopper that limits movement of the connecting portion, A driving control method for an autonomous guided vehicle as described in any one of claims 1 to 9, wherein the step of controlling the relative attitude of the cart to the guided vehicle body in a horizontal plane includes a step of controlling the relative attitude of the cart to the guided vehicle body in a horizontal plane by driving the connecting part with the driving part within an angle range limited by the stopper.

11. The step of controlling the traveling speed of the transport vehicle body includes: acquiring a correction time required to correct a relative attitude of the carriage with respect to the transporting vehicle body by controlling a traveling speed of the transporting vehicle body; The method for controlling driving of an autonomous guided vehicle according to any one of claims 1 to 10, further comprising: detecting a driving abnormality based on a comparison between the correction time and a reference correction time.

12. The method for controlling travel speed of the autonomous guided vehicle body according to claim 11, further comprising the step of learning the reference correction time based on the correction time.

13. The autonomous guided vehicle driving control method of claim 12, wherein the step of learning the standard correction time includes a step of learning the standard correction time for each of the relative attitude of the cart with respect to the guided vehicle body, the traveling speed of the guided vehicle body, the weight of the cart, or the traveling direction of the guided vehicle body.

14. The autonomous guided vehicle driving control method according to any one of claims 1 to 13, further comprising a step of moving the guided vehicle body to a coupling position with the cart when the guided vehicle body and the cart are coupled together based on a state of the cart.

15. An autonomous guided vehicle that tows a cart and travels autonomously, A state acquisition unit that acquires a state of the cart; a control unit that detects a relative attitude of the carriage with respect to a transport vehicle body based on the state of the carriage acquired by the state acquisition unit, and controls a travel speed of the transport vehicle body based on the relative attitude of the carriage with respect to the transport vehicle body, The transport vehicle body or the dolly includes a connecting portion that connects the transport vehicle body and the dolly, The transport vehicle body includes a drive unit that drives the coupling unit, The control unit, when the cart is towed by the transport vehicle body, controls the relative attitude of the cart to the transport vehicle body in a horizontal plane by driving the coupling part using the drive unit so as to cancel out the movement of the cart due to inertia.

16. The state acquisition unit is configured to acquire a state of a feature point of the cart, The autonomous guided vehicle according to claim 15 , wherein the control unit is configured to detect a relative attitude of the cart with respect to the vehicle body based on a state of a feature point of the cart acquired by the state acquisition unit.

17. A trolley and An autonomous guided vehicle that tows the cart and travels autonomously; A control device that transmits a command to the autonomous guided vehicle; The autonomous guided vehicle includes: A state acquisition unit that acquires a state of the cart; a transport vehicle control unit that detects a relative attitude of the carriage with respect to a transport vehicle body based on the state of the carriage acquired by the state acquisition unit, and controls a travel speed of the transport vehicle body based on the relative attitude of the carriage with respect to the transport vehicle body, The transport vehicle body or the dolly includes a connecting portion that connects the transport vehicle body and the dolly, The transport vehicle body includes a drive unit that drives the coupling unit, A conveying system in which the conveying vehicle control unit controls the relative attitude of the cart to the conveying vehicle body in a horizontal plane by driving the connecting part with the drive unit when the conveying vehicle body is towing the cart, so as to cancel out the movement of the cart due to inertia.

Images