Device and method for controlling robot action, device and method for generating operation program, computer program, and operation program
The control system for robots with multiple degrees of freedom stabilizes operations by using a second control method with fewer degrees of freedom only when specific conditions are met, preventing instability and ensuring safe, smooth operation.
Patent Information
- Application Number
- JP2024093819
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2024-06-10
- Publication Date
- 2024-11-06
- Estimated Expiration
- 2043-04-24
AI Technical Summary
The motion of robots with multiple degrees of freedom can become unstable due to singularities or when switching control methods during operation, leading to potential instability.
A control system that includes a first control method for multiple degrees of freedom and a second control method with fewer degrees of freedom, where conditions for using the second method are predetermined, and the system determines whether these conditions are met before executing the operation, ensuring stability by avoiding singularities and unstable motions.
The system effectively stabilizes robot motion by preventing operations that could lead to instability, allowing the robot to operate smoothly and safely, even when approaching singularities, by dynamically switching between control methods based on predefined conditions.
Smart Images

Figure 2024156649000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to an apparatus and method for controlling the movement of a robot, an apparatus and method for generating an operation program, a computer program, and an operation program. [Background technology]
[0002] There is known a technique for switching between a five-axis control program and a six-axis control program when an operation program for causing a robot to perform a task is being executed (for example, see Patent Document 1). [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2005-329521 A Summary of the Invention [Problem to be solved by the invention]
[0004] Conventionally, the motion of a robot with multiple degrees of freedom could become unstable due to singular points, etc. In addition, when switching the control method while executing one motion program, the motion of the robot could also become unstable. [Means for solving the problem]
[0005] In one aspect of the present disclosure, an apparatus for controlling the movement of a robot having multiple degrees of freedom includes an input receiving unit that receives an input specifying one of a first control method for realizing a movement with multiple degrees of freedom and a second control method for realizing a movement with one or more degrees of freedom less than the first control method, the second control method being a control method for realizing a movement with one or more degrees of freedom less than the first control method, and a condition for permitting the movement by the second control method being preset, an action command unit that causes the robot to execute the movement by the first control method or the second control method specified by the input received by the input receiving unit, and a condition determination unit that determines whether or not the condition is satisfied when the action command unit executes the movement by the second control method. If the condition determination unit determines that the condition is not satisfied, the action command unit does not execute the movement by the second control method.
[0006] In another aspect of the present disclosure, an apparatus for generating an operation program that prescribes the operation of a robot having multiple degrees of freedom includes an input receiving unit that receives an input specifying one of a first control method that realizes operation with multiple degrees of freedom and a second control method that realizes operation with one or more degrees of freedom less than the first control method, and a program setting unit that specifies one of the first control method and the second control method in the operation program according to the input received by the input receiving unit. This operation program causes the robot to execute the operation according to the first control method or the second control method specified by the program setting unit.
[0007] A method for controlling the movement of a robot having multiple degrees of freedom includes a processor receiving input specifying one of a first control method that realizes movement with multiple degrees of freedom and a second control method that realizes movement with one or more degrees of freedom less than the first control method, wherein conditions for allowing the movement by the second control method are predetermined, causing the robot to perform movement by the first control method or the second control method specified by the received input, determining whether the conditions are satisfied when performing the movement by the second control method, and if it is determined that the conditions are not satisfied, not performing the movement by the second control method.
[0008] A method for generating an operation program that specifies the operation of a robot having multiple degrees of freedom includes a processor receiving an input that specifies one of a first control method that realizes operation with multiple degrees of freedom and a second control method that realizes operation with one or more degrees of freedom less than the first control method, and specifying one of the first control method and the second control method in the operation program according to the received input. This operation program causes the robot to execute an operation according to the specified first control method or second control method.
[0009] An operating program that specifies the movements of a robot having multiple degrees of freedom and causes the robot to execute the movements is configured to be able to specify one of a first control method that realizes movements with multiple degrees of freedom, and a second control method that realizes movements with one or more degrees of freedom less than the first control method, and causes the robot to execute movements according to the specified first control method or second control method. [Brief description of the drawings]
[0010] [Figure 1] FIG. 1 is a schematic diagram of a robot system according to an embodiment. [Diagram 2] FIG. 2 is a block diagram of the robot system shown in FIG. [Diagram 3] 2 shows an example of a teaching flow executed by the robot system shown in FIG. [Figure 4] 4 is a flowchart showing an example of the process of step S2 in FIG. 3. [Diagram 5] 4 shows an example of a data structure of an operation program. [Figure 6] 4 is a flowchart showing an example of the process of step S3 in FIG. 3. [Figure 7] 1. FIG. 4 is a block diagram showing other functions of the robot system shown in FIG. [Figure 8] 7 is a flowchart showing another example of the flow of step S2 in FIG. 3. [Figure 9] FIG. 1 is a block diagram of an operation program generating device according to an embodiment. [Figure 10]8 is a flowchart showing an example of an operation check flow executed by the robot system shown in FIG. 7. [Figure 11] 4 is a flowchart showing an example of the process of steps S43 and S44 in FIG. 3. [Figure 12] 10 is a flowchart showing yet another example of the flow of step S2 in FIG. 3. [Figure 13] 11 is a flowchart showing another example of the flow of steps S43 and S44 in FIG. 10. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0011] Hereinafter, embodiments of the present disclosure will be described in detail with reference to the drawings. In various embodiments described below, similar elements are given the same reference numerals, and duplicated explanations will be omitted. First, a robot system 10 according to one embodiment will be described with reference to Figs. 1 and 2. The robot system 10 includes a robot 12, a control device 14, and a teaching device 16.
[0012] In this embodiment, the robot 12 is a vertical articulated robot that performs a predetermined task (e.g., work handling, welding, cutting, or laser processing) on a workpiece (not shown). Specifically, the robot 12 has a robot base 18, a rotating body 20, a lower arm 22, an upper arm 24, a wrist 26, and an end effector 28.
[0013] The robot base 18 is fixed to the floor of a work cell or on an automated guided vehicle (AGV). The rotating body 20 is provided on the robot base 18 so as to be rotatable around a first joint axis A1. The first joint axis A1 is, for example, parallel to the vertical direction and is fixed to the rotating body 20. The lower arm 22 is provided on the rotating body 20 so as to be rotatable around a second joint axis A2. The second joint axis A2 is perpendicular to the first joint axis A1 (i.e., parallel to the horizontal direction) and is fixed to a base end of the lower arm 22.
[0014] The upper arm 24 has a base arm 24a and a tip arm 24b. The base arm 24a is provided at the tip of the lower arm 22 so as to be rotatable around a third joint axis A3. The third joint axis A3 is parallel to the second joint axis A2 and is fixed to the base end of the base arm 24a. The tip arm 24b is provided at the tip of the base arm 24a so as to be rotatable around a fourth joint axis A4. The fourth joint axis A4 is perpendicular to the third joint axis A3 and is fixed to the base end of the tip arm 24b.
[0015] The wrist section 26 has a wrist base 26a and a wrist flange 26b. The wrist base 26a is provided at the tip of the distal arm section 24b so as to be rotatable around a fifth joint axis A5. The fifth joint axis A5 is perpendicular to the fourth joint axis A4 and is fixed to the wrist base 26a. The wrist flange 26b is provided at the wrist base 26a so as to be rotatable around a sixth joint axis A6. The sixth joint axis A6 is perpendicular to the fifth joint axis A5 and is fixed to the wrist flange 26b. The end effector 28 is detachably attached to the wrist flange 26b. The end effector 28 is, for example, a robot hand, a welding torch, a cutting tool, or a laser processing head, and performs an operation on a workpiece (workpiece handling, welding, cutting, or laser processing).
[0016] A servo motor 30 (FIG. 2) is connected to each of the joint axes A1 to A6. These servo motors 30 rotate and drive each of the joint axes A1 to A6 in accordance with commands from the control device 14, thereby rotating the rotating body 20, the lower arm 22, the base-end arm 24a, the tip arm 24b, the wrist base 26a, and the wrist flange 26b (i.e., the end effector 28) around each of the joint axes A1 to A6. That is, in this embodiment, the robot 12 has six degrees of freedom.
[0017] On the other hand, the servo motor 30 is provided with a rotation detector 32 (FIG. 2) that detects the rotation positions R1-R6 of the joint axes A1-A6 (in other words, the rotation position of each servo motor 30). The rotation detector 32 has, for example, an encoder or a Hall element, and supplies detection data Dr of the rotation positions R1-R6 to the control device 14.
[0018] The robot 12 is also provided with a force sensor 34 (FIG. 2) for detecting a force F applied to the robot 12. As one example, the force sensor 34 has a six-axis force sensor provided at any part of the robot 12 (for example, the wrist 26 or the robot base 18). As another example, the force sensor 34 has a torque sensor provided at each of the joint axes A1 to A6. The force sensor 34 supplies detection data Df of the detected force F to the control device 14.
[0019] 1, a robot coordinate system C1, a mechanical interface (MIF) coordinate system C2, and a tool coordinate system C3 are set for the robot 12. The robot coordinate system C1 is a fixed coordinate system for controlling the operation of each movable component of the robot 12 (i.e., the rotating body 20, the lower arm 22, the base arm 24a, the tip arm 24b, the wrist base 26a, the wrist flange 26b, and the end effector 28). In this embodiment, the robot coordinate system C1 is set with respect to the robot base 18 so that its origin is located at the center of the robot base 18 and its z axis is parallel to (specifically, coincides with) the first joint axis A1.
[0020] On the other hand, the MIF coordinate system C2 is a moving coordinate system that defines the position P of the hand of the robot 12 (specifically, the wrist flange 26b and the end effector 28) in the robot coordinate system C1. In this embodiment, the MIF coordinate system C2 is set with respect to the wrist flange 26b so that its origin is located at the center of the tip surface of the wrist flange 26b (that is, the intersection point between an imaginary extension line of the sixth joint axis A6 and the tip surface of the wrist flange 26b) and its z axis is parallel to (specifically, coincides with) the sixth joint axis A6.
[0021] The tool coordinate system C3 is a moving coordinate system that defines the position P of the end effector 28 in the robot coordinate system C1, and is disposed in a known positional relationship with the MIF coordinate system C2. In this embodiment, the tool coordinate system C3 is set with respect to the end effector 28 so that its origin (so-called TCP) is disposed at a working position of the end effector 28 (for example, a workpiece gripping position, a welding position, a tool tip point, or a laser light emission port).
[0022] When moving the end effector 28, the processor 46 of the control device 14 sets a tool coordinate system C3 in the robot coordinate system C1, and generates a command to each servo motor 30 to position the end effector 28 at a position P represented by the set tool coordinate system C3. In this manner, the processor 46 drives each servo motor 30 to position the end effector 28 at an arbitrary position P in the robot coordinate system C1. In this document, "position" may refer to both position and orientation.
[0023] The teaching device 16 controls the movement of the robot 12 via the control device 14 and teaches the robot 12 movements for tasks. As shown in Fig. 2, the teaching device 16 is a computer having a processor 36, a memory 38, an I / O interface 40, a display device 42, and an input device 44. The processor 36 has a CPU or a GPU, etc., and is communicatively connected to the memory 38, the I / O interface 40, the display device 42, and the input device 44 via a bus 45, and performs calculation processing for realizing various functions described later while communicating with these components.
[0024] The memory 38 has a RAM or a ROM, etc., and temporarily or permanently stores various data. The memory 38 may be a computer-readable non-transitory recording medium, such as a semiconductor memory, a magnetic recording medium, or an optical recording medium. The I / O interface 40 has, for example, an Ethernet (registered trademark) port, a USB port, an optical fiber connector, or an HDMI (registered trademark) terminal, and communicates data with an external device via wired or wireless communication under instructions from the processor 36.
[0025] The display device 42 has a liquid crystal display or an organic EL display, etc., and visibly displays various data under instructions from the processor 36. The input device 44 has a touch panel, a push button, a switch, a keyboard, a mouse, etc., and receives data input from an operator. The display device 42 and the input device 44 may be integrated into the housing of the teaching device 16, or may be provided separately from the housing of the teaching device 16 and connected to the I / O interface 40. The teaching device 16 may be any type of computer, such as a teaching pendant or a notebook or tablet PC.
[0026] The control device 14 controls the operation of the robot 12. Specifically, the control device 14 is a computer having a processor 46, a memory 48, an I / O interface 50, a display device 52, and an input device 54. Note that the configurations of the processor 46, the memory 48, the I / O interface 50, the display device 52, and the input device 54 are similar to those of the processor 36, the memory 38, the I / O interface 40, the display device 42, and the input device 44, and therefore a duplicated description will be omitted.
[0027] The processor 46 is communicatively connected to the memory 48, the I / O interface 50, the display device 52, and the input device 54 via a bus 55, and performs calculations for realizing the robot control function while communicating with these components. In this embodiment, the I / O interface 50 is communicatively connected to the I / O interface 40 of the teaching device 16.
[0028] The operator provides the control device 14 with a teaching command Ct for teaching the robot 12 to operate, and while moving the robot 12 (specifically, the end effector 28) in a desired direction, teaches a teaching point Pt for positioning the end effector 28 (or the origin of the tool coordinate system C3) during work. The operator operates the input device 44 of the teaching device 16 to provide the processor 36 of the teaching device 16 with an input IN1 for selecting a jog teach mode OM1, a direct teach mode OM2, or an operation replay mode OM3 as the operation mode OM of the robot 12.
[0029] The processor 36 of the teaching device 16 transmits a mode selection command Cm to the control device 14 in accordance with the input IN1 received through the input device 44. The processor 46 of the control device 14 switches the operation mode OM of the robot 12 among a jog teach mode OM1, a direct teach mode OM2, and an action replay mode OM3 in accordance with the mode selection command Cm.
[0030] In the jog teach mode OM1, the operator operates the input device 44 of the teaching device 16 to input a jog command Ct1 for performing a jog operation on the robot 12 as a teaching command Ct. The processor 36 of the teaching device 16 receives the input IN7 of the jog command Ct1, and transmits the received jog command Ct1 to the control device 14. The processor 46 of the control device 14 performs a jog operation on the robot 12 in accordance with the received jog command Ct1.
[0031] On the other hand, in the direct teach mode OM2, the operator applies an operating force Ct2 to any movable component (e.g., the end effector 28) of the robot 12 as a teaching command Ct. The processor 46 of the control device 14 calculates the magnitude and direction of the operator's operating force Ct2 based on the detection data Df of the force sensor 34, and identifies the movable component to which the operating force Ct2 is applied. Then, the processor 46 executes a direct teach function to move the movable component to which the operating force Ct2 is applied in the direction of the operating force Ct2.
[0032] In this way, the processor 36 of the teaching device 16 controls the operation of the robot 12 via the control device 14 and sets a plurality of teaching points Pt n (n=1, 2, 3, . . . ) to create an operation program OP for the robot 12. The operation program OP is a computer program that specifies the operation of the robot 12 for a task. The operation program OP includes, for example, a plurality of teaching points Pt n (Specifically, the coordinate Q of the robot coordinate system C1 n ), the plurality of teaching points Pt n The moving path MP of the robot 12 passing through the robot 12, the moving speed V of the robot 12, and various operations of the robot 12 (including a plurality of teaching points Pt n The operations (positioning the robot 12 to the target position, actuation of the end effector 28, etc.) are defined as instruction codes IC.
[0033] The motion replay mode OM3 is an operation mode OM for checking the motion of the created motion program OP. In the motion replay mode OM3, the processor 36 of the teaching device 16 (or the processor 46 of the control device 14) executes the motion program OP stored in the memory 38 (or the memory 48) at this time, and causes the robot 12 to perform the motions defined in the motion program OP.
[0034] In this embodiment, the processor 36 or 46 operates the robot 12 in accordance with the first control method MT1 or the second control method MT2 while executing the jog teach mode OM1, the direct teach mode OM2, or the motion replay mode OM3. The first control method MT1 is a control method MT that realizes the motion of the robot 12 with six degrees of freedom, and drives six joint axes A1 to A6.
[0035] The first control method MT1 is defined by a first control program (specifically, a six-degree-of-freedom inverse kinematics algorithm) CP1. The first control program CP1 is a program for determining a position P of the hand of the robot 12 in a robot coordinate system C1 (specifically, the coordinates of the MIF coordinate system C2 and the tool coordinate system C3 in the robot coordinate system C1) from the rotational positions R1 to R6 of the six joint axes A1 to A6. The processor 36 or 46 realizes the operation of the robot 12 according to the first control method MT1 by using the first control program CP1.
[0036] On the other hand, the second control method MT2 is a control method MT that realizes the movement of the robot 12 with one or more degrees of freedom less than the first control method MT. In this embodiment, the second control method MT2 is a control method MT that realizes the movement of the robot 12 with five degrees of freedom, and drives five joint axes A1, A2, A3, A5, and A6 out of a total of six joint axes A1 to A6, while fixing the joint axis A4 at a rotation position R4=0°.
[0037] The second control method MT2 is defined by a second control program CP2 (specifically, an inverse kinematics algorithm with five degrees of freedom). The second control program CP2 is a program for determining a position P of the hand of the robot 12 in the robot coordinate system C1 (the coordinates of the MIF coordinate system C2 and the tool coordinate system C3 in the robot coordinate system C1) from the rotational positions R1 to R3, R5 and R6 of the five joint axes A1 to A3, A5 and A6. The processor 36 or 46 realizes the operation of the robot 12 according to the second control method MT2 by using the second control program CP2.
[0038] Next, a method for teaching the robot 12 to operate in the jog teach mode OM1 or the direct teach mode OM2 will be described with reference to Fig. 3. The processor 36 of the teaching device 16 starts the flow shown in Fig. 3 when it receives a teaching start command from an operator, a higher-level controller, or a computer program PG1.
[0039] In step S1, the processor 36 determines whether or not an input IN2 designating the second control method MT2 has been received. Specifically, the processor 36 generates image data IM1 of a graphical user interface (GUI) for designating one of the first control method MT and the second control method MT2, and displays it on the display device 42. While visually checking the image data IM1, the operator operates the input device 44 to provide the processor 36 with an input IN2 designating one of the first control method MT and the second control method MT2.
[0040] When the processor 36 receives an input IN2 specifying the second control method MT2, the processor 36 judges the result as YES and proceeds to step S2, whereas when the processor 36 receives an input IN2 specifying the first control method MT1, the processor 36 judges the result as NO and proceeds to step S3. Thus, in this embodiment, the processor 36 functions as an input receiving unit 62 (FIG. 2) that receives an input IN2 that specifies one of the first control method MT1 that realizes the movement of the robot 12 with multiple degrees of freedom (six degrees of freedom in this embodiment) and the second control method MT that realizes the movement of the robot 12 with one or more degrees of freedom less than the first control method MT2 (five degrees of freedom in this embodiment).
[0041] In step S2, the processor 36 executes a teaching process by the second control method MT2. This step S2 will be described with reference to FIG. 4. After the start of step S2, in step S11, the processor 36 determines whether or not a condition CD2 of the second control method MT2 is satisfied. This condition CD2 is for permitting the robot 12 to operate according to the second control method MT2. In this embodiment, the condition CD2 includes a condition that specifies the position P of the robot 12 when the robot 12 is operated in the second control method MT2.
[0042] More specifically, the condition CD2 is that the rotational position R4 of the fourth joint axis A4 (i.e., the distal arm portion 24b) is R4=0°. _1and a condition CD2 that the z-axis direction of the MIF coordinate system C2 (in other words, the direction of the sixth joint axis A6) is parallel to the vertical direction (i.e., the z-axis direction of the robot coordinate system C1) or the horizontal direction (i.e., the xy plane of the robot coordinate system C1). _2 The processor 36 determines whether the condition CD2 is satisfied based on the detection data Dr of the rotation position R4 of the fourth joint axis A4 detected by the rotation detector 32 at this time. _1 It is determined whether the following is satisfied.
[0043] Further, the processor 36 calculates the coordinate Q in the robot coordinate system C1 of the MIF coordinate system C2 at this time based on the detection data Dr of the rotation positions R1 to R6 of the joint axes A1 to A6 detected by the rotation detector 32 at this time and the second control program CP2. M Find (x,y,z,w,p,r). Coordinate Q M Among these, the coordinates (x, y, z) indicate the position of the origin of the MIF coordinate system C2 in the robot coordinate system C1, and the coordinates (w, p, r) indicate the orientation (i.e., the direction of each axis) of the MIF coordinate system C2 in the robot coordinate system C1. M Based on the coordinates (w, p, r) that indicate the posture, condition CD2 _2 It is determined whether the following is satisfied.
[0044] In step S11, processor 36 determines whether condition CD2 _1 and CD2 _2 If both of the above conditions are met, the answer is YES and the process proceeds to step S12. _1 and CD2 _2 If at least one of the above is not satisfied, the processor 36 determines that the condition is not satisfied and proceeds to step S20. _1 and CD2 _2 ) is satisfied.
[0045] In step S12, the processor 36 determines whether or not a teaching command Ct has been received. As an example, when the above-mentioned jog teach mode OM1 is being executed, the processor 36 functions as the input receiving unit 62 and determines whether or not an input IN7 of a jog command Ct1 has been received from the operator via the input device 44.
[0046] As another example, when the above-mentioned direct teach mode OM2 is being executed, the processor 36 determines whether the processor 46 of the control device 14 has received an operating force Ct2. If the processor 36 has received a teaching command Ct (jog command Ct1 or operating force Ct2), the result is YES, and the process proceeds to step S13, whereas if the processor 36 has determined NO, the process proceeds to step S14.
[0047] In step S13, the processor 36 causes the robot 12 to perform an operation based on the second control method MT2. Specifically, the processor 36 uses the second control program CP2 to control the robot 12 according to the teaching command Ct (the jog command Ct1 or the operating force Ct2) received in the previous step S12, under the condition CD2 of the second control method MT2. _1 (R4=0°), and condition CD2 _2 The robot 12 is caused to perform a five-degree-of-freedom movement so as to continuously satisfy the above condition (the z-axis of the MIF coordinate system C2 being in the vertical or horizontal direction).
[0048] That is, in this step S13, under the second control method MT2, the processor 36 fixes the rotational position R4 of the fourth joint axis A4 to R4 = 0°, and maintains the end effector 28 in an attitude in which the z-axis of the MIF coordinate system C2 is parallel to the vertical or horizontal direction, thereby moving the end effector 28 by operating the robot 12 in accordance with the teaching command Ct.
[0049] More specifically, when the jog / teach mode OM1 is being executed, the processor 36 controls the robot 12 to move in accordance with the condition CD2. _1 and CD2 _2While maintaining the state where the condition is satisfied, the robot 12 is operated via the control device 14 in accordance with the jog command Ct1 received in the immediately preceding step S12. At this time, if the moving direction MD of the robot 12 according to the jog command Ct1 moves the robot 12 in a direction that satisfies the condition CD2 _1 and CD2 _2 If the jog command Ct1 is to move the target object to a position P that does not satisfy the condition CD2 based on the movement direction MD of the jog command Ct1, the processor 36 _1 and CD2 _2 Alternatively, a moving direction MD' that satisfies the above may be calculated, and the robot 12 may be moved in the moving direction MD'.
[0050] On the other hand, when the above-mentioned direct teach mode OM2 is being executed, the processor 36 causes the processor 46 of the control device 14 to execute a direct teach function to move the robot 12 in the direction MD of the operating force Ct2. If the direction MD of the operating force Ct2 moves the robot 12 in the direction MD of the operating force Ct2 under the condition CD2 _1 and CD2 _2 If the operation force Ct2 is to be moved to a position P that does not satisfy the condition CD2 based on the direction MD of the operation force Ct2, the processor 36 _1 and CD2 _2 and cause the control device 14 to execute a direct teach function of moving the robot 12 in the direction MD'. In this way, the processor 36 functions as an operation command unit 66 (FIG. 2) that causes the robot 12 to execute an operation according to the second control method MT2.
[0051] In step S13, the processor 36 may execute a linear motion LM to move the end effector 28. The linear motion LM is a motion to move the end effector 28 from the current position Pc to the target position Pg along a smooth (for example, linear or arcuate) movement path MP with a minimum movement amount.
[0052] Alternatively, the processor 36 may move the end effector 28 by executing an axial movement SM in step S13. The axial movement SM is a movement for rotating at least one joint axis A (e.g., the fifth joint axis A5) from the current rotation position Rc to the target rotation position Rg by a minimum rotation amount. Note that the operator may operate the input device 44 to select the linear movement LM or the axial movement SM, and the processor 36 may execute the selected linear movement LM or the axial movement SM.
[0053] In step S14, the processor 36 determines whether or not a program creation command Cr has been received. The program creation command Cr is to set the current position Pc of the robot 12 at this time to the teaching point Pt n and store the teaching point Pt n The motion of the robot 12 at the teaching point Pt n This is a command for creating an operation program OP by specifying the movement of the end effector 28 to the target position.
[0054] Specifically, the processor 36 generates image data IM2 of a GUI for inputting a program creation command Cr, and displays it on the display device 42. While visually checking the image data IM2, the operator operates the input device 44 to provide the processor 36 with an input IN4 of the program creation command Cr. When the processor 36 functions as the input receiving unit 62 and receives the input IN4, the processor 36 determines YES and proceeds to step S15. On the other hand, when the processor 36 has not received the input IN4, the processor 36 determines NO and proceeds to step S16.
[0055] In step S15, the processor 36 creates an operation program OP. Specifically, the processor 36 creates the current position Pc of the robot 12 at this time point (specifically, the coordinate Q in the robot coordinate system C1 of the tool coordinate system C3 at this time point) in accordance with the program creation command Cr received in the immediately preceding step S14. T ) to the teaching point Pt nThe processor 36 stores the teaching point Pt n The processor 36 writes an instruction code IC for referring to the teaching point Pt n Position data (coordinate Q T ) may be written directly into the operating program OP as an instruction code IC.
[0056] In addition, the processor 36 calculates the teaching point Pt n The processor 36 writes an instruction code IC that specifies the operation of the robot 12 at the target position, the moving path MP, and the moving speed V into the operation program OP. The processor 36 repeatedly executes the flow of steps S12 to S15 to obtain a plurality of teaching points Pt n An operation program OP1 is created in which the operation of the robot 12, the movement path MP, the movement speed V, etc. are specified as instruction codes IC.
[0057] The operation program OP1 created in step S2 realizes the operation of the second control method MT2 (i.e., five degrees of freedom). An example of the data structure of the operation program OP1 is shown in FIG. 5. In the example shown in FIG. 5, "START" on the first line is a command code IC that starts the operation program OP1, while "END" on the i-th line is a command code IC that ends the operation program OP1. Also, "MOVE Pt1" on the second line is a command code IC that specifies the operation of positioning the end effector 28 to the first teaching point Pt1.
[0058] In addition, each teaching point Pt of the operation program OP1 n The information Ir indicates that the rotational position R (R5) of one joint axis A (e.g., the fifth joint axis A5) of the robot 12 is a non-negative value (i.e., R5≧0°). + and information Ir indicating that the rotational position R (R5) of the one joint axis A (the fifth joint axis A5) is a negative value (i.e., R5<0°). - may be further defined.
[0059] This information Ir + and Ir - should be defined in the operation program OP for the operation of the robot 12 with six degrees of freedom, and are information necessary for uniquely determining the solutions of the rotational positions R1 to R6 of the joint axes A1 to A6 of the robot 12 with six degrees of freedom in order to position the end effector 28 (i.e., the tool coordinate system C3) at an arbitrary position in the robot coordinate system C1. In this embodiment, the processor 36 calculates each teaching point Pt n Also, information for six degrees of freedom of movement is + and Ir - According to this configuration, the motion program OP1 with five degrees of freedom can be effectively executed by the robot 12 with six degrees of freedom.
[0060] In step S16, the processor 36 determines whether or not an input IN5 for specifying one of the first control method MT1 and the second control method MT2 for the operation program OP1 has been received. Specifically, the processor 36 generates image data IM4 for specifying one of the first control method MT and the second control method MT2 for the operation program OP1, and displays it on the display device 42.
[0061] While visually checking the image data IM4, the operator operates the input device 44 to provide the processor 36 with an input IN5 that specifies the first control method MT or the second control method MT2. When the processor 36 functions as the input receiving unit 62 and receives the input IN5, the processor 36 judges YES and proceeds to step S17. On the other hand, when the processor 36 judges NO, the processor 36 proceeds to step S18.
[0062] In step S17, the processor 36 specifies the first control method MT or the second control method MT2 in the operation program OP1 created in step S15 according to the input IN5 received in the immediately preceding step S16. Specifically, the processor 36 assigns a flag FG indicating the specification of the first control method MT or the second control method MT2 to the operation program OP1.
[0063] For example, in the immediately preceding step S16, the operator provides an input IN5 that specifies the second control method MT2 for the operation program OP1 that specifies the operation with five degrees of freedom. In this case, in this step S17, the processor 36 assigns a flag FG that indicates the specification of the second control method MT2 to the operation program OP1 created in step S15. Thus, in this embodiment, the processor 36 functions as a program setting unit 68 (FIG. 2) that specifies one of the first control method MT1 and the second control method MT2 for the operation program OP1 in accordance with the input IN5.
[0064] In step S18, the processor 36 determines whether or not the input IN6 specifying the first control method MT1 has been received. Specifically, the processor 36 displays the above-mentioned image data IM1 on the display device 42, and when the processor 36 functions as the input receiving unit 62 and receives the input IN6 specifying the first control method MT1 through the input device 44, the processor 36 determines YES. When the processor 36 determines YES, the processor 36 proceeds to step S3 in FIG. 3, whereas when the processor 36 determines NO, the processor 36 proceeds to step S19.
[0065] In step S19, the processor 36 judges whether or not an operation end command has been received from the operator, the upper controller, or the computer program PG1. If an operation end command has been received, the processor 36 judges YES, and ends the flow of Fig. 4, thereby ending the flow shown in Fig. 3. On the other hand, if the processor 36 judges NO, the process returns to step S11.
[0066] On the other hand, if the result of the determination in step S11 is NO, in step S20, the processor 36 determines whether or not the position P of the robot 12 can be adjusted. _1Assume that the result is NO because the condition (R4=0°) is not satisfied. In this case, the processor 36 determines whether the rotational position R4 of the fourth joint axis A4 at this time is within a predetermined allowable range [Rth1, Rth2] (i.e., Rth1≦R4≦Rth2). The threshold values Rth1 and Rth2 that define this allowable range [Rth1, Rth2] are set to the condition CD2. _1 These can be determined by the operator based on the above criteria (for example, Rth1=-1°, Rth2=1°). If Rth1≦R4≦Rth2, the processor 36 determines YES.
[0067] On the other hand, in the previous step S11, condition CD2 _2 Assume that the result is NO because the condition CD2 (the z-axis of the MIF coordinate system C2 is vertical or horizontal) is not satisfied. In this case, the processor 36 obtains the angle θ of the z-axis direction of the MIF coordinate system C2 from the vertical or horizontal direction at this point. Then, the processor 36 determines whether the angle θ is equal to or smaller than a predetermined threshold θth (i.e., θ≦θth). This threshold θth is set according to the condition CD2 _2 The angle θ may be determined by the operator based on the reference angle θ (for example, θth=5°). Processor 36 determines YES if θ≦θth.
[0068] In addition, in the previous step S11, condition CD2 _1 and CD2 _2 If the result of the determination in step S20 is NO because both of the above conditions are not satisfied, the processor 36 determines the result as YES if Rth1≦R4≦Rth2 and θ≦θth. If the result of the determination in step S20 is YES, the processor 36 proceeds to step S21, whereas if the result of the determination in step S20 is NO, the processor 36 proceeds to step S23.
[0069] In step S21, the processor 36 determines whether or not a position adjustment command Ca has been received. The position adjustment command Ca is a command for adjusting the position P of the robot 12 to a position P' that satisfies the condition CD2. More specifically, the processor 36 generates image data IM3 of a GUI for inputting the position adjustment command Ca, and displays it on the display device 42.
[0070] While visually checking the image data IM3, the operator operates the input device 44 to provide the input IN3 of the position adjustment command Ca to the processor 36. When the processor 36 functions as the input receiving unit 62 and receives the input IN3 of the position adjustment command Ca, the processor 36 determines YES and proceeds to step S22. On the other hand, when the processor 36 has not received the input IN3, the processor 36 determines NO and proceeds to step S14.
[0071] In step S22, the processor 36 functions as the motion command unit 66 to adjust the current position Pc of the robot 12 at this time to a position P' that satisfies the condition CD2. Specifically, the processor 36 functions as the motion command unit 66 to operate the robot 12 via the control device 14 to move the end effector 28 to a position P' that satisfies the condition CD2. _1 (R4=0°) and condition CD2 _2 (The z-axis of the MIF coordinate system C2 is in the vertical or horizontal direction).
[0072] At this time, the processor 36 may move the end effector 28 by executing each axial operation SM described above. In this way, the processor 36 adjusts the position P of the robot 12 so that the condition CD2 is satisfied. After this step S22, the processor 36 proceeds to step S12. Note that when the processor 36 executes step S22, it may generate an alarm signal NS indicating that the robot 12 is now in a state that satisfies the condition CD2 as an image or sound, and display it on the display device 42 or output it through a speaker (not shown) provided in the teaching device 16.
[0073] In addition, when the position Pc of the robot 12 is adjusted to the position P' in step S22, the processor 36 sets the adjusted position P' as a new teaching point Pt n in the operation program OP1, and the operation of the robot 12 (for example, each axis operation SM) for moving the end effector 28 from the pre-adjustment position Pc to the post-adjustment position P' may be specified in the operation program OP1. As a result, the operation executed in step S22 can be taught by specifying it as an instruction code IC in the operation program OP1.
[0074] If the determination in step S20 is NO, in step S23, the processor 36 generates an alarm AL1. For example, the processor 36 generates an image or sound alarm AL1 stating "The robot cannot be operated because the conditions of the second control method are not satisfied," and outputs the image or sound alarm AL1 through the display device 42 or the speaker. After this step S23, the processor 36 proceeds to step S14. Thus, in this embodiment, if the condition CD2 is not satisfied, the processor 36 does not execute the operation of the robot 12 according to the second control method MT2 in step S13.
[0075] In step S23, the processor 36 may attach information for identifying the condition CD2 for which the most recent step S11 was determined to be NO to the alarm AL1. For example, if the most recent step S11 was determined to be NO for the condition CD2 that R4=0°, _1 If the result is NO because the condition CD2 is not satisfied, the processor 36 _1 Information indicating that the above condition is not met may be added to the image or sound of the alarm AL1.
[0076] 3 again, if the determination in step S1 is NO, in step S3, the processor 36 executes a teaching process by the first control method MT1. This step S3 will be described with reference to FIG. 6. After starting step S3, in step S31, the processor 36 determines whether or not a teaching command Ct has been received, similarly to the above-mentioned step S12. If the processor 36 determines YES, the processor 36 proceeds to step S32, whereas if the processor 36 determines NO, the processor 36 proceeds to step S34.
[0077] In step S32, the processor 36 functions as a condition determination unit 64 and determines whether or not a condition CD1 for permitting the operation of the robot 12 by the first control method MT1 is satisfied. The condition CD1 includes, for example, a condition that the robot 12 does not pass near a singular point SP. The singular point SP is, for example, a position of the robot 12 where two of the joint axes A1 to A6 are aligned on a straight line, and it becomes impossible to uniquely determine a solution for the rotational positions R1 to R6 of the joint axes A1 to A6 for positioning the end effector 28 at such a singular point SP.
[0078] In step S32, the processor 36 calculates a target position Pg of the robot 12 (specifically, the end effector 28) according to the teaching command Ct received in the immediately preceding step S31, and determines whether or not a movement path MP of the robot 12 to the target position Pg passes near the singular point SP. If the movement path MP does not pass near the singular point SP, the processor 36 determines YES and proceeds to step S33, whereas if the movement path MP passes near the singular point SP, the processor 36 determines NO and proceeds to step S40.
[0079] In step S33, the processor 36 functions as the operation command unit 66, and causes the robot 12 to execute an operation according to the first control method MT1. Specifically, the processor 36 uses the first control program CP1 to cause the robot 12 to execute an operation with six degrees of freedom in accordance with the teaching command Ct (the jog command Ct1 or the operating force Ct2) received in the most recent step S31.
[0080] In step S33, the processor 36 may move the end effector 28 by executing the linear movement LM or each axis movement SM. Alternatively, the operator may operate the input device 44 to select the linear movement LM or each axis movement SM, and the processor 36 may execute the selected linear movement LM or each axis movement SM. In step S34, the processor 36 determines whether or not a program creation command Cr has been received, similar to step S14 described above. If the processor 36 determines YES, the processor 36 proceeds to step S35, whereas if the processor 36 determines NO, the processor 36 proceeds to step S36.
[0081] In step S35, similarly to step S15 described above, the current position Pc of the robot 12 at this time is set as the teaching point Pt n and store the teaching point Pt n The operation program OP2 created in step S3 is for realizing the operation of the first control method MT1 (that is, six degrees of freedom).
[0082] The operation program OP2 may be created as a computer program separate from the five-degree-of-freedom operation program OP2 created in step S2, and includes instruction codes IC from "START" to "END" like the operation program OP2 shown in Fig. 5. The operation program OP2 also includes information Ir + and Ir - is prescribed.
[0083] In step S36, the processor 36 determines whether or not an input IN5 that specifies one of the first control method MT1 and the second control method MT2 for the operation program OP has been received, similarly to step S16 described above. When the processor 36 functions as the input receiving unit 62 and receives the input IN5, the processor 36 determines YES and proceeds to step S37, whereas when the processor 36 determines NO, the processor 36 proceeds to step S38.
[0084] In step S37, the processor 36 functions as the program setting unit 68 and, similarly to step S17 described above, specifies the first control method MT or the second control method MT2 for the operation program OP2 created in step S35 according to the input IN5 received in the previous step S36. For example, in the previous step S36, the operator provides an input IN5 specifying the first control method MT1 for the operation program OP2 that prescribes the operation with six degrees of freedom. In this case, in this step S37, the processor 36 assigns a flag FG indicating the specification of the first control method MT1 to the operation program OP2 created in step S35.
[0085] In step S38, the processor 36 determines whether or not an input IN2 designating the second control method MT2 has been received, similar to step S1 described above. If the processor 36 determines YES, it proceeds to step S2 in FIG. 3, whereas if the processor 36 determines NO, it proceeds to step S39. In step S39, the processor 36 determines whether or not an operation end command has been received, similar to step S19 described above. If the processor 36 determines YES, it ends the flow of FIG. 6, thereby ending the flow shown in FIG. On the other hand, if the processor 36 determines NO, it returns to step S31.
[0086] On the other hand, if the determination in step S32 is NO, in step S40, processor 36 generates alarm AL2. For example, processor 36 generates image or audio alarm AL2 stating "The robot cannot be operated because the conditions of the first control method are not satisfied," and outputs it through display device 42 or a speaker.
[0087] At this time, the processor 36 may attach information specifying the condition CD1 (passing near a singular point) for which the previous step S32 was determined to be NO to the alarm AL2. After this step S40, the processor 36 proceeds to step S34. Thus, in this embodiment, if the condition CD1 is not satisfied, the processor 36 does not execute the operation of the robot 12 by the first control method MT1 in step S33.
[0088] As described above, the processor 36 can generate a plurality of operation programs OP1, OP2, OP3, ... by sequentially executing steps S2 and S3 in Fig. 3. m Each of the operation programs OP (m=1, 2, 3, . . . ) has a data structure including instruction codes IC from "START" to "END" as shown in FIG. 5, and is assigned a flag FL indicating the designation of the first control method MT or the second control method MT2 in step S17 or S37. m is stored in memory 38 (or 48).
[0089] As described above, in this embodiment, the processor 36 functions as the input receiving unit 62, the condition determining unit 64, the operation command unit 66, and the program setting unit 68 to control the operation of the robot 12 having multiple degrees of freedom (specifically, six degrees of freedom). Therefore, the input receiving unit 62, the condition determining unit 64, the operation command unit 66, and the program setting unit 68 constitute a device 60 (FIG. 2) that controls the operation of the robot 12 having multiple degrees of freedom.
[0090] In this device 60, an input receiving unit 62 receives inputs IN2, IN6 that specify one of a first control method MT1 that realizes an operation with multiple degrees of freedom (six degrees of freedom in this embodiment) and a second control method MT2 that realizes an operation with one or more degrees of freedom less than the first control method MT2 (five degrees of freedom in this embodiment) (steps S1, S18, S38). The second control method MT2 includes a condition CD2 that permits the operation of the robot 12 by the second control method MT2 (specifically, CD2 _1 and CD2_2 ) is determined in advance.
[0091] Furthermore, the operation command unit 66 causes the robot 12 to perform an operation according to the first control method MT1 or the second control method MT2 designated by the inputs IN2 and IN6 received by the input receiving unit 62 (steps S13 and S33). Meanwhile, the condition determination unit 64 determines whether or not a condition CD2 is satisfied when the operation command unit 66 performs an operation according to the second control method MT2 (step S11). Then, when the condition determination unit 64 determines that the condition CD2 is not satisfied (determined as NO in step S11), the operation command unit 66 does not perform an operation according to the second control method MT2.
[0092] Here, in the operation of the robot 12 with multiple degrees of freedom (e.g., six degrees of freedom), the above-mentioned singular point SP occurs, and the operation of the robot 12 may become unstable when passing near the singular point SP. Such a singular point SP may be avoided by limiting the operation of the robot 12 to one or more fewer degrees of freedom (e.g., five degrees of freedom). According to this embodiment, for example, when executing a teaching process, an operator can arbitrarily specify one of a first control method MT1 with multiple degrees of freedom (six degrees of freedom) and a second control method MT2 with fewer degrees of freedom (five degrees of freedom).
[0093] On the other hand, in the operation of the robot 12 with fewer degrees of freedom (five degrees of freedom), if a predetermined condition CD2 is not satisfied, the end effector 28 may not be positioned at an arbitrary position. According to this embodiment, if the condition CD2 is not satisfied by the condition determination unit 64, the operation of the robot 12 with fewer degrees of freedom (five degrees of freedom) is prohibited, whereas if the condition CD2 is satisfied, the operation is permitted.
[0094] According to this configuration, for example, in a teaching process, when the occurrence of a singular point SP is expected, the operator can specify the second control method MT2 to move the robot 12 to any position without considering the singular point SP, and can reliably prevent the operation of the robot 12 from becoming unstable due to the singular point SP. On the other hand, when it is expected that the singular point SP will not occur, the operator can specify the first control method MT1 to cause the robot 12 to perform an operation with multiple degrees of freedom (six degrees of freedom), thereby allowing the robot 12 to operate smoothly.
[0095] In the device 60, the program setting unit 68 sets one of the first control method MT1 and the second control method MT2 as the operation program OP in accordance with the input IN5 received by the input receiving unit 62. m (Steps S17 and S37). m It is possible to appropriately select the control method MT when executing the operation program OP from the first control method MT1 and the second control method MT2. m The execution of this will be described later.
[0096] In the device 60, the motion command unit 66 causes the robot 12 to execute a motion according to the first control method MT1 or the second control method MT2 in response to a teaching command Ct (specifically, a jog command Ct1 or an operating force Ct2) for teaching a motion to the robot 12 (steps S13, S33). According to this configuration, the operator can execute the teaching process by operating the robot 12 according to the first control method MT1 or the second control method MT2 designated arbitrarily.
[0097] As an example of the device 60, the input receiving unit 62 further receives an input IN7 of a jog command Ct1 as a teaching command Ct, and the operation command unit 66 operates the robot according to the jog command Ct1 received by the input receiving unit 62. According to this configuration, the operator can jog the robot 12 according to the first control method MT1 or the second control method MT2 designated arbitrarily in the teaching process.
[0098] As another example of the device 60, the operation command unit 66 acquires an operating force Ct2 applied to the robot 12 as a teaching command Ct based on detection data Df of the force sensor 34 that detects a force F applied to the robot 12, and operates the robot 12 according to the operating force Ct2 (direct teach function). According to this configuration, the operator can operate the robot 12 by the direct teach function in the teaching process according to the first control method MT1 or the second control method MT2 that is arbitrarily designated.
[0099] In the apparatus 60, the condition CD2 defines the position P of the robot 12. _1 (e.g., R4 = 0°) and CD2 _2 (For example, the z-axis of the MIF coordinate system C2 is in the vertical or horizontal direction). Then, the operation command unit 66 determines whether the condition CD2 _1 or CD2 _2 If it is determined that the condition CD2 is not satisfied (NO in step S11), _1 or CD2 _2 The robot 12 is positioned at a position P' that satisfies the above (step S22).
[0100] Thereafter, the motion command unit 66 causes the robot 12 to perform the motion according to the second control method MT2 (step S13). According to this configuration, if the robot 12 is in a state where the condition CD2 is satisfied at the start of step S2, _1 or CD2 _2 Even if it is placed at a position P that does not satisfy condition CD2 _1 or CD2 _2The position P of the robot 12 can be automatically adjusted so as to satisfy the following:
[0101] In this embodiment, the input receiving unit 62 receives an input IN5 that designates one of the first control method MT1 and the second control method MT2 in steps S16 and S36, and the program setting unit 68 sets one of the first control method MT1 and the second control method MT2 as an operation program OP in accordance with the received input IN5 in steps S17 and S37. m is specified.
[0102] As a result, a motion program OP that specifies the motion of the robot 12 with multiple degrees of freedom and that specifies the first control method MT1 or the second control method MT2 is generated. m Therefore, the input receiving unit 62 and the program setting unit 68 generate the operation program OP m The apparatus 100 generates an operation program OP to be executed in accordance with a first control method MT1 or a second control method MT2 arbitrarily designated by an operator. m can be created.
[0103] 3 according to a computer program PG1 prestored in the memory 38 (or 48). The functions of the devices 60 and 100 (input receiving unit 62, condition determining unit 64, operation command unit 66, and program setting unit 68) executed by the processor 36 may be functional modules realized by the computer program PG1.
[0104] Next, other functions of the robot system 10 will be described with reference to Fig. 7 and Fig. 8. In this embodiment, the processor 36 of the teaching device 16 executes the flow shown in Fig. 8 as step S2 in Fig. 3. In the flow shown in Fig. 8, the same processes as those in the flow in Fig. 4 are given the same step numbers, and duplicated explanations will be omitted. In the flow in Fig. 8, the processor 36 executes steps S24 to S27 after step S13.
[0105] Specifically, in step S24, the processor 36 determines whether the robot 12 has come into contact with the surrounding environmental object SR (for example, an operator or a structure within the work cell) based on the detection data Df of the force sensor 34. For example, during the execution of the operation in step S13, the processor 46 of the control device 14 periodically acquires the detection data Df of the force sensor 34, and monitors the contact force Fc applied to the robot 12 when the robot 12 comes into contact with the environmental object SR based on the detection data Df.
[0106] In this step S24, the processor 36 of the teaching device 16 determines YES when the contact force Fc monitored by the control device 14 exceeds a predetermined threshold value Fth (Fc ≧ Fth). When the processor 36 determines YES, it stops the operation of the robot 12 and proceeds to step S25, while when it determines NO, it proceeds to step S26. Thus, in the present embodiment, the processor 36 functions as a contact determination unit 70 (FIG. 7) that determines whether the robot 12 has come into contact with the environmental object SR based on the detection data Df.
[0107] In step S25, the processor 36 functions as an operation command unit 66 and executes an evacuation operation to evacuate the robot 12. Specifically, as the evacuation operation, the processor 36 moves the robot 12 by a predetermined distance in a direction MD” (or a predetermined direction) opposite to the movement direction MD in which the robot 12 was moved in the immediately preceding step S13 from the position P where the robot 12 was stopped when YES was determined in the previous step S24 (that is, the position where contact with the environmental object SR occurred).
[0108] Note that in the evacuation operation, the processor 36 may move the robot 12 (for example, the end effector 28) by executing each of the above-described axis operations SM. At this time, even if the robot 12 is in a state where it does not satisfy the condition CD2, the processor 36 preferentially executes this evacuation operation. Further, in the evacuation operation, the processor 36 may operate the robot 12 at a speed V’ (<V) that is lower than the movement speed V at which the robot 12 was moved in step S13.
[0109] In step S26, the processor 36 functions as the condition determination unit 64 and determines whether or not the robot 12 has deviated to a position P that does not satisfy the condition CD2 of the second control method MT2. Specifically, similar to step S11 described above, the processor 36 determines the rotational position R4 of the fourth joint axis A4 at this time point and the coordinate Q indicating the attitude of the MIF coordinate system C2 at this time point. M Obtain (w,p,r).
[0110] Then, the processor 36 determines the condition CD2 based on the acquired rotational position R4. _1 Determine whether (R4=0°) is still satisfied and obtain the coordinate Q M Based on (w,p,r), condition CD2 _2 (The z-axis of the MIF coordinate system C2 is vertical or horizontal) is still satisfied. The processor 36 determines whether the condition CD2 _1 and CD2 _2 If at least one of the above conditions is not met, the result is YES, and the process proceeds to step S27. _1 and CD2 _2 If both of the above conditions are met, the result is NO, and the process proceeds to step S14.
[0111] In step S27, the processor 36 functions as the operation command unit 66 and executes a return operation to return the robot 12 to the position P' that satisfies the condition CD2 based on the rotation position R4 and the coordinate Q used for the determination in the most recent step S26. _1 (R4=0°) and condition CD2 _2 (The z-axis of the MIF coordinate system C2 is in the vertical or horizontal direction).
[0112] The processor 36 may change the position and posture of the hand (wrist flange 26b and end effector 28) of the robot 12 during this return operation. For example, step S27 is executed after step S25 is executed. In this case, the processor 36 calculates the coordinate Q of the origin of the tool coordinate system C3 (or the MIF coordinate system C2) in the robot coordinate system C1 at the time when the answer to step S24 is YES (or when the operation of the robot 12 is stopped). T 'Store (x,y,z) in memory 48.
[0113] Then, in step S27, the processor 36 calculates the position and posture of the end effector 28 (or the wrist flange 26b) based on the position and posture at this point in time according to the condition CD2 _1 and CD2 _2 and move it to a position that satisfies the coordinate Q T In step S27, the processor 36 moves the robot 12 to the teaching point Pt n You may move it to.
[0114] Note that, in the return operation, the processor 36 may move the robot 12 by executing each axial operation SM described above. Also, in the return operation, the processor 36 may operate the robot 12 at a speed V' that is smaller than the moving speed V at which the robot 12 is moved in step S13. After step S27, the processor 36 proceeds to step S14.
[0115] As described above, in this embodiment, the processor 36 functions as an input receiving unit 62, a condition determination unit 64, an operation command unit 66, a program setting unit 68, and a contact determination unit 70, and these input receiving unit 62, condition determination unit 64, operation command unit 66, program setting unit 68, and contact determination unit 70 constitute the device 60 (Figure 7).
[0116] In this embodiment, when the operation command unit 66 executes the operation of step S13, the contact determination unit 70 determines whether or not the robot 12 has come into contact with the environmental object SR based on the detection data Df of the force sensor 34 (step S24). Then, when the contact determination unit 70 determines that the robot 12 has come into contact with the environmental object SR (YES in step S24), the operation command unit 66 executes an evacuation operation to evacuate the robot 12 from the position P where the contact occurred (step S25). According to this configuration, the evacuation operation can reliably eliminate the contact between the robot 12 and the environmental object SR, thereby improving the safety of the operation of the robot 12.
[0117] In this embodiment, the operation command unit 66 determines whether the robot 12 satisfies the condition CD2 (CD2 _1 and CD2 _2 ), a return operation is executed to return the robot 12 to a position P' that satisfies the condition CD2 (step S27). According to this configuration, if the position P of the robot 12 deviates due to the robot 12 coming into contact with an environmental object SR, or the operator forcibly moving the robot 12 to ensure safety, the robot 12 can be automatically returned to the position P' that satisfies the condition CD2.
[0118] 4 or 8, step S21 may be omitted, and the processor 36 may automatically execute step S22 when determining YES in step S20. Alternatively, steps S20 to S22 may be omitted from the flow of FIG. 4 or 8, and the processor 36 may proceed to step S23 when determining NO in step S11.
[0119] Also, steps S26 and S27 may be omitted from the flow of Fig. 8. Alternatively, steps S24 and S25 may be omitted from the flow of Fig. 8, and the processor 36 may execute steps S26 and S27 after step S13. That is, in this case, the contact determination unit 70 can be omitted from the device 60 of Fig. 7. Also, steps S24 to S27 shown in Fig. 8 may be applied to step S3 shown in Fig. 6. For example, the processor 36 may execute steps S24 to S27 after step S33 in Fig. 6.
[0120] At least one of the functions of the device 60 (i.e., the input receiving unit 62, the condition determining unit 64, the operation command unit 66, the program setting unit 68, and the contact determining unit 70) may be implemented in the control device 14. For example, among the functions of the device 60, the functions of the condition determining unit 64, the operation command unit 66, and the contact determining unit 70 may be implemented in the control device 14. In this case, the processor 46 of the control device 14 functions as the condition determining unit 64, the operation command unit 66, and the contact determining unit 70, and executes the above-mentioned steps S11, S13, S24 to S27, S22, S32, and S33.
[0121] Also, only the functions of the device 100 can be implemented in another computer. Such a form is shown in Fig. 9. The computer 110 shown in Fig. 9 has, for example, a processor (CPU, GPU, etc.), memory (ROM, RAM), a display device (liquid crystal display, organic EL display, etc.), and an input device (touch panel, keyboard, mouse, etc.) (all not shown). Note that the computer 110 may be a desktop, notebook, or tablet PC, or may be a teaching device or control device for the robot 12.
[0122] For example, the processor of the computer 110 may calculate the teaching point Pt n, a moving path MP, a moving speed V, and other teaching data are acquired from the teaching device 16. Then, the processor of the computer 110 generates an operation program OP that defines the acquired teaching data. Then, the processor of the computer 110 functions as an input receiving unit 62, and receives an input IN5 that specifies one of the first control method MT1 and the second control method MT2.
[0123] The processor of the computer 110 may function as the program setting unit 68 and designate one of the first control method MT1 and the second control method MT2 to the operation program OP in accordance with the received input IN5. In this manner, the functions of the device 100 may be implemented in the computer 110, while the program setting unit 68 may be omitted from the device 60.
[0124] Next, another function of the robot system 10 shown in Fig. 7 will be described. In this embodiment, the processor 36 of the teaching device 16 executes the operation program OP generated according to the flow of Fig. m In order to check the operation of the above, the above-mentioned operation replay mode OM3 is executed. Specifically, the processor 36 executes the flow shown in Fig. 10 as the operation replay mode OM3. The processor 36 starts the flow of Fig. 10 when it receives an operation start command from an operator, a higher-level controller, or a computer program PG2.
[0125] In step S41, the processor 36 starts the operation program OP m In this embodiment, the processor 36 sequentially reads out the multiple operation programs OP1, OP2, OP3, ... created according to the flow of Fig. 3 from the memory 38 (or 48) and executes them continuously.
[0126] In addition, multiple operation programs OP mIn this case, the operator operates the input device 44 to provide an input IN8 that determines the order OD, and the processor 36 functions as a program setting unit 68 to execute the created operation program OP in accordance with the input IN8. m Therefore, when executing step S41 for the first time, the processor 36 reads out the operation program OP1 to which the order OD: "1" is assigned from the memory 38 (or 48).
[0127] In step S42, the processor 36 reads the operation program OP read in the previous step S41. m Specifically, the processor 36 determines whether the second control method MT2 is specified in the read operation program OP. m Processor 36 determines whether flag FL indicates the designation of second control method MT2 or not when second control method MT2 is designated, making a determination of YES and proceeding to step S43, whereas when first control method MT1 is designated, making a determination of NO and proceeding to step S44.
[0128] In step S43, the processor 36 executes an operation checking process by the second control method MT2. This step S43 will be described with reference to Fig. 11. The processor 36 executes the operation checking process by the operation program OP read in the most recent step S41. m The instruction code IC: "START" on the first line specified in is read out, and the flow of step S43 is started.
[0129] After the start of step S43, in step S51, the processor 36 reads the operation program OP read in the most recent step S41. m Here, the processor 36 reads the instruction code IC defined in the operation program OP every time it executes step S51. m The instruction code IC (Figure 5) specified in is read in the order of the second line, third line, fourth line, ...
[0130] In step S52, the processor 36 functions as the condition determination unit 64 and determines whether or not the condition CD2 of the second control method MT2 is satisfied. Specifically, the processor 36 analyzes the instruction code IC read in the immediately preceding step S51, and determines the teaching point Pt n When robot 12 is moved to condition CD2 _1 and CD2 _2 The processor 36 determines whether both of the conditions CD2 and CD3 are satisfied. _1 and CD2 _2 If both of the above conditions are met, the answer is YES and the process proceeds to step S53. _1 and CD2 _2 If at least one of the above conditions is not met, the result is NO, and the process proceeds to step S57.
[0131] In step S53, the processor 36 functions as the operation command unit 66 and causes the robot 12 to perform an operation according to the second control method MT2. Specifically, in order to execute the command code IC read in the previous step S51, the processor 36 uses the second control program CP2 to determine the position P of the robot 12 (specifically, the end effector 28) in the robot coordinate system C1 from the rotational positions R1 to R3, R5 and R6 of the joint axes A1 to A3, A5 and A6.
[0132] Then, the processor 36 causes the robot 12 to execute the operation defined in the command code IC as an operation of the second control method MT2 (i.e., five degrees of freedom) based on the obtained position P. In step S54, the processor 36 functions as a contact determination unit 70, similar to the above-mentioned step S24, and determines whether or not the robot 12 has come into contact with the surrounding environmental object SR. If the processor 36 determines YES, the process proceeds to step S56, whereas if the processor 36 determines NO, the process proceeds to step S55.
[0133] In step S55, the processor 36 executes the operation program OP m5, processor 36 judges whether or not there is a command code IC of the next row. If the command code IC of the next row is not the command code IC of the i row in FIG. 5: "END", processor 36 judges as YES and returns to step S51, whereas if the command code IC of the i row is "END", processor 36 judges as NO and proceeds to step S45 in FIG. 10. On the other hand, if the judgement is YES in step S54, processor 36 functions as the operation command unit 66 in step S56, as in step S25 described above, and stops robot 12 after executing an escape operation. After that, processor 36 proceeds to step S57.
[0134] When the result of the determination in step S52 is NO or when step S56 is executed, in step S57, the processor 36 generates an alarm AL. For example, when executing step S57 after the result of the determination in step S52 is NO, the processor 36 generates an image or sound alarm AL4 stating, "The robot cannot be operated because the conditions of the second control method are not satisfied. Re-teaching of the robot is required," and outputs this through the display device 42 or the speaker. At this time, the processor 36 determines whether the condition CD2 for which the result of the determination in the immediately preceding step S52 is NO (condition CD2 _1 or CD2 _2 ) may be attached to the alarm AL1.
[0135] On the other hand, when step S57 is executed after step S56, the processor 36 generates a visual or audio alarm AL5 saying "The robot has been evacuated because there is a possibility that the robot has come into contact with an environmental object" and outputs it through the display device 42 or the speaker. After step S57, the processor 36 ends the flow of step S43 shown in Fig. 11, thereby ending the flow of Fig. 10. In this way, when the condition CD2 is not satisfied, the processor 36 does not execute the operation of the robot 12 according to the second control method MT2 in step S53.
[0136] 10 again, if the determination in step S42 is NO, in step S44, the processor 36 executes an operation checking process using the first control method MT1. This step S44 will be described with reference to FIG. 11. After starting step S44, in step S61, the processor 36 executes the operation program OP read in the most recent step S41, similarly to the above-mentioned step S51. m Read the instruction code IC specified in.
[0137] In step S62, the processor 36 functions as the condition determination unit 64 and determines whether or not the condition CD1 of the first control method MT1 is satisfied. Specifically, the processor 36 analyzes the instruction code IC read in the immediately preceding step S61 and determines the teaching point Pt n Processor 36 determines whether condition CD1 (does not pass near singular point SP) is satisfied when robot 12 is moved to the target position. If processor 36 determines YES, the process proceeds to step S63, and if processor 36 determines NO, the process proceeds to step S67.
[0138] In step S63, the processor 36 functions as the operation command unit 66 and causes the robot 12 to perform an operation according to the first control method MT1. Specifically, in order to execute the instruction code IC read in the previous step S61, the processor 36 uses the first control program CP1 to determine the position P of the robot 12 (end effector 28) in the robot coordinate system C1 from the rotational positions R1 to R6 of the joint axes A1 to A6.
[0139] Then, the processor 36 causes the robot 12 to execute the operation defined in the command code IC as the operation of the first control method MT1 (i.e., six degrees of freedom) based on the obtained position P. Thereafter, the processor 36 sequentially executes step S64 (contact determination) similar to the above-mentioned step S53, step S65 (next command code determination) similar to the above-mentioned step S55, and step S66 (retraction operation) similar to the above-mentioned step S56.
[0140] When the determination in step S62 is NO or when step S66 is executed, in step S67, the processor 36 generates an alarm AL. For example, when executing step S67 after the determination in step S62 is NO, the processor 36 generates an image or sound alarm AL6 stating "The robot cannot be operated because the conditions of the first control method are not satisfied. Re-teaching of the robot is required," and outputs the image or sound alarm AL6 through the display device 42 or the speaker. At this time, the processor 36 may attach information specifying the condition CD1 (passing near a singular point) for which the determination in the immediately preceding step S62 was NO to the alarm AL6.
[0141] On the other hand, when step S67 is executed after step S66, the processor 36 generates the above-mentioned alarm AL5 and outputs it through the display device 42 or the speaker. After step S67, the processor 36 ends the flow of step S44 shown in Fig. 11, thereby ending the flow of Fig. 10. In this way, when the condition CD1 is not satisfied, the processor 36 does not execute the operation of the robot 12 according to the first control method MT1 in step S63.
[0142] Referring again to FIG. 10, when the determination is NO in the above-mentioned step S55 or S65, in step S45, the processor 36 selects the next operation program OP to be executed. m+1 If the determination is YES, the processor 36 returns to step S41 and starts the operation program OP m+1 10. On the other hand, if the processor 36 determines that the result is NO, the processor 36 ends the flow of FIG.
[0143] In this way, the processor 36 executes the plurality of operation programs OP created in the flow of FIG. m In step S17 or S37, the operation program OP is executed in response to the input IN5. m The robot 12 is operated according to the first control method MT1 or the second control method MT2 specified in the operation program OP. mIt is possible to check the operation specified in the.
[0144] As described above, in this embodiment, in response to the input IN5 received by the input receiving unit 62 in the above-mentioned step S16 or S36, the operation program OP in which one of the first control method MT1 and the second control method MT2 is specified is selected in the above-mentioned step S17 or S37. m Then, the operation command unit 66 executes the operation program OP m By executing the operation program OP m The robot 12 is caused to execute an operation according to the first control method MT1 or the second control method MT2 designated by the user (step S53 or S63).
[0145] This operation program OP m defines the motion of the robot 12 having multiple degrees of freedom (six degrees of freedom), and is configured to be able to specify one of the first control method MT1 and the second control method MT2 (specifically, to be able to assign a flag FL). m causes the robot 12 to execute an operation according to the specified first control method MT1 or second control method MT2.
[0146] According to this configuration, the operator can input the operation program OP m Considering the operation of each operation program OP m Since the first control method MT1 or the second control method MT2 can be arbitrarily specified in the operation program OP m When the above is executed, it is possible to reliably prevent the operation of the robot 12 from becoming unstable due to, for example, the above-mentioned singular point SP or the like.
[0147] Also, the operation program OP m Since the control method MT is commanded for each operation, the operation program OP mEven if the control method MT is interrupted midway (for example, the third line in FIG. 5) and then resumed, the robot 12 can be stably operated with the same control method MT. This is advantageous in terms of the stability of the operation of the robot 12 compared to the case where the control method MT is switched during the execution of one operation program.
[0148] In addition, multiple operation programs OP with each control method MT specified m By continuously executing the above, various operations of the robot 12 for performing the work can be realized, and the operation program OP m The control method MT can be switched between the first control method MT1 and the second control method MT2 each time the robot 12 is operated. This makes it possible to flexibly handle tasks that require a wider variety of robot 12 movements.
[0149] 10 in accordance with a computer program PG2 prestored in the memory 38 (or 48). The function of the device 60 executed by the processor 36 may be a functional module realized by the computer program PG2.
[0150] In step S51 or S61 of FIG. 11, the processor 36 executes the operation program OP m In step S52 or S62, the processor 36 may read the instruction codes IC of all the rows (i.e., rows 1 to i) defined in the operation program OP2, and determine whether the condition CD2 or CD1 is satisfied for the operations defined in all the instruction codes IC. If the determination in step S52 or S62 is YES, the processor 36 may read the instruction codes IC of all the rows (i.e., rows 1 to i) defined in the operation program OP2, and determine whether the condition CD2 or CD1 is satisfied for the operations defined in all the instruction codes IC. m All the instruction codes IC may be executed in order from line 1 to line i. In this case, step S55 or S65 may be omitted from the flow of FIG.
[0151] In the robot system 10 shown in FIG. 7, the processor 36 executes the flow shown in FIG. mThen, the flow shown in FIG. 10 is executed to generate the operation program OP m However, it is possible that another computer (for example, the above-mentioned computer 110) is executing the operation program OP. m may be created.
[0152] The processor 36 of the teaching device 16 then reads the operation program OP created by the other computer. m In order to check the operation of the above, the flow shown in Fig. 10 may be executed. In this case, the program setting unit 68 may be omitted from the device 60 in Fig. 7. Also, steps S54 and S56 may be omitted from the flow in Fig. 11. That is, in this case, the contact determination unit 70 may be omitted from the device 60 in Fig. 7.
[0153] 3, 4, 6, 8, 10, and 11 are merely examples, and various modifications may be made. Fig. 12 shows a modified example of step S2 in Fig. 8. In the flow of Fig. 12, when the processor 36 determines YES in step S20, the processor 36 proceeds to step S22 and adjusts the current position Pc of the robot 12. On the other hand, after executing step S23, the processor 36 executes the above-mentioned step S21 and determines whether or not a position adjustment command Ca has been received.
[0154] 12, in step S22′, the processor 36 functions as the operation command unit 66, similarly to step S22 described above, to adjust the current position Pc of the robot 12. On the other hand, if the processor 36 determines NO in step S21 in FIG. 12, the processor 36 proceeds to step S14.
[0155] 12, even if the processor 36 determines NO in step S20, when it receives an input IN3 of a position adjustment command Ca from the operator in step S21, it executes step S22' to adjust the current position Pc of the robot 12. According to this configuration, the robot 12 is prevented from moving unintentionally, thereby ensuring the safety of the operator, and the teaching process can be efficiently carried out.
[0156] 13 shows a modified example of steps S43 and S44 in FIG. 11. In step S43 shown in FIG. 13, the processor 36 executes step S56 and then step S58. In this step S58, the processor 36 functions as the operation command unit 66 and executes the return operation. Specifically, the processor 36 calculates the coordinate Q of the origin of the tool coordinate system C3 (or the MIF coordinate system C2) in the robot coordinate system C1 at the time when the most recent step S54 was judged as YES (or when the operation of the robot 12 was stopped). T Store "(x,y,z) in memory 48.
[0157] Then, in step S58, the processor 36 calculates the coordinates Q from the current position P of the end effector 28 (or the wrist flange 26b). T Alternatively, in step S58, the processor 36 may move the robot 12 to a position of (x, y, z). m 13. Also in step S44 shown in Fig. 13, processor 36 executes a similar return operation in step S68 after step S66. Note that processor 36 may execute step S58 (or S66) when a predetermined time has elapsed since the execution of the evacuation operation in step S56 (or S66).
[0158] In the above embodiment, the condition CD2 of the second control method MT2 _1 However, the case where R4=0° has been described, the condition CD2 _1Alternatively, the second control method MT2 may be determined as R4=180°×α (α is an arbitrary integer). In the above embodiment, the second control method MT2 may be determined as a plurality of control methods MT2 each having a different condition CD2. _1 , MT2 _2 , MT2 _3 , ... may be included.
[0159] For example, control method MT2 _1 The condition CD2 where R4 = 0° _1_1 and the condition CD2 that the z-axis direction of the MIF coordinate system C2 coincides with the vertical downward direction. _2_1 In addition, the control method MT2 may be defined as follows: _2 The condition CD2 R4 = 180° _1_2 and the condition CD2 that the z-axis direction of the MIF coordinate system C2 coincides with the vertical upward direction. _2_2 In addition, the control method MT2 may be defined as follows: _3 The condition CD2 is R4 = -180°. _1_3 and the condition CD2 that the z-axis direction of the MIF coordinate system C2 is parallel to the horizontal direction. _2_3 It may be determined that:
[0160] In this case, the processor 36 functions as the input receiving unit 62, and in the above-mentioned steps S1, S16, and S38, the control method MT2 is selected as the second control method MT2. _1 , MT2 _2 and MT2 _3 Then, the processor 36 receives inputs IN2 and IN5 that specify one of the control methods MT2 and MT3. _1 , MT2 _2 Or MT2 _3 Based on the condition CD2, the above-mentioned steps S11, S13, S20, S22, S23 or S27 are executed.
[0161] In addition, in step S17 described above, processor 36 selects control method MT2 in response to received input IN5. _1 , MT2 _2 Or MT2 _3 The operating program OP mAccording to this configuration, the operator can select various conditions CD2 (CD2 _1_1 , CD2 _1_2 , CD2 _1_3 , CD2 _2_1 , CD2 _2_2 , CD2 _2_3 ) are defined for each of the multiple control methods MT2 _1 , MT2 _2 , MT2 _3 This allows you to teach a wider variety of movements.
[0162] In the above embodiment, the case has been described where the MIF coordinate system C2 and the tool coordinate system C3 are set in the robot 12. However, this is not limiting, and only one of the MIF coordinate system C2 and the tool coordinate system C3 may be set. For example, when the z-axis of the tool coordinate system C3 is set to be parallel to (specifically, coincident with) the sixth joint axis A6, the processor 36 calculates the coordinate Q of the tool coordinate system C3 in the robot coordinate system C1 in steps S11 and S26 described above. T The condition CD2 of the second control method MT2 may be determined based on the above.
[0163] In the above embodiment, the first control method MT1 realizes six degrees of freedom of movement of the robot 12, and the second control method MT realizes five degrees of freedom of movement of the robot 12. However, the first control method MT1 may realize, for example, seven or more degrees of freedom of movement, and the second control method MT may realize four or less degrees of freedom of movement.
[0164] Furthermore, the condition CD2 of the second control method MT may include any other condition, such as a condition that the robot 12 does not pass near the singular point SP, or a condition that the robot 12 is within an allowable operating range. Similarly, the condition CD1 of the first control method MT1 may also include any other condition. Furthermore, the robot 12 is not limited to a vertical articulated robot, and may be any other type of robot, such as a horizontal articulated robot, a parallel link robot, or the like.
[0165] Although the present disclosure has been described in detail above, the present disclosure is not limited to the above-mentioned individual embodiments. Various additions, replacements, modifications, partial deletions, etc. are possible for these embodiments within the scope of the gist of the present disclosure, or within the scope of the gist of the present disclosure derived from the contents described in the claims and their equivalents. These embodiments can also be implemented in combination. For example, in the above-mentioned embodiments, the order of each operation and the order of each process are shown as examples, and are not limited to these. The same applies when numerical values or formulas are used in the description of the above-mentioned embodiments.
[0166] The present disclosure describes the following aspects. (Aspect 1) A device 60 for controlling the movement of a robot 12 having multiple degrees of freedom, comprising: an input receiving unit 62 for receiving inputs IN2, IN5, IN6 that specify one of a first control method MT1 that realizes movement with multiple degrees of freedom (e.g., six degrees of freedom) and a second control method MT2 that realizes movement with one or more degrees of freedom less than the first control method MT1 (e.g., five degrees of freedom), wherein a condition CD2 for permitting the movement by the second control method MT2 is predetermined; an action command unit 66 that causes the robot 12 to execute movement by the first control method MT1 or the second control method MT2 specified by the inputs IN2, IN5, IN6 received by the input receiving unit 62; and a condition determination unit 64 that determines whether or not the condition CD2 is satisfied when the action command unit 66 executes the movement by the second control method MT2; and if the condition determination unit 64 determines that the condition CD2 is not satisfied, the action command unit 66 does not execute the movement by the second control method MT2. (Mode 2) The device 60 described in mode 1 further includes an operation program OP in which one of a first control method MT1 and a second control method MT2 is specified in accordance with an input IN5 received by the input receiving unit 62, and the operation command unit 66 executes the operation program OP to cause the robot 12 to perform an operation according to the first control method MT1 or the second control method MT2 specified in the operation program OP. (Aspect 3) The device 60 described in aspect 2 further includes a program setting unit 68 that specifies one of the first control method MT1 and the second control method MT2 as the operation program OP in accordance with the input IN5 received by the input receiving unit 62. (Aspect 4) The device 60 according to any one of aspects 1 to 3, wherein the motion command unit 66 causes the robot to execute a motion according to the first control method MT1 or the second control method MT2 in response to a teaching command Ct for teaching the robot a motion. (Aspect 5) The input receiving unit 62 further receives an input IN7 of a jog command Ct1 as a teaching command Ct, and the operation command unit 66 causes the robot 12 to perform an operation according to the jog command Ct1 received by the input receiving unit 62, in the device 60 described in aspect 4. (Aspect 6) The device 60 described in aspect 4, in which the operation command unit 66 acquires the operating force Ct2 applied to the robot 12 as a teaching command Ct based on the detection data Df of the force sensor 34 that detects the force F applied to the robot 12, and causes the robot 12 to perform an operation according to the operating force Ct2. (Embodiment 7) Condition CD2 defines the position P of the robot 12. _1 , CD2 _2 , CD2 _1_1 , CD2 _1_2 , CD2 _1_3 , CD2 _2_1 , CD2 _2_2 , CD2 _2_3 An apparatus 60 according to any one of aspects 1 to 6, comprising: when the condition determination unit 64 determines that a condition CD2 is not satisfied, an operation command unit 66 positions the robot 12 at a position P' that satisfies the condition CD2, and then causes the robot 12 to perform an operation according to a second control method MT2. (Embodiment 8) Condition CD2 defines the position P of the robot 12. _1 , CD2 _2 , CD2 _1_1 , CD2 _1_2 , CD2 _1_3 , CD2 _2_1 , CD2 _2_2 , CD2 _2_3The device 60 according to any one of aspects 1 to 7 includes an action command unit 66 that, if the robot 12 deviates into a position P that does not satisfy the condition CD2 when executing the action, executes a return action to return the robot 12 to a position P' that satisfies the condition CD2. (Aspect 9) An apparatus 60 described in any of aspects 1 to 8, further comprising a contact determination unit 70 that determines whether or not the robot 12 has come into contact with an environmental object SR based on detection data Df from a force sensor 34 that detects a force F applied to the robot 12 when the action command unit 66 executes an action, and when the contact determination unit 70 determines that the robot 12 has come into contact with the environmental object SR, the action command unit 66 executes an evacuation action to evacuate the robot 12 from the position P where the contact occurred. (Aspect 10) The second control method MT2 is a different condition CD2 _1_1 , CD2 _1_2 , CD2 _1_3 , CD2 _2_1 , CD2 _2_2 , CD2 _2_3 There are multiple control methods MT2 _1 , MT2 _2 , MT2 _3 The input reception unit 62 includes a first control method MT1 and a plurality of control methods MT2 as a second control method MT2. _1 , MT2 _2 , MT2 _3 10. The apparatus 60 according to any one of aspects 1 to 9, wherein the apparatus 60 accepts inputs IN2, IN5, and IN6 that specify one of the above. (Mode 11) An apparatus 100 for generating an operation program OP that prescribes the operation of a robot 12 having multiple degrees of freedom (e.g., six degrees of freedom), comprising: an input receiving unit 62 that receives an input IN5 that specifies one of a first control method MT1 that realizes operation with that many degrees of freedom, and a second control method MT2 that realizes operation with one or more degrees of freedom less than the first control method MT1 (e.g., five degrees of freedom); and a program setting unit 68 that specifies one of the first control method MT1 and the second control method MT2 in the operation program OP in accordance with the input IN5 received by the input receiving unit 62, and the operation program OP causes the robot 12 to perform operation according to the first control method MT1 or the second control method MT2 specified by the program setting unit 68. (Aspect 12) A method for controlling the movement of a robot 12 having multiple degrees of freedom (e.g., six degrees of freedom), in which a processor 36, 46 accepts inputs IN2, IN5, IN6 that specify one of a first control method MT1 that realizes movement with that many degrees of freedom, and a second control method MT2 that realizes movement with one or more degrees of freedom less than the first control method MT1 (e.g., five degrees of freedom), in which a condition CD2 for permitting the movement by the second control method MT2 is predetermined, causes the robot 12 to perform movement by the first control method MT1 or the second control method MT2 specified by the accepted inputs IN2, IN5, IN6, and determines whether the condition CD2 is satisfied when the movement by the second control method MT2 is performed, and if it is determined that the condition CD2 is not satisfied, does not perform the movement by the second control method MT2. (Aspect 13) A method for generating an operation program OP that specifies the operation of a robot 12 having multiple degrees of freedom (e.g., six degrees of freedom), wherein a processor 36, 46 receives an input IN5 that specifies one of a first control method MT1 that realizes operation with multiple degrees of freedom and a second control method MT5 that realizes operation with one or more degrees of freedom less than the first control method MT1 (e.g., five degrees of freedom), and specifies one of the first control method MT1 and the second control method MT2 in the operation program OP according to the received input IN5, and the operation program OP causes the robot 12 to perform operation according to the specified first control method MT1 or second control method MT2. (Aspect 14) Computer programs PG1, PG2 that cause processors 36, 46 to execute the method described in aspect 12 or 13. (Mode 15) An operation program OP that specifies the movement of a robot 12 having multiple degrees of freedom (e.g., six degrees of freedom) and causes the robot 12 to execute the movement, the operation program OP being configured to be able to specify one of a first control method MT1 that realizes movement with multiple degrees of freedom, and a second control method MT2 that realizes movement with one or more degrees of freedom less than the first control method MT1 (e.g., five degrees of freedom), and causing the robot 12 to execute the movement according to the specified first control method MT1 or second control method MT2. [Explanation of symbols]
[0167] 10 Robot System 12. Robot 14 Control device 16 Teaching device 36,46 processor 60,100 equipment 62 Input reception section 64 Condition judgment section 66 Operation command section 68 Program Setting Section 70 Contact determination section 110 Computer
Claims
1. An apparatus for controlling the movement of a robot having multiple degrees of freedom, comprising: an input receiving unit that receives an input specifying one of a first control method that realizes the operation with multiple degrees of freedom and a second control method that realizes the operation with one or more degrees of freedom less than the first control method, wherein a condition for allowing the operation by the second control method is determined in advance; an operation command unit that causes the robot to execute the operation according to the first control method or the second control method designated by the input received by the input receiving unit; a condition determination unit that determines whether or not the condition is satisfied when the operation command unit executes the operation according to the second control method, When the condition determination unit determines that the condition is not satisfied, the operation command unit does not execute the operation according to the second control method.
2. an operation program in which one of the first control method and the second control method is designated in response to the input received by the input receiving unit, The device according to claim 1 , wherein the operation command unit executes the operation program to cause the robot to perform the operation according to the first control method or the second control method specified in the operation program.
3. The device according to claim 2 , further comprising a program setting unit that specifies one of the first control method and the second control method for the operation program in accordance with the input received by the input receiving unit.
4. The apparatus according to claim 1 , wherein the action command unit causes the robot to execute the action according to the first control method or the second control method in response to a teaching command for teaching the action.
5. The input receiving unit further receives an input of a jog command as the teaching command, The apparatus according to claim 4 , wherein the motion command unit causes the robot to execute the motion in response to the jog command received by the input receiving unit.
6. The operation command unit includes: acquiring an operating force applied to the robot as the teaching command based on detection data from a force sensor that detects a force applied to the robot; The apparatus of claim 4 , further comprising: a controller configured to cause the robot to perform the action in response to the actuation force.
7. the conditions include a condition that defines a position of the robot; The operation command unit includes: When the condition determination unit determines that the condition is not satisfied, the robot is positioned at the position that satisfies the condition; The apparatus of claim 1 , further comprising: a control unit for controlling the robot to perform the motion according to the second control method.
8. the conditions include a condition that defines a position of the robot; The device according to claim 1 , wherein the action command unit executes a return action to return the robot to the position that satisfies the condition if the robot deviates to the position that does not satisfy the condition when executing the action.
9. a contact determination unit that determines whether or not the robot has come into contact with an environmental object based on detection data from a force sensor that detects a force applied to the robot when the action command unit executes the action, The device according to claim 1 , wherein, when the contact determination unit determines that the robot has come into contact with the environmental object, the action command unit executes an escape action to cause the robot to escape from a position where the contact occurred.
10. the second control method includes a plurality of control methods each having a different condition defined therefor, The device according to claim 1 , wherein the input receiving unit receives an input specifying one of the first control method and the plurality of control methods as the second control method.
11. An apparatus for generating an operation program that defines the operation of a robot having multiple degrees of freedom, comprising: an input receiving unit that receives an input specifying one of a first control method for realizing the operation with multiple degrees of freedom and a second control method for realizing the operation with one or more degrees of freedom less than the first control method; a program setting unit that specifies one of the first control method and the second control method in the operation program in accordance with the input received by the input receiving unit, and the operation program causes the robot to execute the operation according to the first control method or the second control method specified by the program setting unit.
12. A method for controlling the movement of a robot having multiple degrees of freedom, comprising the steps of: The processor: accepting an input designating one of a first control method for realizing the operation with multiple degrees of freedom and a second control method for realizing the operation with one or more degrees of freedom less than that of the first control method, the second control method being a method in which a condition for permitting the operation by the second control method is determined in advance; causing the robot to execute the operation according to the first control method or the second control method designated by the received input; determining whether or not the condition is satisfied when the operation according to the second control method is executed; The method of claim 1, wherein, if it is determined that the condition is not satisfied, the operation according to the second control method is not executed.
13. A method for generating an operation program that defines the operation of a robot having multiple degrees of freedom, comprising the steps of: The processor: receiving an input designating one of a first control method for realizing the operation with multiple degrees of freedom and a second control method for realizing the operation with one or more degrees of freedom less than the first control method; A method for specifying one of the first control method and the second control method in the operation program according to the received input, and the operation program causes the robot to perform the operation according to the specified first control method or second control method.
14. A computer program product configured to cause the processor to perform the method according to claim 12 or 13.
15. An operation program for defining an operation of a robot having multiple degrees of freedom and for causing the robot to execute the operation, A first control method for realizing the operation with multiple degrees of freedom and a second control method for realizing the operation with one or more degrees of freedom less than the first control method are configured to be able to be designated; An operation program that causes the robot to execute the operation according to the specified first control method or the specified second control method.
Citation Information
Patent Citations
Industrial robot
JP1988052982A
Control method for manipulator
JP1991003786A
Redundant freedom degree robot device
JP1993061510A
Control device for multi-joint robot
JP1994312392A
Articulated robot
JP2005329521A
