Transport robot control system and transport robot control method

The transfer robot control system stabilizes the transportation of towed vehicles by estimating caster angles and adjusting the initial movement direction, addressing the instability caused by mismatched steering angles.

JP2024159307APending Publication Date: 2024-11-08PANASONIC INTELLECTUAL PROPERTY MANAGEMENT CO LTD
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
JP2023075212
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-04-28
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

In autonomous mobile devices transporting towed vehicles, the instability of the towed vehicle's posture occurs when the steering angle of its casters differs from the device's moving direction, leading to unstable driving.

Method used

A transfer robot control system and method that includes an angle estimation section to determine the steering angle of the object's casters and an initial movement direction determination section to stabilize the transport robot's movement based on these angles, ensuring gradual changes in direction.

Benefits of technology

This approach stabilizes the transportation of objects by suppressing sudden changes in caster angles, maintaining a consistent posture and ensuring stable travel.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024159307000001_ABST
    Figure 2024159307000001_ABST
Patent Text Reader

Abstract

To stabilize a travel of a transported article.SOLUTION: A transport robot control system 100 comprises an angle estimation unit 197, a movement control unit 193, and an initial motion direction determining unit 198. The angle estimation unit 197 estimates a steering angle of a caster of a transported article which is transported by a transport robot 1. The movement control unit 193 controls a movement of the transport robot 1. The initial motion direction determination unit 198 determines an initial motion direction of the transport robot 1 based on the steering angle of the caster estimated by the angle estimation unit 197 when the transport robot 1 transports the transported article.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present disclosure relates to a transport robot control system and a transport robot control method, and more particularly to a transport robot control system and a transport robot control method for transporting an object having casters. [Background technology]

[0002] The autonomous driving device described in Patent Document 1 is an autonomous driving device that tows a towed vehicle equipped with casters that rotatably support wheels and that can rotate the entire casters along a rotation axis perpendicular to the rotation axis of the wheels. The autonomous driving device includes a vehicle position detection unit that detects the vehicle position, a forward movement control unit that drives and controls the drive wheels of the autonomous driving device so that the autonomous driving device and the towed vehicle move forward, a reverse movement control unit that drives and controls the drive wheels of the autonomous driving device so that the autonomous driving device and the towed vehicle move backward, and a turning control unit that drives and controls the drive wheels of the autonomous driving device so that the autonomous driving device and the towed vehicle turn. When the vehicle position detection unit detects that the autonomous driving device and the towed vehicle have reached a turning position, the forward movement control unit and the turning control unit drive and control the drive wheels of the autonomous driving device so that the autonomous driving device and the towed vehicle turn a predetermined amount while moving forward. The reverse control unit drives and controls the drive wheels of the autonomous driving device so that, when the autonomous driving device and the towed vehicle have turned to a reverse position, the autonomous driving device and the towed vehicle reverse to a target position. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2021-144363 A Summary of the Invention [Problem to be solved by the invention]

[0004] In an autonomous driving device (transport robot) such as that described in Patent Document 1, when the autonomous driving device (transport robot) and the towed vehicle (transported object) change their direction of movement while maintaining a constant posture of the autonomous driving device (transport robot), if the steering angle of the casters of the towed vehicle (transported object) differs from the direction of movement of the autonomous driving device (transport robot), the movement of the towed vehicle (transported object) may become unstable.

[0005] The present disclosure has been made in consideration of the above-mentioned circumstances, and has an object to provide a transport robot control system and a transport robot control method that can stabilize the travel of a transported object. [Means for solving the problem]

[0006] A transport robot control system according to an aspect of the present disclosure includes an angle estimator, a movement controller, and an initial direction determiner. The angle estimator estimates a steering angle of a caster of an object to be transported by a transport robot. The movement controller controls the movement of the transport robot. The initial direction determiner determines an initial direction of the transport robot based on the steering angle of the caster estimated by the angle estimator when the transport robot transports the object.

[0007] A transport robot control method according to an aspect of the present disclosure includes an angle estimation step and an initial movement direction determination step. In the angle estimation step, a steering angle of a caster of an object to be transported by the transport robot is estimated. In the initial movement direction determination step, an initial movement direction of the transport robot is determined based on the steering angle of the caster estimated in the angle estimation step when the transport robot transports the object. Effect of the Invention

[0008] According to the present disclosure, the travel of the transported object can be stabilized. [Brief description of the drawings]

[0009] [Figure 1]FIG. 1 is a block diagram of a transfer robot control system according to an embodiment of the present disclosure. [Diagram 2] FIG. 2 is an external view of a component mounting system in which the above-mentioned transfer robot control system is used. [Diagram 3] FIG. 3 is a bottom view of the transport robot of the transport robot control system when the transport robot is transporting an object. [Figure 4] FIG. 4 is an explanatory diagram for explaining the operation of the angle estimator of the transfer robot control system. [Diagram 5] FIG. 5 is an explanatory diagram for explaining the operation of the angle estimator of the transfer robot control system. [Figure 6] FIG. 6 is a flowchart for explaining the operation of the transfer robot control system. [Figure 7] FIG. 7 is a plan view for explaining the operation of the transport robot included in the transport robot control system. [Figure 8] FIG. 8 is a plan view for explaining the operation of the transport robot of the transport robot control system in the transport start area in the first operation example. [Figure 9] FIG. 9 is a plan view for explaining the operation of the transport robot of the transport robot control system in the transport start area in the first operation example. [Figure 10] FIG. 10 is a plan view for explaining an operation of the transport robot of the transport robot control system in the first operation example in the first direction change area. [Figure 11] FIG. 11 is a plan view for explaining an operation of the transport robot of the transport robot control system in the first operation example in the first direction change area. [Figure 12] FIG. 12 is a plan view for explaining the operation of the transport robot of the transport robot control system in the first operation example in the second direction change area. [Figure 13]FIG. 13 is a plan view for explaining the operation of the transport robot of the transport robot control system in the first operation example in the second direction change area. [Figure 14] FIG. 14 is a plan view for explaining the operation of the transport robot of the transport robot control system in the first operation example in a target area. [Figure 15] FIG. 15 is a bottom view of the transport robot of the transport robot control system according to the second operation example, in a state where the transport robot is transporting an object to be transported. [Figure 16] FIG. 16 is a plan view for explaining the operation of the transport robot of the transport robot control system in the second operation example. [Figure 17] FIG. 17 is a bottom view for explaining the operation of the initial-movement-direction determining unit of the transport robot control system according to the modified example. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0010] A transfer robot control system 100 according to an embodiment of the present disclosure will be described in detail with reference to the drawings. Note that each figure referred to in the following description is a schematic diagram, and the size and thickness ratio of each component in each figure does not necessarily reflect the actual dimensional ratio. In addition, the embodiment and modified example described below are merely examples of the present disclosure, and the present disclosure is not limited to the embodiment and modified example. Even if it is not the embodiment and modified example, various modifications are possible according to the design, etc., as long as it does not deviate from the technical idea of ​​the present disclosure.

[0011] (1) Overview First, an overview of a transfer robot control system 100 according to the present embodiment will be described with reference to FIGS. 1, 4, 5, and 8. FIG.

[0012] As shown in FIG. 1, the transfer robot control system 100 includes an angle estimator 197, a movement controller 193, and an initial movement direction determiner 198.

[0013] The angle estimation unit 197 estimates the steering angle θ0 of the caster C0 of the transported object 2 transported by the transport robot 1, as shown in FIGS.

[0014] The movement control unit 193 controls the movement of the transfer robot 1 .

[0015] The initial movement direction determination unit 198 determines the initial movement direction Df of the transport robot 1 based on the steering angle θ0 of the caster C0 estimated by the angle estimation unit 197 when the transport robot 1 transports the transported object 2.

[0016] Here, the "initial movement direction Df of the transport robot 1" is the direction in which the transport robot 1 starts moving after the angle estimator 197 has completed estimating the steering angle θ0 of the caster C0.

[0017] According to the above configuration, when the transport robot 1 changes its moving direction, the transport robot 1 starts moving in the initial direction Df determined based on the steering angle θ0 of the caster C0, thereby preventing the steering angle θ0 of the caster C0 from changing suddenly, and stabilizing the travel of the transported object 2. Note that "the transport robot 1 changes its moving direction" includes not only the transport robot 1 changing its moving direction while moving, but also the transport robot 1 starting to move while stopped.

[0018] (2) Details The transport robot control system 100 according to this embodiment will be described in detail below with reference to the drawings. In the following description, in Figs. 7 to 14 and 16, the X-axis direction is defined as the left-right direction, the Y-axis direction as the front-rear direction, and the positive direction in the X-axis direction is defined as the right side, and the positive direction in the Y-axis direction is defined as the front side. These directions are defined when the transport robot 1 travels while towing the transported object 2, and are not intended to limit the directions of the transport robot 1 when in use to these directions. Also, the arrows indicating the respective directions in the drawings are merely shown for the purpose of explanation and do not have any substance.

[0019] (2.1) Overall configuration of the transport robot control system As shown in FIG. 1, the transport robot control system 100 includes a transport robot 1 that transports an object 2, and a host system 3 that controls the transport operation of the object 2 by the transport robot 1.

[0020] The transport robot 1 and the host system 3 are configured to be able to communicate with each other. In the present disclosure, "capable of communication" means that information can be exchanged directly or indirectly via the network NT1 or the relay device 6 by an appropriate communication method such as wired communication or wireless communication. In this embodiment, the host system 3 and the transport robot 1 can communicate in both directions, and both the host system 3 can transmit information to the transport robot 1 and the transport robot 1 can transmit information to the host system 3. In FIG. 1, the number of transport robots 1 is one, but the number of transport robots 1 may be two or more. In other words, the host system 3 may control the transport work by each of the multiple transport robots 1. In addition, the transport robot 1 can transport multiple types of transported objects 2. In other words, the host system 3 may control the transport work of multiple types of transported objects 2 by the multiple transport robots 1.

[0021] As shown in FIG. 2, the transfer robot control system 100 of this embodiment is used in a component mounting system 200 including a component mounter 4 that mounts a component E1 on a board E2.

[0022] The supply of components E1 to the component mounter 4 is performed by a component supplying device 5. Here, the component supplying device 5 is a transported object 2 possessed by the transport robot control system 100, and is transported to the component mounter 4 by a transport robot 1 provided in the transport robot control system 100. In other words, the transported object 2 is the component supplying device 5 that supplies components E1 to the component mounter 4 that mounts the components E1 on the board E2.

[0023] In this embodiment, the transport robot 1, for example, receives instructions from a higher-level system 3, and moves the transported object 2 placed at a certain location within a specified area in which the component mounting system 200 is installed, to a position where it will be connected to the component mounting machine 4.

[0024] (2.2) Carried object As explained in "(2.1) Overall Configuration of the Transport Robot Control System", in this embodiment, the transported object 2 is a component supplying device 5 that supplies components E1 to a component mounter 4 that mounts the components E1 on a board E2. Here, the component supplying device 5 includes, for example, at least one of a tape supplying unit that supplies a reel around which a tape having the components E1 attached is wound, a tray supplying unit for supplying trays on which the components are placed, a batch exchange cart for supplying multiple types of components, a tape scrap collection box, a mask magazine cart, a solder pod exchange cart, and a cart for carrying materials before and after work.

[0025] As shown in FIG. 3, the transported object 2 has a main body 20 and a plurality of (for example, four) casters C0.

[0026] The main body 20 is formed, for example, in a rectangular parallelepiped shape. Here, the short side direction of the main body 20 is defined as a first direction DR1, and the long side direction is defined as a second direction DR2.

[0027] A gripped portion 21 that is gripped by a gripping portion 13 (described later) of the transfer robot 1 is provided on a front surface 201 of the main body 20.

[0028] Four casters C0 (C1A to C4A) are provided on the underside of the main body 20. Specifically, casters C1A, C2A are provided side by side along the first direction DR1 on the front surface 201 side of the underside. Casters C3A, C4A are provided side by side along the first direction DR1 on the rear surface 202 side of the underside. This allows the transported object 2 to move on the movement surface G1 (see FIG. 2).

[0029] As shown in FIG. 3 and FIG. 8 to FIG. 14, the four casters C0 (C1A to C4A) are each configured to be rotatable about a steering axis Ax0 (Ax1 to Ax4) along a direction (up-down direction) perpendicular to the moving surface G1. In other words, the four casters C0 are configured so that their respective steering angles θ0 (θ1 to θ4) change in accordance with the moving direction of the transport robot 1 when the transport robot 1 is in a transported state. In this disclosure, the "steering angle θ0 of the caster C0" refers to the inclination of the rotation axis (axle) Aw0 of the caster C0 with respect to the first direction DR1. In the following description, the axles Aw0 of the casters C1A to C4A may be referred to as axles Aw1 to Aw4, respectively.

[0030] Moreover, the steering axis Ax0 of the caster C0 is provided at a position separated from the axle Aw0 of the caster C0 when viewed from the top-bottom direction. Here, in a state in which the transported object 2 is transported by the transport robot 1, when the axle Aw0 is parallel to the first direction DR1 and the axle Aw0 is on the rear surface 202 side of the main body 20 with respect to the steering axis Ax0, the steering angle θ0 is 0° (360°). Also, it is assumed that the steering angle θ0 of the caster C0 increases counterclockwise (in Figs. 8 to 14).

[0031] (2.3) Transport robot 2 and 3, the transport robot 1 is a vehicle-type robot for transporting an object 2. In the following description, the transport robot 1 is described as a towing-type vehicle-type robot that transports the object 2 by towing it.

[0032] In this embodiment, the host system 3 communicates with the transport robot 1 via the network NT1 and the relay device 6, and indirectly controls the movement of the transport robot 1.

[0033] 8 to 14, the transport robot 1 autonomously travels on a flat moving surface G1 consisting of, for example, a floor surface. The transport robot 1 can travel on the moving surface G1 while holding a transport target 2. This allows the transport robot 1 to transport the transport target 2 placed at a certain location to another location (a target point Pg) by, for example, pulling or pushing the transport target 2 with the transport robot 1.

[0034] The transfer robot 1 includes a storage battery, such as a lithium ion battery or a nickel-metal hydride battery, and operates using electrical energy stored in the storage battery.

[0035] 3, the transport robot 1 has a main body 10 and at least one (e.g., two) steering wheel 11 that is provided on the main body 10 and has a changeable steering angle. The transport robot 1 further has a plurality of auxiliary wheels 12 (e.g., two in this embodiment).

[0036] The main body 10 is formed, for example, in a rectangular parallelepiped shape. Here, when the transport robot 1 is gripping the transported object 2, the longitudinal direction of the main body 10 is aligned with a first direction DR1 which is a short side direction of the main body 20 of the transported object 2, and the short side direction of the main body 10 is aligned with a second direction DR2 which is a longitudinal direction of the main body 20. In other words, when the transport robot 1 is gripping the transported object 2, the longitudinal direction of the main body 10 is the first direction DR1, and the short side direction of the main body 10 is the second direction DR2.

[0037] The two steering wheels 11 and the two auxiliary wheels 12 are disposed on the underside of the main body 10. In this embodiment, the two steering wheels 11 are disposed so as to be aligned along a first direction DR1 with respect to the main body 10. In addition, the two auxiliary wheels 12 are disposed so as to be aligned along a second direction DR2 with respect to the main body 10.

[0038] In this embodiment, as described above, the steering angle of the steering wheel 11 is changeable. Here, the "steering angle of the steering wheel 11" refers to the inclination of the rotation axis (axle) of the steering wheel 11 with respect to the first direction DR1. That is, the steering wheel 11 is integrated with a drive mechanism that rotates the steering wheel 11 around the axle and a steering mechanism that changes the inclination of the axle of the steering wheel 11 with respect to the first direction DR1.

[0039] The two auxiliary wheels 12 are driven wheels that change direction to follow the moving direction of the transport robot 1.

[0040] The transfer robot 1 further includes a gripping unit 13. The gripping unit 13 is provided on the rear surface 101 of the main body 10. The gripping unit 13 is provided corresponding to a gripped portion 21 of the transfer target 2.

[0041] The transport robot 1 holds the transported object 2 by gripping the gripped portion 21 of the transported object 2 with the gripper 13. The transport robot 1 moves together with the transported object 2 held by the transport robot 1. Here, the gripper 13 may grip the gripped portion 21 by a mechanical mechanism or may grip the gripped portion 21 by a mechanism using magnetic attraction force or the like.

[0042] When the transport robot 1 transports the transport object 2, there are three travel modes: the transport robot 1 leads the transport object 2 and tows it; the transport robot 1 leads the transport object 2 and pushes it; and the transport robot 1 slides in the first direction DR1 to transport the transport object 2. Generally, the travel mode in which the transport robot 1 tows the transport object 2 is more stable than the travel mode in which the transport object 2 is pushed from behind, so the transport robot 1 usually moves by towing the transport object 2.

[0043] As shown in FIG. 1, the transfer robot 1 further includes a gripping drive unit 14, a moving unit 15, a detection unit 16, a communication unit 17, a storage unit 18, and a control unit 19.

[0044] The grip driving unit 14 drives the grip unit 13 to cause the transport robot 1 to hold the transport target object 2. The grip driving unit 14 is accommodated inside the main body 10.

[0045] The moving unit 15 controls the rotation and steering angle of the steering wheel 11. The moving unit 15 is built into the main body 10. The moving unit 15 includes, for example, an electric motor, and indirectly applies the driving force generated by the electric motor to the steering wheel 11 via a gear box, a belt, or the like. The moving unit 15 may also be configured to apply the driving force directly to the steering wheel 11, such as an in-wheel motor.

[0046] This allows the transfer robot 1 to move in any direction on the moving surface G1. Also, the transfer robot 1 can move in any direction on the moving surface G1 while keeping the main body 10 in a constant posture.

[0047] 3, the detection unit 16 detects the presence or absence of an object in a detection area A1 around the main body 10 of the transfer robot 1. The detection area A1 is set to a sector-shaped area centered on the detection unit 16. Note that the detection area A1 is not limited to a sector-shaped area and can be set arbitrarily.

[0048] The detection unit 16 is a range sensor (distance measurement sensor) and is realized by, for example, LiDAR (Light Detection and Ranging). Note that the detection unit 16 is not limited to LiDAR. This type of sensor may be a sensor that measures the distance to an object by using at least one of sound waves, light, and radio waves.

[0049] 3, the detection unit 16 is provided at a central position along the first direction DR1 on the lower surface of the main body 10. In addition to the detection unit 16, the transfer robot 1 may further include a range sensor that detects the presence or absence of an object in a detection area different from that of the detection unit 16.

[0050] The communication unit 17 is configured to be able to communicate with the upper system 3. In this embodiment, the communication unit 17 communicates with one or more relay devices 6 installed in the area where the transport robot 1 is operated by wireless communication using radio waves as a medium. Therefore, the communication unit 17 and the upper system 3 communicate indirectly through at least the network NT1 and the relay device 6. In other words, each relay device 6 is a device (access point) that relays communication between the communication unit 17 and the upper system 3. The relay device 6 communicates with the upper system 3 through the network NT1. In this embodiment, as an example, wireless communication conforming to standards such as Wi-Fi (registered trademark), Bluetooth (registered trademark), ZigBee (registered trademark), or low-power radio (specific low-power radio) that does not require a license is adopted for communication between the relay device 6 and the communication unit 17. In addition, the network NT1 is not limited to the Internet, and may be, for example, a local communication network within the area where the transport robot 1 is operated or within the operating company of this area.

[0051] The storage unit 18 includes a rewritable non-volatile memory such as an EEPROM (Electrically Erasable and Programmable Read-Only Memory). The storage unit 18 stores in advance electronic map information of the moving surface G1 along which the transport robot 1 moves. The electronic map information of the moving surface G1 includes position information of objects to be placed on the moving surface G1.

[0052] The control unit 19 mainly comprises a computer system having one or more processors and a memory. The functions of the control unit 19 are realized by the processor of the computer system executing a program recorded in the memory of the computer system. The program may be recorded in the memory, or may be provided via a telecommunication line such as the Internet, or may be provided by recording it on a non-transitory recording medium such as a memory card.

[0053] 1, the control unit 19 has functions such as a grip control unit 191, a position detection unit 192, a movement control unit 193, a movement area setting unit 194, a traveling direction setting unit 195, a determination unit 196, an angle estimation unit 197, an initial direction determination unit 198, an acquisition unit 199, and a request unit 190. Note that these merely indicate functions realized by the control unit 19, and do not necessarily indicate actual configurations.

[0054] The grip control unit 191 controls the grip driving unit 14 to cause the gripping unit 13 to grip the gripped part 21 .

[0055] The position detection unit 192 detects the current position (current location) of the main body 10. For example, the position detection unit 192 estimates the current position of the main body 10 on the moving plane G1 based on detection information of surrounding objects by the detection unit 16 provided in the transport robot 1 and electronic map information of the moving plane G1 in the facility. The position detection unit 192 may estimate the current position on the moving plane G1 by using a local positioning system (LPS) using a radio wave beacon. That is, the position detection unit 192 may estimate the current position based on the radio wave intensity when a beacon signal transmitted from each of a plurality of transmitters installed in the facility is received by a receiver provided in the transport robot 1 and the installation positions of each transmitter. The position detection unit 192 may also estimate the current position of the main body 10 by using a global navigation satellite system (GNSS) such as a global positioning system (GPS). The position coordinates of the main body 10 detected by the position detection unit 192 may be position coordinates in a two-dimensional orthogonal coordinate system set on the moving plane G1, or may be position coordinates in a three-dimensional orthogonal coordinate system.

[0056] The movement control unit 193 controls the movement of the transport robot 1. Here, the movement control unit 193 can change the steering angle of the two steering wheels 11 to move the transport robot 1 in all directions on the moving surface G1 on which the transport robot 1 moves while keeping the attitude of the main body 10 relative to the traveling direction of the transport robot 1 constant.

[0057] The movement control unit 193 controls the moving unit 15 based on a control command received by the communication unit 17 from the higher-level system 3 to move the main body 10 .

[0058] The movement area setting unit 194 sets a movement area AR10 (see FIG. 7) of the main body 10 from the current position to the target point Pg based on information on the current position of the main body 10 detected by the position detection unit 192 and information on the target point Pg received from the higher-level system 3. The movement area AR10 is an area on the movement plane G1 and includes the current position and the target point Pg. The main body 10 moves from the current position to the target point Pg by moving within the movement area AR10. The position of the main body 10 is defined, for example, by the position of the center point of the main body 10 in the first direction DR1 and the second direction DR2.

[0059] The travel direction setting unit 195 sets a target travel direction Dt of the main body 10 in a predetermined unit area AR0 within the movement area AR10. The function of the travel direction setting unit 195 and the target travel direction Dt will be described in detail in "(2.5) Operation Example".

[0060] The determination unit 196 determines whether the detection unit 16 can detect the steering angle θ0 of the caster C0 of the transported object 2 transported by the transport robot 1.

[0061] The angle estimation unit 197 estimates the steering angle θ0 when the determination unit 196 determines that the steering angle θ0 can be detected by the detection unit 16. As an example, a method for estimating the steering angle θ0 (θ1) of the caster C1A by the angle estimation unit 197 will be described below with reference to Figures 4 and 5. Note that the steering angles θ2 to θ4 of the casters C2A to C4A can also be estimated in the same manner as the steering angle θ1.

[0062] As shown in FIGS. 4 and 5, the caster C1A is rotatable within a rotation area As around the steering axis Ax1.

[0063] 4, a case will be described in which the rear end C11 of the caster C1A is located within a common area Ac, which is included in the detection area A1 and is a sector area Af having a radius equal to the distance between the center point (reference point Ps) of the detection unit 16 and the steering axis Ax1, and which is overlapped with the rotation area As. Note that the "rear end C11" here refers to the end of the caster C1A on the opposite side to the steering axis Ax1 in the longitudinal direction when the caster C1A is viewed from below.

[0064] In this case, the angle estimation unit 197 estimates the steering angle θ1 of the caster C1A based on the position of the nearest point Pc that is closest to the reference point Ps on the caster C1A. More specifically, when the rear end C11 of the caster C1A is located within the common area Ac, the nearest point Pc is a point on the rear end C11. Therefore, the angle estimation unit 197 can estimate the direction in which the rear end C11 of the caster C1A exists relative to the steering axis Ax1 based on the position of the nearest point Pc and, for example, the position of the steering axis Ax1 acquired in advance, and can estimate the steering angle θ1. In other words, the angle estimation unit 197 estimates the inclination of the line perpendicular to the line connecting the nearest point Pc and the steering axis Ax1 with respect to the first direction DR1 as the steering angle θ1. This simplifies the estimation process of the steering angle θ2 of the angle estimation unit 197 compared to the case where the steering angle θ1 is estimated from the entire shape of the caster C2A detected by the detection unit 16.

[0065] Also, as shown in Figure 5, when the rear end portion C11 is located outside the common area Ac, the steering angle θ1 cannot be estimated from the position of the nearest point Pc, so the angle estimation unit 197 estimates the steering angle θ1 from the overall shape of the caster C1A detected by the detection unit 16.

[0066] The initial direction determination unit 198 determines the initial direction Df of the transport robot 1 based on the steering angle θ0 of the caster C0 estimated by the angle estimation unit 197 when the transport robot 1 transports the transported object 2. If the angle estimation unit 197 is unable to estimate the steering angle θ0 of the caster C0, the initial direction determination unit 198 sets the previous moving direction of the transport robot 1 as the initial direction Df. Here, the "previous moving direction of the transport robot 1" refers to the direction in which the transport robot 1 was moving immediately before the angle estimation unit 197 starts estimating the steering angle θ0 of the caster C0. The function of the initial direction determination unit 198 and the initial direction Df will be described in detail in "(2.5) Operation Example".

[0067] When the angle estimation unit 197 cannot estimate the steering angle θ0 of the caster C0, the acquisition unit 199 acquires the previous movement direction of the transport robot 1 from the host system 3. Specifically, when the angle estimation unit 197 cannot estimate the steering angle θ0 of the caster C0, the acquisition unit 199 acquires the previous movement direction of the transport robot 1 from the storage unit 35 of the host system 3 that stores the movement history of the transport robot 1.

[0068] When the host system 3 controls the transporting operation of a plurality of types of transported objects 2, the request unit 190 inquires of the host system 3 about the type of the transported object 2 currently being transported by the transport robot 1. Specifically, the request unit 190 transmits a request signal to the host system 3 to make the host system 3 respond with the type of the transported object 2.

[0069] Furthermore, the transport robot 1 is appropriately provided with components other than those described above, such as a charging circuit for a storage battery.

[0070] (2.4) Host System The host system 3 is a system for controlling the transport robot 1, and is realized by, for example, a server device including a computer system. The host system 3 indirectly controls the transport robot 1 by issuing instructions to the transport robot 1. Specifically, when the host system 3 issues an instruction to the transport robot 1 to transport the transported object 2, the transport robot 1 autonomously performs a transport operation to move the transported object 2 to the target point Pg in response to the transport instruction. The host system 3 may be located inside the facility where the transport robot 1 performs the transport operation, or outside the facility.

[0071] As shown in FIG. 1, the upper system 3 includes a control unit 31, a communication unit 32, an operation reception unit 33, a display unit 34, and a storage unit 35.

[0072] The communication unit 32 communicates with the transport robot 1 via the network NT1 and the relay device 6. As a communication method between the communication unit 32 and the relay device 6, an appropriate communication method such as wireless communication or wired communication is adopted.

[0073] The operation acceptance unit 33 has a function of accepting operations of a user who uses the higher-level system 3. In this embodiment, the operation acceptance unit 33 is realized by, for example, a pointing device such as a mouse, a keyboard, or a combination of these. The operation acceptance unit 33 may also be realized by a voice recognition unit that accepts operations by voice uttered by the user. The operation acceptance unit 33 may accept information input to a terminal such as a tablet terminal used by the user via the communication unit 32.

[0074] The display unit 34 is used to present information to a user who uses the higher-level system 3. The display unit 34 is realized by a display device such as a liquid crystal display or an organic EL display. When the higher-level system 3 has a touch panel display, the touch panel display may function as the operation receiving unit 33 and the display unit 34.

[0075] The storage unit 35 includes, for example, a rewritable non-volatile memory such as an EEPROM. The storage unit 35 stores, for example, a transportation plan for the transported object 2 input by a user of the upper system 3. The storage unit 35 also stores a movement history of the transport robot 1.

[0076] Here, the transportation plan for the transported object 2 includes the transport destination of the transported object 2, the date and time of transportation, etc. When the higher-level system 3 controls the transportation of multiple types of transported objects 2, the storage unit 35 stores the transportation plans for each of the multiple types of transported objects 2. The storage unit 35 may store information about the transport robot 1 that has been instructed to transport the transported object 2 based on the transportation plan (for example, a mobile object ID assigned to each transport robot 1).

[0077] The control unit 31 mainly comprises a computer system including, for example, a memory and a processor. That is, the functions of the control unit 31 are realized by the processor executing a program recorded in the memory of the computer system. The program may be pre-recorded in the memory, may be provided via a telecommunication line such as the Internet, or may be provided by recording it on a non-transitory recording medium such as a memory card.

[0078] The control unit 31 has functions such as a transport instruction unit 311 and a response unit 312. Note that these merely indicate functions realized by the control unit 31 and do not necessarily indicate actual configurations.

[0079] The transport instruction unit 311 gives the transport robot 1 a control instruction (transport instruction) for transporting the transport object 2 via the communication unit 32. The transport instruction unit 311 gives the transport robot 1 a transport instruction to transport the transport object 2, which is placed at a certain location on the moving surface G1, to the target point Pg, for example, thereby causing the transport robot 1 to transport the transport object 2 to the target point Pg. For example, the transport instruction unit 311 transmits a transport instruction including information on the position where the transport object 2 is located, information on the target point Pg, and the like, to the transport robot 1, thereby causing the transport robot 1 to perform a gripping operation of gripping the transport object 2 and a transporting operation of transporting the gripped transport object 2 to the target point Pg.

[0080] When the reply unit 312 receives a request signal for replying the type of the transported object 2 from the request unit 190 of the transport robot 1, it transmits information unique to the type of the transported object 2 (transported object ID) to the transport robot 1.

[0081] (2.5) Example of operation An example of the operation of the transport robot control system 100 will be described below with reference to Fig. 6 to Fig. 16. Note that the flowchart shown in Fig. 6 is merely an example of the operation of the transport robot control system 100, and the order of processes may be changed as appropriate, and processes may be added or omitted as appropriate.

[0082] 8 to 14, the casters C1A to C4A, which are actually hidden by the main body 20, are made visible.

[0083] In the following description, as shown in FIG. 7, four component mounters 4 (41 to 44) are installed lined up in the left-right direction on the moving surface G1, and the transport robot control system 100 controls the transport robot 1 to transport the transported object 2 (component supply device 5) to a position where the component E1 can be supplied to the component mounter 42.

[0084] The transport robot control system 100 controls the transport of a plurality of types of transport objects 2, and each of the plurality of types of transport objects 2 has a different number and arrangement of casters C0, for example.

[0085] (2.5.1) First operation example Below, we will explain an example of the operation of the transport robot control system 100 when the transport robot 1 transports a transport object 2A, which is one type of transport object 2 out of multiple types of transport objects 2 that are the transport targets of the transport robot control system 100, as shown in Figure 3.

[0086] The transported object 2A has a main body 10 and four casters C0 (casters C1A to C4A). The casters C1A and C2A are arranged side by side along the first direction DR1. The casters C3A and C4A are arranged side by side along the first direction DR1. The casters C1A and C3A are arranged side by side along the second direction DR2. The casters C2A and C4A are arranged side by side along the second direction DR2. In other words, the distance between the casters C1A and C2A is equal to the distance between the casters C3A and C4A.

[0087] First, the transport instruction unit 311 of the higher-level system 3 issues a transport instruction to the transport robot 1 waiting, for example, at a waiting place or the like, to transport the transported object 2 to the target point Pg. At this time, the transport instruction unit 311 transmits information on the position of the transported object 2 to be transported and information on the destination (target point Pg) of the transported object 2 to be transported to the transport robot 1. When the communication unit 17 receives the transport instruction from the transport instruction unit 311, the movement control unit 193 moves the main body 10 to a point (grasping point) where the transported object 2 can be grasped.

[0088] When the main body 10 arrives at the gripping point, the grip control unit 191 controls the grip driving unit 14 to cause the gripping unit 13 to grip the gripped part 21 (step ST1).

[0089] When the gripping portion 13 grips the gripped portion 21 at the gripping point, the movement control portion 193 transports the main body 10 to a predetermined transport start point P0.

[0090] At the transfer start point P0, the movement area setting unit 194 sets a movement area AR10 of the main body 10 from the transfer start point P0 to the target point Pg based on information on the current position (transfer start point P0) of the main body 10 detected by the position detection unit 192 and information on the target point Pg received from the upper system 3 (step ST2). Specifically, the movement area setting unit 194 virtually divides the movement plane G1 into a plurality of square unit areas AR0. As shown in FIG. 7, the movement area AR10 includes a transfer start area ARs, a connection area AR1 to AR4, a first direction change area ARc1, a second direction change area ARc2, and a target area ARg. The transfer start area ARs is a unit area AR0 including the transfer start point P0. The first direction change area ARc1 and the second direction change area ARc2 are unit areas AR0 in which the movement direction of the main body 10 needs to be changed. Moreover, the connection areas AR1 and AR2 are unit areas AR0 that connect the transfer start area ARs and the first direction change area ARc1. Moreover, the connection areas AR3 and AR4 are unit areas AR0 that connect the first direction change area ARc1 and the second direction change area ARc2. The target area ARg is a unit area AR0 that includes the target point Pg. Here, in the transfer start area ARs, the first direction DR1 of the transfer object 2A and the transfer robot 1 holding the transfer object 2A coincides with the left-right direction on the moving surface G1, and the second direction DR2 coincides with the front-rear direction on the moving surface G1.

[0091] Furthermore, for example, when the main body 10 reaches the transfer start point P0, the request unit 190 transmits a request signal to the upper system 3 to make the upper system 3 respond with the type of the transported object 2. At this time, the request signal includes, for example, information (mobile object ID) specific to the transport robot 1 that transmitted the request signal.

[0092] When the response unit 312 of the higher-level system 3 receives a request signal from the request unit 190 via the communication unit 32, the response unit 312 identifies the type of the transported object 2 transported by the transport robot 1 based on the moving object ID included in the request signal and the transport plan for the transported object 2 stored in the storage unit 35. In the first operation example, the response unit 312 identifies the type of the transported object 2 transported by the transport robot 1 as the transported object 2A.

[0093] The reply unit 312 transmits to the transport robot 1 the identification information including the identified type of the transport object 2 (the transport object 2A).

[0094] When receiving the specific information including the type of the transported object 2 (transported object 2A) from the upper system 3, the travel direction setting unit 195 sets the target travel direction Dt (first target travel direction Dt1) of the main body 10 in the transfer start area ARs (step ST3). Specifically, the travel direction setting unit 195 sets the first target travel direction Dt1 to the direction (forward) from the transfer start area ARs toward the first direction change area ARc1.

[0095] Next, the determination unit 196 determines whether or not the detection unit 16 can detect the steering angle θ0 of the predetermined caster C0 set according to the type of the transported object 2 (step ST4). Here, in the first operation example, the predetermined caster C0 set according to the type of the transported object 2 is the caster C1A to C4A of the transported object 2A. Correspondence information between the type of the transported object 2 and the predetermined caster C0 is stored, for example, in the memory unit 18 of the transport robot 1. Note that the predetermined caster C0 may be a part of the casters C1A to C4A.

[0096] Here, in a state where the main body 10 is located at the transfer start point P0, as shown in FIG. 3, the detection area A1 of the detection unit 16 includes the shielded areas Ah1A and Ah2A that are shielded by the casters C1A and C2A, respectively. However, in a state where the main body 10 is located at the transfer start point P0, the casters C3A and C4A are located in an area outside the shielded areas Ah1A and Ah2A within the detection area A1. Therefore, since the detection unit 16 can detect the casters C1A to C4A, the determination unit 196 determines that the predetermined caster C0 (casters C1A to C4A) can be detected (step ST4: Yes). In other words, the determination unit 196 determines that the angle estimation unit 197 can estimate the steering angle θ0 (θ1 to θ4) of the predetermined caster C0 (casters C1A to C4A).

[0097] When the determination unit 196 determines that the casters C1A to C4A are detectable, the angle estimation unit 197 of the transport robot 1 estimates the steering angle θ0 (θ1 to θ4) of a predetermined caster C0 that is set according to the type of the transported object 2 (step ST5).

[0098] The initial direction determination unit 198 determines the initial direction Df of the transport robot 1 (main body 10) based on the steering angles θ1 to θ4 (step ST6). Specifically, the initial direction determination unit 198 determines the initial direction Df of the main body 10 based on the average value of the steering angles θ1 to θ4 estimated by the angle estimation unit 197. Here, in the first operation example, it is assumed that the angle estimation unit 197 estimates the steering angles θ1 to θ4 in the transport start area ARs as steering angle θ1=-45°, steering angle θ2=-60°, steering angle θ3=-45°, and steering angle θ4=-60°. At this time, the average value of the steering angles θ1 to θ4 (average steering angle θav) is -52.5°. The initial direction determination unit 198 determines the initial direction Df (first initial direction Df1) of the main body 10 in the transfer start area ARs to be a direction tilted by an average steering angle θav from the front-rear direction (the Y-axis direction in FIG. 8). More specifically, the initial direction determination unit 198 determines the first initial direction Df1 of the main body 10 in the transfer start area ARs to be a direction tilted by 52.5° to the right with respect to the front-rear direction.

[0099] Based on the first initial direction Df1 and the first target travel direction Dt1, the movement control unit 193 moves the main body 10 of the transfer robot 1 from the current position (transfer start point P0) to the first point P1, which is a target direction point where the movement direction of the main body 10 becomes the first target travel direction Dt1 (step ST7). The movement operation of the main body 10 from the transfer start point P0 to the first point P1 by the movement control unit 193 will be described in detail below.

[0100] When the travel direction setting unit 195 sets the first target travel direction Dt1 to forward, the movement control unit 193 moves the main body 10 from the transfer start point P0 along a route (first route R1) including the curved portion Cv1 while keeping the posture of the main body 10 constant, as shown in Figs. 7 to 9. In other words, the first route R1 from the transfer start point P0 to the first point P1 includes the curved portion Cv1. More specifically, the curved portion Cv1 includes a circular arc Ca1. The circular arc Ca1 is, for example, a circular arc with the first initial movement direction Df1 as a tangent.

[0101] Here, since the main body 20 of the carried object 2 moves following the main body 10, the steering angles θ1 to θ4 rotate counterclockwise about the steering axes Ax1 to Ax4 as the main body 10 moves along the first path R1. Then, as shown in Fig. 9, when the moving direction of the main body 10 becomes forward, which is the first target traveling direction Dt1, at the first point P1, the steering angles θ1 to θ4 each become approximately 0°. Note that the movement control unit 193 may move the main body 10 along the first path R1 so that the change amount (rotation amount) of the steering angles θ1 to θ4 per unit time is constant.

[0102] This allows the movement direction of the main body 10 and the main body 20 of the transported object 2 to be gradually changed from the first initial direction Df1 to the first target travel direction Dt1 without suddenly changing the steering angles θ1 to θ4, thereby stabilizing the travel of the transported object 2A.

[0103] When the movement direction of the main body 10 becomes the first target traveling direction Dt1, as shown in FIG. 7, the movement control unit 193 moves the main body 10 forward along the straight path Rs1 to a second point P2 within the first direction change area ARc1.

[0104] When the main body 10 moves to the second point P2 in the first direction change area ARc1, the travel direction setting unit 195 changes the target travel direction Dt to the second target travel direction Dt2, which is the direction (left) from the first direction change area ARc1 to the second direction change area ARc2 (step ST8: Yes).

[0105] When the target traveling direction Dt is changed, the initial direction determination unit 198 determines the initial direction Df again. In the first operation example, the determination unit 196 determines that the casters C1A to C4A can be detected in the first direction change area ARc1 and the second direction change area ARc2 (step ST4: Yes).

[0106] The initial movement direction determination unit 198 again determines the initial movement direction Df of the main body 10 based on the steering angles θ1 to θ4 when the main body 10 is at the second point P2 (steps ST5 to ST6). Here, it is assumed that the angle estimation unit 197 estimates that the steering angles θ1 to θ4 are all 0° in the first direction change area ARc1. At this time, the average value of the steering angles θ1 to θ4 (average steering angle θav) is 0°. The initial movement direction determination unit 198 determines the initial movement direction Df (second initial movement direction Df2) of the main body 10 in the first direction change area ARc1 to be forward, which is a direction that is not inclined with respect to the front-to-rear direction.

[0107] When the target travel direction Dt is changed, the movement control unit 193 moves the transport robot 1 to a target direction point (third point P3) where the movement direction of the transport robot 1 becomes the changed target travel direction Dt based on the initial movement direction Df (second initial movement direction Df2) determined by the initial movement direction determination unit 198 after the change of the target travel direction Dt and the changed target travel direction Dt (second target travel direction Dt2) (step ST7). The movement operation of the main body 10 from the second point P2 to the third point P3 by the movement control unit 193 will be described in detail below.

[0108] When the travel direction setting unit 195 changes the target travel direction Dt to the second target travel direction Dt2 (leftward), the movement control unit 193 moves the main body 10 from the second point P2 along a second path R2 including an arc Ca2 with the second initial direction Df2 as a tangent while keeping the posture of the main body 10 constant, as shown in Figures 7, 10 and 11.

[0109] Here, the steering angles θ1 to θ4 rotate counterclockwise about the steering axes Ax1 to Ax4 as the main body 10 moves along the second route R2. Then, as shown in Fig. 11, when the moving direction of the main body 10 becomes the leftward direction, which is the second target traveling direction Dt2, at the third point P3, the steering angles θ1 to θ4 each become approximately 90°.

[0110] When the movement direction of the main body 10 becomes the second target travel direction Dt2, as shown in FIG. 7, the movement control unit 193 moves the main body 10 leftward along the straight path Rs2 to a fourth point P4 within the second direction change area ARc2.

[0111] When the main body 10 moves to the fourth point P4 in the second direction change area ARc2, the travel direction setting unit 195 changes the target travel direction Dt to the third target travel direction Dt3, which is the direction (downward) from the second direction change area ARc2 toward the target area ARg (step ST8: Yes).

[0112] When the target traveling direction Dt is changed, the initial direction determination unit 198 determines the initial direction Df again (steps ST4: Yes to ST6). Specifically, the initial direction determination unit 198 determines the initial direction Df of the main body 10 again based on the steering angles θ1 to θ4 when the main body 10 is at the fourth point P4. Here, it is assumed that the angle estimation unit 197 estimates that the steering angles θ1 to θ4 are all 90° in the second direction change area ARc2. At this time, the average value of the steering angles θ1 to θ4 (average steering angle θav) is 90°. The initial direction determination unit 198 determines the initial direction Df (third initial direction Df3) of the main body 10 in the second direction change area ARc2 to be a direction tilted 90° to the left with respect to the front-rear direction (leftward).

[0113] When the target travel direction Dt is changed, the movement control unit 193 moves the transport robot 1 to a target direction point (fifth point P5) where the movement direction of the transport robot 1 becomes the third target travel direction Dt3 (downward) after the change based on the initial movement direction Df (third initial movement direction Df3) determined by the initial movement direction determination unit 198 after the change of the target travel direction Dt and the changed target travel direction Dt (third target travel direction Dt3) (step ST7). The movement operation of the main body 10 from the fourth point P4 to the fifth point P5 by the movement control unit 193 will be described in detail below.

[0114] When the travel direction setting unit 195 changes the target travel direction Dt to the third target travel direction Dt3 (downward), the movement control unit 193 moves the main body 10 from the fourth point P4 along a third route R3 including an arc Ca3 with the third initial direction Df3 as a tangent, while keeping the posture of the main body 10 constant, as shown in Figures 7, 12 and 13.

[0115] Here, the steering angles θ1 to θ4 rotate counterclockwise about the steering axes Ax1 to Ax4 as the main body 10 moves along the third route R3. Then, as shown in Fig. 13, when the moving direction of the main body 10 becomes the third target traveling direction Dt3, which is downward, at the fifth point P5, the steering angles θ1 to θ4 each become approximately 180°.

[0116] When the movement direction of the main body 10 becomes the third target traveling direction Dt3, as shown in Figs. 7 and 14, the movement control unit 193 moves the main body 10 downward along a straight path Rs3 to a target point Pg in the target area ARg.

[0117] Here, the target travel direction Dt is not changed at the target point Pg (step ST8: No), and the grip control unit 191 controls the grip driving unit 14 to cause the gripping unit 13 to release (ungrasp) the gripped portion 21 (step ST9).

[0118] (2.5.2) Second operation example 15, an operation example of the transport robot control system 100 will be described when the transport robot 1 transports a transport object 2B, which is one type of transport object 2 among multiple types of transport objects 2 to be transported by the transport robot control system 100. The transport object 2B is a different type of transport object 2 from the transport object 2A. In the following explanation, detailed explanation of operations common to the first operation example will be omitted.

[0119] The transported object 2B has a main body 20 and four casters C0 (casters C1B to C4B). The casters C1B and C2B are arranged side by side along the first direction DR1. The casters C3B and C4B are arranged side by side along the first direction DR1. Here, the distance between the casters C1B and C2B is narrower than the distance between the casters C3B and C4B.

[0120] The movement control unit 193 moves the main body 10 to a point where the transported object 2 can be gripped (a gripping point).

[0121] When the main body 10 arrives at the gripping point, the grip control unit 191 controls the grip driving unit 14 to cause the gripping unit 13 to grip the gripped part 21 (step ST1).

[0122] When the gripping unit 13 grips the gripped unit 21 at the gripping point, the movement area setting unit 194 sets a movement area AR10 (step ST2).

[0123] When the gripping portion 13 grips the gripped portion 21 at the gripping point, the movement control portion 193 transports the main body 10 to a predetermined transport start point P0.

[0124] At the transfer start point P0, the movement area setting unit 194 sets a movement area AR10 based on information on the transfer start point P0 and information on the destination point Pg (step ST2).

[0125] Furthermore, for example, when the main body 10 reaches the transfer start point P0, the request unit 190 transmits a request signal to the upper system 3 to make the upper system 3 respond with the type of the load 2 to be transferred.

[0126] When the response unit 312 of the upper system 3 receives a request signal from the request unit 190 via the communication unit 32, it identifies the type of transported object 2 to be transported by the transport robot 1 as transported object 2B based on the moving object ID included in the request signal and the transport plan for the transported object 2 stored in the memory unit 35.

[0127] The reply unit 312 transmits to the transport robot 1 the identification information including the identified type of the transport object 2 (the transport object 2B).

[0128] When receiving specific information including the type of the transported object 2 (transported object 2B) from the upper system 3, the travel direction setting unit 195 sets the target travel direction Dt of the main body 10 in the transfer start area ARs to forward (step ST3).

[0129] Next, the determination unit 196 determines whether or not the detection unit 16 can detect the steering angle θ0 of the predetermined caster C0 set according to the type of the transported object 2 (step 4). Here, in the second operation example, the predetermined caster C0 set according to the type of the transported object 2 is the casters C1B to C4B of the transported object 2B.

[0130] Here, in a state where the main body 10 is located at the transfer start point P0, as shown in FIG. 15, the detection area A1 includes the shielded areas Ah1B and Ah2B that are shielded by the casters C1B and C2B, respectively. In the second operation example, in a state where the main body 10 is located at the transfer start point P0, the casters C3B and C4B are located within the shielded areas Ah1B and Ah2B, respectively, and the casters C3B and C4B are shielded by the casters C1B and C2B, making them undetectable by the detection unit 16. For this reason, the determination unit 196 determines that the predetermined caster C0 (casters C1B to C4B) is undetectable (step ST4: No). In other words, the determination unit 196 determines that the angle estimation unit 197 is unable to estimate the steering angle θ0 of the predetermined caster C0.

[0131] When the determination unit 196 determines that a predetermined caster C0 (casters C1B to C4B) cannot be detected, the angle estimation unit 197 does not estimate the steering angle θ0 of the casters C1B to C4B.

[0132] If the angle estimation unit 197 cannot estimate the steering angle θ0, the initial movement direction determination unit 198 determines the previous moving direction of the transfer robot 1 as the initial movement direction. A method of determining the initial movement direction Df in the second operation example will be described below.

[0133] In the second operation example, the transport robot 1 transports the transported object 2B into the transport start area ARs by moving in a direction (movement direction Dm) inclined to the right by an angle φ with respect to the front-rear direction as shown in Fig. 16. As described above, the memory unit 35 of the upper system 3 stores the movement history of the transport robot 1. Here, the movement history of the transport robot 1 stored in the memory unit 35 includes information on the movement direction Dm.

[0134] When the main body 10 is located at the transfer start point P0, if the angle estimation unit 197 cannot estimate the steering angles θ1 to θ4, the acquisition unit 199 acquires the previous moving direction of the transfer robot 1 from the storage unit 35 of the host system 3 (step ST10). Here, the previous moving direction of the transfer robot 1 is the moving direction Dm.

[0135] When the acquisition unit 199 acquires the movement direction Dm, the initial movement direction determination unit 198 sets the initial movement direction Df (first initial movement direction Df1) of the main body 10 in the transfer start area ARs as the movement direction Dm (step ST11).

[0136] In this way, even if the angle estimator 197 cannot estimate the steering angle θ0 of the caster C0, the initial direction Df can be determined, and the travel of the transported object 2 can be stabilized.

[0137] The subsequent operations are substantially the same as those in the first operation example, and therefore detailed explanations will be omitted. However, when the target traveling direction Dt is changed in the first direction change area ARc1 or the second direction change area ARc2 (step ST8: Yes), if the determination unit 196 determines that the predetermined caster C0 (casters C1B to C4B) cannot be detected (step ST4: No), the subsequent operations are steps ST10 and ST11.

[0138] (3) Modifications The above embodiment is merely one of various embodiments of the present disclosure. The above embodiment can be modified in various ways depending on the design, etc., as long as the object of the present disclosure can be achieved. In addition, functions similar to those of the transport robot control system 100 may be embodied in a control method (transport robot control method), a computer program, or a non-transitory recording medium on which a program is recorded, etc.

[0139] The transport robot control method according to the above embodiment includes an angle estimation step and an initial direction determination step. In the angle estimation step, a steering angle θ0 of a caster C0 of a transported object 2 transported by the transport robot 1 is estimated. In the initial direction determination step, an initial direction of the transport robot 1 is determined based on the steering angle θ0 of the caster C0 estimated in the angle estimation step when the transport robot 1 transports the transported object 2. In addition, the (computer) program according to the above embodiment is a program for causing a computer system to execute the above-mentioned control method.

[0140] Modifications of the above embodiment are listed below. The modifications described below can be applied in appropriate combinations.

[0141] In the second operation example of the above embodiment, when some (casters C3B, C4B) of the predetermined caster C0 (casters C1B to C4B) are in an undetectable state, the determination unit 196 determines that the predetermined caster C0 (casters C1B to C4B) is undetectable, but the determination unit 196 may determine that only the casters C1B and C2B are detectable. In other words, when the casters C3B and C4B are in an undetectable state, the determination unit 196 may determine that the angle estimation unit 197 is capable of estimating the steering angles θ1 and θ2 of the casters C1B and C2B. When the determination unit 196 determines that the casters C1B and C2B are detectable, the angle estimation unit 197 estimates the steering angles θ1 and θ2 of the casters C1B and C2B. That is, the angle estimation unit 197 may estimate the steering angles θ1 and θ2 of the casters C1B and C2B among the casters C1B to C4B, and the initial movement direction determination unit 198 may determine the first initial movement direction Df1 based on the steering angles θ1 and θ2. This makes it possible to determine the initial movement direction Df even if the steering angle θ0 of some caster C0 among the casters C1B to C4B cannot be estimated.

[0142] In the first operation example of the above embodiment, the initial direction determination unit 198 determines the initial direction Df of the transport robot 1 (main body 10) based on the steering angles θ1 to θ4. However, the initial direction Df may be determined based on the position of the intersection of the rotation axis (axle) Aw0 (Aw1 to Aw4) of the caster C0 (caster C1A to C4A). A specific description will be given below. First, the initial direction determination unit 198 calculates the center of gravity position of the intersection of the rotation axis (axle) Aw0 (Aw1 to Aw4) having the inclination of the steering angles θ1 to θ4 estimated by the angle estimation unit 197. For example, as shown in FIG. 17, the initial direction determination unit 198 calculates the direction of the axles Aw1 to Aw4 from the steering angles θ1 to θ4, and further calculates the positions of the intersections Q1 to Q6 of the axles Aw1 to Aw4. Then, the initial direction determination unit 198 calculates the center of gravity position Q7 of the intersections Q1 to Q6. The initial movement direction determination unit 198 may determine, as the initial movement direction Df, the tangent direction Ds of an arc that is centered on the center of gravity position Q7 and passes through the center of gravity K5 of each of the ground contact points (K1 to K4) of the casters C1A to C4A.

[0143] In the first operation example of the above embodiment, the initial direction determination unit 198 determines the initial direction Df of the transport robot 1 (main body 10) based on the average value of the steering angles θ1 to θ4 estimated by the angle estimation unit 197, but it is not limited to a simple average, and a weighted average may be used. In this case, by considering the moment of the transported object 2 and the center of gravity of the load of the transported object 2, it is possible to make the travel more stable than when the initial direction Df is determined by a simple average. Specifically, as shown in FIG. 3, the casters C0 (C1A, C2A) on the front surface 201 side (the side gripped by the transport robot 1) of the main body 20 have less moment than the casters C0 (C3A, C4A) on the rear surface 202 side of the main body 20, so that the travel can be made more stable by determining the initial direction Df based on a weighted average with a larger weight on the average angle of the casters C1A and C2A. In addition, in the case of a transported load 2 in which the center of gravity of the load is biased, the travel can be made more stable by determining the initial direction Df based on a weighted average in which the weight of the average angle of multiple casters C0 that are close to each other is increased depending on the distance between the center of gravity of the load and the caster C0.

[0144] At least some of the functions of the control unit 19 of the transport robot 1 (e.g., functions of the movement area setting unit 194, the travel direction setting unit 195, the judgment unit 196, the angle estimation unit 197, the initial movement direction determination unit 198, etc.) may be possessed by the control unit 31 of the higher-level system 3.

[0145] The movement history of the transport robot 1 may be stored in the memory unit 18 of the transport robot 1. In this case, the acquisition unit 199 may acquire the previous movement direction of the transport robot 1 from the memory unit 18 when the angle estimation unit 197 cannot estimate the steering angle θ0 of the caster C0.

[0146] The transport robot control system 100 in the present disclosure includes a computer system. The computer system is mainly composed of a processor and a memory as hardware. The processor executes a program recorded in the memory of the computer system, thereby realizing the functions of the transport robot control system 100 in the present disclosure. The program may be pre-recorded in the memory of the computer system, provided through an electric communication line, or provided by recording it in a non-transitory recording medium such as a memory card, an optical disk, or a hard disk drive that can be read by the computer system. The processor of the computer system is composed of one or more electronic circuits including a semiconductor integrated circuit (IC) or a large-scale integrated circuit (LSI). The integrated circuits such as IC or LSI referred to here are called by different names depending on the degree of integration, and include integrated circuits called system LSI, VLSI (Very Large Scale Integration), or ULSI (Ultra Large Scale Integration). Furthermore, a field-programmable gate array (FPGA) that is programmed after the manufacture of the LSI, or a logic device that can reconfigure the connection relationship inside the LSI or reconfigure the circuit partition inside the LSI, can also be adopted as a processor. The electronic circuits may be integrated in one chip or distributed among multiple chips. The chips may be integrated in one device or distributed among multiple devices. The computer system referred to here includes a microcontroller having one or more processors and one or more memories. Thus, the microcontroller is also composed of one or more electronic circuits including a semiconductor integrated circuit or a large-scale integrated circuit.

[0147] (4) Summary As described above, the transport robot control system (100) of the first embodiment includes an angle estimation unit (197), a movement control unit (193), and an initial movement direction determination unit (198). The angle estimation unit (197) estimates a steering angle of a caster (C0) of a transported object (2) transported by the transport robot (1). The movement control unit (193) controls the movement of the transport robot (1). The initial movement direction determination unit (198) determines an initial movement direction (Df) of the transport robot (1) based on the steering angle (θ0) of the caster (C0) estimated by the angle estimation unit (197) when the transport robot (1) transports the transported object (2).

[0148] According to this embodiment, when the transport robot (1) changes its moving direction, the steering angle (θ0) of the caster (C0) can be prevented from changing suddenly, and the travel of the transported object (2) can be stabilized.

[0149] In the transport robot control system (100) of the second aspect, in the first aspect, the transport robot (1) has a main body (10) and at least one steering wheel (11) provided on the main body (10) and capable of changing the steering angle. The movement control unit (193) changes the steering angle of the at least one steering wheel (11) to move the transport robot (1) in all directions on the movement plane (G1) along which the transport robot (1) moves, while keeping the attitude of the main body (10) relative to the traveling direction of the transport robot (1) constant.

[0150] In the third aspect of the transport robot control system (100), in the first or second aspect, the transported object (2) is a component supplying device (5) that supplies a component (E1) to a component mounting machine (4) that mounts the component (E2) on a board (E2).

[0151] According to this embodiment, the travel of the component supply device (5) can be stabilized.

[0152] According to this embodiment, when the transport robot (1) changes the direction of movement while keeping the posture of the main body (10) constant, it is possible to prevent the steering angle (θ0) of the caster (C0) from changing suddenly, thereby stabilizing the travel of the transported object (2).

[0153] In the fourth aspect of the transport robot control system (100), in any of the first to third aspects, the movement control unit (193) moves the transport robot (1) from the current position of the transport robot (1) to a position where the movement direction of the transport robot (1) becomes the target movement direction (Dt) based on the initial movement direction (Df) and the target movement direction (Dt).

[0154] According to this embodiment, the moving direction of the main body (10) can be gradually changed from the initial direction (Df) to the target moving direction (Dt). Also, the steering angle (θ0) of the caster (C0) can be gradually changed.

[0155] In the transfer robot control system (100) of the fifth embodiment, the route from the current position to the point where the moving direction of the transfer robot (1) becomes the target moving direction (Dt) in the fourth embodiment includes a curved portion (Cv1).

[0156] According to this embodiment, the moving direction of the main body (10) can be gradually changed from the initial direction (Df) to the target moving direction (Dt) along the curved portion (Cv1). Also, the steering angle (θ0) of the caster (C0) can be gradually changed.

[0157] In the transfer robot control system (100) of the sixth embodiment, in the fifth embodiment, the curved portion (Cv1) includes a circular arc (Ca1).

[0158] According to this embodiment, the moving direction of the main body (10) can be gradually changed from the initial direction (Df) to the target moving direction (Dt) along the arc (Ca1). Also, the steering angle (θ0) of the caster (C0) can be gradually changed.

[0159] In the transfer robot control system (100) of the seventh aspect, in any one of the fourth to sixth aspects, the initial movement direction determination unit (198) determines the initial movement direction (Df) again when the target travel direction (Dt) is changed.

[0160] According to this embodiment, when the transport robot (1) changes its moving direction after the target travel direction (Dt) is changed, a sudden change in the steering angle (θ0) of the caster (C0) can be suppressed, and the travel of the transported object (2) can be stabilized.

[0161] In the eighth aspect of the transport robot control system (100), in the seventh aspect, when the target traveling direction (Dt) is changed, the movement control unit (193) moves the transport robot (1) to a point where the movement direction of the transport robot (1) becomes the changed target traveling direction (Dt) based on the initial movement direction (Df) determined by the initial movement direction determination unit (198) after the target traveling direction (Dt) is changed and the changed target traveling direction (Dt).

[0162] According to this embodiment, after the target traveling direction (Dt) is changed, the moving direction of the main body (10) can be gradually changed from the initial movement direction (Df) to the target traveling direction (Dt).

[0163] In a ninth aspect of the transport robot control system (100), in any of the first to eighth aspects, the angle estimation unit (197) estimates the steering angle (θ0) of the caster (C0) based on the position of the nearest point (Pc) on the caster (C0) that is closest to the reference point (Ps).

[0164] According to this embodiment, the process of estimating the steering angle (θ0) by the angle estimator (197) can be simplified.

[0165] In a transport robot control system (100) of a tenth aspect, in any one of the first to ninth aspects, an angle estimation unit (197) estimates a steering angle (θ0) of a predetermined caster (C0) set according to the type of transported object (2). An initial movement direction determination unit (198) determines an initial movement direction (Df) based on the steering angle (θ0) of the predetermined caster (C0).

[0166] According to this embodiment, the travel of a plurality of types of transported objects (2) can be stabilized.

[0167] The transport robot control system (100) of the eleventh aspect is the tenth aspect, further comprising a storage unit (18) that stores correspondence information between the type of the transport object (2) and a predetermined caster (C0).

[0168] According to this embodiment, the travel of a plurality of types of transported objects (2) can be stabilized.

[0169] In a transport robot control system (100) of a twelfth aspect, in any one of the first to eleventh aspects, the transported object (2) has one or more casters (C0). The initial movement direction determination unit (198) determines the initial movement direction (Df) based on the steering angle (θ0) of the caster (C0) for which the angle estimation unit (197) can estimate the steering angle (θ0) among the one or more casters (C0).

[0170] According to this embodiment, even if the steering angle (θ0) of some of the one or more casters (C0) cannot be estimated, the initial direction (Df) can be determined.

[0171] In a transport robot control system (100) of a thirteenth aspect, in any one of the first to twelfth aspects, the transported object (2) has a plurality of casters (C0). The angle estimation unit (197) estimates the steering angle (θ0) of the plurality of casters (C0). The initial movement direction determination unit (198) determines the initial movement direction (Df) based on the average value of the steering angles (θ0) of the plurality of casters (C0) estimated by the angle estimation unit (197).

[0172] According to this embodiment, when the steering angles (θ0) of the multiple casters (C0) are different, the initial direction (Df) can be determined.

[0173] In the transport robot control system (100) of the 14th aspect, in any of the first to 13th aspects, the initial direction determination unit (198) determines the most recent moving direction of the transport robot (1) as the initial direction (Df) when the angle estimation unit (197) is unable to estimate the steering angle (θ0) of the caster (C0).

[0174] According to this aspect, even if the angle estimation unit (197) is unable to estimate the steering angle (θ0) of the caster (C0), the initial direction (Df) can be determined, thereby stabilizing the travel of the transported object (2).

[0175] The transport robot control system (100) of the 15th aspect further includes an acquisition unit (199) that acquires the previous movement direction from the host system 3 when the angle estimation unit (197) is unable to estimate the steering angle (θ0) of the caster (C0) in the 14th aspect.

[0176] According to this aspect, even if the angle estimation unit (197) is unable to estimate the steering angle (θ0) of the caster (C0), the initial direction (Df) can be determined, thereby stabilizing the travel of the transported object (2).

[0177] The transport robot control method of the sixteenth aspect includes an angle estimation step and an initial movement direction determination step. In the angle estimation step, a steering angle (θ0) of a caster (C0) of a transported object (2) transported by the transport robot (1) is estimated. In the initial movement direction determination step, an initial movement direction (Df) of the transport robot (1) is determined based on the steering angle (θ0) of the caster (C0) estimated in the angle estimation step when the transported object (2) is transported by the transport robot (1).

[0178] According to this embodiment, when the transport robot (1) changes its moving direction, the steering angle (θ0) of the caster (C0) can be prevented from changing suddenly, and the travel of the transported object (2) can be stabilized.

[0179] The second to fifteenth aspects are not essential components of the transport robot control system (100) and may be omitted as appropriate. [Explanation of symbols]

[0180] 1. Transport robot 2. Transported object 4. Component Mounting Machine 5 Parts supply device 10 Main unit 11 Steering wheel 18 Storage section 100 Transport robot control system 193 Movement control section 197 Angle estimation part 198 Initial Direction Determination Unit 199 Acquisition Department C0 Caster Ca1 Arc Cv1 curve part Df Initial direction Dt Target direction of travel E1 Parts E2 Board G1 moving surface Pc Nearest point Ps reference point θ0 steering angle

Claims

1. An angle estimation unit that estimates a steering angle of a caster of an object to be transported by the transport robot; A movement control unit that controls movement of the transport robot; and an initial movement direction determination unit that determines an initial movement direction of the transport robot based on the steering angle of the caster estimated by the angle estimation unit when the transport robot transports the transported object. Transport robot control system.

2. The transport robot has a main body and at least one steering wheel provided on the main body and capable of changing a steering angle, The movement control unit changes a steering angle of the at least one steering wheel to move the transport robot in all directions on a moving surface on which the transport robot moves while maintaining a constant attitude of the main body relative to the traveling direction of the transport robot. The transport robot control system according to claim 1 .

3. The transported object is a component supplying device that supplies components to a component mounting machine that mounts the components on a board.

3. The transport robot control system according to claim 1.

4. The movement control unit moves the transport robot from a current position of the transport robot to a position where the movement direction of the transport robot becomes the target movement direction based on the initial movement direction and a target movement direction.

3. The transport robot control system according to claim 1.

5. The route from the current point to the point includes a curved portion. The transport robot control system according to claim 4 .

6. The curved portion includes a circular arc. The transport robot control system according to claim 5 .

7. The initial direction determination unit determines the initial direction again when the target traveling direction is changed. The transport robot control system according to claim 4 .

8. When the target traveling direction is changed, the movement control unit moves the transport robot to a point where the movement direction of the transport robot becomes the changed target traveling direction, based on the initial movement direction determined by the initial movement direction determination unit after the change of the target traveling direction and the changed target traveling direction. The transport robot control system according to claim 7 .

9. The angle estimation unit estimates a steering angle of the caster based on a position of a nearest point on the caster that is closest to a reference point.

3. The transport robot control system according to claim 1.

10. The angle estimation unit estimates a predetermined steering angle of the caster that is set according to a type of the transported object, The initial movement direction determination unit determines the initial movement direction based on a steering angle of the predetermined caster.

3. The transport robot control system according to claim 1.

11. The transport vehicle further includes a storage unit that stores correspondence information between the type of the transported object and the predetermined caster. The transport robot control system according to claim 10.

12. the transported object has one or more casters, The initial movement direction determination unit determines the initial movement direction based on a steering angle of a caster whose steering angle is capable of being estimated by the angle estimation unit, among the one or more casters.

3. The transport robot control system according to claim 1.

13. the transported object has a plurality of casters, The angle estimator estimates steering angles of the plurality of casters, The initial movement direction determination unit determines the initial movement direction based on an average value of the steering angles of the plurality of casters estimated by the angle estimation unit.

3. The transport robot control system according to claim 1.

14. The initial movement direction determination unit determines the previous moving direction of the transport robot as the initial movement direction when the angle estimation unit cannot estimate the steering angle of the caster.

3. The transport robot control system according to claim 1.

15. and an acquisition unit that acquires the immediately preceding moving direction from a host system when the angle estimation unit is unable to estimate the steering angle of the caster. The transport robot control system according to claim 14.

16. An angle estimation step of estimating a steering angle of a caster of an object to be transported by the transport robot; and an initial movement direction determination step of determining an initial movement direction of the transport robot based on the steering angle of the caster estimated in the angle estimation step when the transport robot transports the transported object. A transport robot control method.

Citation Information

Patent Citations

  • Autonomous traveling device, autonomous traveling control method, and autonomous traveling control program

    JP2021144363A