Robot operation control method, and control device

The method adjusts robot speed based on applied forces to prevent object detachment, ensuring safety and efficiency in handling heavy objects.

JP2024160482AActive Publication Date: 2024-11-14DMG MORI CO LTD
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
JP2023075525
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-05-01
Publication Date
2024-11-14
Estimated Expiration
2043-05-01

AI Technical Summary

Technical Problem

Conventional robot operation control methods face a trade-off between safety and efficiency, particularly when handling heavy objects, as reducing movement speed to prevent object loss compromises overall efficiency.

Method used

A method and control device that adjust the robot's movement speed based on the force applied to the held object, reducing speed only when a force attempts to pull the object out of the hand, ensuring stability and preventing detachment while maintaining efficiency.

Benefits of technology

This approach enhances safety by preventing object loss during robot operations without unnecessarily slowing down movements, thus maintaining operational efficiency.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024160482000001_ABST
    Figure 2024160482000001_ABST
Patent Text Reader

Abstract

To provide a robot operation control method and a control device which can maintain efficiency to a certain extent while securing safety.SOLUTION: A control device 55 controls a robot 30 which has a hand as an end effector, directly or indirectly holds an object to be held by the hand, and moves the hand in a three-dimensional space. The control device 55 is configured to set moving speed in moving when a force in a direction coming off from the hand acts on the object to be held to be lower, compared to moving speed when the force in a coming off direction does not act on the object to be held, when moving the hand. The control device 55 as one specific embodiment monitors a load in a direction at which the object to be held comes off from the hand among loads detected by a force sensor 37 provided on the robot 30, when moving the hand, and decelerates operation speed specified for the movement, when the load exceeds a predetermined reference load.SELECTED DRAWING: Figure 9
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a method and control device for controlling the operating speed of a robot that has a hand as an end effector, holds an object directly or indirectly in the hand, and moves the hand in three-dimensional space, in other words, the moving speed of the hand. [Background technology]

[0002] An industrial robot, for example, is configured to have a hand as an end effector, to hold an object directly or indirectly in the hand, and to move the hand in a three-dimensional space. The operation of such a robot is controlled by a numerical control device that performs control according to a control program, and the operation speed is commanded by a speed code included in the control program, and generally, a fast feed speed is commanded when there is no risk of interference with other structures during operation, and a slow feed speed is commanded when there is a risk of interference with other structures.

[0003] However, there is a certain limit to the holding force with which the hand can hold the object, and if the weight of the object is heavy, it may not be possible to hold the object stably, and there is a concern that the object may come off while the hand is moving.

[0004] In view of this, in the past, although not a robot, an automatic tool changer for a machine tool has been proposed in which a means for determining the weight of a tool is provided and the changing speed is controlled in accordance with the weight of the changeable tool, i.e., if the determined weight of the changeable tool is equal to or greater than a predetermined weight, the changing speed is slowed down (see JP 64-58444 A (Patent Document 1) below).

[0005] Thus, when the invention disclosed in Patent Document 1 is applied to the motion control of the above-mentioned conventional robot, a configuration can be adopted in which a means for determining the weight of the held object is provided, and if the determined weight of the replacement tool is equal to or greater than a predetermined weight, the movement speed of the hand is slowed down.By adopting such a configuration, it is possible to prevent the held object from falling off while the hand is moving. [Prior art documents] [Patent documents]

[0006] [Patent Document 1] Japanese Patent Publication No. 64-58444 Summary of the Invention [Problem to be solved by the invention]

[0007] However, as in the above-mentioned conventional example, if the movement speed of the hand is slowed down when the weight of the object to be held is heavy, the overall operating speed of the robot will be slowed down, and although safety will be ensured, another problem will arise in that efficient work cannot be achieved. Safety and efficiency are, so to speak, trade-offs, and therefore there is a demand for measures that can maintain a certain degree of efficiency while ensuring safety.

[0008] In addition, the motion of the robot described above is not constant, and various movement paths and postures are adopted depending on the required work, so forces of various directions and magnitudes act on the object held by the hand depending on the motion of the robot. If a force acts on the object that would cause it to slip out of the hand, the holding state of the object becomes unstable, and there is a risk that the object will come off the hand.

[0009] The present invention has been made in consideration of the above-mentioned circumstances, and has an object to provide a robot operation control method and control device that can maintain a certain degree of efficiency while ensuring safety. [Means for solving the problem]

[0010] In order to solve the above problems, the present invention provides a method for controlling, using a control device, an operation of a robot that includes a hand as an end effector, holds an object to be held directly or indirectly in the hand, and moves the hand in a three-dimensional space, the method comprising: This relates to a robot operation control method in which, when the hand is moved, the moving speed is made slower when a force acts on the held object in a direction that causes the held object to slip out of the hand than when no force acts on the held object in the direction that causes the held object to slip out of the hand.

[0011] The present invention also provides a control device for controlling a robot that includes a hand as an end effector, holds an object to be held directly or indirectly in the hand, and moves the hand in a three-dimensional space, comprising: The control device relates to a robot control device that is configured to slow down the movement speed when a force acts on the held object in a direction that causes the held object to slip out of the hand, when the hand is moved, compared to the movement speed when a force does not act on the held object in the direction that causes the held object to slip out.

[0012] According to the operation control method and control device of the present invention, when the hand of the robot is moved, the movement speed is set to be slower when a force acts on the held object in a direction that causes it to slip out of the hand than when a force does not act on the held object in that direction. When a force that causes the held object to slip out of the hand acts on the held object, the holding state of the held object by the hand becomes unstable, and there is a risk that the held object will come off the hand during the hand's movement. However, by slowing down the movement speed when a force acts on the held object in a direction that causes it to slip out of the hand compared to when the force does not act on the held object, it is possible to prevent the held object from coming off the hand. In addition, since the movement speed is slowed down only when a force acts on the held object in a direction that causes it to slip out of the hand, it is possible to ensure the safety of the robot's operation without unnecessarily impairing the work efficiency of the robot, compared to when the movement speed is uniformly slowed down.

[0013] Furthermore, in the above-mentioned operation control method and control device, the movement speed of the hand can be set by the operation program executed by the control device, and when a force acts on the held object in a direction that causes it to slip out of the hand, the movement speed is set to a slower speed than when a force does not act on the held object in a direction that causes it to slip out of the hand.

[0014] Alternatively, the robot may be provided with the hand with a force sensor interposed therebetween, and when the hand is moved under the control of the control device, the load detected by the force sensor in the direction in which the object to be held is to slip out of the hand may be monitored, and when the load exceeds a predetermined reference load, it may be determined that the object to be held is moving in the direction in which the force to slip out acts on the object to be held, and the motion speed designated for the movement may be slowed down. In this case, the control device may slow down the designated motion speed at a rate corresponding to the load in the direction in which the force sensor is detected. In this way, it is possible to prevent the work efficiency of the robot from decreasing as much as possible, and to reliably prevent the object to be held from coming off the hand.

[0015] Alternatively, the robot may be operated in an idle state under the control of the control device, and the power supplied to the motor constituting the robot during the idle operation may be acquired in advance as a reference power, and then the control device may monitor the power supplied to the motor as an actual power when the robot is actually operated, and when the actual power exceeds a limit power set based on the reference power, it may be determined that the movement is one in which a force acts on the held object in the direction of slipping out, and the operation speed designated for the movement may be decelerated. In this case, the control device may decelerate the designated operation speed at a rate corresponding to the actual power. In this manner, it is possible to prevent the work efficiency of the robot from decreasing as much as possible, and to reliably prevent the held object from falling off the hand. Effect of the Invention

[0016] As described above, according to the present invention, the moving speed during movement when a force acts on the held object in a direction that causes it to slip out of the hand is slower than during other movements, so that it is possible to prevent the held object from falling off the hand. Also, since the moving speed is slowed down only during movement when a force acts on the held object in a direction that causes it to slip out of the hand, it is possible to ensure the safety of the robot's operation without unnecessarily impairing the robot's work efficiency, compared to a case in which the moving speed is uniformly slowed down. [Brief description of the drawings]

[0017] [Figure 1] 1 is a perspective view of a machining system according to an embodiment of the present invention, showing a tool transport device as a main part thereof; [Diagram 2] FIG. 1 is a perspective view of a machining system according to an embodiment of the present invention, showing a tool storage device as a main part thereof; [Diagram 3] 5A to 5C are explanatory diagrams for explaining the operation of the tool attaching / detaching robot according to the embodiment. [Figure 4] 5A to 5C are explanatory diagrams for explaining the operation of the tool attaching / detaching robot according to the embodiment. [Diagram 5] 5A to 5C are explanatory diagrams for explaining the operation of the tool attaching / detaching robot according to the embodiment. [Figure 6] FIG. 2 is a front view showing the tool body according to the embodiment. [Figure 7] FIG. 7 is a diagram showing the tool body according to the present embodiment, and is a left side view in FIG. 6. [Figure 8] 5 is an explanatory diagram for explaining a force acting on the tool body according to the embodiment. FIG. [Figure 9] FIG. 2 is a block diagram showing a schematic configuration of a control device according to the present embodiment. [Figure 10] FIG. 11 is a block diagram showing a schematic configuration of a control device according to another embodiment of the present invention. [Figure 11] FIG. 4 is an explanatory diagram showing an operation program according to the present embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0018] Hereinafter, specific embodiments of the present invention will be described with reference to the drawings.

[0019] 1 and 2, the machining system 1 of this example includes a plurality of machine tools M aligned in a row along the direction of the arrow AB, a tool storage device 5 having a plurality of tool storage racks 6 aligned in a row along the direction AB facing the row of machine tools M, and a tool transport device 10 disposed between the row of machine tools M and the row of tool storage racks 6 for transporting tool bodies TB between each machine tool M and each tool storage rack 6. The machining system 1 shown in Fig. 1 is extended in the direction of the arrow B, and the row of machine tools M and the row of tool storage racks 6 shown in Fig. 2 are disposed on the extension of the row, and naturally, the end of the arrangement exists in the direction of the arrow B.

[0020] 6 and 7, the tool body TB is composed of a tool T and a tool holder TH that holds the tool T. The tool holder TH is made of a cylindrical member and has a storage hole TH6 that opens on one end face, i.e., the end face on the right side in the figure, and a ball-lock mechanism (not shown) provided in the storage hole TH6. The tool T is held by the tool holder TH while being clamped by the ball-lock mechanism (not shown) with its held shaft T1 inserted into the storage hole TH6. The tool T can be attached to and detached from the tool holder TH by human power.

[0021] The tool holder TH has two two-face widths TH1, TH2 formed across its axis and whose normals are perpendicular to each other, on the outer periphery opposite the opening in the axial direction, and also has a two-face width TH3, which is similarly formed across the axis and is wider than the two-face widths TH1, TH2, on the outer periphery on the opening side in the axial direction.

[0022] The two-face width TH3 is formed so that its normal line is parallel to the normal line of the two-face width TH2, and V-shaped grooves TH4, TH4 are formed on each face of the two-face width TH3 along the axial direction, while engagement grooves TH5, TH5 are formed on each face of the two-face width TH2 along a direction perpendicular to the axis.

[0023] Each of the machine tools M includes a tool magazine TM that stores a plurality of tool bodies TB, and is configured to perform a predetermined machining operation using the tool bodies TB stored in the tool magazine TM. Each of the machine tools M includes a numerical control device (not shown), which numerically controls the motion mechanism and controls the operation of the tool magazine TM. Each of the holding sections provided in the tool magazine TM is provided with a pair of gripping claws made of spring bodies, and the tool body TB is held in each holding section while being clamped by the gripping claws as the gripping claws fit into the V-shaped grooves TH4, TH4.

[0024] The tool storage rack 6 is composed of a plurality of holding frames 8 erected at predetermined intervals along the AB direction, and a frame-shaped support frame 7 that supports the holding frames 8. The holding frame 8 has cutout portions (holding portions) that are provided at a predetermined pitch on both sides thereof and are formed to open outward, and the tool body TB is held in each cutout portion by the engagement of the engagement grooves TH5, TH5 with the cutout portions.

[0025] The tool transport device 10 includes a moving device 11 arranged along the AB direction, a movable table 15 transported by the moving device 11, a tool holding device 20 provided on the movable table 15, a tool mounting / detaching robot 30 and an air blowing device 40, and a control device 50 for controlling the operation of the moving device 11, the tool mounting / detaching robot 30 and the air blowing device 40.

[0026] The moving device 11 is arranged in parallel along the AB direction and is composed of a pair of guide rails 14 that guide the movement of the moving table 15, a support base 12 that supports the guide rails 14, and a drive device 13 that moves the moving table 15.

[0027] The driving device 13 is composed of, for example, a rack (not shown) disposed on the support base 12 along the AB direction, a pinion gear (not shown) provided on the moving table 15, and a motor (not shown) that drives the pinion gear (not shown). The pinion gear (not shown) meshes with the rack (not shown), and by rotating the pinion gear (not shown) with the motor (not shown), the moving table 15 is guided by the guide rail 14 and moves along the AB direction due to the meshing relationship between the pinion gear (not shown) and the rack (not shown).

[0028] The position of the movable platform 15 in the AB direction can be detected by a position detector (not shown) consisting of a scale (not shown) arranged on the support base 12 along the AB direction and a reader (not shown) arranged on the movable platform 15 for reading the position of the scale (not shown). The movable platform 15 is driven by the drive unit 13 based on the position information detected by the position detector (not shown) under the control of the control unit 50, and moves to a work position set for each machine tool M and a work position set for each tool storage rack 6. In this example, the position shown in FIG. 1 (end position in the direction of the arrow A) is the home position of the movable platform 15, and is also the work position for the tool magazine TM of the machine tool M arranged at the end of the direction of the arrow A. In addition, a maintenance landing 12a is formed in the support base 12 at this position in a portion corresponding to the tool magazine TM. This landing 12a can be provided in a portion corresponding to each tool magazine TM as necessary.

[0029] The tool attaching / detaching robot 30 is a six-axis articulated robot, and includes a base 31 fixed on the movable stage 15, a first arm 32 provided on the base 31, a second arm 33 connected to the first arm 32, a third arm 34 connected to the second arm 33, and a hand 35 as an end effector provided at the tip of the third arm 34. Two drive motors (not shown) are provided at each of the connection portion (joint portion) between the base 31 and the first arm 32, the connection portion (joint portion) between the first arm 32 and the second arm 33, the connection portion (joint portion) between the second arm 33 and the third arm 34, and the connection portion (joint portion) between the third arm 34 and the hand 35. By controlling the drive of each drive motor (not shown) corresponding to the six axes by the control device 50, the hand 35 can be moved to any position in a three-dimensional space and can be made to take any posture.

[0030] The hand 35 is a so-called gripper, and is capable of gripping the two-face width TH2 of the tool holder TH constituting the tool body TB. A force sensor 37 is provided between the third arm 34 and the hand 35, and in this example, the force acting on the hand 35, specifically, the force in the first axis direction (arrow ab direction in FIG. 6) in which the hand 35 opens and closes, the force in the second axis direction (arrow cd direction in FIG. 8) which is the axis direction of the third arm 34 and perpendicular to the first axis, and the force in the third axis direction (arrow ef direction in FIG. 8) which is perpendicular to the first axis and second axis, can be detected by the force sensor 37.

[0031] As shown in Figures 3 and 4, the tool holding device 20 is provided opposite the tool mounting / detaching robot 30 within the operating area of ​​the tool mounting / detaching robot 30, and is composed of long, plate-like tool holding members 21, 23 arranged in parallel at a predetermined interval, and a frame 25 provided on the movable table 15 for supporting the tool holding members 21, 23 in an upright position (standing position).

[0032] The tool holding members 21, 23 are provided with a plurality of notches 22, 24 arranged at a predetermined pitch in the vertical direction and overlapping each other on the right side as viewed from the tool attaching / detaching robot 30, and formed to open outward, and a corresponding pair of the notches 22, 24 form a holding portion to which the tool body TB is attached. The tool body TB is held in the notches 22, 24 by inserting the portions of the tool holder TH related to the engagement grooves TH5, TH5 into the notches 22, 24.

[0033] As shown in Figures 1 and 4, the air blow device 40 is provided within the operating area of ​​the tool attaching / detaching robot 30, immediately to the left of the tool holding device 20 when seen from the tool attaching / detaching robot 30, and includes a housing-shaped air blow box 41 having an opening 42 on its upper surface, a plurality of nozzles (not shown) provided within the air blow box 41 and discharging pressurized air, a pressurized air supply source (not shown) for supplying pressurized air to the nozzles (not shown) via appropriate piping (not shown), and a control valve provided midway through the piping (not shown).

[0034] The control device 50 is composed of a computer including a CPU, RAM, ROM, etc., and controls the operation of the moving device 11, the tool mounting / dismounting robot 30, the air blow device 40, etc., as described above. Specifically, the control device 50 operates the tool transport device 10 according to a predetermined operation program, takes out the commanded tool body TB from the commanded tool magazine TM, transports the taken-out tool body TB, and stores it in the commanded tool storage rack 6. Conversely, the control device 50 takes out the commanded tool body TB from the commanded tool storage rack 6, transports the taken-out tool body TB, and stores it in the commanded tool magazine TM.

[0035] Hereinafter, a specific operation will be described in which the tool transport device 10 takes out a designated tool body TB from a designated tool magazine TM and stores it in a designated tool storage rack 6 under the control of the control device 50. Information on the target tool magazine TM, the tool storage rack 6, and the storage position in the tool storage rack 6, as well as operation commands (take-out command and store-in command) are transmitted from a higher-level management device (not shown) to the control device 50. Information on the tool body TB to be taken out and a take-out command are also transmitted from the higher-level management device (not shown) to a numerical control device (not shown) of the machine tool M equipped with the target tool magazine TM, and the numerical control device (not shown) that receives the command and information moves the commanded tool body TB from the tool magazine TM to the set entry / exit position TMa, and then transmits a take-out preparation completion signal to the control device 50.

[0036] As described above, when the control device 50 receives information on the target tool magazine TM, the tool storage rack 6, and the storage position in the tool storage rack 6, as well as the operation command (removal and storage command) from the management device (not shown), the control device 50 first drives the drive device 13 of the movement device 11 to move the moving table 15 to the commanded tool magazine TM, in this example, the work position of the tool magazine TM shown in FIG. 1 (movement operation). The position of the moving table 15 corresponds to the home position. On the other hand, the numerical control device (not shown) of the machine tool M equipped with the target tool magazine TM receives information on the tool body TB to be removed from the upper management device (not shown) and the removal command, and then drives the tool magazine TM to move the commanded tool body TB to the loading / unloading position TMa shown in FIG. 1, and then transmits a removal preparation completion signal to the control device 50.

[0037] When the moving operation is completed and a removal preparation completion signal is received from the corresponding numerical control device (not shown), the control device 50 then drives the tool mounting / removal robot 30 to grip the tool body TB moved to the insertion / removal position TMa of the tool magazine TM by the hand 35 at the end of the tool holder TH and the outer surface corresponding to the two-face width TH2,TH2, and removes it from the tool magazine TM (removal operation), and transmits a removal completion signal to the numerical control device (not shown). Note that, when there are multiple tool bodies TB to be removed instructed by a higher-level management device (not shown), after receiving the removal completion signal from the control device 50, the numerical control device (not shown) moves the tool body TB to be removed next to the insertion / removal position TMa, and then repeats the process of transmitting the removal preparation completion signal to the control device 50.

[0038] Next, the control device 50 drives the tool mounting / removing robot 30 to carry the tool body TB held by the hand 35 into the air blow box 41 through the upper opening 42 of the air blow box 41 (carrying-in operation), and opens the control valve (not shown) for a predetermined time to discharge pressurized air from the nozzles (not shown) (discharging operation). As a result, the cutting chips and coolant liquid adhering to the tool T of the tool body TB are blown away by the discharged air flow, and the tool T is cleaned.

[0039] After the pressurized air has been discharged from the nozzle (not shown) for a predetermined time in the manner described above, the control device 50 drives the tool mounting / dismounting robot 30 to transport the tool body TB from the air blow box 41 (transporting operation), and then, as shown in Figures 3 and 4, inserts the transported tool body TB into the empty cutout portions 22, 24 of the tool holding device 20, i.e., inserts the portions of the tool holder TH relating to the engagement grooves (engaged surfaces) TH5, TH5 into the cutout portions 22, 24 to hold the tool body TB in the tool holding device 20 (temporary placement operation), and closes the control valve (not shown) to stop the discharge of pressurized air from the nozzle (not shown) (stopping operation).

[0040] Furthermore, when there are multiple tool bodies TB to be removed instructed by a higher-level management device (not shown), the control device 50 receives a removal preparation completion signal from the numerical control device (not shown) and then repeatedly executes the removal operation, loading operation, discharge operation, carry-out operation, temporary placement operation and stopping operation for each tool body TB to be removed.

[0041] When the process of removing the commanded tool body TB from the tool magazine TM is completed as described above, the control device 50 then drives the drive device 13 of the moving device 11 to move the moving table 15 to the commanded working position of the tool storage rack 6 (transport operation), and then drives the tool mounting / detaching robot 30 to store the tool body TB held by the tool holding device 20 in the commanded storage position of the commanded tool storage rack 6 (storing operation). When there are multiple tool bodies TB to be stored, this storing operation is performed for each tool body TB.

[0042] Next, the control device 50 removes the commanded tool body TB from the commanded tool magazine TM and stores it in the commanded tool storage rack 6. The control device 50 can also execute a process of removing the commanded tool body TB from the commanded tool storage rack 6 and storing it in the commanded tool magazine TM by the reverse operation. At this time, since it is assumed that the tool body TB in the tool storage rack 6 is kept clean, the execution of the carry-in operation, discharge operation, carry-out operation, and stop operation for cleaning the tool body TB can be omitted.

[0043] The control device 50 which performs the above-mentioned control is provided with a robot control unit 55 as shown in Fig. 9 as a control unit which controls the operation of the tool attaching / detaching robot 30. Specifically, as shown in Fig. 9, this robot control unit 55 is made up of an operation program storage unit 56, a program analysis unit 57, an axis control unit 58, an axis driving unit 59, a parameter storage unit 60, a speed adjustment unit 61, and the like.

[0044] The operation program storage unit 56 is a functional unit that stores a program that commands the operation of the tool attaching / detaching robot 30, and is composed of, for example, operation commands that define movement and stopping, position commands that define the position and orientation (posture) of the hand 35, path commands that define a movement path such as linear movement and circular movement, and speed commands that define a movement speed, and the like. An operation program that has been created in advance is input via an input / output device 65 connected to the robot control unit 55 and stored in the operation program storage unit 56. An example of this operation program is shown in FIG. 11. This operation program is written in a language called SLIM, in which "MOVE" is a command that means movement, "P004", "P005", and "P006" are position commands, "L" is a command that means linear movement, "C" is a command that means circular movement, and "SPEED1" and "SPEED2" are commands that mean the movement speed, respectively.

[0045] The specific position and posture of each position command in the operation program are obtained by operating the tool attachment / detachment robot 30 through a manual operation called a teaching operation. The rotational angle positions of each drive motor provided at each joint when the tool attachment / detachment robot 30 is operated through the teaching operation are obtained as parameters, and the parameters obtained for each position command are stored in the parameter memory unit 60 via the input / output device 65.

[0046] The program analysis unit 57 is an operation program stored in the operation program memory unit 56, reads out the operation program to be executed, analyzes the commands, and extracts commands related to movement, such as the above-mentioned movement command "MOVE", position commands "P004", "P005", "P006", path commands "L", "C", speed commands "SPEED1", "SPEED2", etc., and when a command related to movement is extracted, transmits the command related to movement to the axis control unit 57.

[0047] The axis control unit 58 drives each drive motor of the tool attaching / detaching robot 30 via the axis drive unit 59 in response to a command transmitted from the program analysis unit 57. Specifically, the axis control unit 58 reads out a parameter corresponding to each position command, for example, "P004", from the parameter storage unit 60, generates a rotation command (control signal) for each drive motor so that the rotation angle position of each drive motor becomes the read rotation angle position, and the movement path of the hand 35 follows the commanded movement path (linear movement or circular movement), and further moves at a commanded speed, and transmits the generated rotation command (control signal) to the axis drive unit 59. Then, the axis drive unit 59 supplies a drive current corresponding to the rotation command received from the axis control unit 58 to each drive motor of the tool attaching / detaching robot 30, thereby moving the hand 35 to the commanded position. The axis control unit 58 is configured to feedback-control each drive motor based on a feedback signal transmitted from an encoder provided in each drive motor.

[0048] The speed adjusting unit 61 monitors the load in the direction in which the tool body TB is removed from the hand 35, for example, the load in the direction of the arrow f, among the loads detected by the force sensor 37 provided in the tool attaching / detaching robot 30, and performs processing to transmit a control signal for decelerating the moving speed of the hand 35, in other words, the rotation speed of each driving motor, to the axis control unit 58 when the load in the direction of the arrow f exceeds a predetermined reference load. This deceleration control signal is a control signal that has a ratio of less than 100% (for example, 70%) with respect to the current speed command, and can be set to a constant ratio or a ratio according to the magnitude of the load exceeding a reference value, for example, the ratio can be set to a smaller ratio as the load increases. Thus, the moving speed of the hand 35 is decelerated with respect to the command speed by inputting this deceleration control signal to the axis control unit 58.

[0049] The reference load is a load assumed to cause the tool body TB to slip out of the hand 35, and can be set theoretically or empirically. Although the force in the direction in which the tool body TB slips out of the hand 35 is assumed to be greatest in the direction of arrow f, the force to be monitored is not limited to the force in the direction of arrow f, and forces in other directions may be monitored.

[0050] According to the tool transporting device 10 of this embodiment configured as described above, under the control of the control device 50, the tool transporting device 10 takes out the designated tool body TB from the designated tool magazine TM and stores it in the designated tool storage rack 6. At that time, the operation of the tool attaching / detaching robot 30 is controlled by the robot control unit 55, and during the operation, the speed adjustment unit 61 monitors the load in the direction in which the tool body TB is removed from the hand 35, and when this load exceeds a predetermined reference load, the moving speed of the hand 35 is decelerated with respect to the commanded speed.

[0051] Thus, according to the tool transport device 10 of this embodiment, the load in the direction in which the tool body TB slips out of the hand 35 is monitored during operation of the tool attaching / detaching robot 30, and when this load exceeds a predetermined reference load, the moving speed of the hand 35 is decelerated, thereby making it possible to prevent the tool body TB from slipping out of the hand 35 during movement of the hand 35. Moreover, since the moving speed is decelerated only when the force in the direction in which the tool body TB slips out of the hand 35 exceeds the reference load, the safety of the operation of the tool attaching / detaching robot 30 can be ensured without unnecessarily impairing the work efficiency of the tool attaching / detaching robot 30, as compared to a case in which the moving speed is uniformly slowed.

[0052] Furthermore, by slowing down the movement speed of the hand 35 as the load exceeding the reference value increases, it is possible to prevent as much as possible a decrease in the work efficiency of the tool attachment / detachment robot 30, and also to reliably prevent the tool body TB from coming off the hand 35.

[0053] Although one embodiment of the present invention has been described above, the aspects that the present invention can adopt are not limited to the above example.

[0054] For example, the control device 50 may be configured to include a robot control unit 55' as shown in Fig. 10 as a control unit for controlling the operation of the tool attaching / detaching robot 30. This robot control unit 55' includes a speed adjustment unit 61' having a different function instead of the speed adjustment unit 61, and other configurations are the same as those in the above example. Therefore, the same components as those in the robot control unit 55 in the above example are denoted by the same reference numerals, and detailed description thereof will be omitted. In this case, the force sensor 37 may not be provided.

[0055] The speed adjustment unit 61' obtains and stores the driving power supplied to each driving motor constituting the tool attaching / detaching robot 30 from the axis driving unit 59 as a reference power when the tool attaching / detaching robot 30 is operated in an idle state, i.e., when the hand 35 is not holding the tool body TB, under the control of the robot control unit 55'.

[0056] Then, under the control of the robot control unit 55', the speed adjustment unit 61' obtains and monitors the driving power supplied to each driving motor of the tool attaching / detaching robot 30 as actual power from the axis driving unit 59 when the tool attaching / detaching robot 30 is performing actual operation, i.e., when the hand 35 is operating with the tool body TB held, and when the actual power exceeds a limit power set based on a previously obtained reference power, it determines that the movement is causing a force to act in a direction such that the tool body TB will come out of the hand 35, and performs processing to send a control signal to the axis control unit 58 to decelerate the movement speed of the hand 35, in other words, the rotational speed of each driving motor.

[0057] As described above, the axis control unit 58 is configured to feedback control each of the drive motors based on a feedback signal transmitted from an encoder provided in each of the drive motors. When a large load acts on each of the drive motors, a rotational follow-up delay occurs in each of the drive motors in response to the load, and the drive current supplied from the axis drive unit 59 to each of the drive motors is increased in response to the follow-up delay. Since the load acting on each of the drive motors is considered to be the largest when a force acts in a direction in which the tool body TB is removed from the hand 35, it can be determined that there is a possibility that the tool body TB will be removed from the hand 35 when the actual power exceeds the limit power. Therefore, when the actual power exceeds the limit power set based on the reference power previously obtained, the speed adjustment unit 61' transmits a control signal (deceleration control signal) for decelerating the rotational speed of each of the drive motors to the axis control unit 58, thereby decelerating the moving speed of the hand 35.

[0058] As in the above example, the deceleration control signal can be a control signal that has a ratio of less than 100% (e.g., 70%) to the current speed command, can be a constant ratio, or can be set to a ratio according to the magnitude of the excess over the limit power, for example, the larger the excess over the limit power, the smaller the ratio can be set. Thus, by inputting this deceleration control signal to the axis control unit 58, the moving speed of the hand 35 is decelerated with respect to the command speed. The limit power is the power supplied to each drive motor when it is determined that there is a possibility that the tool body TB will slip out of the hand 35, and can be set theoretically or empirically.

[0059] Thus, according to this embodiment, the actual power supplied to each drive motor during actual operation of the tool attaching / detaching robot 30 is monitored, and when the actual power exceeds a preset limit power, the moving speed of the hand 35 is decelerated, thereby making it possible to prevent the tool body TB from coming off the hand 35 while the hand 35 is moving. Moreover, since the moving speed of the hand 35 is decelerated only when the actual power supplied to each drive motor exceeds the limit power, the safety of the operation of the tool attaching / detaching robot 30 can be ensured without unnecessarily impairing the work efficiency of the tool attaching / detaching robot 30, as compared to a case in which the moving speed is uniformly slowed.

[0060] Furthermore, when the speed adjustment unit 61' is configured to slow down the moving speed of the hand 35 at a rate corresponding to the amount by which the actual power exceeds the limit power, it is possible to prevent as much as possible a decrease in the work efficiency of the tool attaching / detaching robot 30, and to reliably prevent the tool body TB from detaching from the hand 35.

[0061] Furthermore, the present invention is not limited to the aspect in which the moving speed of the hand 35 is slowed down by the above-mentioned speed adjustment units 61 and 61', but can also adopt an aspect in which, in the operation program (the operation program stored in the operation program memory unit 56) for operating the tool attaching / detaching robot 30, the moving speed of the hand 35 is set to a slower speed when a force is acting in a direction that causes the tool body TB to come out of the hand 35, compared to when a force is not acting in a direction that causes the tool body TB to come out of the hand 35.

[0062] 8, when the hand 35 is moved linearly in the direction of the arrow f, the largest force acts in the direction in which the tool body TB slips out of the hand 35, when the hand 35 is moved in an arc in the direction of the arrow gh, the next largest force acts when the hand 35 is moved linearly in the direction of the arrow cd. On the other hand, when the hand 35 is moved linearly in the direction of the arrow e, no force acts in the direction in which the tool body TB slips out of the hand 35.

[0063] Therefore, the movement speed when the hand 35 is moved in a straight line in the direction of the arrow f can be set to the slowest, the movement speed when the hand 35 is moved in an arc in the direction of the arrow gh can be set to the next slowest, the movement speed when the hand 35 is moved in a straight line in the direction of the arrow cd can be set to the next slowest, and the movement speed when the hand 35 is moved in a straight line in the direction of the arrow e can be set to the fastest.

[0064] Even with this configuration, when moving the hand 35 of the tool attaching / detaching robot 30, when a force is acting in a direction that causes the tool body TB to slip out of the hand 35, the movement speed is set to a slower speed than when a force is not acting in a direction that causes the tool body TB to slip out.Therefore, compared to when the movement speed of the hand 35 is uniformly set to a slower speed, the safety of the operation of the tool attaching / detaching robot 30 can be ensured without unnecessarily impairing the work efficiency of the tool attaching / detaching robot 30.

[0065] It should be noted that the above-described embodiment is illustrative in all respects and is not restrictive. Modifications and changes are possible for those skilled in the art. The scope of the present invention is indicated by the claims, not the above-described embodiment. Furthermore, the scope of the present invention includes modifications from the embodiments within the scope of the claims and the equivalent scope. [Explanation of symbols]

[0066] 1 Processing system 5 Tool storage device 6 Tool Storage Rack 7 Support Frame 8 Retaining Frame 10 Tool transport device 11. Mobile Devices 12 Support base 13 Drive unit 14 Guide rail 15 Mobile stand 20 Tool holding device 21,23 Tool holding member 22,24 Notch 23 Frame 30 Tool attachment / detachment robot 35 Hands 37 Force Sensor 40 Air blower 41 Air Blow Box 42 Aperture 50 Control device 55 Robot control unit 56 Operation program storage unit 57 Program Analysis Section 58 Axis control section 59 Axis Drive Unit 60 Parameter storage section 61 Speed ​​adjustment section 65 I / O Devices M machine tool TM Tool Magazine T-tool TH Tool Holder TB tool body

Claims

1. A method for controlling, using a control device, an operation of a robot that has a hand as an end effector, holds an object to be held in the hand directly or indirectly, and moves the hand in a three-dimensional space, comprising: A robot motion control method characterized in that, when moving the hand, when a force acts on the held object in a direction that causes it to slip out of the hand, the moving speed is made slower than when a force does not act on the held object in the direction that causes it to slip out of the hand.

2. The robot is controlled in its operation according to an operation program executed by the control device, 2. A robot motion control method as described in claim 1, characterized in that the movement speed of the hand specified in the operation program is set to be slower when a force acts on the held object in a direction that causes the held object to slip out of the hand than when a force does not act on the held object in the direction that causes the held object to slip out of the hand.

3. the robot includes the hand with a force sensor interposed therebetween, 2. The robot motion control method according to claim 1, wherein the control device monitors a load detected by the force sensor when moving the hand, the load being a load in a direction that would cause the held object to slip out of the hand, and when the load exceeds a predetermined reference load, determines that the movement is one in which a force in the direction that would cause the held object to slip out is acting on the held object, and decelerates a motion speed specified for the movement.

4. 4. The robot motion control method according to claim 3, wherein the control device reduces the specified motion speed at a rate according to the load in the direction of breaking away detected by the force sensor.

5. The robot is operated in an idle state, and power supplied to a motor constituting the robot during the idle state is acquired in advance as a reference power; 2. The robot movement control method according to claim 1, wherein the control device monitors the power supplied to the motor as actual power when the robot is actually moved, and when the actual power exceeds a limit power set based on the reference power, determines that the movement will cause a force to act on the held object in the direction of slipping out, and decelerates the movement speed specified for the movement.

6. 6. The robot motion control method according to claim 5, wherein said control device reduces said designated motion speed at a rate according to said actual power.

7. A control device for controlling a robot that has a hand as an end effector, holds an object to be held directly or indirectly in the hand, and moves the hand in a three-dimensional space, The control device is configured to slow down the movement speed when a force acts on the held object in a direction that causes the held object to slip out of the hand, when the hand is moved, compared to the movement speed when a force does not act on the held object in the direction that causes the held object to slip out.

8. The control device is configured to control the operation of the robot according to an operation program; 8. A robot control device as described in claim 7, characterized in that the movement speed of the hand specified in the operation program is set to be slower when a force acts on the held object in a direction to cause it to slip out of the hand than when a force does not act on the held object in the direction to cause it to slip out.

9. the robot includes the hand with a force sensor interposed therebetween, 8. A robot control device according to claim 7, characterized in that the control device is configured to monitor a load detected by the force sensor when the hand is moved, which is a load in a direction that would cause the held object to slip out of the hand, and when the load exceeds a predetermined reference load, to determine that the movement is one in which a force in the direction that would cause the held object to slip out is acting on the held object, and to decelerate a specified operating speed for the movement.

10. 10. The robot control device according to claim 9, wherein the control device is configured to decelerate the specified motion speed at a rate according to the load in the escape direction detected by the force sensor.

11. 8. A robot control device according to claim 7, wherein the control device is configured to monitor, as an actual power, the power supplied to a motor constituting the robot when the robot is actually operated, and, when the actual power exceeds a limit power which is set using the power supplied to the motor when the robot is operated in an idle state as a reference power, to determine that a force in the direction of the robot slipping out is acting on the held object, and to decelerate an operating speed designated for the movement.

12. The robot control device according to claim 11, wherein the control device is configured to reduce the specified motion speed at a rate according to the actual power.

Citation Information

Patent Citations

  • Control method for work transfer robot

    JP1990180573A

  • Method of controlling self-propelled robot

    JP1994285776A

  • Transportation system, control method of transportation system, and control program of transportation system

    JP2022024521A

  • Substrate transport robot and operation method thereof

    JP6884109B2

  • Tool transport device

    WO2022185375A1