[go: up one dir, main page]

WO2024105777A1 - 制御装置およびコンピュータ - Google Patents

制御装置およびコンピュータ Download PDF

Info

Publication number
WO2024105777A1
WO2024105777A1 PCT/JP2022/042393 JP2022042393W WO2024105777A1 WO 2024105777 A1 WO2024105777 A1 WO 2024105777A1 JP 2022042393 W JP2022042393 W JP 2022042393W WO 2024105777 A1 WO2024105777 A1 WO 2024105777A1
Authority
WO
WIPO (PCT)
Prior art keywords
effector
constraint
constraints
user
screen
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
PCT/JP2022/042393
Other languages
English (en)
French (fr)
Inventor
勇樹 近藤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fanuc Corp
Original Assignee
Fanuc Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fanuc Corp filed Critical Fanuc Corp
Priority to DE112022007752.2T priority Critical patent/DE112022007752T5/de
Priority to JP2024558536A priority patent/JPWO2024105777A1/ja
Priority to PCT/JP2022/042393 priority patent/WO2024105777A1/ja
Priority to CN202280101737.5A priority patent/CN120187560A/zh
Priority to TW112142122A priority patent/TW202421392A/zh
Publication of WO2024105777A1 publication Critical patent/WO2024105777A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1671—Programme controls characterised by programming, planning systems for manipulators characterised by simulation, either to verify existing program or to create and verify new program, CAD/CAM oriented, graphic oriented programming systems

Definitions

  • This disclosure relates to a control device and a computer.
  • the user In industrial robots, the user generally teaches the robot to make it perform the desired operation.
  • the robot's control device generates a path based on the instruction and moves the robot.
  • a mode in which the robot moves without user operation based on preset operation commands is called automatic operation mode or AUTO mode.
  • AUTO mode a mode in which the robot moves without user operation based on preset operation commands
  • the user performs an operation called jog operation using a portable operation panel.
  • the user must take care to ensure that the robot moves safely while closely observing the robot, effector, workpiece, and other objects.
  • the user must also take care of the posture of the effector so that it can perform its function.
  • cycle time is generally a priority.
  • constraints may be set on the robot's movements, such as only allowing rotations around an axis perpendicular to the ground.
  • a function is generally known in which an operable area or an inaccessible area is set in advance so that the robot does not interfere with the surrounding environment, and the robot is operated only within the area where no interference occurs.
  • a function is also known in which a detailed interference calculation is performed using a 3D model of the robot and the surrounding environment. See, for example, Patent Document 1.
  • a technique is also known for generating a path so that a protrusion of an effector does not point toward a person or the like. For example, see Patent Document 2.
  • the robot's path As one example, if there is an appropriate range for the posture, position, etc. of the effector for the effector to perform its function safely, it is desirable for the robot's path to satisfy this range. As one example, if path generation and jog operation are not performed reflecting the properties of the effector, undesirable situations such as dropping the target such as a workpiece may occur. As one example, effectors attached to the tip of the robot are diverse, such as hands and suction cups for handling objects, welding torches, and inspection scanners, and it is desirable for the robot to operate in accordance with the effector. As one example, settings that fix the posture of the effector to a specific state narrow the options for path generation and jog operation, are not efficient, and may result in a decrease in cycle time. There is a demand for technology that allows settings according to the type of effector, the function required of the effector, the type of target, the type of work, and the functions required for the work.
  • the control device of the first aspect of the present disclosure includes a processor and a memory unit that stores effector constraints, which are constraints on changes in at least one of the position and orientation of a robot's effector as viewed from a predetermined reference coordinate, and the processor causes the robot to perform an action constrained by the effector constraints that are set based on input from a user or an external device.
  • effector constraints which are constraints on changes in at least one of the position and orientation of a robot's effector as viewed from a predetermined reference coordinate
  • the control device of the second aspect of the present disclosure includes a processor, a memory unit, and a display device that displays a setting screen for effector constraints, which are constraints on changes in at least one of the position and orientation of a robot's effector as viewed from a predetermined reference coordinate, and the setting screen is for setting the effector constraints based at least on user input.
  • the computer of the third aspect of the present disclosure includes a processor, a storage unit, and a display device that displays a setting screen for effector constraints, which are constraints on changes in at least one of the position and orientation of a robot's effector as viewed from a predetermined reference coordinate, and the setting screen is for setting the effector constraints based at least on user input, and the processor performs a simulation to cause the robot model to perform an operation based on the effector constraints and determines whether the operation satisfies a standard.
  • effector constraints which are constraints on changes in at least one of the position and orientation of a robot's effector as viewed from a predetermined reference coordinate
  • the setting screen is for setting the effector constraints based at least on user input
  • the processor performs a simulation to cause the robot model to perform an operation based on the effector constraints and determines whether the operation satisfies a standard.
  • FIG. 1 is a schematic diagram of a robot system including a robot according to an embodiment.
  • FIG. 2 is a block diagram showing the configuration of a control device for a robot according to the present embodiment. 2 is a schematic diagram of various effectors attached to the robot of the present embodiment.
  • FIG. 5A to 5C are schematic diagrams illustrating the operation of an effector attached to the robot of the present embodiment. 5 is a diagram showing an example of effector constraints set in the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • FIG. 2 is a block diagram showing an example of functions of a control device according to the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment.
  • 5 is an example of a screen displayed by the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment. 5 is an example of a screen displayed by the control device of the present embodiment.
  • the control device 1 is provided for controlling an arm 10A of a robot 10 (FIG. 1).
  • the robot 10 is not limited to a specific type, but the robot 10 of this embodiment is a multi-joint robot having six axes.
  • the robot 10 may be a multi-joint robot having five or fewer axes or seven or more axes, a horizontal multi-joint robot, a multi-link robot, or the like.
  • the robot 10 or its arm 10A may be supported by a traveling device such as a linear guide, an AGV (Automatic Guided Vehicle), a vehicle, a walking robot, or the like.
  • the robot 10 may be a collaborative robot that can avoid contact or proximity with surrounding people, objects, etc. by using well-known sensors such as visual sensors and force sensors.
  • the arm 10A has a number of movable parts 12 connected to each other by joints, and a number of servo motors 11 that drive each of the movable parts 12 (Figs. 1 and 2).
  • Each servo motor 11 has an operating position detection device such as a sensor for detecting its operating position, an encoder 11A, etc.
  • the control device 1 receives the detection value of the encoder 11A.
  • an effector 30 such as a hand or tool is attached to the tip of an arm 10A, and the arm 10A is part of a robot system that performs work on an object 2, which is a work target on a transport device, for example.
  • the operations are well-known operations such as removing object 2, processing object 2, and attaching parts to object 2.
  • Processing object 2 is well-known processing such as machining, painting, and cleaning.
  • the transport device can be a conveyor, an AGV (Automatic Guided Vehicle), or anything that can move object 2 such as a car under manufacture.
  • object 2 In the case of a car under manufacture, the chassis, tires, motor, etc. function as the transport device, and object 2, which is the body on the chassis, etc., is transported.
  • Object 2 can be various objects such as industrial products, goods including food, parts of goods, parts of structures, animals, parts of animals, parts of people, etc.
  • the effector 30 may be a dedicated hand, suction cup, etc. for handling items.
  • the effector 30 may also be equipped with a wide variety of devices, such as tools for assembly processes, guns for spot welding, torches for arc welding, scanners for inspection systems, etc. In this way, the effector 30 is not limited to a specific effector.
  • the effector 30 When the effector 30 has a moving part such as a finger of a hand, the effector 30 is equipped with a servo motor 31 that drives the moving part ( Figure 2).
  • the servo motor 31 has an operating position detection device for detecting its operating position, and an example of the operating position detection device is an encoder. The detection value of the operating position detection device is transmitted to the control device 1.
  • Various types of servo motors such as rotary motors and linear motors can be used as each of the servo motors 11 and 31.
  • the effector 30 is usually attached to the tip of the arm 10A, but may also be attached to the longitudinal middle part or base end of the arm 10A.
  • a hand that grasps the target 2 as the effector 30 or a hand that attracts the target 2 using a suction cup, magnet, electromagnet, etc. is often used.
  • the target 2 may be placed in a container or flat tray as the effector 30.
  • the target 2 may also be placed in a box or basket as the effector 30.
  • the effector 30 may have limited appropriate postures for functioning as an effector.
  • the effector 30, which is a hand using a suction cup, a magnet, or an electromagnet may not be able to hold the target 2 reliably if it cannot attract the target 2 from a predetermined direction such as above.
  • the user when placing the target 2 on the effector 30, which is a tray, the user must take care to prevent the target 2 from falling off.
  • the control device 1 has a processor 21 having one or more processor elements such as a CPU, a microcomputer, an image processor, etc., and a display device 22.
  • the control device 1 also has a storage unit 23 having a non-volatile storage, ROM, RAM, etc.
  • the control device 1 also has a servo controller 24 corresponding to each of the servo motors 11 of the robot 10, and a servo controller 25 corresponding to the servo motor 31 of the effector 30.
  • the control device 1 also has an input unit 26 connected to the control device 1 by wire or wirelessly.
  • the input unit 26 is an input device such as a portable operation panel that can be carried by the user.
  • the input unit 26 is a tablet computer. In the case of a portable operation panel, tablet computer, etc., the input is performed using a touch screen function.
  • the portable operation panel or tablet computer may also have a display device 22.
  • the memory unit 23 stores a system program 23A, which performs the basic functions of the control device 1.
  • the memory unit 23 also stores one or more operation programs 23B.
  • the operation program 23B includes multiple commands, information, etc. for operating the robot.
  • the operation program 23B includes at least information on the coordinates and posture of multiple teaching points, commands related to movements between teaching points, etc.
  • the storage unit 23 also stores a control program 23C, a path generation program 23D, etc.
  • the control program 23C is a known feedback program, feedforward program, etc.
  • the control device 1 generates a path based on the operation program 23B using the path generation program 23D, and generates control commands using the control program 23C to move along the path, thereby controlling the arm 10A.
  • the position and posture of the arm 10A of the robot 10 it is common to specify coordinates as viewed from a robot reference coordinate system 101 ( FIG. 1 ) that serves as a reference that does not move in space as the teaching points, etc.
  • a robot reference coordinate system 101 FIG. 1
  • the position and posture of a coordinate system set on a flange surface (mechanical interface) at the tip of the arm 10A are generally specified as the teaching points, etc.
  • an effector coordinate system 102 FIG. 1
  • the position and posture of the effector coordinate system 102 are generally specified as the teaching points, etc.
  • the coordinate system set at the tip of the arm 10A is also considered to be the effector coordinate system 102, and the coordinate system set on the flange surface is also treated as the effector coordinate system 102.
  • a reference coordinate system 101 and an effector coordinate system 102 that does not move relative to the effector 30 are set.
  • the effector coordinate system 102 may also be called by other names such as a tool coordinate system.
  • the control device 1 recognizes the position and orientation of the effector coordinate system 102 in the reference coordinate system 101 by well-known calibration or the like.
  • the user can set effector constraints that constrain the relative change of the effector coordinate system 102 with respect to the reference coordinate system 101 .
  • An example of setting effector constraints is shown in Fig. 5.
  • a first example of effector constraints is a constraint on the position coordinates (X, Y, Z) of the effector coordinate system 102.
  • a place where "0" is input as both the upper and lower limits means that no change is allowed.
  • the fact that no effector constraint is set may be expressed by "-" or the like.
  • the constraint on the relative change of the effector coordinate system 102 in the first example may be set based on the position and orientation of the reference coordinate system 101, the effector coordinate system 102, or another coordinate system.
  • the reference coordinate system 101, the effector coordinate system 102, or another coordinate system is a predetermined coordinate system, which may be simply referred to as a coordinate system in the following description.
  • the constraint on the orientation of the effector coordinate system 102 in the second example may also be set based on the position and orientation of the coordinate system.
  • the constraint on the position and orientation of the effector coordinate system 102 may be set based on the position and orientation of the effector coordinate system 102 before the arm 10A starts a certain operation.
  • a third example of an effector constraint is a constraint on the velocity of the effector coordinate system 102.
  • the velocity is, for example, the velocity in the direction of travel of the effector coordinate system 102 in the coordinate system, or the velocities in each of the X, Y, and Z directions.
  • a fourth example of an effector constraint is a constraint on the angular velocity of the effector coordinate system 102.
  • the angular velocity is the angular velocity around an axis of the effector coordinate system 102 in the coordinate system, or the angular velocity around the X, Y, and Z axes.
  • a fifth example of an effector constraint is a constraint on the acceleration of the effector coordinate system 102.
  • the acceleration is, for example, the acceleration in the direction of travel of the effector coordinate system 102 in the coordinate system, or the acceleration in each of the X, Y, and Z directions.
  • a sixth example of an effector constraint is a constraint on the angular acceleration of the effector coordinate system 102.
  • the angular acceleration is the angular acceleration around an axis of the effector coordinate system 102 in the coordinate system, or the angular acceleration around the X, Y, and Z axes.
  • the third to sixth examples of effector constraints are also constraints on the change in at least one of the position and orientation of the effector 30.
  • the effector constraint may be a combination of any two or more of the first to sixth examples. Also, a value or formula equivalent to the amount obtained by time-differentiating the position and/or orientation three or more times may be used. Also, the effector constraint may be a constraint on the change in the position and/or orientation of the effector coordinate system 102 relative to a specified reference coordinate. Note that the change in the position and/or orientation of the effector coordinate system 102 relative to the specified reference coordinate is the change in the position and/or orientation of the effector relative to the specified reference coordinate. Also, the constraints on angular velocity, accelerations, etc. in the third to sixth examples are constraints on the change in the position and/or orientation of the effector as viewed from the specified reference coordinate.
  • the operation program 23B coordinate and posture information, the command, and effector constraints are set for each teaching point.
  • effector constraints are not set for teaching point 1 (position and posture [1]) and teaching point 2 (position and posture [2]).
  • effector constraints 1 and 2 described below are set for teaching point 3 (position and posture [3]) and teaching point 4 (position and posture [4]), respectively.
  • the screen 200 of FIG. 6 is a screen that accepts an operation for displaying a screen related to setting effector constraints. The operation is a tap at a predetermined position on the screen 200 or a predetermined button. The button may be provided in the input unit 26.
  • effector constraint setting screen 210 shown in FIG. 6 appears.
  • An effector constraint or effector constraint set, described below, can be selected on setting screen 210.
  • an effector constraint or effector constraint set is set at any teaching point, as shown in FIG. 7.
  • the user can set, as effector constraints, a coordinate system and constraints on positional and pose changes of the effector coordinate system 102 relative to the reference coordinates.
  • an input unit 26 that allows the user to edit such settings is provided on a portable operation panel also known as a teach pendant.
  • Settings such as effector constraints are stored in the memory unit 23, or a specified memory unit such as a memory unit of a separate control device or a memory unit on the cloud.
  • effector constraints are stored in a memory unit of a separate control device or a memory unit on the cloud, these memory units and memory units function as the memory unit of the control device 1.
  • a screen related to the setting is displayed on the display device 22 of the input unit 26.
  • the processor 21 of the control device 1 causes the display device 22 to display a screen 300 shown in Fig. 8.
  • the screen 300 is a screen for the user to select a transition to a setting screen for the effector constraints.
  • An operation unit 500 for performing the selection and the like is displayed on the display device 22.
  • Directional keys, a decision key, a back key for returning to the screen before the transition or to the screen of a higher layer, and the like are displayed on the operation unit 500, and the user performs input by operating these keys.
  • buttons corresponding to the functions may be provided on the input unit 26.
  • the processor 21 causes the display device 22 to display a screen 301 of Fig. 9.
  • the screen 301 is a screen for the user to select a transition to a reference coordinate system setting screen.
  • the processor 21 causes the display device 22 to display a screen 302 of Fig. 9.
  • the screen 302 is a screen for the user to select the setting of an arbitrary reference coordinate system from among a plurality of reference coordinate systems.
  • the processor 21 When the user selects, for example, reference coordinate system 1 from among the multiple reference coordinate systems on screen 302, the processor 21 causes the display device 22 to display screen 303 of FIG. 9.
  • Screen 303 is a screen for setting the reference coordinate system 1 selected by the user. As shown on screen 303, the user can set the position and orientation of reference coordinate system 1.
  • the processor 21 causes the display device 22 to display a screen 303 of Fig. 10.
  • the user can set the selected reference coordinate system 2.
  • the coordinate systems set by the reference coordinate systems 1, 2, etc. can be used as the reference coordinate system 101.
  • the user can set a plurality of reference coordinate systems using the screens 302 and 303. This configuration is useful for improving the degree of freedom in setting effector constraints, which will be described later.
  • the processor 21 causes the display device 22 to display screen 304 of FIG. 11.
  • Screen 304 is a screen for the user to select the setting of one of a number of effector coordinates.
  • the processor 21 When the user selects, for example, effector coordinate 1 from among the multiple effector coordinates on screen 304, the processor 21 causes the display device 22 to display screen 305 of FIG. 11.
  • Screen 305 is a screen for setting the effector coordinate 1 selected by the user. As shown on screen 305, the user can set the position and orientation of effector coordinate 1.
  • the processor 21 causes the display device 22 to display a screen 305 of Fig. 12.
  • the user can set the selected effector coordinate 2.
  • the user can set a plurality of effector coordinates using the screens 304 and 305. This configuration is useful for improving the degree of freedom in setting effector constraints, which will be described later.
  • the processor 21 causes the display device 22 to display screen 306 of FIG. 13.
  • Screen 306 is a screen that allows the user to select the setting of any one of the multiple effector constraints.
  • effector constraint 1 When the user selects, for example, effector constraint 1 from among the multiple effector constraints on screen 306, the processor 21 causes the display device 22 to display screen 307 of FIG. 13.
  • Screen 307 is a screen for setting effector constraint 1 selected by the user, and the user can set the effector constraint using screen 307.
  • the effector constraint is intended to restrict changes as viewed from a specified reference coordinate of the effector coordinate system 102 fixed to the effector 30.
  • the user can set a reference coordinate system that serves as the basis for effector constraint 1.
  • Effector constraint 2 can be set in a similar manner.
  • the reference coordinate system is always fixed, or when reference coordinate system 101 is used, it is possible to omit setting the reference coordinate system on screen 307.
  • effector coordinates 1 are set for effector constraint 1.
  • effector coordinates 2 are set for effector constraint 2.
  • Effector constraints restrict changes in the position and/or posture of the effector 30 as viewed from the set effector coordinates (predetermined reference coordinates). For this reason, the configuration in which effector coordinates can be set or selected as described above, and the configuration in which the user can set effector coordinates for each effector constraint, each lead to an improvement in the degree of freedom of setting by the user.
  • effector constraint elements described below, are set for each effector constraint.
  • effector coordinate 1 is set diagonally upward relative to the effector coordinate system 102
  • effector coordinate 2 is set at a different position horizontally relative to the effector coordinate system 102.
  • effector constraint 1 is set at teaching point 3 (position and attitude [3]).
  • the processor 21 operates the arm 10A so that the effector 30 moves based on the operation program 23B.
  • teaching point 2 position and attitude [2]
  • teaching point 3 the change in the position and attitude of the effector coordinate system 102 as viewed from effector coordinate 1 (predetermined reference coordinate) is constrained by the effector constraint element set in effector constraint 1.
  • teaching point 4 the change in the position and attitude of the effector coordinate system 102 as viewed from effector coordinate 2 (predetermined reference coordinate) is constrained by the effector constraint element set in effector constraint 2.
  • effector coordinate 1 for effector 30 at teaching point 3 corresponds to the position of effector 30 in effector coordinate 1 shown on screen 305 in FIG. 11.
  • the position of effector coordinate 2 can also be set in a similar manner.
  • a teaching point or a passing point between teaching points may be used as the predetermined reference coordinate.
  • the change in position and attitude at each teaching point or each passing point of the effector 30 moving according to the operation program 23B is controlled so as to be within the range of the effector constraint element as viewed from the position and attitude of the teaching point or the passing point.
  • a teaching point or a passing point between teaching points is used as the predetermined reference coordinate, it is not necessary to set the screen 305 in Fig. 11 and Fig. 12, and it is also not necessary to set the effector coordinates on the screen 307 in Fig. 13.
  • the screen 307 in Fig. 13 may be configured to accept a setting that sets the effector coordinates 1 as the position and orientation of the teaching point or the passing point.
  • the effector constraint element of the effector constraint can also be said to indicate the range within which changes in the position of the effector 30 are permitted.
  • the processor 21 operates the arm 10A in the above-described configuration, the actual position and orientation of the effector 30 (effector coordinate system 102) is positioned within the range within which changes in the position of the effector 30 are permitted by the effector constraint.
  • the target of effector constraint 1 is a section.
  • an item "Applicable range of effector constraint” is displayed on screen 307, and the user inputs the teaching point number or the like of the target of the effector constraint to the right of "Range of effector constraint". If the teaching point numbers are consecutive numbers, the section becomes the target of effector constraint 1.
  • the section subject to the effector constraint may be specified by describing the start/end of the effector constraint within the operation program 23B.
  • an effector constraint that is always applied regardless of the operation program 23B may be set.
  • an operation program 23B that is always applied may be set for each effector constraint.
  • a space or a posture type of the arm 10A may be set as the "application range of the effector constraint" on the screen 307 shown in FIG. 13.
  • the range of the dashed line 307A in FIG. 13 indicates the range in the X-Z direction, but a range of, for example, about several tens of centimeters in the Y direction may also be set within that range.
  • a plurality of posture types of the arm 10A may be displayed on the screen 307, and the selected posture type may be input to the right of the "application range of the effector constraint".
  • the effector constraint 1 is applied while the posture of the arm 10A corresponds to that posture type.
  • a configuration in which the user can set a route to be subject to the effector constraint on the screen 307 may also be adopted.
  • the control device 1 may automatically set effector constraints based on the effector constraints set for each teaching point of the operation program 23B and other set effector constraints. This automatically set effector constraint is also based on the effector constraints set by the user for each teaching point, and is therefore an effector constraint set based on user input.
  • the arm 10A may be placed on a bar counter.
  • the work may be a work in which the arm 10A holds an object 2 such as a cup using the effector 30 which is a hand, and a work in which the held object 2 is provided to a position at the counter corresponding to a customer.
  • a visual sensor is provided to observe the working range of the arm 10A, and the control device 1 recognizes the position of the effector 30, the position of the target 2, the surrounding environment 4 in which there is movement within the space, approaching objects including the customer, etc., based on the output of the visual sensor.
  • the control device 1 sequentially calculates the path along which the effector 30 moves for the work while recognizing the range of the surrounding environment 4 and the approaching objects.
  • the processor 21 can apply the effector constraints set in the space when generating the path.
  • screen 307 the user can set the movable range of the effector 30 in the X, Y, and Z directions as effector constraint 1.
  • Screen 307 allows the user to set a "reference”.
  • the “reference” is shown by coordinates in, for example, reference coordinate system 1, reference coordinate system 101, effector coordinate system 102, etc.
  • Screen 307 allows the user to set an "upper limit” and a “lower limit”.
  • the "upper limit” and “lower limit” are, for example, the movable amount or movable range relative to the coordinates of the "reference”.
  • effector constraint elements the movable ranges in the X, Y, and Z directions having the "reference”, “upper limit”, and “lower limit” are referred to as effector constraint elements.
  • the user can set the rotational movable range, angular velocity, and angular acceleration of the effector 30 around the X, Y, and Z axes, and the velocity and acceleration in the X, Y, and Z directions as effector constraint 1.
  • Values or formulas equivalent to the amount obtained by time-differentiating the range of rotational movement around the X, Y, and Z axes, velocity, acceleration, angular velocity, angular acceleration, position, or orientation three or more times are also called effector constraint elements.
  • effector coordinates 1 set as the effector coordinates on screen 307 is used as a "reference”, or if the "reference" is automatically set by control device 1, input and display of the "reference” may be omitted. Also, it is not necessary to set all effector constraint elements, and if some are fixed, they may be automatically set by control device 1, etc.
  • the user can set the "reference” arbitrarily. Therefore, the user can set a position and posture different from the position and posture of the effector 30 set at each teaching point and the position and posture of the effector coordinate 1 set on the screen 307 as the "reference".
  • This configuration leads to an improvement in the degree of freedom of setting by the user, and the accuracy, safety, efficiency, etc. of the operation of the arm 10A.
  • the user can set each "reference" around the X, Y, and Z axes as a neutral posture of the effector 30.
  • improving the efficiency of the operation of the arm 10A includes improving the cycle time of the operation of the arm 10A, etc.
  • the processor 21 when the user returns to screen 301 as shown in FIG. 15 and selects to transition to the effector constraint set setting screen, the processor 21 causes the display device 22 to display screen 308 of FIG. 15.
  • Screen 308 is a screen that allows the user to select the setting of any one of the multiple effector constraint sets.
  • the processor 21 When the user selects, for example, set 1 from among the multiple sets on screen 308, the processor 21 causes the display device 22 to display screen 309 of FIG. 15.
  • Screen 309 is a screen for setting effector constraint set 1 selected by the user, and the user can set the effector constraint set using screen 309.
  • An effector constraint set can associate multiple effector constraints.
  • the user can incorporate any selected effector constraints 1 to 3 into effector constraint set 1, and can also set each of effector constraints 1 to 3 to be enabled or disabled.
  • the user can also set the relationship between multiple effector constraints 1 to 3 as "1 ⁇ 2 ⁇ 3", where "1 ⁇ 2 ⁇ 3" means effector constraint 1, effector constraint 2, and effector constraint 3.
  • "Effector Constraint Set 1" can be set in the "Effector Constraint” column on screen 200 in FIG. 7, instead of "Effector Constraint 1", etc.
  • This configuration allows the user to improve the freedom of settings.
  • This configuration also allows the user to organize and apply multiple effector constraints set on screen 307, which leads to accuracy, safety, efficiency, etc. of the movement of arm 10A.
  • screens 306, 307, etc. can be used to set each effector constraint and each effector constraint element to be enabled or disabled. It is also possible to omit the settings on screen 309 as necessary.
  • the processor 21 uses the path generation program 23D to create a path for moving the position and orientation of the effector coordinate system 102 from the previous teaching point to the target teaching point based on the operation program 23B, etc. For example, the processor 21 creates the path while performing a well-known interpolation calculation between the previous teaching point and the target teaching point.
  • the processor 21 performs the path creation while also applying the effector constraint.
  • the path creation may be described as path creation or path generation.
  • the processor 21 transmits a control command according to the created path to each servo controller 24 .
  • the processor 21 performs similar processing even when the robot 10 is a collaborative robot.
  • the processor 21 may generate an avoidance path for avoiding an avoidance target.
  • any state may be set within the effector constraints.
  • that state may be set as the neutral state.
  • the path generation may result in the effector 30 remaining tilted.
  • the processor 21 may, for example, bring the final attitude of the effector 30 closer to or back to 0 deg.
  • the position and posture of the effector 30 at the time of setting each teaching point may be set as a neutral state.
  • the user places the effector 30 in a first position and posture by hand guide operation, and performs an operation for setting a teaching point at the input unit 26, for example.
  • the first position and posture are set for teaching point 1 on the screen 200, for example.
  • the user can set teaching point 2 and subsequent points in the same manner.
  • the user may place the actual position and posture of the effector 30 according to the image of the arm 10A during operation. For this reason, a configuration in which the above-mentioned first position and posture are set as a neutral state at each teaching point is useful for reducing the user's efforts and achieving both accuracy, safety, efficiency, etc. of the operation of the arm 10A.
  • the processor 21 controls the arm 10A to perform restoring operation control to return the position and posture of the effector 30 to a neutral state.
  • the restoring operation control is performed using at least one of values calculated according to, for example, a constant velocity or angular velocity, a constant acceleration or angular acceleration, the amount of deviation from the neutral state, etc.
  • a spring-like variable that acts like a spring according to the amount of deviation may be used to perform the restoring operation control.
  • a damper-like variable that acts like a damper according to the rate of change or angular velocity of change of the amount of deviation may be used to perform the restoring operation control.
  • An inertial variable that acts like an inertial force according to the acceleration of change or angular acceleration of change of the amount of deviation may be used to perform the restoring operation control. A combination of these variables may also be used.
  • the object 2 is carried on a simple tray-shaped effector 30. Since the effector 30 is in a tray shape, the object 2 may fall due to the effector 30 being tilted or moving at an inappropriate speed.
  • the position of the effector coordinate 1 is set slightly above the center of gravity of the target 2 by the screens 305 and 307, and constraints on the attitude, angular velocity, and angular acceleration are set.
  • the processor 21 Based on this setting, the processor 21 generates a path of the effector coordinate system 102 (effector 30) from one position and posture to another. At this time, the effector 30 carrying the target 2 tends to move like a pendulum around the neutral state position and posture set by the effector constraint. This limits large tilts and accelerations at the position of the target 2, and furthermore, the centrifugal force generated by the pendulum movement presses the target 2 against the effector 30, which helps prevent the target 2 from falling.
  • the user can set the effector constraint element to a certain value that corresponds to the allowable range of acceleration in the direction corresponding to the vertical direction of the effector 30 and the direction corresponding to the centrifugal force. Also, the user can set the allowable range of acceleration in other directions to a sufficiently small value, such as 1/5 or less of the above value. In this case, the effector 30 also tends to move like a pendulum.
  • the posture constraint in the effector constraint is not limited to Euler angle notation, and quaternion notation, etc. may also be used. Furthermore, the constraint does not need to be a scalar value, and may be set as a function.
  • the effector constraint may be set to switch depending on the position, posture, etc. of the arm 10A. The effector constraint may be set to switch depending on the state of the arm 10A (whether or not it is holding the target 2, etc.).
  • a configuration is adopted in which the original teaching position or the effector constraint can be selected in the operation program 23B.
  • a "constraint priority" column is added to the screen 200 in FIG. 7 for setting whether the effector constraint is to be prioritized over the teaching point designation of the operation program 23B for each teaching point or each section of the route.
  • the user can easily and reliably set which of the operation program 23B and the effector constraint is to be prioritized.
  • the position and orientation (X, Y, Z, ⁇ x, ⁇ y, ⁇ z) of the effector 30 is constrained by the teaching position and teaching orientation of the operation program 23B or the effector constraint is not limited to the above example.
  • the above configuration leads to a reduction in the number of constraints set at each teaching point. Also, the above configuration realizes the operation of the arm 10A that can keep the position and posture of the effector 30 in an appropriate state by having effector constraints, which can lead to the creation and selection of a path that can improve the cycle time.
  • multiple effector constraints can be set, but a configuration in which only one effector constraint can be set may also be adopted.
  • the function of the effector constraint is realized by providing one set consisting of a reference coordinate system, effector coordinates, and effector constraint elements, but it may be difficult to express various functions using one effector constraint. Therefore, as shown in screens 306 and 307 in FIG. 13, a configuration in which multiple effector constraints can be set may also be adopted. Also, a configuration in which multiple effector constraints can be set so that they can be applied to each target section, range, teaching point, etc. may also be adopted.
  • an effector constraint set is set.
  • the user sets effector constraint 1 as the first effector constraint using screens 305, 306, and 307.
  • the user sets reference coordinate system 1 at a position that does not move in space, and sets effector coordinates 1 above the center of gravity of the effector.
  • Effector constraint 1 sets constraints to allow translational and rotational motion of effector 30.
  • Effector constraint 1 also sets constraints on angular velocity and angular acceleration. If the user selects the corresponding tag on screen 307, it becomes possible to set angular velocity, angular acceleration, etc.
  • effector constraint 2 as the second effector constraint using screens 305, 306, and 307. At that time, the user sets the position and orientation of effector coordinate 2 as the position and orientation of reference coordinate system 2, and sets effector coordinate 2 below the center of gravity of the effector. Translation and rotation are not allowed in effector constraint 2.
  • effector constraint 3 as the third effector constraint using screens 305, 306, and 307. In doing so, the user constrains the position and orientation of effector coordinates 2 with respect to reference coordinate system 1. Effector constraint 3 is set to allow translational and rotational motion. Effector constraint 3 also constrains the translational speed and acceleration.
  • the following example describes another example of setting an effector constraint set.
  • the user sets effector constraint 1 as the first effector constraint using screens 305, 306, and 307.
  • the user sets reference coordinate system 1 at a position that does not move in space.
  • the user also sets effector coordinates 1 on the rotation axis J3 of joint 3C shown in FIG. 1, and sets effector constraint 1.
  • Effector constraint elements are set in effector constraint 1 to allow translational and rotational motion.
  • angular velocity and angular acceleration are restricted in effector constraint 1.
  • effector constraint 2 as the second constraint using screens 305, 306, and 307. At that time, the user sets effector coordinate 1 as reference coordinate system 2, and sets effector coordinate 2 below the center of gravity of the effector. In effector constraint 2, effector constraint elements are set so that translational and rotational movements are permitted.
  • effector constraint 3 as the third effector constraint using screens 305, 306, and 307. In doing so, the user constrains effector coordinates 2 with respect to reference coordinate system 1.
  • effector constraint elements are set so that translational motion is permitted.
  • effector constraint elements are set so as to constrain the translational speed and acceleration.
  • joint 3C In a normal robot, when attempting to move joint 3B in Figure 1 around its rotation axis J2, joint 3C also moves symmetrically around rotation axis J3, and may move so as to maintain the posture of the wrist axis. On the other hand, when attempting to move the rotation axis, this action often does not occur. With conventional settings, it is difficult to perform movement around rotation axis J3 while keeping the posture of the wrist and movable part 12 (J2 arm) between joints 3B and 3C unchanged.
  • a set of the reference coordinate system, effector coordinates, and effector constraint may be referred to as one unit of effector constraint.
  • an effector constraint is a collection of individual constraints such as position, speed, and acceleration, and each individual constraint is referred to as an effector constraint element.
  • multiple effector constraints may be prepared, and the processor 21 calls and uses the required effector constraint from the memory unit 23.
  • Multiple effector constraint sets may be prepared according to various states of the arm 10A.
  • the state of the arm 10A differs depending on the type of effector 30, the type of target 2, the type of arm 10A, etc.
  • An effector constraint set is a combination of multiple effector constraints.
  • the user only needs to use the prepared effector constraint set. This configuration reduces the effort required for the user to make settings, and also leads to accuracy, safety, efficiency, etc. of the operation of the arm 10A.
  • effector constraints By setting effector constraints, it becomes possible to generate a path that takes into account the properties of the effector 30, target 2, etc., but it is difficult to accurately reflect the properties of the effector 30, target 2, etc. in the effector constraints.
  • the user can determine the effector constraints using calculations, etc., but differences in experience between users will result in variations in the accuracy of the effector constraints. In such situations, trial and error is required to input the effector constraints.
  • settings for constraints that are actually necessary will be omitted, leading to unintended malfunctions.
  • the effector constraint includes a plurality of effector constraint elements, and a priority can be set for at least one of the plurality of effector constraint elements as shown in a screen 307 in FIG. 13.
  • the screen 307 has a column of "priority”, and a priority can be set to correspond to each effector constraint element.
  • an "absolute” priority is set for the "upper limit” and “lower limit” of the angle around the X-axis, which are effector constraint elements.
  • the “absolute” priority can be said to be a must-have setting that must be used by the processor 21, for example.
  • Priorities are also set for the other effector constraint elements, and "absolute", “high”, and “low” are set in descending order of priority.
  • the robot 10 can operate under conditions where it is not necessary to observe any of the X, Y, and Z rotational position constraints among the effector constraints, for example, and the number of options for paths that the processor 21 can set increases.
  • the processor 21 can select a more effective path that can improve cycle time, etc.
  • the effector constraints have priorities, such as constraints that must be observed and constraints that do not necessarily have to be observed.
  • priorities such as constraints that must be observed and constraints that do not necessarily have to be observed.
  • the processor 21 may be configured not to observe constraints with a low priority based on preset criteria. To realize this configuration, a priority is set for each effector constraint and each effector constraint element, and the priority is stored in the memory unit 23.
  • the presets can be prepared so that there are differences in the priority of effector constraint elements.
  • Effector constraints include constraints that are intentionally set by the user and constraints that are not intentionally set.
  • constraints that are intentionally set by the user may be called designated constraints
  • constraints that are not intentionally set and can be optimized may be called dependent constraints.
  • Information indicating whether a constraint is designated or dependent may be stored in the memory unit 23 together with each effector constraint.
  • the control device 1 accepts a setting for each effector constraint element as a constraint element that causes the processor 21 to use a value designated by the user, or a setting for a constraint element that allows changes by the processor 21, and the accepted setting is stored in the memory unit 23.
  • the settings are indicated by "designated” and "dependent” in Figures 13, 19, and 23.
  • the effector constraint when the user uses a preset effector constraint, it is desirable to initially set the effector constraint as a dependent constraint, since the details of the effector constraint are not set by the user. If the user edits a preset effector constraint, the effector constraint becomes a specified constraint. The user can later change whether the effector constraint is a specified constraint or a dependent constraint.
  • effector constraints and the distinction between designated constraints and dependent constraints may be set for each effector constraint element, or may be set collectively for each effector constraint set.
  • intent of the constraints can be made clearer by providing priority and a distinction between specified and dependent constraints.
  • a preset automatic setting program 23F that automatically sets effector constraints and/or effector constraining elements is stored in the storage unit 23.
  • the preset automatic setting program 23F automatically sets effector constraints and/or effector constraining elements based on information on the effector 30 and the target 2 that the user can objectively obtain and functions and performance (functional requirements) that the user subjectively expects.
  • the functional requirements may be expressed qualitatively, such as "I don't want it to shake,””Idon't want it to tip over,””Idon't want it to be dropped,””Idon't want it to be tilted,” or “I don't want it to move from its place,” for example, with respect to the object 2.
  • This function requirement can be expressed as an effector constraint element, and therefore presets of the effector constraint elements corresponding to the function requirements are stored in the storage unit 23 in advance.
  • the type of combination of effector 30 and target 2 is configured so that the user can select from multiple types of presets.
  • Presets include a type that fits on a tray, a type that fits on a container, a type that fits into a box, a type that is grabbed by hand, a type that is sucked in, etc.
  • Presets also include a type that processes the target with a welding gun, a type that processes the target with a welding torch, a type that processes the target with various tools, etc.
  • This configuration does not limit the type of effector 30, and the presets are intended to assist in information input. Effectors that do not fit into the presets can also be used.
  • 3D CAD models of the effector 30 and target 2 If the shape, as well as the center of gravity and weight of target 2, the center of gravity and weight of the effector, the movable parts of effector 30, etc. are used together with the 3D CAD model, a more accurate physical model will be created. It is desirable to add parameters necessary to explain physical behavior to the physical model, such as a spring constant indicating the hardness of the material, a damping coefficient that dampens vibrations, and a friction coefficient when objects rub against each other. With a physical model, it becomes possible to reproduce physical behavior such as the behavior of grabbing with a hand and the behavior of target 2 falling in a simulation.
  • the physical model used in this embodiment is for carrying out a physical simulation. Since various settings of the physical model require a lot of work, it is desirable for the model to be constructed from information that is easily available to the user.
  • the approximate arrangement of the effector 30 and target 2 is determined by selecting a preset of the type of combination of the effector 30 and target 2. Once the arrangement is determined, an approximate physical model can be generated simply by adding the shape, center of gravity, weight, and the like of the characteristic parts of the effector 30 and target 2.
  • the control device 1 stores in the memory unit 23 information on the type, shape, etc. of the effector 30 and the target 2, information on functional requirements, and information on effector constraint elements appropriate for realizing the functional requirements, in a mutually associated state.
  • the processor 21 sets effector constraint elements based on the above information, functional requirements input by the user, information on the physical model, etc., and presents them to the user.
  • a screen for setting using the presets is displayed on the display device 22 of the input unit 26 .
  • the processor 21 of the control device 1 causes the display device 22 to display a screen 401 shown in Fig. 16.
  • the screen 401 may be displayed instead of the screen 301.
  • the screen 401 is a screen for the user to select a transition to a setting screen for effector information.
  • the processor 21 causes the display device 22 to display a screen 402 of Fig. 16.
  • the screen 402 is a screen for the user to select any one of a plurality of effector type settings.
  • the processor 21 causes the display device 22 to display screen 403 of FIG. 16.
  • Screen 403 is a screen for setting effector type 1 selected by the user. As shown on screen 403, the user can set the effector type by selection.
  • Screen 404 is a screen for setting the dimensions, center of gravity, and other positions of the selected effector type.
  • screen 404 is configured so that the weight, material, etc. of the selected effector type can also be set.
  • the processor 21 causes the display device 22 to display screen 405 of FIG. 17.
  • Screen 405 is a screen that allows the user to select any one of multiple target type settings.
  • Screen 406 is a screen for setting the target type 1 selected by the user. As shown on screen 406, the user can set the target type by selection.
  • Screen 407 is a screen for setting the dimensions and position of the selected target type, such as the center of gravity.
  • screen 407 is configured so that the weight, material, etc. of the selected target type can also be set.
  • screen 407 may also be configured so that the position of the selected target type relative to the selected effector type can also be set.
  • the processor 21 causes the display device 22 to display screen 408 of FIG. 18.
  • Screen 408 is a screen for setting the positional relationship of the selected target type to the selected effector type.
  • the processor 21 causes the display device 22 to display screen 409 of FIG. 18.
  • Screen 409 is a screen for setting the positional relationship 1 selected by the user. As shown on screen 409, the user can set the positional relationship by inputting numerical values and moving the displayed effector diagram and/or target diagram.
  • the processor 21 causes the display device 22 to display screen 410 of FIG. 19.
  • Screen 410 is a screen for selecting an effector type, a target type, a target positional relationship, etc.
  • the effector type information may be automatically set based on input information (input) from an external device.
  • input information input information
  • the effector 30 is connected to the control device 1
  • a signal may be sent from the effector 30 to the control device 1
  • the processor 21 may set the effector type based on the input signal (input).
  • the target type and target positional relationship may be automatically set.
  • Screen 410 is a screen for selecting a transition to a function request (request) setting screen and for displaying the set function request.
  • processor 21 causes display device 22 to display screen 411 of FIG. 19.
  • Screen 411 is a screen for the user to select a function request.
  • Screen 411 displays "enabled” in the position corresponding to each function request, indicating that it has been set.
  • a function request (request) is, for example, a user request regarding an operation to be performed by effector 30 on target 2.
  • the effector constraints are set by the settings on screens 410 and 411.
  • the effector constraints include, for example, the same settings as those on screen 307. Therefore, the processor 21 can control the arm 10A using the effector constraints that have been set.
  • the processor 21 causes the display device 22 to display screen 412 of FIG. 19.
  • Screen 412 displays the contents of the effector constraints that have been set, and accepts changes to each setting of the effector constraints.
  • Screen 412 is configured to accept user input for registering the effector constraint, whose settings have been changed, as one of the presets.
  • the memory unit 23 stores a plurality of effector constraints. Furthermore, the memory unit 23 stores a plurality of effector constraints so that they correspond to a plurality of combinations of the effector type, which is the type of the effector 30, and the target type, which is the type of the target 2.
  • the processor 21 sets the corresponding effector constraint. This configuration reduces the effort required for the user to make settings, and also leads to accuracy, safety, efficiency, etc. of the operation of the arm 10A.
  • the effector constraint is set based only on the effector type setting.
  • the effector constraint is set based only on the target type setting.
  • the processor 21 sets the effector constraint based on at least one of the information on the effector type and the information on the target type, and the input for the setting by the user.
  • the processor 21 sets the effector constraint based at least on the information on the effector type and the input from the external device.
  • effector constraints are set based on requests input by the user. This configuration is useful for achieving a high level of both reducing the effort required for users to make settings and improving the accuracy, safety, efficiency, etc. of the operation of the arm 10A.
  • the effector constraints are set according to the input values of the user, and preset effector constraints are set based on the functional requirements input by the user.
  • the set effector constraints do not necessarily function normally as expected by the user. There is a possibility that important settings may be omitted, unnecessary settings may be present, fine adjustments of effector constraint elements may be insufficient, and the path may not be as expected by the user.
  • the most reliable method is to check the movement path using the actual robot 10. However, if there are any imperfections in the settings, the act of checking itself poses a risk. Therefore, checking whether the effector constraints are appropriate through simulation reduces the risk.
  • the user To perform a simulation, the user must input the movement pattern (movement program 23B) of the arm 10A.
  • movement pattern movement program 23B
  • a set of various movement patterns of the arm 10A is preferably prepared in advance as presets. The user normally selects any of the movement patterns from the presets, and in exceptional individual cases, the user creates or modifies a supplementary movement pattern by inputting it.
  • 3D models of the surrounding environment 4, approaching objects including people and items carried by people, robot 10, effector 30, target 2, etc. are reproduced on the simulator, and operations such as automatic driving, jogging, and hand guide operation are simulated.
  • the simulation is preferably a physical simulation that can reproduce the falling of target 2, etc. For example, already created physical models of effector 30 and target 2 are utilized.
  • the simulation can calculate the acceleration of the effector 30 and the target 2, which cannot normally be monitored in reality.
  • Simulation tolerances are set as permissible thresholds for the position, attitude, speed, acceleration, angular speed, angular acceleration, etc. of the effector 30 and the target 2.
  • the simulation can check whether the operation of the effector 30 falls within the simulation tolerances. If a simulation tolerance corresponding to the functional requirements has been prepared in advance, that tolerance may be used. Alternatively, values, settings, etc. used as the simulation tolerances may be selected from the effector constraint set.
  • the simulation can determine whether or not the functional requirements are met under any conditions assumed by the user. It is preferable that the processor 21 displays the state of operation in the simulation on the display device 22, etc.
  • the processor 21 may modify, improve, or optimize the following effector constraints based on the constraint modification program 23G. This configuration is useful for reducing the user's workload while also achieving accuracy, safety, efficiency, etc., of the operation of the arm 10A.
  • effector constraint elements For example, the fine-tuning of effector constraint elements by the user described above is trial and error-based, which places a large burden on the user. If priority, importance, etc. are set when setting effector constraint elements, the effector constraint elements with low importance and low priority are likely to be changed. These become the effector constraint elements to be adjusted.
  • a constraint modification program 23G that modifies the effector constraint set based on the results of the simulation is stored in the memory unit 23.
  • the requirement for the simulation tolerance may be used as an indicator for judging whether the effector constraint set is good or bad.
  • the cycle time may also be an indicator for judging whether the effector constraint set is good or bad.
  • the above-mentioned indicators for judging whether the effector constraint set is good or bad are merely examples and are not limited to these.
  • the effector constraint set index may be set as an indicator for judging whether the effector constraint set is good or bad.
  • the effector constraint set with the maximum (or minimum) effector constraint set index is the best effector constraint set.
  • a method for modifying an effector constraint set using a simulation the following method is considered. First, a general genetic algorithm can be applied. After performing a simulation, an effector constraint set index is calculated. Based on the result of the simulation, an alternative plan for the effector constraint element to be adjusted is created. A number of alternative plans may be created at once.
  • a simulation is performed again using the effector constraint elements of the alternative, and an effector constraint set index is calculated. Further alternatives are generated based on the effector constraint set with an improved effector constraint set index. The number of alternatives generated can be changed depending on the degree of improvement in the effector constraint set index.
  • the above simulation and the improvement or optimization of the effector constraints based on the results of the simulation may be performed by the processor 21 of the control device 1 or by another computer.
  • the other computer has a processor, display device, memory unit, input unit, etc. similar to those of the control device 1.
  • the memory unit of the other computer stores programs, data, information, etc. similar to those of the memory unit 23.
  • the memory unit of the other computer also stores a simulation program and models of the surrounding environment 4, robot 10, effector 30, target 2, etc.
  • Effector constraints improved or optimized by another computer may be input to the control device 1, and when the input is received, the processor 21 of the control device 1 may set the input effector constraints in the operation program 23B, etc. In this case, based on the input from the computer as an external device, the processor 21 causes the arm 10A to perform an operation constrained by the effector constraints.
  • a screen for simulating effector constraints is displayed on the display device 22 of the input unit 26 .
  • the processor 21 causes the display device 22 to display screen 421 of Fig. 21.
  • Screen 421 is a screen for the user to select an arbitrary simulation condition setting from among a plurality of simulation condition settings.
  • the processor 21 When the user selects the setting of simulation condition 1 on screen 421, the processor 21 causes the display device 22 to display screen 422 of FIG. 21. Screen 422 is a screen for making various settings for the simulation. When the user selects the simulation setting on screen 422, the processor 21 causes the display device 22 to display screen 423 of FIG. 21. Screen 423 is a screen for setting the evaluation items to be evaluated in the simulation, setting the conditions for each evaluation item including the setting of the simulation tolerances, etc.
  • the user After configuring settings on screens 422 and 423, the user performs operations to execute a simulation on screen 421. This causes the processor 21 to display the simulation execution screen 424 in FIG. 22, and also displays the results of the evaluation items that were set on screens 425 and 426 in FIG. 22.
  • the processor 21 may also evaluate whether the operation of the effector 30 is within the simulation tolerance. When the operation of the effector 30 is not within the simulation tolerance, the processor 21 may display screen 427 of FIG. 23. When the operation of the effector 30 is not within the simulation tolerance, the processor 21 may determine or estimate the effector constraint element that is causing this, and display the effector constraint element to the user, as in screen 427. In screen 427, the color of the effector constraint element determined to be the cause is changed.
  • the processor 21 can improve or optimize the effector constraints using the results of the simulation based on the constraint modification program 23G. For example, when "optimize settings" is selected on the screen 401, the effector constraints are improved or optimized.
  • each effector constraint element on screen 307 of Fig. 13 is a designated constraint (user)
  • some of the effector constraint elements in the acceleration/angular acceleration tabs, etc. of the screen 307 in FIG. 13 are the cause as shown in FIG. 23, and are not set with "designation", that is, are dependent constraints (optimizable).
  • the processor 21 performs the improvement or optimization by changing the effector constraint elements that are determined to be the cause and are not set with "designation".
  • the user can instruct the processor 21 to perform the improvement or optimization while recognizing the constraint elements that are not automatically changed.
  • This configuration leads to easier setting by the user, and also leads to accuracy, safety, efficiency, etc. of the operation of the arm 10A.
  • the processor 21 controls the arm 10A so that it is within the range of the effector constraint even during a jog operation, and the arm 10A operates in this manner. This reduces or prevents the effector 30 from being placed in an unintended position due to an operational error, etc. In addition, since the operation of the effector 30 is restricted by the effector constraint, the number of steps required for confirmation by the user during a jog operation is reduced. Furthermore, when the effector constraint is set to the neutral state described above, the processor 21 operates the arm 10A during a jog operation so as to bring the posture of the effector 30 closer to the neutral posture. With this configuration, the effector 30 is maintained in a state close to a desired posture without the user having to perform any special operation on the directional keys, joystick, etc.
  • a hand guide operation in which the user holds the tip of the arm 10A and applies an external force to the tip to move the arm 10A.
  • the direction and magnitude of the external force are detected by a sensor, and the processor 21 moves the arm 10A in the direction of the external force according to the detection result of the sensor.
  • the processor 21 moves the arm 10A in the direction of the external force according to the detection result of the sensor.
  • the hand guide operation if the user applies an external force in the wrong direction, this can also result in an operation error.
  • a 3D model of the robot 10, a 3D model of the effector 30, and a 3D model of the target 2, which is a workpiece, are stored in the storage unit 23.
  • the target 2 In handling an object, the target 2 is not always grasped, but may be integrated with the surrounding environment 4, and in particular, the target 2 may be moving on a conveyor or may be grasped by another robot system. For this reason, it is desirable to distinguish between the state of the target 2 moving together with the effector 30 (target on the effector side) and the state of the target 2 moving together with the surrounding environment 4 (target on the surrounding environment 4 side).
  • a 3D model corresponding to the surrounding environment 4 is also stored in the memory unit 23, and this 3D model is also used in the interference calculation.
  • the processor 21 calculates the distance between the models based on the interference calculation program 23H using robot control commands such as the robot 10, effector 30, target 2, surrounding environment 4, and operation program 23B. In principle, the processor 21 safely stops the arm 10A if the result of the interference calculation falls below the allowable distance for approaching.
  • the processor 21 may be able to avoid interference by operating the arm 10A within the range of the effector constraints. For example, during jog or hand guide operations, interference may be likely to occur between the 3D model of the effector 30 and a 3D model corresponding to the surrounding environment 4. At this time, the processor 21 can move the arm 10A within the range of the effector constraints to avoid contact with the surrounding environment 4. If there were no effector constraints, the processor 21 would in principle stop the arm 10A, but being able to move as described above means that the jog or hand guide operation by the user is not interrupted. This configuration enables efficient and flexible jog and hand guide operations.
  • the memory unit 23 stores effector constraints, which are constraints on changes in the position and posture of the effector 30 as viewed from a specified reference coordinate.
  • the processor 21 also causes the robot 10 to perform operations constrained by the effector constraints set based on input from the user or an external device. This leads to accuracy, safety, efficiency, etc. of the robot 10's operations. For example, it becomes easier or more certain to set (avoid) postures that should be avoided depending on the type of effector 30 or target 2. It may also be possible to reduce or facilitate the effort required for the teaching or setting work described above. It may also lead to the creation or selection of an avoidance path that can improve cycle time while realizing operations of the arm 10A that can maintain the position and posture of the effector 30 in an appropriate state.
  • the control device 1 also includes an input unit 26 that allows the user to input effector constraint elements of the effector constraint. This configuration is useful for setting appropriate effector constraints for a wide variety of effectors 30 and a wide variety of tasks.
  • the effector constraint can set at least one of the effector constraint elements of the speed constraint, acceleration constraint, angular velocity constraint, and angular acceleration constraint as viewed from a specified reference coordinate of the effector 30.
  • This configuration is useful for setting appropriate effector constraints for a wide variety of effectors 30 and a wide variety of tasks.
  • by setting these effector constraint elements it may be possible to facilitate the setting of the operation settings or operation constraints of the arm 10A, for example, when setting a large number of teaching points for a complex task on the arm 10A.
  • Appendix 1 A processor; a storage unit for storing an effector constraint, which is a constraint on a change in at least one of a position and a posture of the effector of the robot as viewed from a predetermined reference coordinate; A control device in which the processor causes the robot to perform an action constrained by the effector constraints set based on input from a user or an external device.
  • Appendix 2 2. The control device according to claim 1, wherein the memory unit is capable of storing a plurality of the effector constraints.
  • Appendix 3 3. The control device according to claim 1, wherein the storage unit is capable of storing an effector constraint set formed by combining a plurality of the effector constraints.
  • Appendix 4 The control device described in Appendix 3, wherein the memory unit stores a plurality of operation programs for operating the robot and a plurality of effector constraint sets each corresponding to the plurality of operation programs.
  • Appendix 5 A processor; A storage unit; a display device that displays a setting screen for setting effector constraints, which are constraints on changes in at least one of the position and posture of the effector of the robot as viewed from a predetermined reference coordinate; A control device, wherein the setting screen is for setting the effector constraints based at least on a user's input.
  • Appendix 6 6. The control device according to claim 1, further comprising an input unit capable of inputting the effector constraint.
  • the storage unit stores a plurality of effector constraints; the effector constraints each correspond to at least one of a type of the effector and a type of target of the effector's action; A control device as described in any of appendix 1 to 6, wherein the processor sets the effector constraints based at least on at least one of information regarding the type of the effector and information regarding the type of the target, and user input.
  • the effector constraint comprises a plurality of effector constraint elements; The effector constraint can set a priority to at least one of the plurality of effector constraint elements; 7.
  • the processor operates the robot using at least the effector constraints including the priority.
  • the effector constraint comprises a plurality of effector constraint elements;
  • the control device according to any one of claims 1 to 6, configured to accept, for each of the plurality of effector constraint elements, a setting of a designated constraint that causes the processor to use a value designated by a user, or a setting of a dependent constraint that allows the processor to change the value.
  • the processor performs a simulation to cause the robot model to perform the movement using at least the effector constraints, and determines whether the movement satisfies a criterion.
  • [Appendix 12] 12 The control device of claim 11, wherein the processor modifies the effector constraints to satisfy the criteria when the operation does not satisfy the criteria.
  • Appendix 14 A processor; A storage unit; a display device that displays a setting screen for setting effector constraints, which are constraints on changes in at least one of the position and posture of the effector of the robot as viewed from a predetermined reference coordinate; the setting screen is for setting the effector constraint based at least on a user input,
  • the processor simulates causing the robot model to perform an action using at least the effector constraints, and determines whether the action satisfies a criterion.
  • Appendix 15 15. The computer of claim 14, wherein the processor modifies the effector constraints to satisfy the criteria when the action does not satisfy the criteria.
  • Control device 2 Target 10 Robot 10A Arm 11 Servo motor 11A Encoder 12 Movable part 21 Processor 22 Display device 23 Memory unit 23A System program 23B Operation program 23C Control program 23D Path generation program 23F Preset automatic setting program 23G Constraint modification program 23H Interference calculation program 24 Servo controller 25 Servo controller 26 Input unit 200 Screen (operation program) 300 to 309 Screens 401 to 412 Screens 421 to 427 Screen 500 Operation section

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Numerical Control (AREA)

Abstract

エフェクタの種類、エフェクタに要求される機能、対象の種類、作業の種類、作業に要求される機能等に応じた設定が可能となる技術が望まれている。　プロセッサと、ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約を格納する記憶部と、を備え、前記プロセッサは、ユーザ又は外部機器からの入力に基づき設定される前記エフェクタ制約によって制約された動作を前記ロボットに行わせる、制御装置。

Description

制御装置およびコンピュータ
　本開示は制御装置およびコンピュータに関する。
　産業用ロボットにおいて、ロボットに所望の動作をさせるために、一般的にユーザがロボットを教示する。ロボットの制御装置は教示に基づき経路を生成してロボットを動かす。一般的に、予め設定された動作指令に基づきユーザの操作なしでロボットが動くモードが自動運転モードやＡＵＴＯモード等と称される。また、一般的に、ユーザがロボットを教示する際は、ユーザは可搬式操作盤を用いてジョグ操作と呼ばれる操作を行う。ジョグ操作時は、ユーザはロボット、エフェクタ、ワークを含む対象等をよく観察しながら、ロボットが安全に動くよう配慮する必要がある。また、ユーザは、エフェクタが機能を発揮できるようエフェクタの姿勢についても配慮する必要がある。
　自動運転モード用の経路生成が行われる際、一般的にはサイクルタイムが重視される。また、ロボットの動作において地面に垂直な軸回りの回転だけを許容する等の制約が設定される場合がある。
　産業用ロボットにおいては、一般的に、ロボットが周囲の環境に干渉しないように、動作可能な領域または侵入不可能な領域が予め設定され、干渉しない範囲内だけでロボットを動作させる機能が知られている。ロボットや周囲の環境の３Ｄモデルを利用して、詳細な干渉計算を行う機能も知られている。例えば特許文献１を参照されたい。
　産業用ロボットにおいて、エフェクタの突起部が人などに向かないように経路生成する技術も知られている。例えば特許文献２を参照されたい。
特開２０１７－０９４４３０号公報 特開２０１６－１９６０６９号公報
　一例ではあるが、エフェクタが安全に機能を発揮するための、エフェクタの姿勢、位置等に適正な範囲がある場合、ロボットの経路がこれを満たしていることが望ましい。一例ではあるが、エフェクタの性質を反映した経路生成やジョグ操作が行われなければ、ワーク等の対象を落下させる等の望ましくない状況を引き起こす可能性がある。一例ではあるが、ロボットの先端部等に装着されるエフェクタは、物品ハンドリング用のハンドや吸盤、溶接用のトーチ、検査用のスキャナなど多種多様であり、エフェクタに合わせたロボットの動作が望ましい。一例ではあるが、エフェクタの姿勢を特定の状態に固定する設定では、経路生成やジョグ操作の選択肢が狭まり、効率的ではなく、サイクルタイムの低下の可能性もある。エフェクタの種類、エフェクタに要求される機能、対象の種類、作業の種類、作業に要求される機能等に応じた設定が可能となる技術が望まれている。
　本開示の第１の態様の制御装置は、プロセッサと、ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約を格納する記憶部と、を備え、前記プロセッサは、ユーザ又は外部機器からの入力に基づき設定される前記エフェクタ制約によって制約された動作を前記ロボットに行わせる。
　本開示の第２の態様の制御装置は、プロセッサと、記憶部と、ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約の設定画面を表示する表示装置と、を備え、前記設定画面は、ユーザの入力に少なくとも基づき前記エフェクタ制約を設定するためのものである。
　本開示の第３の態様のコンピュータは、プロセッサと、記憶部と、ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約の設定画面を表示する表示装置と、を備え、前記設定画面は、ユーザの入力に少なくとも基づき前記エフェクタ制約を設定するためのものであり、前記プロセッサは、前記エフェクタ制約に基づき前記ロボットのモデルに動作を行わせるシミュレーションを行い、前記動作が基準を満たしているか否かを判定する。
一実施形態のロボットを含むロボットシステムの概略図である。 本実施形態のロボットの制御装置の構成を示すブロック図である。 本実施形態のロボットに取付けられる様々なエフェクタの概略図である。 本実施形態のロボットに取付けられるエフェクタの動作の概略図である。 本実施形態の制御装置に設定されるエフェクタ制約の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置の機能の例を示すブロック図である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。 本実施形態の制御装置が表示する画面の例である。
　一実施形態のロボットの制御装置１が以下説明される。制御装置１は、ロボット１０のアーム１０Ａを制御するために設けられている（図１）。
　ロボット１０は特定の種類に限定されないが、本実施形態のロボット１０は６軸を有する多関節ロボットである。ロボット１０は５軸以下又は７軸以上を有する多関節ロボット、水平多関節ロボット、マルチリンクロボット等であってもよい。また、ロボット１０又はそのアーム１０Ａが、リニアガイド等の走行装置、ＡＧＶ（Automatic Guided Vehicle）、車両、歩行型ロボット等に支持されていてもよい。
　なお、ロボット１０が、視覚センサ、力センサ等の周知のセンサを用いて、周囲の人、物等との接触、近接等を回避できる協働ロボットであってもよい。
　アーム１０Ａは、互いに関節によって接続された複数の可動部１２と、複数の可動部１２をそれぞれ駆動する複数のサーボモータ１１と、を備えている（図１および図２）。各サーボモータ１１はその作動位置を検出するためのセンサ、エンコーダ１１Ａ等の作動位置検出装置を有する。本実施形態では、制御装置１はエンコーダ１１Ａの検出値を受信する。
　図１に示すように、例えばアーム１０Ａの先端部にハンド、ツール等のエフェクタ３０が取付けられ、アーム１０Ａは例えば搬送装置上の作業対象である対象２に作業を行うロボットシステムの一部である。
　前記作業は、対象２の取出し、対象２に対する処理、対象２への部品取付け等の公知の作業である。対象２に対する処理は、加工、塗装、洗浄等の公知の処理である。搬送装置は、コンベヤ、ＡＧＶ（Automatic Guided Vehicle）、製造中の車等の対象２を移動できるものであればよい。製造中の車の場合、シャーシ、タイヤ、モータ等が搬送装置として機能し、シャーシ上のボディ等である対象２が搬送される。対象２は、工業製品、食品等を含む物品、物品の一部、構造物の部分、動物、動物の一部、人の一部等の様々な対象であり得る。
　エフェクタ３０は、物品ハンドリング用の専用のハンド、吸盤等であってもよい。また、エフェクタ３０が、組み立て工程用の工具、スポット溶接用のガン、アーク溶接用のトーチ、検査システム用のスキャナなど多種多様な機器を備えていてもよい。このように、エフェクタ３０は特定のエフェクタに限定されない。
　エフェクタ３０がハンドの指等の動作部を有する場合、エフェクタ３０は動作部を駆動するサーボモータ３１を備えている（図２）。サーボモータ３１はその作動位置を検出するための作動位置検出装置を有し、作動位置検出装置は一例としてエンコーダである。作動位置検出装置の検出値は制御装置１に送信される。各サーボモータ１１，３１として、回転モータ、直動モータ等の各種のサーボモータが用いられ得る。
　エフェクタ３０は主にアーム１０Ａの先端部に取付けられるが、アーム１０Ａの長手方向の中間部分や基端部に取付けられてもよい。ロボット１０と人との間でワークの受け渡しが行われるシステムにおいては、図３のように、エフェクタ３０としての対象２を把持するハンド又は吸盤、磁石、電磁石等を用いて対象２を吸引するハンドが用いられることが多い。代わりに、対象２がエフェクタ３０としてのコンテナ又は平板状のトレイに置かれる場合もある。また、対象２がエフェクタ３０としての箱やかごに入る場合もある。
　近年では可撓性を有する指で柔らかく把持するハンド等が普及しており、当該ハンドもエフェクタ３０の一例である。
　前述のエフェクタ３０は、エフェクタとして機能するための適切な姿勢が限定的である場合がある。図４のように、例えば吸盤、磁石、電磁石を用いるハンドであるエフェクタ３０は、対象２を上方等の所定の方向から吸引できないと、対象２の保持が確実でなくなる場合がある。また、例えばトレイであるエフェクタ３０に対象２を載せる場合は、当然に対象２が落ちないようにユーザが配慮する必要がある。
　制御装置１は、図２に示すように、ＣＰＵ、マイクロコンピュータ、画像処理プロセッサ等の１つ又は複数のプロセッサ素子を有するプロセッサ２１と、表示装置２２と、を有する。また、制御装置１は、不揮発性ストレージ、ＲＯＭ、ＲＡＭ等を有する記憶部２３を有する。
　また、制御装置１は、ロボット１０のサーボモータ１１にそれぞれ対応しているサーボ制御器２４と、エフェクタ３０のサーボモータ３１に対応しているサーボ制御器２５と、を有する。制御装置１は、制御装置１に有線又は無線によって接続された入力部２６も有する。一例では、入力部２６はユーザが持ち運べるポータブル操作盤等の入力装置である。他の例では入力部２６はタブレットコンピュータである。ポータブル操作盤、タブレットコンピュータ等の場合は前記入力がタッチスクリーン機能を用いて行われる。ポータブル操作盤又はタブレットコンピュータが表示装置２２を有する場合もある。
　記憶部２３はシステムプログラム２３Ａを格納しており、システムプログラム２３Ａは制御装置１の基本機能を担っている。また、記憶部２３は単一又は２以上の動作プログラム２３Ｂを格納している。動作プログラム２３Ｂは、ロボットを動作させるための複数の指令、情報等を含む。本実施形態の動作プログラム２３Ｂは、複数の教示点の座標および姿勢の情報、教示点間の動きに関する指令等を少なくとも含む。
　記憶部２３は、制御プログラム２３Ｃ、経路生成プログラム２３Ｄ、等も格納している。制御プログラム２３Ｃは、公知のフィードバックプログラム、フィードフォワードプログラム等である。
制御装置１は、経路生成プログラム２３Ｄを用いて動作プログラム２３Ｂに基づき経路を生成し、制御プログラム２３Ｃを用いて経路の通りに動けるように制御指令を生成し、アーム１０Ａを制御する。
　なお、ロボット１０のアーム１０Ａの位置および姿勢を教示する際、空間に対して動かない基準となるロボットの基準座標系１０１（図１）から見た座標を前記教示点等として指定することが一般的である。エフェクタ３０が無い状態では、アーム１０Ａの先端のフランジ面（メカニカルインターフェース）に設定された座標系の位置および姿勢が前記教示点等として一般的に指定される。エフェクタ３０がある状態では、エフェクタ３０の所定位置等にエフェクタ座標系１０２（図１）が設定される場合がある。この場合、エフェクタ座標系１０２の位置および姿勢が前記教示点等として一般的に指定される。
　なお、本実施形態では、アーム１０Ａの先端に設定される座標系もエフェクタ座標系１０２であると見なし、上記のフランジ面に設定される座標系もエフェクタ座標系１０２として扱う。
　本実施形態では、基準座標系１０１と、エフェクタ３０に対して相対的に動かないエフェクタ座標系１０２とが設定される。エフェクタ座標系１０２はツール座標系等の他の名称で呼ばれる場合もある。制御装置１は、周知のキャリブレーション等によって、基準座標系１０１におけるエフェクタ座標系１０２の位置および姿勢を認識している。
　本実施形態では、ユーザは基準座標系１０１に対するエフェクタ座標系１０２の相対変化を制約するエフェクタ制約を設定できる。
　図５にエフェクタ制約の設定の例が示されている。図５のように、エフェクタ制約の第１の例は、エフェクタ座標系１０２の位置座標(Ｘ，Ｙ，Ｚ)の制約である。エフェクタ制約の第２の例は、エフェクタ座標系１０２の姿勢(Ｘ軸周り＝θｘ、Ｙ軸周り＝θｙ、Ｚ軸周り＝θｚ)の制約である。なお、図５の例では、“０”が上限にも下限にも入力されている箇所は変化を許容しないことを意味する。エフェクタ制約が設定されていないことが“‐”等で表現されてもよい。
　第１の例のエフェクタ座標系１０２の前記相対変化の制約は、基準座標系１０１、エフェクタ座標系１０２、又は他の座標系の位置および姿勢を基準として設定され得る。なお、基準座標系１０１、エフェクタ座標系１０２、又は他の座標系は所定の座標系であり、これが以下の説明で単に座標系と称される場合がある。第２の例のエフェクタ座標系１０２の姿勢の制約も座標系の位置および姿勢を基準として設定され得る。なお、エフェクタ座標系１０２の位置および姿勢の制約が、アーム１０Ａがある動作を開始する前のエフェクタ座標系１０２の位置および姿勢を基準として設定されてもよい。
　図５のように、エフェクタ制約の第３の例は、エフェクタ座標系１０２の速度の制約である。当該速度は、例えば、座標系におけるエフェクタ座標系１０２の進行方向の速度、または、Ｘ方向、Ｙ方向、およびＺ方向のそれぞれの速度である。エフェクタ制約の第４の例は、エフェクタ座標系１０２の角速度の制約である。当該角速度は、座標系におけるエフェクタ座標系１０２のある軸線周りの角速度、または、Ｘ軸、Ｙ軸、およびＺ軸周りの角速度である。
　図５のように、エフェクタ制約の第５の例は、エフェクタ座標系１０２の加速度の制約である。当該加速度は、例えば、座標系におけるエフェクタ座標系１０２の進行方向の加速度、または、Ｘ方向、Ｙ方向、およびＺ方向のそれぞれの加速度である。エフェクタ制約の第６の例は、エフェクタ座標系１０２の角加速度の制約である。当該角加速度は、座標系におけるエフェクタ座標系１０２のある軸線周りの角加速度、または、Ｘ軸、Ｙ軸、およびＺ軸周りの角加速度である。エフェクタ制約の第３～第６の例も、エフェクタ３０の位置および姿勢の少なくとも一方の変化の制約である。
　エフェクタ制約は前記第１～第６の例の何れか２つ以上の組合せであってもよい。また、位置および／又は姿勢を3回以上時間微分した量に相当する値や式等を用いてもよい。また、エフェクタ制約は、エフェクタ座標系１０２の位置および／又は姿勢の所定の基準座標に対する変化の制約であればよい。なお、エフェクタ座標系１０２の位置および／又は姿勢の所定の基準座標に対する変化は、エフェクタの位置および／又は姿勢の所定の基準座標に対する変化である。また、第３～第６の例の角速度、各加速度等の制約も、エフェクタの位置および／又は姿勢の所定の基準座標から見た変化の制約である。
　本実施形態の典型的な例では、動作プログラム２３Ｂにおいて、各教示点について、座標および姿勢の情報と、前記指令と、エフェクタ制約とが設定される。制御装置１のプロセッサ２１が表示装置２２に表示させる図７の画面２００では、教示点１（位置姿勢［１］）および教示点２（位置姿勢［２］）にはエフェクタ制約が設定されていない。一方、教示点３（位置姿勢［３］）および教示点４（位置姿勢［４］）には後述のエフェクタ制約１および２がそれぞれ設定されている。好ましくは、図６の画面２００は、エフェクタ制約の設定に関する画面を表示するための操作を受付ける画面である。当該操作は、画面２００上の所定の位置のタップ、所定のボタンである。当該ボタンが入力部２６に設けられていてもよい。
　例えば、画面２００の教示点３の“なめらか”の右のエリアをユーザがタップすると、図６に示すエフェクタ制約の設定画面２１０があらわれる。設定画面２１０で後述のエフェクタ制約又はエフェクタ制約セットが選択され得る。当該操作が繰り返されると、図７に示すように任意の教示点にエフェクタ制約又はエフェクタ制約セットが設定される。
　一例では、ユーザは、エフェクタ制約として、座標系と、基準座標に対するエフェクタ座標系１０２の位置変化および姿勢変化の制約とを設定できる。好ましくは、このような設定をユーザが編集できる入力部２６は、ティーチペンダントとも称される可搬式操作盤に備えられている。エフェクタ制約等の設定は記憶部２３、もしくは別途の制御装置の記憶装置、クラウド上の記憶部等の所定の記憶部に格納される。エフェクタ制約が別途の制御装置の記憶装置、クラウド上の記憶部等に格納される場合、これらの記憶装置および記憶部は制御装置１の記憶部として機能する。
　エフェクタ制約の設定のため、例えば入力部２６の表示装置２２に前記設定に関する画面が表示される。例えば、制御装置１のプロセッサ２１は表示装置２２に図８に示される画面３００を表示させる。画面３００は、ユーザがエフェクタ制約の設定画面への遷移を選択するための画面である。
　表示装置２２には、前記選択等を行う操作部５００が表示される。操作部５００には、方向キー、決定キー、遷移前の画面又は上位レイヤーの画面に戻るための戻るキー等が表示され、ユーザはこれらのキー操作を用いて入力を行う。なお当該機能に対応したボタンが入力部２６に設けられてもよい。
　画面３００においてユーザがエフェクタ制約の設定画面への遷移を選択すると、プロセッサ２１は表示装置２２に図９の画面３０１を表示させる。画面３０１は、ユーザが基準座標系の設定画面への遷移を選択するための画面である。
　画面３０１においてユーザが基準座標系の設定画面への遷移を選択すると、プロセッサ２１は表示装置２２に図９の画面３０２を表示させる。画面３０２は、ユーザが複数の基準座標系のうち任意の基準座標系の設定を選択するための画面である。
　画面３０２においてユーザが複数の基準座標系のうち例えば基準座標系１を選択すると、プロセッサ２１は表示装置２２に図９の画面３０３を表示させる。画面３０３は、ユーザが選択した基準座標系１の設定をするための画面である。画面３０３に示すように、ユーザは基準座標系１の位置および姿勢を設定できる。
　なお、画面３０２においてユーザが基準座標系２を選択すると、プロセッサ２１は表示装置２２に図１０の画面３０３を表示させる。図１０では、ユーザは、選択した基準座標系２の設定をすることができる。基準座標系１，２等によってそれぞれ設定された座標系は基準座標系１０１として用いられ得る。
　本実施形態では、ユーザは画面３０２，３０３を用いて複数の基準座標系を設定できる。当該構成は、後述のエフェクタ制約の設定の自由度を向上する上で有用である。
　図１１に示すように画面３０１に戻った状態で、ユーザがエフェクタ座標の設定画面への遷移を選択すると、プロセッサ２１は表示装置２２に図１１の画面３０４を表示させる。画面３０４は、ユーザが複数のエフェクタ座標のうち何れかのエフェクタ座標の設定を選択するための画面である。
　画面３０４においてユーザが複数のエフェクタ座標のうち例えばエフェクタ座標１を選択すると、プロセッサ２１は表示装置２２に図１１の画面３０５を表示させる。画面３０５は、ユーザが選択したエフェクタ座標１の設定をするための画面である。画面３０５に示すように、ユーザはエフェクタ座標１の位置および姿勢を設定できる。
　なお、画面３０４においてユーザがエフェクタ座標２を選択すると、プロセッサ２１は表示装置２２に図１２の画面３０５を表示させる。図１２では、ユーザは、選択したエフェクタ座標２の設定をすることができる。
　本実施形態では、ユーザは画面３０４，３０５を用いて複数のエフェクタ座標を設定できる。当該構成は、後述のエフェクタ制約の設定の自由度を向上する上で有用である。
　図１３に示すように画面３０１に戻った状態で、ユーザがエフェクタ制約の設定画面への遷移を選択すると、プロセッサ２１は表示装置２２に図１３の画面３０６を表示させる。画面３０６は、ユーザが複数のエフェクタ制約のうち任意のエフェクタ制約の設定を選択するための画面である。
　画面３０６においてユーザが複数のエフェクタ制約のうち例えばエフェクタ制約１を選択すると、プロセッサ２１は表示装置２２に図１３の画面３０７を表示させる。画面３０７は、ユーザが選択したエフェクタ制約１の設定をするための画面であり、ユーザは画面３０７を用いてエフェクタ制約を設定できる。エフェクタ制約は、エフェクタ３０に対し固定されたエフェクタ座標系１０２の所定の基準座標から見た変化を制約するためのものである。
　より具体的に、画面３０７に示すように、ユーザはエフェクタ制約１の基準となる基準座標系を設定できる。エフェクタ制約２も同様に設定され得る。基準座標系が常に固定である場合、基準座標系１０１を用いる場合等は、画面３０７における基準座標系の設定は省くことも可能である。
　また、画面３０７に示すように、ユーザはエフェクタ制約ごとにエフェクタ座標を設定できる。画面３０７ではエフェクタ制約１にエフェクタ座標１が設定されている。エフェクタ制約２についても同様に例えばエフェクタ座標２が設定される。エフェクタ制約は、設定されたエフェクタ座標（所定の基準座標）から見たエフェクタ３０の位置および／又は姿勢の変化の制約をするものである。このため、上記のようにエフェクタ座標を設定又は選択できる構成と、ユーザはエフェクタ制約ごとにエフェクタ座標を設定できる構成は、それぞれユーザによる設定の自由度の向上に繋がる。また、エフェクタ制約ごとに後述のエフェクタ制約要素が設定される。
　図１１および図１２の画面３０５では、設定されたエフェクタ座標のエフェクタ３０の位置および姿勢が図で示されている。図１１ではエフェクタ座標１がエフェクタ座標系１０２に対し斜め上方に設定され、図１２ではエフェクタ座標２がエフェクタ座標系１０２に対し水平方向に異なる位置に設定されている。
　上記の画面２００の動作プログラム２３Ｂの例では、教示点３（位置姿勢［３］）にエフェクタ制約１が設定されている。プロセッサ２１は、エフェクタ３０が動作プログラム２３Ｂに基づき移動するようにアーム１０Ａを動作させる。この場合、例えば教示点２（位置姿勢［２］）と教示点３との間において、エフェクタ座標１（所定の基準座標）から見たエフェクタ座標系１０２の位置および姿勢の変化がエフェクタ制約１で設定されたエフェクタ制約要素によって制約される。プロセッサ２１が当該制約を教示点３と教示点４との間で適用する場合もあり得る。同様に、教示点４に関して、エフェクタ座標２（所定の基準座標）から見たエフェクタ座標系１０２の位置および姿勢の変化がエフェクタ制約２で設定されたエフェクタ制約要素によって制約される。
　ここで、教示点３にあるエフェクタ３０に対するエフェクタ座標１（所定の基準座標）の位置は、図１１の画面３０５に示されるエフェクタ座標１のエフェクタ３０の位置に対応している。エフェクタ座標２（所定の基準座標）の位置も同様に設定され得る。
　なお、所定の基準座標として教示点や教示点間の通過点が用いられる場合もあり得る。つまり、動作プログラム２３Ｂによって動いているエフェクタ３０の各教示点や各通過点における位置および姿勢の変化が、その教示点や通過点の位置および姿勢から見てエフェクタ制約要素の範囲内となるように制御される。
　所定の基準座標として教示点や教示点間の通過点が用いられる場合、図１１および図１２の画面３０５の設定は不要となり、図１３の画面３０７のエフェクタ座標の設定も不要となる。図１３の画面３０７が、エフェクタ座標１を教示点又は通過点の位置および姿勢とする設定を受付けるように構成されていてもよい。
　なお、エフェクタ制約のエフェクタ制約要素は、エフェクタ３０の位置の変化が許容される範囲を示しているとも言える。典型的には、前述の構成でプロセッサ２１がアーム１０Ａを動作させる時、エフェクタ制約によってエフェクタ３０の位置の変化が許容される範囲内に、エフェクタ３０（エフェクタ座標系１０２）の実際の位置および姿勢が配置される。
　また、エフェクタ制約１の対象が区間となる場合もあり得る。この場合例えば、画面３０７において、“エフェクタ制約の適用範囲”の項目が表示され、“エフェクタ制約の範囲”の右に当該エフェクタ制約の対象の教示点番号等をユーザが入力する。教示点番号が連続した複数の番号である場合、その区間がエフェクタ制約１の対象となる。
　また、動作プログラム２３Ｂの内部にてエフェクタ制約を開始/終了するように記述することによってエフェクタ制約の対象の区間が指定されてもよい。
　また動作プログラム２３Ｂによらず、常に適用されるエフェクタ制約が設定されてもよい。
　またエフェクタ制約ごとに、常に適用される動作プログラム２３Ｂが設定されてもよい。
　なお、図１３に示す画面３０７で、“エフェクタ制約の適用範囲”として例えば空間又はアーム１０Ａの姿勢タイプが設定されてもよい。例えば、図１３の破線３０７Ａの範囲はＸ－Ｚ方向の範囲を示しているが、当該範囲でＹ方向にも例えば数十ｃｍ程度の範囲が設定され得る。画面３０７でユーザが当該空間を選択によって“エフェクタ制約の適用範囲”の右側に入力すると、当該空間がエフェクタ制約１の適用範囲として設定される。同様に画面３０７にアーム１０Ａの複数の姿勢タイプが表示され、選択された姿勢タイプが“エフェクタ制約の適用範囲”の右側に入力されてもよい。この場合、アーム１０Ａの姿勢が当該姿勢タイプに該当する間はエフェクタ制約１が適用される。なお、エフェクタ制約の対象となる経路をユーザが画面３０７で設定できる構成も採用し得る。
　なお、動作プログラム２３Ｂの各教示点に設定されたエフェクタ制約やその他の設定されたエフェクタ制約に基づき、制御装置１が自動的にエフェクタ制約を設定することも可能である。この自動的に設定されるエフェクタ制約も、ユーザが各教示点に対し設定したエフェクタ制約に基づくので、ユーザの入力に基づき設定されるエフェクタ制約である。
　また、アーム１０Ａが動作できる空間、アーム１０Ａがエフェクタ３０を用いて対象２対して行う作業の内容等をユーザが制御装置１に教示し、当該教示に基づきアーム１０Ａが前記作業を行う場合もあり得る。例えばバーカウンターにアーム１０Ａが配置される場合が考えられる。前記作業は、アーム１０Ａがハンドであるエフェクタ３０を用いてコップ等の対象２を保持する作業、保持した対象２をカウンターの客に対応する位置に提供する作業等である。
　この場合、例えばアーム１０Ａの作業範囲を観察する視覚センサが設けられ、制御装置１は視覚センサの出力に基づきエフェクタ３０の位置、対象２の位置、前記空間内において動きがある周囲環境４、前記客を含む接近物等を認識する。制御装置１は、周囲環境４および接近物の存在範囲を認識しながら、前記作業のためにエフェクタ３０が動く経路を逐次計算する。この場合でも、プロセッサ２１は、前記経路の生成時に前記空間に設定されたエフェクタ制約を適用できる。
　また、画面３０７に示すように、ユーザはエフェクタ制約１として、エフェクタ３０のＸ，Ｙ，Ｚ方向の移動可能範囲を設定できる。画面３０７は“基準”を設定できる。当該“基準”は、例えば基準座標系１、基準座標系１０１、エフェクタ座標系１０２等における座標で示される。画面３０７は“上限”および“下限”を設定できる。当該“上限”および“下限”は、例えば“基準”の座標に対する移動可能量又は移動可能範囲である。本実施形態では“基準”、“上限”、および“下限”を有するＸ，Ｙ，Ｚ方向の各々の移動可能範囲がエフェクタ制約要素と称される。同様に、ユーザはエフェクタ制約１として、エフェクタ３０のＸ，Ｙ，Ｚ軸周りの回転移動可能範囲、角速度、および角加速度と、Ｘ，Ｙ，Ｚ方向の速度および加速度とを設定できる。Ｘ，Ｙ，Ｚ軸周りの各々の回転移動可能範囲、速度、加速度、角速度、角加速度、位置または姿勢を3回以上時間微分した量に相当する値や式等もエフェクタ制約要素と称される。
　なお、画面３０７のエフェクタ座標として設定されたエフェクタ座標１の位置および姿勢が“基準”として用いられる場合、“基準”が制御装置１によって自動的に設定される場合等は、“基準”の入力や表示が省かれ得る。また、全てのエフェクタ制約要素を設定する必要はなく、その一部が固定されている場合、制御装置１によって自動的に設定される場合等もある。
　本実施形態では、ユーザが“基準”を任意に設定可能に構成されている。このため、ユーザは、各教示点で設定したエフェクタ３０の位置および姿勢や画面３０７で設定されたエフェクタ座標１の位置および姿勢と異なる位置および姿勢を、“基準”として設定できる。当該構成は、ユーザによる設定の自由度の向上、アーム１０Ａの動作の正確性、安全性、効率化等に繋がる。例えば、エフェクタ３０の種類ごとに好ましい姿勢がある場合等に、ユーザはエフェクタ３０のニュートラルな姿勢としてＸ，Ｙ，Ｚ軸周りの各々の“基準”を設定できる。また、プロセッサ２１がエフェクタ３０の位置および姿勢を“基準”に近付ける制御（本稿にて復元動作制御と称する）を行うように構成することも可能である。これらの構成によって、教示作業の手間の低減、容易化等を図りながら、アーム１０Ａの動作の正確性、安全性、効率化等の向上が可能となる。
　なお、本実施形態において、アーム１０Ａの動作の効率化には、アーム１０Ａの動作のサイクルタイムの向上等が含まれる。
　本実施形態では、図１５に示すように画面３０１に戻った状態で、ユーザがエフェクタ制約セットの設定画面への遷移を選択すると、プロセッサ２１は表示装置２２に図１５の画面３０８を表示させる。画面３０８は、ユーザが複数のエフェクタ制約セットのうち任意のエフェクタ制約セットの設定を選択するための画面である。
　画面３０８においてユーザが複数のセットのうち例えばセット１を選択すると、プロセッサ２１は表示装置２２に図１５の画面３０９を表示させる。画面３０９は、ユーザが選択したエフェクタ制約セット１の設定をするための画面であり、ユーザは画面３０９を用いてエフェクタ制約セットを設定できる。エフェクタ制約セットは、複数のエフェクタ制約を関係付けることができる。
　より具体的に、画面３０９に示すように、ユーザは、エフェクタ制約セット１に任意に選択されたエフェクタ制約１～３を組み込むことができ、また、エフェクタ制約１～３の各々の有効又は無効を設定できる。また、ユーザは、複数のエフェクタ制約１～３の関係付けを“１∩２∩３”のように設定できる。“１∩２∩３”はエフェクタ制約１、且つ、エフェクタ制約２、且つ、エフェクタ制約３の意味である。例えば、図７の画面２００の“エフェクタ制約”の列に“エフェクタ制約１”等の代わりに“エフェクタ制約セット１”を設定することができる。
　当該構成は、ユーザによる設定の自由度の向上に繋がる。また、当該構成によって、ユーザは画面３０７で設定された複数のエフェクタ制約を整理して適用することが可能となり、これはアーム１０Ａの動作の正確性、安全性、効率化等に繋がる。なお、本実施形態では、画面３０６、３０７等は各エフェクタ制約および各エフェクタ制約要素の有効又は無効を設定できる。必要性に応じて画面３０９の設定を省くことも可能である。
　図１４に示すように、プロセッサ２１は、経路生成プログラム２３Ｄを用いて、動作プログラム２３Ｂ等に基づき、エフェクタ座標系１０２の位置および姿勢を直前の教示点から対象教示点に移動する経路作成を行う。例えば、プロセッサ２１は、直前の教示点と対象教示点との間に関する周知の補間演算を行いながら、前記経路作成を行う。
　この際、プロセッサ２１は、動作プログラム２３Ｂのエフェクタ制約および／又は前述のように空間（範囲）に設定されたエフェクタ制約がある場合は、エフェクタ制約も適用しながら前記経路作成を行う。なお、本実施形態において、前記経路作成は、経路の作成又は経路の生成と説明される場合がある。
　そして、プロセッサ２１は、作成された経路に応じた制御指令を各サーボ制御器２４に送信する。
　ロボット１０が前記協働ロボットの場合でもプロセッサ２１は同様の処理を行う。また、協働ロボットの場合、プロセッサ２１は回避対象を回避するための回避経路の生成を行う場合もある。
　エフェクタ制約の範囲内であればどのような状態も取り得る設定がされてもよい。または、エフェクタ３０に適した状態がある場合は、当該状態がニュートラルな状態として設定されてもよい。例えばエフェクタ制約としてＸ軸周りに±５ｄｅｇの制約がある場合で、好適な状態を設定していないと、経路生成の結果、エフェクタ３０が最終的に傾いたままとなる可能性がある。例えば０ｄｅｇがニュートラルな状態として設定されると、プロセッサ２１は例えばエフェクタ３０の最終的な姿勢を前記０ｄｅｇに近付け、又は、戻す。
　なお、ユーザが後述のジョグ操作又はハンドガイド操作を用いて各教示点を設定する時に、各教示点の設定時のエフェクタ３０の位置および姿勢がニュートラルな状態として設定されてもよい。例えば、ユーザがハンドガイド操作によってエフェクタ３０を第１の位置および姿勢に配置し、そこで例えば入力部２６で教示点設定のための操作を行う。これにより、例えば画面２００の教示点１用に第１の位置および姿勢が設定される。ユーザは教示点２以降も同様に設定できる。ユーザは、ジョグ操作又はハンドガイド操作を用いて各教示点を設定する場合に、実際のエフェクタ３０の位置および姿勢をアーム１０Ａの作業時のイメージに合わせて配置する場合がある。このため、上記の第１の位置および姿勢等が各教示点におけるニュートラルな状態として設定される構成は、ユーザの手間の低減と、アーム１０Ａの動作の正確性、安全性、効率化等との両立のために有用である。
　プロセッサ２１はアーム１０Ａを制御してエフェクタ３０の位置および姿勢をニュートラルな状態に戻す復元動作制御を行う。復元動作制御は、例えば一定の速度又は角速度、一定の加速度又は角加速度、ニュートラルな状態からの乖離量等に応じて計算される値の少なくとも１つを用いて行われる。復元動作制御を行うために、前記乖離量に応じてバネのように作用するバネ的変数が用いられてもよい。また、復元動作制御を行うために、前記乖離量の変化速度又は変化角速度に応じてダンパのように作用するダンパ的変数が用いられてもよい。復元動作制御を行うために、前記乖離量の変化加速度又は変化角加速度に応じて慣性力のように作用する慣性的変数が用いられてもよい。これらの変数の組み合わせが用いられても良い。
　例えば物品ハンドリングの例として、対象２を簡易なトレイ形状のエフェクタ３０に乗せて運ぶことが挙げられる。トレイ形状であるので、当然エフェクタ３０の傾き、不適切な速度等により、対象２が落下する可能性がある。
　例えば、画面３０５および画面３０７によってエフェクタ座標１の位置が対象２の重心より少し上に設定されると共に、姿勢、角速度、角加速度の制約が設定される。
　当該設定に基づき、プロセッサ２１はある位置姿勢から他の位置姿勢までのエフェクタ座標系１０２（エフェクタ３０）の経路を生成する。この際、対象２を乗せたエフェクタ３０がエフェクタ制約で設定されたニュートラル状態の位置および姿勢を中心に振り子のように動く傾向が出る。これにより、対象２の位置では大きな傾きや加速度が制限され、さらに振り子動作により生じる遠心力によって対象２がエフェクタ３０に押し付けられ、これらは対象２の落下防止に繋がる。
　他の例では、ユーザは、エフェクタ制約要素の設定において、エフェクタ３０の上下方向に対応する方向且つ上記遠心力に対応する方向の加速度の許容範囲だけある値に設定できる。また、ユーザは、他の方向の加速度の許容範囲を前記値の１／５以下等の十分に小さい値に設定できる。この場合も、エフェクタ３０が振り子のように動く傾向が出る。
　なお、エフェクタ制約における姿勢の制約は、オイラー角表記に限られず、クォータニオン表記等も採用され得る。また、制約がスカラ値である必要は無く、関数として設定されていてもよい。アーム１０Ａの位置、姿勢等に応じてエフェクタ制約が切り替わる設定がされてもよい。アーム１０Ａの状態(対象２を保持しているか否か等)に応じてエフェクタ制約が切り替わる設定がされてもよい。
　ロボットの教示が行われる際、通常は各教示点やエフェクタ３０の経路の全体に亘って６自由度分の位置姿勢(Ｘ，Ｙ，Ｚ，θｘ，θｙ，θｚ)が指定される。エフェクタ制約が設定されている場合、エフェクタ制約に位置および姿勢を指定する作用があるため、通常の教示とは異なる位置および姿勢の教示が可能となる。
　例えば物品ハンドリングの多くの場合において、対象２を拾う際と置く際は正確な位置決めが必要であるが、それ以外の位置ではエフェクタ３０の凡その位置および姿勢が決まっていればよい。凡その位置(Ｘ，Ｙ，Ｚ)で良いケースであっても、従来の教示方法では６軸分の位置および姿勢(Ｘ，Ｙ，Ｚ，θｘ，θｙ，θｚ)を指定する必要がある。エフェクタ制約で姿勢(θｘ，θｙ，θｚ)が制約されている場合は、教示は位置の情報(Ｘ，Ｙ，Ｚ)さえあればよい。この場合、ある位置から他の位置までの経路が、エフェクタ制約の姿勢の制約内で生成される。
　好ましくは、元々の教示位置とエフェクタ制約のどちらを用いるかを動作プログラム２３Ｂの中で選択できる構成が採用される。例えば、図７の画面２００に、各教示点や経路の各区間について、エフェクタ制約を動作プログラム２３Ｂの教示点の指定よりも優先するか否かを設定するための“制約優先”の列が加えられる。この場合、ユーザは動作プログラム２３Ｂとエフェクタ制約の何れを優先するかを容易且つ確実に設定できる。なお、エフェクタ３０の位置および姿勢(Ｘ，Ｙ，Ｚ，θｘ，θｙ，θｚ)が動作プログラム２３Ｂの教示位置および教示姿勢とエフェクタ制約のどちらで制約されるかは、上記の例に限定されない。
　上記の構成は、各教示点における制約の設定の低減に繋がる。また、上記の構成は、エフェクタ制約があることによって、エフェクタ３０の位置および姿勢を適正な状態に保つことができるアーム１０Ａの動作を実現し、これはサイクルタイムの向上を図れる経路の作成、選択等に繋がり得る。
　なお、図１３の画面３０６，３０７に示すように、本実施形態では複数のエフェクタ制約を設定できるが、１つのエフェクタ制約だけが設定できる構成も採用され得る。なお、基準座標系と、エフェクタ座標と、エフェクタ制約要素とからなるセットを１つ備えることでエフェクタ制約の機能が発揮されるが、１つのエフェクタ制約によって様々な機能を表現することは難しい場合がある。そこで、図１３の画面３０６，３０７に示すように、エフェクタ制約を複数設定できる構成が採用されてもよい。また、複数のエフェクタ制約を各々の対象の区間、範囲、又は教示点等の点で適用できるように設定できる構成が採用されてもよい。
　以下の例ではエフェクタ制約セットが設定される。例えば、ユーザは、１つ目のエフェクタ制約として、画面３０５，３０６，３０７を用いてエフェクタ制約１を設定する。その際に、ユーザは、空間に対して動かない位置に基準座標系１を設定し、エフェクタの重心の上方部にエフェクタ座標１を設定する。エフェクタ制約１ではエフェクタ３０の並進運動と回転運動を許容するように制約が設定される。またエフェクタ制約１では角速度および角加速度の制約も設定される。なお、ユーザが画面３０７において対応するタグを選択すると、角速度、角加速度等の設定が可能となる。
　ユーザは、２つ目のエフェクタ制約として、画面３０５，３０６，３０７を用いてエフェクタ制約２を設定する。その際に、ユーザは、エフェクタ座標２の位置および姿勢を基準座標系２の位置および姿勢として設定し、エフェクタの重心の下方部にエフェクタ座標２を設定する。エフェクタ制約２では並進および回転が許容されない。
　ユーザは、３つ目のエフェクタ制約として、画面３０５，３０６，３０７を用いてエフェクタ制約３を設定する。その際に、ユーザは、基準座標系１に対し、エフェクタ座標２の位置および姿勢を制約する。エフェクタ制約３では並進運動と回転運動を許容するように制約が設定される。またエフェクタ制約３では並進の速度と加速度が制約される。
　当該設定に基づき経路が生成されると、図１１および図１２のように対象２を乗せたトレイ形状のエフェクタ３０がエフェクタ座標１で並進移動し、振り子のように動く。また、エフェクタ座標２の位置では大きな並進加速度が制限される。当該設定は対象２の落下を防止するために有利である。当該設定はあくまでも一つの例であり、設定内容は上記の例に限られず、エフェクタ制約は任意の数だけ設定され得る。
　以下の例ではエフェクタ制約セットの他の設定例が説明される。例えば、ユーザは、１つ目のエフェクタ制約として、画面３０５，３０６，３０７を用いてエフェクタ制約１を設定する。その際に、ユーザは、空間に対して動かない位置に基準座標系１を設定する。また、ユーザは、図１に示す関節３Ｃの回転軸線Ｊ３の上にエフェクタ座標１を設定すると共に、エフェクタ制約１を設定する。エフェクタ制約１は並進運動と回転運動を許容するようにエフェクタ制約要素が設定される。またエフェクタ制約１では角速度と角加速度が制約される。
　ユーザは、２つ目の制約として、画面３０５，３０６，３０７を用いてエフェクタ制約２を設定する。その際に、ユーザは、エフェクタ座標１を基準座標系２として設定し、エフェクタの重心の下方部にエフェクタ座標２を設定する。エフェクタ制約２では並進運動と回転運動が許容されるようにエフェクタ制約要素が設定される。
　ユーザは、３つ目のエフェクタ制約として、画面３０５，３０６，３０７を用いてエフェクタ制約３を設定する。その際に、ユーザは、基準座標系１に対しエフェクタ座標２を制約する。エフェクタ制約３では並進運動が許容されるようにエフェクタ制約要素が設定される。またエフェクタ制約３では並進の速度と加速度を制約するようにエフェクタ制約要素が設定される。
　通常ロボットは、図１の関節３Ｂをその回転軸線Ｊ２周りに動かそうとする際には関節３Ｃも回転軸線Ｊ３周りに対称的に動き、手首軸の姿勢を維持するように動くことがある。一方、回転軸線を動かそうとした際にはこの作用が無いことが多い。関節３Ｂと関節３Ｃとの間の可動部１２（Ｊ２アーム）と手首の姿勢をそのままにして、回転軸線Ｊ３周りの動作を行うことは従来の設定では難しい。
　上記の他の設定例のエフェクタ制約セットが設定されると、回転軸線Ｊ３周りの回転動作が行われる際、エフェクタ座標２の位置では回転が制限される。当該構成および設定は、対象２の落下防止のために有用である。
　ユーザがエフェクタ制約を複数に分けて設定することで、ユーザの考え等に応じて動作を切り分けやすくなり、エフェクタ制約の設定もユーザに分かり易くなる。当該構成は、ロボットのリスクアセスメントのために有用であり、アーム１０Ａの動作の教示や設定に関するミスを減らすためにも有用である。
　本実施形態において、基準座標系、エフェクタ座標、エフェクタ制約のセットを１つの単位のエフェクタ制約と称する場合がある。また、エフェクタ制約は、位置、速度、加速度等の個々の制約をまとめたものであり、個々の制約をエフェクタ制約要素と称する。また、エフェクタ制約が複数用意されていても良く、プロセッサ２１は記憶部２３から必要なエフェクタ制約を呼び出して使用する。
　様々なアーム１０Ａの状態に応じた複数のエフェクタ制約セットが準備されていてもよい。アーム１０Ａの状態は、エフェクタ３０のタイプ、対象２のタイプ、アーム１０Ａのタイプ等により差が生ずる。エフェクタ制約セットは複数のエフェクタ制約を組合せたものである。また、アーム１０Ａの状態ごと、または、動作プログラム２３Ｂごとにエフェクタ制約セットが１つ又は複数準備されていると、ユーザは準備されたエフェクタ制約セットを使用するだけでよい。当該構成は、ユーザによる設定の手間の低減に繋がり、アーム１０Ａの動作の正確性、安全性、効率化等にも繋がる。
　エフェクタ制約を設定することで、エフェクタ３０、対象２等の性質を考慮した経路生成が可能となるが、エフェクタ３０、対象２等の性質を正しくエフェクタ制約に反映させることは難しい。エフェクタ制約をユーザが計算等を用いて決定できる場合もあるが、ユーザごとの経験の違いによりエフェクタ制約の精度にばらつきが生ずる。このような状況ではエフェクタ制約を入力するために試行錯誤が必要となる。また、本来必要な制約の設定が漏れ、意図せぬ不具合を招く可能性がある。これらは以下の構成によって改善され得る。
［優先度］
　本実施形態では、エフェクタ制約は複数のエフェクタ制約要素を含み、図１３の画面３０７に示すように複数のエフェクタ制約要素のうち少なくとも１つに優先度を設定できる。例えば、画面３０７は、“優先度”の列を有し、各エフェクタ制約要素に対応するように優先度を設定可能である。画面３０７では、エフェクタ制約要素であるＸ軸周りの角度の“上限”および“下限”に“絶対”の優先度が設定されている。“絶対”の優先度は例えばプロセッサ２１が必ず用いなければならないマストアプライ設定であるとも言える。他のエフェクタ制約要素にもそれぞれ優先度が設定され、優先度が高い順に“絶対”、“高”、および“低”が設定されている。
　当該構成によって、ユーザの設定の自由度が増す。また、例えばエフェクタ制約の中のＸ，Ｙ，Ｚの回転位置制約のうち何れかを必ずしも守らなくてもよい条件でロボット１０が動作可能となり、プロセッサ２１が設定し得る経路の選択肢が増える。また、プロセッサ２１はサイクルタイムの向上等が望めるより効果的な経路を選択できるようになる。
　本実施形態のエフェクタ制約には、必ず守ってほしい制約や、必ずしも守らなくても良い制約など、優先度がある。経路生成時に、全ての制約を守っている状態が望ましい場合もあるが、それほど重要でない制約を守ろうとして効果的な経路を選択できない可能性もある。つまり、優先度が低い制約を守らないことで効果的な経路を選択可能になる場合がある。このため、予め設定された基準に基づき優先度が低い制約をプロセッサ２１が守らないよう構成されてもよい。当該構成の実現のために、各エフェクタ制約や各エフェクタ制約要素に優先度が設定され、優先度は記憶部２３に格納される。
　後述のようにユーザがプリセットのエフェクタ制約を用いる場合も、エフェクタ制約要素の優先度に差が生じるようにプリセットを準備することができる。機能要求を満たす上で重要なエフェクタ制約要素ほど優先度が高くなる。優先度はユーザが後から変更できる。
　エフェクタ制約には、ユーザが意図して設定する制約と、意図して設定しない制約とがある。本実施形態においては、ユーザが意図して設定する(user ordered)制約を指定制約、意図して設定していない最適化可能性のある(optimizable)制約を従属制約と称する場合がある。指定制約であるか従属制約であるかを示す情報が各エフェクタ制約と共に記憶部２３に格納されてもよい。例えば、エフェクタ制約要素の各々について、ユーザによって指定された値をプロセッサ２１に使わせる制約要素であるとの設定又はプロセッサ２１による変更を許容する制約要素であるとの設定を制御装置１が受付け、受付けた設定が記憶部２３に格納される。当該設定は図１３、図１９、および図２３に“指定”および“従属”で示されている。
　後述のようにユーザがプリセットのエフェクタ制約を用いる場合、エフェクタ制約の詳細はユーザが設定したものではないため、最初は従属制約とすることが望ましい。ユーザがプリセットのエフェクタ制約に編集を加えた場合、当該エフェクタ制約は指定制約となる。指定制約であるか従属制約であるかはユーザが後から変更できる。
　また、エフェクタ制約の優先度と、指定制約と従属制約の区別が、エフェクタ制約要素ごとに設定される構成が可能であり、エフェクタ制約セットごとにまとめて設定される構成も可能である。
　複数のエフェクタ制約セットを有するケースでは、優先度と、指定制約と従属制約の区別をつけることで、制約の意図が分かりやすくなる。
［プリセット］
　本実施形態において、好ましくは、エフェクタ制約および／又はエフェクタ制約要素を自動的に設定するプリセット自動設定プログラム２３Ｆが記憶部２３に格納されている。プリセット自動設定プログラム２３Ｆは、ユーザが客観的に取得できるエフェクタ３０および対象２の情報と、ユーザが主観的に期待する機能や性能(機能要求)とに基づき、エフェクタ制約および／又はエフェクタ制約要素を自動的に設定する。
　機能要求は、例えば対象２について、「揺らしたくない」「倒したくない」「落としたくない」「傾けたくない」「その場から動かしたくない」等の定性的な表現でも良い。
　この機能要求は、エフェクタ制約要素として表現することが可能である。このために、機能要求に対応するエフェクタ制約要素のプリセットが予め記憶部２３に記憶されている。
　この場合、例えば、エフェクタ３０と対象２の組合せのタイプについて、ユーザは複数種類のプリセットから選択できるように構成されている。プリセットとして、トレイに乗るタイプ、コンテナに乗るタイプ、箱に入るタイプ、ハンドでつかむタイプ、吸引するタイプ等がある。また、プリセットとして、溶接ガンで対象に加工するタイプ、溶接トーチで対象に加工するタイプ、各種工具で対象に加工するタイプなどがある。当該構成はエフェクタ３０の種類を限定するものではなく、プリセットは情報入力を補助するためのものである。プリセットに当てはまらないエフェクタも使用可能である。
　エフェクタ３０や対象２の３Ｄ－ＣＡＤモデルが用いられることも望ましい。この形状に加えて、対象２の重心位置、重量、エフェクタの重心位置、重量、エフェクタ３０の可動部分等などが３Ｄ－ＣＡＤモデルと共に用いられると、より正確な物理モデルが作成される。物理モデルには、材料の硬さを示すバネ定数、振動を減衰する減衰係数、物体同士が擦れたときの摩擦係数等、物理的な挙動を説明する上で必要なパラメータを付与することが望ましい。物理モデルがあれば、シミュレーション上で、ハンドで掴む挙動、対象２が落ちる挙動等の物理的な挙動が再現可能となる。
　本実施形態にて使用する物理モデルは、物理シミュレーションを実施するためのものである。物理モデルの各種設定は工数を要するため、ユーザが容易に入手可能な情報から構築できるものが望ましい。
　典型的なエフェクタ３０と対象２であれば、前記のエフェクタ３０と対象２の組合せのタイプのプリセットを選択することで、エフェクタ３０と対象２のおおよその配置が決まる。配置が決まっていれば、エフェクタ３０や対象２の特徴部分の形状、重心、重量等を追加するだけで、おおよその物理モデルが生成される。
　制御装置１は、エフェクタ３０と対象２のタイプ、形状等の情報と、機能要件の情報と、それを実現するのに適切なエフェクタ制約要素の情報とを、互いに対応付けられた状態で記憶部２３に格納している。プロセッサ２１は、前記の情報、ユーザが入力する機能要件、および物理モデルの情報等を元に、エフェクタ制約要素を設定し、ユーザに提示する。
　より具体的な例が以下に説明される。
　例えば入力部２６の表示装置２２に前記プリセットを用いた設定のための画面が表示される。
　先ず、制御装置１のプロセッサ２１は表示装置２２に図１６に示される画面４０１を表示させる。画面４０１が画面３０１の代わりに表示されてもよい。画面４０１は、ユーザがエフェクタ情報の設定画面への遷移を選択するための画面である。
　画面４０１においてユーザがエフェクタ情報の設定画面への遷移を選択すると、プロセッサ２１は表示装置２２に図１６の画面４０２を表示させる。画面４０２は、ユーザが複数のエフェクタタイプの設定のうち任意のエフェクタタイプの設定を選択するための画面である。
　画面４０２においてユーザがエフェクタタイプ１の設定を選択すると、プロセッサ２１は表示装置２２に図１６の画面４０３を表示させる。画面４０３は、ユーザが選択したエフェクタタイプ１の設定をするための画面である。画面４０３に示すように、ユーザは選択によってエフェクタタイプを設定できる。
　画面４０３においてユーザが選択したエフェクタタイプの詳細設定を選択すると、プロセッサ２１は表示装置２２に図１６の画面４０４を表示させる。画面４０４は、選択したエフェクタタイプの寸法設定、重心位置等の位置設定をするための画面である。好ましくは、画面４０４は、選択したエフェクタタイプの重量、材質等も設定できるように構成されている。
　図１７に示すように画面４０１に戻った状態で、ユーザが対象情報の設定画面への遷移を選択すると、プロセッサ２１は表示装置２２に図１７の画面４０５を表示させる。画面４０５は、ユーザが複数の対象タイプの設定のうち任意の対象タイプの設定を選択するための画面である。
　画面４０５においてユーザが対象タイプ１の設定を選択すると、プロセッサ２１は表示装置２２に図１７の画面４０６を表示させる。画面４０６は、ユーザが選択した対象タイプ１の設定をするための画面である。画面４０６に示すように、ユーザは選択によって対象タイプを設定できる。
　画面４０６においてユーザが選択した対象タイプの詳細設定を選択すると、プロセッサ２１は表示装置２２に図１７の画面４０７を表示させる。画面４０７は、選択した対象タイプの寸法設定、重心位置等の位置設定をするための画面である。好ましくは、画面４０７は、選択した対象タイプの重量、材質等も設定できるように構成されている。なお、選択した対象タイプの選択したエフェクタタイプに対する位置設定もできるように画面４０７が構成されていてもよい。
　図１８に示すように画面４０１に戻った状態で、ユーザが対象位置関係情報の設定画面への遷移を選択すると、プロセッサ２１は表示装置２２に図１８の画面４０８を表示させる。画面４０８は、選択したエフェクタタイプに対する選択した対象タイプの位置関係を設定するための画面である。
　画面４０８においてユーザが例えば位置関係１の設定を選択すると、プロセッサ２１は表示装置２２に図１８の画面４０９を表示させる。画面４０９は、ユーザが選択した位置関係１の設定をするための画面である。画面４０９に示すように、ユーザは数値の入力、表示されるエフェクタの図および／又は対象の図の移動によって位置関係を設定できる。
　図１９に示すように画面４０１に戻った状態で、ユーザがエフェクタ制約をプリセットから設定する設定画面への遷移を選択すると、プロセッサ２１は表示装置２２に図１９の画面４１０を表示させる。画面４１０は、エフェクタタイプの選択、対象タイプの選択、対象位置関係の選択等を行うための画面である。
　なお、エフェクタタイプが固定されている場合、エフェクタタイプの情報が外部機器からの入力情報（入力）に基づき自動的に設定される場合等もあり得る。例えば、エフェクタ３０が制御装置１に接続された時にエフェクタ３０から制御装置１に信号が送信され、当該入力信号（入力）に基づきプロセッサ２１がエフェクタタイプを設定してもよい。同様に、対象タイプおよび対象位置関係が固定されている場合、対象タイプおよび対象位置関係が自動的に設定される場合もある。
　画面４１０は、機能要求（要求）の設定画面への遷移を選択し、また、設定された機能要求を表示するための画面である。ユーザが機能要求の設定のための所定の操作、例えば“設定を生成”のボタンを押すと、プロセッサ２１は表示装置２２に図１９の画面４１１を表示させる。画面４１１は、ユーザが機能要求を選択するための画面である。画面４１１は、各機能要求に対応する位置に設定済であることを示す“有効”の表示が出る。画面４１１では、ユーザは複数の機能要求を設定することもできる。機能要求（要求）は、例えばエフェクタ３０が対象２に対し行う作業に関するユーザの要求である。
　画面４１０，４１１の設定によって、エフェクタ制約が設定される。当該エフェクタ制約には、例えば、画面３０７と同様の各設定が含まれる。このため、設定されたエフェクタ制約を用いてプロセッサ２１はアーム１０Ａを制御できる。
　画面４１０に戻った状態で、ユーザが“生成ログを見る”を押すことにより、プロセッサ２１は表示装置２２に図１９の画面４１２を表示させる。画面４１２は、設定されたエフェクタ制約の内容を表示し、エフェクタ制約の各設定の変更を受付けるものである。画面４１２は、各設定が変更されたエフェクタ制約をプリセットの１つとして登録するためのユーザの入力を受付けるように構成されている。
　このように、記憶部２３は複数のエフェクタ制約を格納している。また、エフェクタ３０のタイプである前記エフェクタタイプと対象２のタイプである前記対象タイプの複数の組合せに複数のエフェクタ制約がそれぞれ対応するように記憶部２３に格納されている。そして、ユーザが入力部２６等を用いて任意の組合せを入力すると、プロセッサ２１は対応するエフェクタ制約を設定する。当該構成は、ユーザによる設定の手間の低減に繋がり、アーム１０Ａの動作の正確性、安全性、効率化等にも繋がる。
　なお、前記エフェクタタイプの設定だけに基づきエフェクタ制約が設定される場合もあり得る。または、前記対象タイプの設定だけに基づきエフェクタ制約が設定される場合もあり得る。例えば、作業内容やそれに対する要求が固定されているエフェクタタイプ又は対象の場合、機能要求等の他の設定が無い状態で、前記エフェクタタイプ又は前記対象タイプの設定だけに基づきエフェクタ制約が設定される。当該構成では、ユーザは前記エフェクタタイプ又は前記対象タイプの設定のための入力を行えばよい。つまり、プロセッサ２１は、前記エフェクタタイプに関する情報および前記対象タイプに関する情報の少なくとも１つと、前記ユーザによる前記設定のための入力とに基づき、エフェクタ制約を設定する。エフェクタ３０が制御装置１に接続された時に、外部機器であるエフェクタ３０から制御装置１に前記エフェクタタイプに関する情報、信号等が入力されてもよい。この場合、プロセッサ２１は、前記エフェクタタイプに関する情報と、前記外部機器からの入力とに少なくとも基づき、エフェクタ制約を設定する。これらの構成は、ユーザによる設定の手間の更なる低減に繋がり、且つ、アーム１０Ａの動作の正確性、安全性、効率化等の向上にも寄与する。また、経験が不足しているユーザでもエフェクタ制約を適切に行えるようになり、これはアーム１０Ａの動作の正確性、安全性、効率化等のために有用である。
　また、本実施形態では、ユーザが入力する要求にも基づきエフェクタ制約が設定される。当該構成は、ユーザによる設定の手間の低減と、アーム１０Ａの動作の正確性、安全性、効率化等の向上との両立を、高いレベルで達成するために有用である。
［シミュレータ］
　本実施形態において、前述のように、ユーザの入力値によってエフェクタ制約が設定され、また、ユーザが入力する機能要求に基づきプリセットされたエフェクタ制約が設定される。しかし、たとえプリセットの場合であっても、設定したエフェクタ制約がユーザの期待通りに必ず正常に機能するとは限らない。重要な設定の抜け落ち、不要な設定の存在、エフェクタ制約要素の微調整の不足等が生じ、ユーザが想定していた経路とならない可能性がある。
　実際のロボット１０を用いて動作経路を確認することが最も確実な確認方法である。しかし、設定に不備がある場合は確認行為自体がリスクとなる。そのためエフェクタ制約が妥当であるかをシミュレーション上で確認することは前記リスクの低減となる。
　シミュレーションを実施するために、ユーザはアーム１０Ａの動作パターン（動作プログラム２３Ｂ）を入力する必要がある。一方、ジョグ操作、ハンドガイド操作等の動作パターンは無数にあり得る。このため、好ましくは、アーム１０Ａの様々な動作パターンのセットがプリセットとして予め準備されている。ユーザは通常はプリセットの中の任意の動作パターンを選択し、例外的な個別の事例の場合はユーザが補足的に動作パターンを入力によって作成又は修正する。
　周囲環境４、人や人が運ぶ物を含む接近物、ロボット１０、エフェクタ３０、対象２等の３Ｄモデルがシミュレータ上で再現され、自動運転、ジョグ操作、ハンドガイド操作などの動作のシミュレーションが行われる。シミュレーションは、対象２の転倒等を再現可能な物理シミュレーションが望ましい。例えば、作成済のエフェクタ３０と対象２の物理モデルが活用される。
　シミュレーションは、現実では通常モニタリングできないエフェクタ３０および対象２の加速度等を計算可能である。エフェクタ３０および対象２の位置、姿勢、速度、加速度、角速度、角加速度等に対し、許容される閾値としてのシミュレーション許容値が設定される。シミュレーションは、エフェクタ３０の動作が前記シミュレーション許容値に収まっているか否かを確認できる。機能要求に相当するシミュレーション許容値が予め用意されている場合は、当該許容値が用いられてもよい。または、エフェクタ制約セットの中からシミュレーション許容値として用いられる値、設定等が選択されてもよい。
　シミュレーションの結果、対象２の転倒、落下等の作業の不具合が生ずる可能性がある。シミュレーションは、ユーザが想定する任意の条件で、機能要求を満たしているか否かを判定できる。プロセッサ２１がシミュレーション上での動作の様子を表示装置２２等に表示することが好ましい。
　シミュレーション許容値の要件が満たされない場合や、サイクルタイムが条件を満たさない場合は、エフェクタ制約要素を見直すことで改善が可能である。ユーザがシミュレーションの様子を確認し、エフェクタ制約要素を微調整することも可能である。
　シミュレーションの結果に基づきプロセッサ２１が制約修正プログラム２３Ｇに基づき以下のエフェクタ制約の修正、改善、又は最適化を行ってもよい。当該構成は、ユーザの手間の低減と、アーム１０Ａの動作の正確性、安全性、効率化等との両立を図る上で有用である。
　例えば、前述のユーザによるエフェクタ制約要素の微調整は、試行錯誤的でありユーザの負担が大きい。エフェクタ制約要素の設定時に、優先度、重要度等を設定している場合、重要度が低いエフェクタ制約要素のうち優先度が低いものは変更される可能性が高い。これが調整対象のエフェクタ制約要素となる。シミュレーションの結果に基づきエフェクタ制約セットを修正する制約修正プログラム２３Ｇは記憶部２３に格納されている。
　シミュレーションが実施され、シミュレーション許容値の要件が満たされない場合のリスクの大きさがエフェクタ制約セットの良し悪しの判断指標として用いられてもよい。またサイクルタイムがエフェクタ制約セットの良し悪しの判断指標であってもよい。前記のエフェクタ制約セットの良し悪しの判断指標はあくまで例であり、これらに限定されない。ユーザのリスクアセスメントの判断基準となどを織り込んで、エフェクタ制約セットの良し悪しの判断指標として、エフェクタ制約セット指標が設定され得る。
　例えば、エフェクタ制約セット指標が最大(または最小)となる条件が最も良いエフェクタ制約セットであるとの定義が可能である。
　シミュレーションを用いたエフェクタ制約セットの修正方法の例として、以下のような方法が考えられる。先ず、一般的な遺伝的アルゴリズムを適用することができる。シミュレーションの実施の後、エフェクタ制約セット指標が計算される。シミュレーションの結果に基づき、調整対象のエフェクタ制約要素の代替案が作成される。代替案は一度に複数作られてもよい。
　前記の代替案のエフェクタ制約要素を用いて、再度シミュレーションが実施され、エフェクタ制約セット指標が計算される。エフェクタ制約セット指標が改善されているエフェクタ制約セットを元にさらに代替案が生成される。エフェクタ制約セット指標の改善度合いに応じて、代替案の生成数などを変えることが可能である。
　上記のようなエフェクタ制約セットの代替案の生成は、予め決めた回数実施される、または、予め決められたエフェクタ制約セット指標を超えるまで実施される。当該処理によって、サイクルタイム等の面で適したエフェクタ制約セットが得られる。上記の処理は１例であり、この処理に限定されない。
　上記のシミュレーションおよびその結果に基づくエフェクタ制約の改善又は最適化は、制御装置１のプロセッサ２１が実施してもよく、別のコンピュータが実施してもよい。別のコンピュータは、制御装置１と同様のプロセッサ、表示装置、記憶部、入力部等を有する。別のコンピュータの記憶部には記憶部２３と同様のプログラム、データ、情報等が格納されている。また、別のコンピュータの記憶部には、シミュレーションプログラムと、周囲環境４、ロボット１０、エフェクタ３０、対象２等のモデルも格納されている。
　別のコンピュータによって改善又は最適化されたエフェクタ制約が制御装置１に入力され、当該入力があった時に制御装置１のプロセッサ２１が入力されたエフェクタ制約を動作プログラム２３Ｂ等に設定してもよい。この場合、外部機器としてのコンピュータからの入力に基づき、プロセッサ２１はエフェクタ制約によって制約された動作をアーム１０Ａに行わせる。
　より具体的な例が以下説明される。
　例えば入力部２６の表示装置２２にエフェクタ制約のシミュレーションを行うための画面が表示される。
　図２０に示す画面４０１においてユーザがエフェクタ制約シミュレーションの画面への遷移を選択すると、プロセッサ２１は表示装置２２に図２１の画面４２１を表示させる。画面４２１は、ユーザが複数のシミュレーション条件の設定のうち任意のシミュレーション条件の設定を選択するための画面である。
　画面４２１においてユーザがシミュレーション条件１の設定を選択すると、プロセッサ２１は表示装置２２に図２１の画面４２２を表示させる。画面４２２はシミュレーションのための各種設定をする画面である。ユーザが画面４２２のシミュレーション設定を選択すると、プロセッサ２１は表示装置２２に図２１の画面４２３を表示させる。画面４２３はシミュレーションに評価させる評価項目の設定、前記シミュレーション許容値の設定を含む各評価項目の条件設定等を行う画面である。
　ユーザは、画面４２２，４２３で設定を行った後、画面４２１においてシミュレーションを実行するための操作を行う。これにより、プロセッサ２１は図２２のシミュレーション実行画面４２４を表示し、また、図２２の画面４２５、４２６において設定された評価項目の結果を表示する。
　また、プロセッサ２１が、エフェクタ３０の動作がシミュレーション許容値内か否かを評価してもよい。そして、エフェクタ３０の動作が前記シミュレーション許容値内でないときに、プロセッサ２１が図２３の画面４２７を表示してもよい。エフェクタ３０の動作がシミュレーション許容値内に入らない時、プロセッサ２１が、その原因となっているエフェクタ制約要素を判断又は推定し、画面４２７のようにそのエフェクタ制約要素をユーザに示すための表示を行ってもよい。画面４２７では原因であると判断されたエフェクタ制約要素の色が変えられている。
　プロセッサ２１は、制約修正プログラム２３Ｇに基づき、シミュレーションの結果を用いてエフェクタ制約の改善又は最適化を行うことができる。例えば、画面４０１において“設定最適化”が選択された時に、エフェクタ制約の改善又は最適化が行われる。
　一例として、図１３の画面３０７のエフェクタ制約１を用いてシミュレーションが行われる場合について説明する。エフェクタ制約１のエフェクタ制約要素のいくつかが前記原因であると判断されると、プロセッサ２１は原因であると判断されたエフェクタ制約要素を修正する。この時、前述のように図１３の画面３０７の各エフェクタ制約要素は指定制約(user
ordered)を意味する“指定”が設定されている。また、図１３の画面３０７の加速度・角加速度のタブ等にあるエフェクタ制約要素のいくつかが図２３に示すように前記原因であり、それらは“指定”が設定されていない、つまり従属制約(optimizable)であるものとする。例えば、プロセッサ２１は、原因であると判断され“指定”が設定されていなエフェクタ制約要素を変更することによって前記改善又は最適化を行う。この場合、ユーザは、自動的に変更される制約要素とされない制約要素を認識しながら、プロセッサ２１に前記改善又は最適化を指示できる。当該構成は、ユーザの設定の容易化に繋がり、アーム１０Ａの動作の正確性、安全性、効率化等にも繋がる。
［ジョグ操作・ハンドガイド操作］
　ジョグ操作はユーザが入力部２６の方向キー、ジョイスティック等を用いて直接アーム１０Ａを動かすものである。このため、アーム１０Ａの特性の理解や周囲環境４の観察が十分でないと、アーム１０Ａ又はエフェクタ３０と周囲環境４との接触、エフェクタ３０の望ましくない姿勢への変位等を招来する操作ミスが発生し易い。本実施形態では、ジョグ操作時にもエフェクタ制約を適用する設定が可能である。
　プロセッサ２１が、ジョグ操作時にもエフェクタ制約の範囲内となるようにアーム１０Ａを制御し、このようにアーム１０Ａが動作する。これにより、操作ミス等によりエフェクタ３０が意図せぬ姿勢となることが低減又は防止される。また、エフェクタ制約でエフェクタ３０の動作が制約されるので、ジョグ操作時のユーザの確認の工数が削減される。
　また、エフェクタ制約に前述のニュートラルな状態の設定がされている場合は、プロセッサ２１はジョグ操作時にエフェクタ３０の姿勢をニュートラルな姿勢に近付けるようにアーム１０Ａを動作させる。当該構成によって、ユーザが方向キー、ジョイスティック等において特別な操作を行うことなく、エフェクタ３０が好ましい姿勢に近い状態で維持される。
　ユーザがロボットを教示する時等に、ユーザがアーム１０Ａの先端部を持ち、ユーザが当該先端部に外力を加えてアーム１０Ａを動かすハンドガイド操作がある。ハンドガイド操作では、前記外力の方向および大きさがセンサによって検出され、センサの検出結果に応じてプロセッサ２１がアーム１０Ａを外力の方向に動かす。ハンドガイド操作においても、ユーザが誤った方向に外力を加えてしまうと、前記操作ミスとなる可能性がある。本実施形態では、ハンドガイド操作時にもエフェクタ制約を適用する設定が可能であり、ハンドガイド操作においてもジョグ操作時と同様の効果を奏し得る。
［干渉計算ありのジョグ操作・ハンドガイド操作］
　ジョグ操作、ハンドガイド操作を実行する際、ロボット１０のアーム１０Ａおよびエフェクタ３０が周囲環境４と接触しないことが重要である。接触しないことが明らかでない場合、干渉計算をすることが望ましい。この場合、制御装置１は、記憶部２３に格納された干渉計算プログラム２３Ｈに基づきプロセッサ２１が干渉計算を行う。
　干渉計算に必要な基本的な情報が以下説明される。
　まず、ロボット１０の３Ｄモデルと、エフェクタ３０の３Ｄモデルと、ワークである対象２の３Ｄモデルとが、記憶部２３に格納されている。物品ハンドリングなどにおいて、対象２は常に把持されているとは限らず、周囲環境４と一体となっている場合もあり、特に対象２が搬送装置に乗って動いている場合や他のロボットシステムによって把持されている場合もある。このため、エフェクタ３０と共に動く対象２(エフェクタ側の対象)か、周囲環境４と共に動く対象２(周囲環境４側の対象)かで状態を区別することが望ましい。
　周囲環境４に相当する３Ｄモデルも記憶部２３に格納されており、当該３Ｄモデルも干渉計算に用いられる。ここで、アーム１０Ａの動作を制限するために、仮想的に侵入不可能な領域が設定されることは一般的に行われる。本実施形態では、プロセッサ２１は、干渉計算プログラム２３Ｈに基づき、ロボット１０、エフェクタ３０、対象２、周囲環境４、動作プログラム２３Ｂ等のロボットの制御指令を用いてモデル同士の距離を計算する。原則的に、プロセッサ２１は、干渉計算の結果、接近しても良い距離の許容値を下回る場合はアーム１０Ａを安全に停止させる。
　ここで、本実施形態のようにプロセッサ２１がアーム１０Ａをエフェクタ制約の範囲で動作させることで、干渉の回避が可能である場合がある。例えば、ジョグ操作又はハンドガイド操作の時にエフェクタ３０の３Ｄモデルと周囲環境４に相当する３Ｄモデルとの干渉が発生しそうになる場合がある。この時に、プロセッサ２１はエフェクタ制約の範囲で周囲環境４との接触を避けるようにアーム１０Ａを動かすことができる。エフェクタ制約がなければプロセッサ２１は原則的にアーム１０Ａを停止させることになるが、上記のように動けることでユーザによるジョグ操作又はハンドガイド操作が中断されることがなくなる。当該構成によって、効率的で柔軟なジョグ操作およびハンドガイド操作が可能になる。
　本実施形態では、記憶部２３は、エフェクタ３０の位置および姿勢の所定の基準座標から見た変化の制約であるエフェクタ制約を格納している。また、プロセッサ２１は、ユーザ又は外部機器からの入力に基づき設定されるエフェクタ制約によって制約された動作をロボット１０に行わせる。これはロボット１０の動作の正確性、安全性、効率化等に繋がる。例えば、エフェクタ３０や対象２の種類に応じた避けたい姿勢の設定（回避）が容易又は確実になる。また、前述の教示作業又は設定作業の手間の低減、容易化等が可能となる場合もある。また、エフェクタ３０の位置および姿勢を適正な状態に保つことができるアーム１０Ａの動作を実現しながら、サイクルタイムの向上を図れる回避経路の作成、選択等に繋がる場合がある。
　また、制御装置１はユーザがエフェクタ制約のエフェクタ制約要素等を入力するための入力部２６を備える。当該構成は、多種多様なエフェクタ３０や多種多様な作業に対し適切なエフェクタ制約を設定する上で有用である。
　また、エフェクタ制約はエフェクタ３０の所定の基準座標から見た速度の制約、加速度の制約、角速度の制約、および角加速度のエフェクタ制約要素の少なくとも１つを設定可能である。当該構成は、多種多様なエフェクタ３０や多種多様な作業に対し適切なエフェクタ制約を設定する上で有用である。また、これらのエフェクタ制約要素の設定があることによって、例えばアーム１０Ａに複雑な作業のために多数の教示点設定等を行う時に、アーム１０Ａの動作設定又は動作制約の設定の容易化が可能になる場合がある。
　本開示の実施形態について詳述したが、本開示は前述した個々の実施形態に限定されるものではない。これらの実施形態は、本開示の要旨を逸脱しない範囲で、または、特許請求の範囲に記載された内容とその均等物から導き出される本開示の思想および趣旨を逸脱しない範囲で、種々の追加、置き換え、変更、部分的削除等が可能である。例えば、前述した実施形態において、各動作の順序の変更、各処理の順序の変更、条件に応じた一部の動作の省略又は追加、条件に応じた一部の処理の省略又は追加は、上記の例に拘泥されることなく可能である。また、上記実施形態の説明に数値又は数式が用いられている場合も同様である。
［付記１］
　プロセッサと、
　ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約を格納する記憶部と、を備え、
　前記プロセッサは、ユーザ又は外部機器からの入力に基づき設定される前記エフェクタ制約によって制約された動作を前記ロボットに行わせる、制御装置。
［付記２］
　前記記憶部は、前記エフェクタ制約を複数記憶可能である、付記１に記載の制御装置。
［付記３］
　前記記憶部は、複数の前記エフェクタ制約を組合せて成るエフェクタ制約セットを記憶可能である、付記１又は２に記載の制御装置。
［付記４］
　前記記憶部には、前記ロボットを動作させるための複数の動作プログラムと、前記複数の動作プログラムにそれぞれ対応する複数の前記エフェクタ制約セットと、が格納されている、付記３に記載の制御装置。
［付記５］
　プロセッサと、
　記憶部と、
　ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約の設定画面を表示する表示装置と、を備え、
　前記設定画面は、ユーザの入力に少なくとも基づき前記エフェクタ制約を設定するためのものである、制御装置。
［付記６］
　前記エフェクタ制約を入力可能な入力部を備える、付記１～５の何れかに記載の制御装置。
［付記７］
　前記記憶部は複数のエフェクタ制約を格納しており、
　前記複数のエフェクタ制約は、前記エフェクタのタイプおよび前記エフェクタの作業の対象のタイプの少なくとも１つにそれぞれ対応しており、
　前記プロセッサは、前記エフェクタの前記タイプに関する情報および前記対象の前記タイプに関する情報の少なくとも１つと、ユーザの入力とに少なくとも基づき前記エフェクタ制約を設定する、付記１～６の何れかに記載の制御装置。
［付記８］
　前記ユーザの入力は、前記エフェクタによる前記作業に関し前記ユーザが求める要求を設定するものである、付記７に記載の制御装置。
［付記９］
　前記エフェクタ制約は複数のエフェクタ制約要素を含み、
　前記エフェクタ制約は、前記複数のエフェクタ制約要素のうち少なくとも１つに優先度を設定可能であり、
　前記プロセッサは、前記優先度を含む前記エフェクタ制約を少なくとも用いて前記ロボットを動作させる、付記１～６の何れかに記載の制御装置。
［付記１０］
　前記エフェクタ制約は複数のエフェクタ制約要素を含み、
　前記複数のエフェクタ制約要素の各々について、ユーザによって指定された値を前記プロセッサに使わせる指定制約の設定又は前記プロセッサによる変更を許容する従属制約の設定を受付けるように構成されている、付記１～６の何れかに記載の制御装置
［付記１１］
　前記プロセッサは、前記エフェクタ制約を少なくとも用いて前記ロボットのモデルに前記動作を行わせるシミュレーションを行い、前記動作が基準を満たしているか否かを判定する、付記１～１０の何れかに記載の制御装置。
［付記１２］
　前記プロセッサは、前記動作が前記基準を満たしていない時に前記基準を満たすように前記エフェクタ制約を修正する、付記１１に記載の制御装置。
［付記１３］
　前記エフェクタ制約は、前記エフェクタの前記所定の基準座標から見た速度の制約、前記エフェクタの前記所定の基準座標から見た加速度の制約、前記エフェクタの前記所定の基準座標から見た角速度の制約、前記エフェクタの前記所定の基準座標から見た角加速度の制約、および前記位置または前記姿勢を3回以上時間微分した量に相当する値若しくは式の制約の少なくとも１つを設定可能である、付記１～１２の何れかに記載の制御装置。
［付記１４］
　プロセッサと、
　記憶部と、
　ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約の設定画面を表示する表示装置と、を備え、
　前記設定画面は、ユーザの入力に少なくとも基づき前記エフェクタ制約を設定するためのものであり、
　前記プロセッサは、前記エフェクタ制約を少なくとも用いて前記ロボットのモデルに動作を行わせるシミュレーションを行い、前記動作が基準を満たしているか否かを判定する、コンピュータ。
［付記１５］
　前記プロセッサは、前記動作が前記基準を満たしていない時に前記基準を満たすように前記エフェクタ制約を修正する、付記１４に記載のコンピュータ。
１　制御装置
２　対象
１０　ロボット
１０Ａ　アーム
１１　サーボモータ
１１Ａ　エンコーダ
１２　可動部
２１　プロセッサ
２２　表示装置
２３　記憶部
２３Ａ　システムプログラム
２３Ｂ　動作プログラム
２３Ｃ　制御プログラム
２３Ｄ　経路生成プログラム
２３Ｆ　プリセット自動設定プログラム
２３Ｇ　制約修正プログラム
２３Ｈ　干渉計算プログラム
２４　サーボ制御器
２５　サーボ制御器
２６　入力部
２００　画面（動作プログラム）
３００～３０９　画面
４０１～４１２　画面
４２１～４２７　画面
５００　操作部

Claims (15)

  1. 　プロセッサと、
    　ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約を格納する記憶部と、を備え、
    　前記プロセッサは、ユーザ又は外部機器からの入力に基づき設定される前記エフェクタ制約によって制約された動作を前記ロボットに行わせる、制御装置。
  2. 　前記記憶部は、前記エフェクタ制約を複数記憶可能である、請求項１に記載の制御装置。
  3. 　前記記憶部は、複数の前記エフェクタ制約を組合せて成るエフェクタ制約セットを記憶可能である、請求項１又は２に記載の制御装置。
  4. 　前記記憶部には、前記ロボットを動作させるための複数の動作プログラムと、前記複数の動作プログラムにそれぞれ対応する複数の前記エフェクタ制約セットと、が格納されている、請求項３に記載の制御装置。
  5. 　プロセッサと、
    　記憶部と、
    　ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約の設定画面を表示する表示装置と、を備え、
    　前記設定画面は、ユーザの入力に少なくとも基づき前記エフェクタ制約を設定するためのものである、制御装置。
  6. 　前記エフェクタ制約を入力可能な入力部を備える、請求項１～５の何れか１項に記載の制御装置。
  7. 　前記記憶部は複数のエフェクタ制約を格納しており、
    　前記複数のエフェクタ制約は、前記エフェクタのタイプおよび前記エフェクタの作業の対象のタイプの少なくとも１つにそれぞれ対応しており、
    　前記プロセッサは、前記エフェクタの前記タイプに関する情報および前記対象の前記タイプに関する情報の少なくとも１つと、ユーザの入力とに少なくとも基づき前記エフェクタ制約を設定する、請求項１～６の何れか１項に記載の制御装置。
  8. 　前記ユーザの入力は、前記エフェクタによる前記作業に関し前記ユーザが求める要求を設定するものである、請求項７に記載の制御装置。
  9. 　前記エフェクタ制約は複数のエフェクタ制約要素を含み、
    　前記エフェクタ制約は、前記複数のエフェクタ制約要素のうち少なくとも１つに優先度を設定可能であり、
    　前記プロセッサは、前記優先度を含む前記エフェクタ制約を少なくとも用いて前記ロボットを動作させる、請求項１～６の何れか１項に記載の制御装置。
  10. 　前記エフェクタ制約は複数のエフェクタ制約要素を含み、
    　前記複数のエフェクタ制約要素の各々について、ユーザによって指定された値を前記プロセッサに使わせる指定制約の設定又は前記プロセッサによる変更を許容する従属制約の設定を受付けるように構成されている、請求項１～６の何れか１項に記載の制御装置。
  11. 　前記プロセッサは、前記エフェクタ制約を少なくとも用いて前記ロボットのモデルに前記動作を行わせるシミュレーションを行い、前記動作が基準を満たしているか否かを判定する、請求項１～１０の何れか１項に記載の制御装置。
  12. 　前記プロセッサは、前記動作が前記基準を満たしていない時に前記基準を満たすように前記エフェクタ制約を修正する、請求項１１に記載の制御装置。
  13. 　前記エフェクタ制約は、前記エフェクタの前記所定の基準座標から見た速度の制約、前記エフェクタの前記所定の基準座標から見た加速度の制約、前記エフェクタの前記所定の基準座標から見た角速度の制約、前記エフェクタの前記所定の基準座標から見た角加速度の制約、および前記位置または前記姿勢を3回以上時間微分した量に相当する値若しくは式の制約の少なくとも１つを設定可能である、請求項１～１２の何れか１項に記載の制御装置。
  14. 　プロセッサと、
    　記憶部と、
    　ロボットのエフェクタの位置および姿勢の少なくとも一方の所定の基準座標から見た変化の制約であるエフェクタ制約の設定画面を表示する表示装置と、を備え、
    　前記設定画面は、ユーザの入力に少なくとも基づき前記エフェクタ制約を設定するためのものであり、
    　前記プロセッサは、前記エフェクタ制約を少なくとも用いて前記ロボットのモデルに動作を行わせるシミュレーションを行い、前記動作が基準を満たしているか否かを判定する、コンピュータ。
  15. 　前記プロセッサは、前記動作が前記基準を満たしていない時に前記基準を満たすように前記エフェクタ制約を修正する、請求項１４に記載のコンピュータ。
PCT/JP2022/042393 2022-11-15 2022-11-15 制御装置およびコンピュータ Ceased WO2024105777A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
DE112022007752.2T DE112022007752T5 (de) 2022-11-15 2022-11-15 Steuereinheit und computer
JP2024558536A JPWO2024105777A1 (ja) 2022-11-15 2022-11-15
PCT/JP2022/042393 WO2024105777A1 (ja) 2022-11-15 2022-11-15 制御装置およびコンピュータ
CN202280101737.5A CN120187560A (zh) 2022-11-15 2022-11-15 控制装置以及计算机
TW112142122A TW202421392A (zh) 2022-11-15 2023-11-01 控制裝置以及電腦

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2022/042393 WO2024105777A1 (ja) 2022-11-15 2022-11-15 制御装置およびコンピュータ

Publications (1)

Publication Number Publication Date
WO2024105777A1 true WO2024105777A1 (ja) 2024-05-23

Family

ID=91084011

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2022/042393 Ceased WO2024105777A1 (ja) 2022-11-15 2022-11-15 制御装置およびコンピュータ

Country Status (5)

Country Link
JP (1) JPWO2024105777A1 (ja)
CN (1) CN120187560A (ja)
DE (1) DE112022007752T5 (ja)
TW (1) TW202421392A (ja)
WO (1) WO2024105777A1 (ja)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001071285A (ja) * 1999-09-01 2001-03-21 Minolta Co Ltd 作業ロボット
WO2018092860A1 (ja) * 2016-11-16 2018-05-24 三菱電機株式会社 干渉回避装置
CN111399514A (zh) * 2020-03-30 2020-07-10 浙江钱江机器人有限公司 一种机器人时间最优轨迹规划方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001071285A (ja) * 1999-09-01 2001-03-21 Minolta Co Ltd 作業ロボット
WO2018092860A1 (ja) * 2016-11-16 2018-05-24 三菱電機株式会社 干渉回避装置
CN111399514A (zh) * 2020-03-30 2020-07-10 浙江钱江机器人有限公司 一种机器人时间最优轨迹规划方法

Also Published As

Publication number Publication date
CN120187560A (zh) 2025-06-20
DE112022007752T5 (de) 2025-07-03
TW202421392A (zh) 2024-06-01
JPWO2024105777A1 (ja) 2024-05-23

Similar Documents

Publication Publication Date Title
US11117254B2 (en) Robotic navigation system and method
Borst et al. DLR hand II: Experiments and experience with an anthropomorphic hand
US12296485B2 (en) Robot arm with adaptive three-dimensional boundary in free-drive
US10737396B2 (en) Method and apparatus for robot path teaching
US9387589B2 (en) Visual debugging of robotic tasks
US20210001484A1 (en) Collaborative Robot System Incorporating Enhanced Human Interface
US20220388156A1 (en) Maintaining free-drive mode of robot arm for period of time
JP6314134B2 (ja) ロボット訓練のためのユーザインターフェース
US20150127151A1 (en) Method For Programming Movement Sequences Of A Redundant Industrial Robot And Industrial Robot
US9919424B1 (en) Analog control switch for end-effector
JP4976883B2 (ja) マニピュレータシステム
KR20130122970A (ko) 다관절형 로봇의 제어 장치, 제어 방법 및 제어 프로그램을 기록한 컴퓨터 판독가능한 기록 매체
US20220379463A1 (en) Safe activation of free-drive mode of robot arm
JP2019018272A (ja) モーション生成方法、モーション生成装置、システム及びコンピュータプログラム
US20240416504A1 (en) Method for Precise, Intuitive Positioning of Robotic Welding Machine
US20190311079A1 (en) Simulation apparatus, robot, simulation method, and program therefor
CN107336228B (zh) 显示包含附加轴的状态的动作程序的机器人的控制装置
KR102219543B1 (ko) 다관절 로봇 및 다관절 로봇 시스템
JP6904759B2 (ja) ロボットの移動速度制御装置及び方法
Kuan et al. VR-based teleoperation for robot compliance control
WO2024105777A1 (ja) 制御装置およびコンピュータ
Allspaw et al. Implementing virtual reality for teleoperation of a humanoid robot
WO2024105779A1 (ja) 制御装置およびコンピュータ
JP7583490B1 (ja) 制御装置、制御方法、及びプログラム
JP2023140592A (ja) 教示装置および教示プログラム

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22965753

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 112022007752

Country of ref document: DE

WWE Wipo information: entry into national phase

Ref document number: 2024558536

Country of ref document: JP

WWE Wipo information: entry into national phase

Ref document number: 202280101737.5

Country of ref document: CN

WWP Wipo information: published in national office

Ref document number: 202280101737.5

Country of ref document: CN

WWP Wipo information: published in national office

Ref document number: 112022007752

Country of ref document: DE

122 Ep: pct application non-entry in european phase

Ref document number: 22965753

Country of ref document: EP

Kind code of ref document: A1