WO2016103297A1 - アーム型のロボットの障害物自動回避方法及び制御装置 - Google Patents
アーム型のロボットの障害物自動回避方法及び制御装置 Download PDFInfo
- Publication number
- WO2016103297A1 WO2016103297A1 PCT/JP2014/006475 JP2014006475W WO2016103297A1 WO 2016103297 A1 WO2016103297 A1 WO 2016103297A1 JP 2014006475 W JP2014006475 W JP 2014006475W WO 2016103297 A1 WO2016103297 A1 WO 2016103297A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- posture
- robot
- virtual
- final
- geometric model
- Prior art date
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
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/0095—Manipulators transporting wafers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/06—Safety devices
-
- 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/06—Programme-controlled manipulators characterised by multi-articulated arms
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/162—Mobile manipulator, movable base with manipulator arm mounted on it
-
- 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/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- H—ELECTRICITY
- H01—ELECTRIC ELEMENTS
- H01L—SEMICONDUCTOR DEVICES NOT COVERED BY CLASS H10
- H01L21/00—Processes or apparatus adapted for the manufacture or treatment of semiconductor or solid state devices or of parts thereof
- H01L21/67—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere
- H01L21/683—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for supporting or gripping
- H01L21/687—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for supporting or gripping using mechanical means, e.g. chucks, clamps or pinches
- H01L21/68707—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for supporting or gripping using mechanical means, e.g. chucks, clamps or pinches the wafers being placed on a robot blade, or gripped by a gripper for conveyance
Definitions
- the present invention relates to an obstacle automatic avoidance method and control device for an arm type robot.
- Patent Document 1 discloses a method of returning to the work origin by going back along the route. Specifically, a control method for returning a robot that performs a series of operations along a desired route from a stop position to a work origin by sequentially executing a control program including a movement command, which has already been executed. When reversely executing the control program sequentially, each movement command is executed using the position argument of the previous movement command.
- Patent Document 2 discloses a robot that can return to the origin even when the robot abnormally stops outside the moving path. Specifically, an area block creation process that divides an area map including at least an operation area where the robot operates into each area block having a predetermined area, and a direction setting that sets the return direction of the robot for each divided area block A process. Thereby, interference with an obstacle can be avoided.
- Patent Document 1 cannot return to the work origin when the robot stops abnormally outside the movement path.
- Patent Document 2 can do this.
- the method described in Patent Document 2 has a problem in that it is necessary to set the return direction of the robot for each area block in advance, and the work amount of the worker who performs the setting work increases. Further, the determination of the return direction also requires a judgment based on the rules of experience of the workers, and there is a problem that it is difficult to secure the workers.
- the data amount of the data in which the return direction of the robot is set for each area block becomes enormous. In other words, there is a problem that a complicated setting is required for the return direction of the robot.
- the present invention has been made in view of the above problems, and is a robot obstacle automatic avoidance method and control that can safely reach a predetermined posture with a simple setting regardless of where the robot stops.
- An object is to provide an apparatus.
- an obstacle automatic avoidance method for a robot is an arm type robot including a robot arm in which one or more links are connected by a joint and a hand is provided at a tip.
- An obstacle automatic avoidance method a geometric model representing step of modeling the robot as a geometric model by modeling the robot so as to have a geometric shape, an entry prohibited area where the geometric model should not enter, and the entry prohibited area
- a region setting step for setting an operation region in which the geometric model operates, a final posture determining step for determining a final posture of the robot, and a case where the robot changes from the current posture toward the final posture.
- An initial trajectory determining step for determining an initial trajectory of the hand at a predetermined point on the initial trajectory
- a virtual posture calculating step for calculating a virtual posture of the robot to respond
- an interference determining step for determining whether the geometric model in the virtual posture interferes with the entry prohibition region, and interference in the interference determining step.
- the virtual posture is determined as a via posture, and when it is determined that interference occurs, a repulsive force that repels relatively the interference portion of the entry prohibition region and the interference portion of the geometric model is virtually generated, A posture in a state where an interference part of the geometric model is pushed out from the entry prohibition region to the motion region by a virtual repulsive force, and a via posture determination step for determining the calculated posture as a via posture; from the current posture An update trajectory that determines the trajectory of the hand as an update trajectory when changing to the final posture via the via posture
- the initial trajectory determination step, the virtual posture calculation step, the interference determination step, the transit posture assuming that the via posture determined in the determination step and the latest via posture determination step is the current posture in the initial trajectory determination step. And a step of repeatedly executing the update trajectory determination step.
- the robot's virtual posture corresponding to a predetermined point on the initial trajectory of the hand is calculated, and the robot's geometric model in the virtual posture is prohibited from entering. It is determined whether or not it interferes with an area (obstacle). If it is determined that there is no interference, the virtual posture is determined as a via posture that passes when the current posture changes from the current posture to the final posture. A posture in a state where the portion is pushed out from the entry prohibition region to the motion region is calculated, and the posture is determined as a via posture. Therefore, when the geometric model of the robot interferes with the entry prohibition area, a via posture that does not interfere with the entry prohibition area is given, so that collision with an obstacle is avoided.
- the final posture determination step includes a sum of absolute values of angular displacements of the joints between the current posture of the robot and the final candidate posture among the plurality of final candidate postures of the robot set on a known trajectory.
- the final candidate posture with the minimum value may be selected and determined as the final posture.
- a posture close to the current posture of the robot can be selected as the final posture. Therefore, the time required to reach the final posture can be shortened.
- the via posture determination step calculates a torque generated around the rotation axis of each joint of the robot in a virtual posture by the virtual repulsive force, and further changes after the predetermined time of the robot that changes due to the influence of the torque.
- the calculation of the virtual posture is repeated with the virtual posture as a starting point to calculate the temporal change of the virtual posture of the robot, and based on the virtual posture of the robot when the temporal change of the virtual posture of the robot converges
- the via posture may be determined.
- the virtual repulsive force may be configured to increase in proportion to the distance that the geometric model has entered the entry prohibition area.
- a route candidate posture generating step for generating a route candidate posture other than the posture pushed by the virtual repulsive force of the robot, and determining whether the route candidate posture is a posture approaching the final posture.
- the route posture is determined based on the route candidate posture. 1 determination step.
- the posture pushed back to the motion region corresponds to a point on the initial trajectory. Interference is repeated and the robot enters a stationary state, and the robot does not approach the final posture.
- a via posture corresponding to a point that is not on the initial trajectory can be obtained, so even if it falls into such a stationary state, it passes through another via posture that approaches the final posture. Can reach the final posture.
- a second determination is made as to whether to select the route candidate posture based on a probability value. If it is determined to be selected in the determination step and the second determination step, a second determination step of determining the via posture based on the via candidate posture may be included.
- an arm-type robot control apparatus includes an arm-type robot including a robot arm in which one or more links are connected by a joint and a hand is provided at a tip.
- the control device is defined by a geometric model expression unit that models the robot as a geometric model by modeling the robot so as to have a geometric shape, an entry prohibition area that the geometric model should not enter, and the entry prohibition area.
- An initial trajectory determination unit that determines an initial trajectory of the robot, and calculates a virtual posture of the robot corresponding to a predetermined point on the initial trajectory.
- a virtual posture calculation unit an interference determination unit that determines whether or not the geometric model in the virtual posture interferes with the entry prohibition region, a via posture determination unit that determines a via posture, an update trajectory determination unit, And when the interference determination unit determines that the interference determination unit does not interfere, the via posture determination unit determines the virtual posture as a via posture, and determines that interference occurs, the interference part of the entry prohibition area and the geometric model
- a repulsive force that relatively repels the interference portion is virtually generated, and a posture in a state in which the interference portion of the geometric model is pushed from the entry prohibition region to the operation region by the virtual repulsion force is calculated.
- the updated trajectory determining unit determines the trajectory of the hand when changing from the current posture to the final posture via the via posture.
- the initial trajectory determination unit, the virtual posture calculation unit, the interference determination unit, and the via posture assuming that the latest via posture determined by the via posture determination unit is the current posture of the initial trajectory determination unit
- the determination unit and the update trajectory determination unit are configured to repeatedly process.
- the robot's virtual posture corresponding to a predetermined point on the initial trajectory of the hand is calculated, and the robot's geometric model in the virtual posture is prohibited from entering. It is determined whether or not it interferes with an area (obstacle). If it is determined that there is no interference, the virtual posture is determined as a via posture that passes when the current posture changes from the current posture to the final posture. A posture in a state where the portion is pushed out from the entry prohibition region to the motion region is calculated, and the posture is determined as a via posture. Therefore, when the geometric model of the robot interferes with the entry prohibition area, a via posture that does not interfere with the entry prohibition area is given, so that collision with an obstacle is avoided.
- the present invention has an effect that the robot can safely reach a predetermined posture by simply avoiding interference with an obstacle regardless of where the robot stops at a simple setting.
- FIG. 2 is a block diagram schematically showing a configuration example of a control system of the robot of FIG. 1. It is explanatory drawing which shows the selection method of the last attitude
- FIG. 1 is a plan view illustrating a configuration example of an equipment 110 including the robot 100 according to Embodiment 1 of the present invention.
- the equipment 110 is equipment for processing a substrate, for example, and the robot 100 is installed therein, and includes, for example, a wall 111 surrounding the chamber 113 and a wall 112 projecting inward from the wall 111 inside the chamber. These walls 111 and 112 constitute an obstacle in the operation of the robot 100.
- the robot 100 is a robot that transports a substrate such as a semiconductor wafer or a glass wafer.
- the robot 100 is an arm-type robot including a robot arm in which one or more links are connected by joints and a hand is provided at the tip. More specifically, the robot 100 is a horizontal articulated robot, and includes a base 1, a first arm 2, a second arm 3, and a hand 4, which are linearly connected. Yes. In the present embodiment, the first arm 2, the second arm 3, and the hand 4 constitute a robot arm.
- the robot 100 also includes a controller 5 (see FIG. 2) that controls the operation of the robot 100.
- the base 1 is, for example, a hollow cylindrical member.
- a first arm drive unit 12 (see FIG. 2) including a servomotor is disposed inside the base 1.
- the 1st arm drive part 12 is comprised so that the 1st joint shaft 2a mentioned later may be rotated.
- the first arm 2 is, for example, a hollow plate-like member, and is formed in a substantially strip shape in plan view.
- the first arm 2 has a first joint shaft 2 a formed so as to protrude downward from the bottom surface of the base end portion of the first arm 2.
- shaft 2a is attached to the base 1 so that rotation is possible centering on the rotation axis L1 extended in az direction, and this part comprises the 1st joint. Accordingly, the first arm 2 is configured to rotate in the xy plane.
- the rotation axis L1 constitutes the reference point O on the xy plane.
- a second arm driving unit 13 (see FIG. 2) including a servo motor is disposed inside the first arm 2.
- the 2nd arm drive part 13 is comprised so that the 2nd joint axis
- the relative angular position q1 (see FIG. 3) around the rotation axis L1 with respect to the base 1 of the first arm 2 is detected by the encoder of the servo motor of the first arm driving unit 12.
- This encoder constitutes the first arm angular position detector 15 (see FIG. 2).
- the first arm 2 may be referred to as the first link, and the first joint axis 2a may be referred to as one axis.
- the second arm 3 is, for example, a hollow plate-like member, and is formed in a substantially strip shape in plan view.
- the second arm 3 is provided with a second joint shaft 3 a so as to protrude downward from the bottom surface of the base end portion of the second arm 3.
- the second joint shaft 3a is attached to the first arm 2 so as to be rotatable about a rotation axis L2 extending in parallel with the rotation axis L1, and this portion constitutes a second joint. Accordingly, the second arm 3 is configured to rotate on the xy plane.
- a hand drive unit 14 (see FIG. 2) including a servo motor is disposed.
- the hand drive unit 14 is configured to rotate a third joint shaft 4a described later.
- the relative angular position q2 (see FIG. 3) around the rotation axis L2 of the second arm 3 with respect to the first arm 2 is detected by the encoder of the servo motor of the second arm drive unit 13.
- This encoder constitutes the second arm angular position detector 16 (see FIG. 2).
- the second arm 3 is sometimes referred to as a second link, and the second joint axis 3a is sometimes referred to as a two-axis.
- the hand 4 holds a substrate and is formed in a flat plate shape.
- the hand 4 has a third joint shaft 4a formed so as to protrude downward from the bottom surface of the base end portion thereof.
- shaft 4a is attached to the 2nd arm 3 so that rotation is possible centering on the rotation axis L3 extended in parallel with rotation axis L1, L2, and this part comprises the 3rd joint. Therefore, the hand 4 is configured to rotate in the xy plane.
- the relative angular position q3 (see FIG. 3) around the rotation axis L3 with respect to the second arm 3 of the hand 4 is detected by the servo motor encoder of the hand drive unit 14.
- This encoder constitutes the hand angle position detector 17 (see FIG. 2).
- the hand 4 is sometimes referred to as the third link, and the third joint axis 4a is sometimes referred to as the third axis.
- FIG. 2 is a block diagram schematically showing a configuration example of the control system of the robot 100.
- the controller 5 provided in the robot 100 includes, for example, a control unit 21 having a computing unit such as a CPU and a storage unit 22 having a memory such as a ROM and a RAM.
- the controller 5 may be composed of a single controller that performs centralized control, or may be composed of a plurality of controllers that perform distributed control in cooperation with each other.
- the control unit 21 includes a first arm control unit 31, a second arm control unit 32, a hand control unit 33, a final posture determination unit 34, an initial trajectory determination unit 35, a virtual posture calculation unit 36, a geometric model expression unit 37, and a region setting.
- These functional units 31 to 41 are functional blocks (functional modules) realized by the control unit 21 executing a predetermined control program stored in the storage unit 22.
- the first arm control unit 31 controls the first arm driving unit 12 to rotate the first arm 2 around the rotation axis L1 in the xy plane.
- the second arm control unit 32 controls the second arm driving unit 13 to rotate the second arm 3 around the rotation axis L2 in the xy plane.
- the hand control unit 33 controls the hand driving unit 14 to rotate the hand 4 around the rotation axis L3 in the xy plane.
- the main control unit (not shown) of the control unit 21 detects the first arm angular position detection unit 15, the second arm angular position detection unit 16, and the hand angular position detection of the robot 100. Based on the angular position detected by the unit 17 and the final posture, the final angular position is output to the first arm control unit 31, the second arm control unit 32, and the hand control unit 33, respectively.
- the first arm control unit 31, the second arm control unit 32, and the hand control unit 33 are respectively angles of corresponding control objects (first joint axis 2a, second joint axis 3a, and third joint axis 4a).
- the corresponding first arm drive unit 12, second The arm driving unit 13 and the hand driving unit 14 are feedback-controlled.
- the geometric model expression unit 37 represents the robot 100 as a geometric model M by modeling it to have a geometric shape.
- the geometric model expression unit 37 represents the first arm 2, the second arm 3, and the hand 4 with geometric models M1, M2, and M3.
- the geometric model M1 of the first arm 2 is, for example, an oval model as shown in FIG.
- the geometric model M1 is expressed so as to be separated from the figure outside the figure obtained by projecting the first arm 2 onto the xy plane.
- the geometric model M2 of the second arm 3 is, for example, an oval model.
- the geometric model M2 is expressed so as to be separated from the figure outside the figure obtained by projecting the second arm 3 onto the xy plane.
- the geometric model M3 of the hand 4 is, for example, a water drop type model.
- the geometric model M3 is defined (defined) so as to be separated from the figure outside the figure obtained by projecting the hand 4 holding the substrate onto the xy plane.
- the area setting unit 40 is defined (defined) by an entry prohibition area S1 into which the geometric models M1 to M3 should not enter and an entry prohibition area S1, and the geometric models M1 to M3 operate.
- the operation area S2 to be set is set.
- the entry prohibition region S1 and the operation region S2 are stored in the storage unit 22, and the region setting unit 40 reads out the entry prohibition region S1 and the operation region S2 from the storage unit 22, thereby preventing the entry prohibition region.
- S1 and operation area S2 are set.
- the entry prohibition region S1 is set so as to include a region inside the inner wall surface (wall surface of the wall 111 and the wall 112) of the chamber 113 of the facility 110. Further, a virtual line extending along the boundary between the entry prohibition area S1 and the operation area S2 constitutes the boundary line B.
- the final posture determination unit 34 determines the final posture Pt of the robot 100.
- the final posture determination unit 34 selects and determines one final posture Pt from a plurality of final candidate postures Ptc stored in the storage unit 22.
- the final candidate posture Ptc is a posture set on a known trajectory that does not interfere with the entry prohibition area S1. Therefore, if the robot 100 can reach any one of the postures, the robot 100 can follow the known trajectory and operate without interfering with the entry prohibition area S1.
- FIG. 3 is an explanatory diagram showing a method for selecting the final posture Pt of the robot 100.
- the final posture determination unit 34 selects one final posture Pt from a plurality of final candidate postures Ptc (one of which is shown in FIG. 3), first, the current posture Ps and the final candidate posture Ptc The total sum E of the absolute values of the joint angle displacement of each joint axis is calculated based on the following equation.
- the final candidate posture Ptc having the smallest value of E is selected, and this is determined as the final posture Pt.
- the initial trajectory determination unit 35 determines the initial trajectory Ta of the hand 4 when the robot 100 changes from the current posture Ps toward the final posture Pt determined by the final posture determination unit 34.
- the initial trajectory Ta is a trajectory that is uniquely determined by being given the current posture Ps and the final posture Pt.
- the virtual posture calculation unit 36 calculates the virtual posture Pp of the robot 100 at a predetermined point on the initial trajectory Ta.
- the interference determination unit 38 determines whether or not the geometric models M1 to M3 of the robot 100 in the virtual posture Pp interfere with the entry prohibition area S1.
- the via posture determining unit 39 calculates a via posture Pv that passes when the current posture Ps changes toward the final posture Pt.
- the via posture determination unit 39 determines the virtual posture Pp as the via posture Pv.
- the via posture determination unit 39 determines that at least one of the geometric models M1 to M3 interferes with the entry prohibited area S1, the interference part of the entry prohibited area S1 and the interference part of the geometric model are relatively compared.
- FIG. 4 is a flowchart showing a method of calculating the via posture Pv of the robot 100.
- FIG. 5A to 5C are explanatory diagrams showing a method for calculating the via posture Pv of the robot 100.
- FIG. 5A to 5C are explanatory diagrams showing a method for calculating the via posture Pv of the robot 100.
- the robot 100 is a robot having three links, but the following is a concept when generalized as a robot having n links.
- the distance di at which the geometric model of the robot 100 has entered the entry prohibition area S1 is determined (step S71).
- the calculation of the distance di is performed according to the form of interference between each geometric model and the entry prohibition area S1 in the virtual posture Pp.
- a point P (x, y) on the geometric model Mi having the maximum distance from the boundary line B in the interference portion of the geometric model Mi (the portion marked with light ink in FIG. 5A). Is calculated. Then, in the normal direction of the boundary line B, the distance between the point P and the boundary line B is set to the distance di.
- the distance between the point P and the vertex Q of the boundary line B is set to the distance di.
- the side from the vertex Q of the boundary line B toward one intersection R of the geometric model and the boundary line B A point P1 (x, y) on the geometric model Mi having a maximum distance from the boundary line B is calculated. Then, the distance between the point P1 and the boundary line B is set to the distance di1 in the normal direction of the line segment QR.
- the distance between the point P2 and the boundary line B is set to the distance di2 in the normal direction of the line segment QR '.
- the calculation of the distance di is configured to be performed according to the form of interference between the geometric model in the virtual posture Pp and the entry prohibition region S1, but is not limited to the above configuration.
- a virtual repulsive force fi is calculated for each link based on the following equation (2) (step S72).
- the virtual repulsive forces fi1 and fi2 are calculated based on the equation (2), respectively, and then the virtual repulsive forces fi1 and fi2 are combined to generate the virtual repulsive force.
- the force fi is calculated.
- the virtual repulsive force fi is not generated in the i-th link determined not to interfere with the entry prohibition area S1.
- step S73 a virtual torque ⁇ generated around each axis of the robot 100 generated by the virtual repulsive force fi is calculated (step S73).
- the virtual repulsive force fi generated in the i-th link determined to interfere with the boundary line B is configured to affect not only the i-th link but also the i ⁇ n-th link. ing.
- the virtual repulsive force fi affects other links and generates torque. Therefore, another link is rotated by the torque, and a via posture Pv different from the virtual posture Pp can be generated.
- the calculation of the angle ⁇ i is performed according to the form of interference between each geometric model and the entry prohibition area S1.
- the angle ⁇ i is an angle formed by the normal direction of the boundary line B and the x axis in the xy plane.
- the angle ⁇ i is an angle formed by the line segment PQ and the x axis.
- the angle ⁇ i is an angle formed by the resultant vector of the virtual repulsive force and the x axis.
- q (•) is a symbol with a single symbol (dot) on q.
- a virtual posture Pp is set based on q [k] (step S74).
- the avoidance trajectory determination unit 41 determines the trajectory of the hand 4 as the updated trajectory Tb when the current posture Ps changes to the final posture Pt via the via posture Pv.
- FIG. 6 is a flowchart showing an operation example of the robot 100 according to the embodiment of the present invention.
- 7A to 7F are diagrams showing an operation example of the robot 100 according to the embodiment of the present invention.
- the final posture determination unit 34 of the control unit 21 determines the final posture Pt of the robot 100 (final posture determination step) (step S10).
- the final posture determination unit 34 of the control unit 21 calculates E values for the four final candidate postures Ptc1 to Ptc4, and selects the final candidate posture Ptc4 that minimizes the value of E as the final posture Pt. .
- the displacement of each axis required to reach the final posture Pt from the current posture Ps can be reduced. The average time required for the process can be shortened.
- the initial trajectory determination unit 35 of the control unit 21 determines an initial trajectory Ta that the robot 100 changes from the current posture Ps toward the final posture Pt (initial trajectory determination step) (step S20).
- the virtual posture calculation unit 36 of the control unit 21 is a robot at a predetermined point on the side near the current posture Ps in the initial trajectory Ta and toward the final posture Pt from the current posture Ps.
- 100 virtual postures Pp are calculated (virtual posture calculation step) (step S30).
- the vicinity means an attitude obtained by making a minute change to each axis from the current attitude.
- the region setting unit 40 of the control unit 21 reads and sets the entry prohibition region S1 and the operation region S2 from the storage unit 22 (region setting step) (step S35).
- the geometric model representation unit 37 of the control unit 21 models the first arm 2, the second arm 3, and the hand 4 of the robot 100 in the virtual posture Pp, and uses the geometric models M1, M2, and M3, respectively.
- Express geometric model expression step
- the geometric models M1 to M3 are simplified models of the first arm 2, the second arm 3, and the hand 4 of the robot 100, it is possible to reduce the amount of calculation required to determine interference described later. Interference can be quickly determined.
- the outer periphery of the figure drawn by the virtual lines of the geometric models M1 to M3 is defined (defined) so as to be separated from this figure outside the figure obtained by projecting the hand 4 holding the substrate onto the xy plane. Is done. That is, since the geometric model is expressed more thickly than the first arm 2, the second arm 3, and the hand 4, the interference determination unit 38 of the control unit 21 performs the geometric model and the entry prohibition region S1 in step S50 described later. Even when it is determined that the robot 100 and the robot 110 are interfering with each other, it is possible to prevent the robot 100 and the equipment 110 from interfering with each other and prevent the robot 100 or the substrate held by the robot 100 from actually contacting the equipment 110. can do.
- the entry prohibition area S1 is set so as to include an area inside the inner wall surface of the chamber 113 of the equipment 110, the robot 100 or a substrate held by the robot 100 is more likely to come into contact with the equipment 110. It can be surely prevented.
- the interference determination unit 38 of the control unit 21 determines whether or not the geometric models M1 to M3 in the virtual posture Pp interfere with the entry prohibition region S1 (interference determination step) (step S50). That is, the fact that the geometric model and the entry prohibition area S1 interfere is a state where the boundary line and the boundary line B of the geometric model intersect.
- the geometric model expression unit 37 generates the geometric model in the step immediately before the interference determination by the interference determination unit 38.
- the present invention is not limited to this. You may perform in the arbitrary steps before interference determination.
- the setting of the entry prohibition area S1 and the entry prohibition area S2 by the area setting unit 40 may be performed in an arbitrary step before the interference determination by the interference determination unit 38.
- step S60 the via attitude
- Step S70 when the interference determination unit 38 of the control unit 21 determines in step S50 that the geometric model and the boundary line B interfere (Yes in step S50), the via posture determination unit of the control unit 21 7E, as shown in FIG. 7E, calculates a posture in a state where the interference portion of the geometric model is pushed out from the entry prohibition region S1 to the motion region S2, and determines the calculated posture as a via posture Pv (delay via posture determination). Step) (Step S70).
- the updated trajectory determining unit 41 of the control unit 21 moves the hand 4 when changing from the current posture Ps to the final posture Pt via the via posture Pv. Is determined as the update trajectory Tb (update trajectory determination step) (step S80).
- control unit 21 determines (assumes) the via posture Pv as a new current posture Ps and determines (assumes) the updated trajectory Tb as a new initial trajectory Ta (step S90).
- the virtual posture calculation unit 36 of the control unit 21 calculates a new virtual posture Pp at a predetermined point near the current posture Ps on the initial trajectory Ta and on the side from the current posture Ps toward the final posture Pt. (Step S100).
- step S100 it is determined whether or not the virtual posture Pp calculated in step S100 matches the final posture Pt. If it is determined that they do not match (No in step S110), steps S40 to S110 are repeatedly executed. That is, steps S40 to S110 are executed until the current posture Ps matches the final posture Pt.
- step S100 matches the final posture Pt (Yes in step S110)
- the process is terminated.
- FIG. 7F a final update trajectory Tb that avoids interference with the entry prohibition region S1 is generated.
- the robot 100 is configured to actually move the robot 100 from the current posture Ps toward the final posture Pt along the final update trajectory Tb after the above processing is completed. . That is, when the transit posture Pv is reset as the new current posture Ps in step S90, the control unit 21 does not move the first arm 2, the second arm 3, and the hand 4 toward the current posture Ps.
- the history of the updated trajectory Tb is stored in the storage unit 22.
- the present invention is not limited to this, and each time the transit posture Pv is determined as a new current posture Ps in step S90, the control unit 21 moves toward the current posture Ps by the first arm 2, the second arm 3, And the hand 4 may actually be moved.
- the robot 100 is a virtual posture of the robot 100 corresponding to a predetermined point on the initial trajectory Ta of the hand 4 when the robot 100 changes from the current posture Ps toward the final posture Pt.
- Pp is calculated, and it is determined whether or not the geometric models M1 to M3 of the robot 100 in the virtual posture Pp interfere with the entry prohibition area S1 defined (delimited) corresponding to the obstacle.
- the virtual posture Pp is determined as a via posture Pv that passes when the current posture Ps changes from the current posture Ps toward the final posture Pt.
- the virtual repulsive force fi is determined.
- the initial trajectory Ta is a trajectory that is uniquely determined by being given the current posture Ps and the final posture Pt.
- the via posture Pv determined in step S70 is a posture uniquely determined by the positional relationship between each geometric model and the boundary line B in the virtual posture Pp. Therefore, in the first embodiment, for example, when the direction pushed back by the repulsive force coincides with the direction of the initial trajectory Ta, the updated trajectory Tb determined based on the posture pushed by the virtual repulsive force fi is In some cases, the final posture Pt may not be approached.
- This embodiment is an embodiment in consideration of a case where the update trajectory Tb does not approach the final posture Pt.
- FIG. 8 is a flowchart showing an operation example of the robot 100 according to the second embodiment of the present invention.
- step S70 the determination of the via posture in step S70 is executed as follows.
- step S271 it is determined whether or not the vehicle is in a stationary state (stationary state determining step) (step S271).
- whether or not the vehicle is in the stationary state is determined based on the sum E of absolute values of the joint angle displacement of each joint axis between the virtual posture Pp and the final posture Pt based on the following equation (5). To calculate.
- steps S71 to S74 are executed. Steps S71 to S74 are the same as steps S71 to S74 in the first embodiment, and a description thereof will be omitted.
- step S271 if it is determined in step S271 that the control unit 21 is in a stationary state, the via-posture determination unit 39 of the control unit 21 has a posture other than the posture pushed by the virtual repulsive force fi in the vicinity of the current posture Ps.
- a route candidate posture Pvc is calculated (route candidate posture generation step) (step S272).
- the route candidate posture Pvc is a randomly generated posture. However, it is not limited to this. Instead of this, for example, it may be generated according to the situation around the current posture Ps.
- step S273 it is determined whether or not the via candidate posture Pvc is a posture closer to the final posture Pt than the current posture Ps (first determination step) (step S273).
- whether or not the via candidate posture Pvc is a posture approaching the final posture Pt is determined based on the value of E calculated based on the following equation (6) and the following equation (7). This is done by comparing the value of E calculated based on this.
- the above equation (6) is to obtain the sum E (qr) of the absolute value of the joint angle displacement of each joint axis between the route candidate posture Pvc and the final posture Pt.
- the above equation (7) is to obtain the sum E (q) of absolute values of the joint angle displacement of each joint axis between the current posture Ps and the final posture Pt.
- the said Formula (8) is a type
- the via posture determining unit 39 of the control unit 21 determines that the posture approaches the final posture Pt (Yes in step S273), the via posture Pv is determined based on the via candidate posture Pvc (first determining step) (Ste S274). Further, it is determined whether or not the trajectory from the current posture to the transit posture Pv does not interfere with the entry prohibition area S1.
- step S275 determines whether or not the via candidate posture Pvc is selected as the via posture Pv (second).
- This selection is performed using probability values.
- this selection is performed by calculating the transition probability P ( ⁇ , t) according to the evaluation value of the via candidate posture Pvc by the following equation (9), and using the via candidate posture Pvc according to this probability. Decide whether to select Pv. Also, this transition probability graph is illustrated as a line indicated by a in the figure.
- the transition probability P ( ⁇ , t) becomes closer to 0, that is, the smaller the degree that the route candidate posture Pvc deviates from the final posture Pt than the current posture Ps, the route candidate posture Pvc passes through.
- the possibility of being selected as the posture Pv is increased (approaching 1), and the greater the degree that the via candidate posture Pvc deviates from the final posture Pt than the current posture Ps, the more likely the via candidate posture Pvc is selected as the via posture Pv.
- the nature becomes low (approaching 0).
- the via posture Pv is determined based on the via candidate posture Pvc (second determination step) (step S276).
- control part 21 performs the process after step S80 similarly to the said embodiment.
- the probability of selecting a posture that deviates from the final posture Pt is reduced by decreasing the value of the parameter t as shown by the line b in the graph of FIG. May be.
- the robot 100 moves the posture pushed into the motion region S2 to a point on the initial trajectory Ta. Therefore, the interference of the geometric model with respect to the entry prohibition area S1 is repeated, and the robot 100 enters the stationary state, and the robot 100 does not approach the final posture Pt (cannot reach the final posture).
- a via posture Pv corresponding to a point not on the initial trajectory Ta can be obtained, and an updated trajectory Tb is determined based on this posture, via another via posture Pv that approaches the final posture Pt.
- the final posture Pt can be reached.
- the state in which the current final posture Pt cannot be reached can be suitably removed. Since it is determined whether or not the route candidate posture is selected based on a probability value that decreases in proportion to the degree of divergence between the final posture Pt and the route candidate posture Pvc, the degree of divergence from the current posture Ps is small. The possibility that the route candidate posture Pvc is selected as the route posture Pv is increased. As a result, a state in which the current final posture cannot be reached more appropriately can be suitably removed.
- FIGS. 10A and 10B are diagrams showing simulation conditions of the robot 100 in the present embodiment.
- the current posture Ps, the entry prohibition area S1, the action area S2, and the geometric model M of the robot 100 are set.
- FIG. 10C is a diagram illustrating a simulation result of the robot 100, and is a diagram illustrating a hand trajectory. As shown in FIG. 10C, it can be seen that the robot 100 reaches the final posture Pt from the current posture Ps.
- the robot 100 is configured as a horizontal articulated robot, the geometric model is expressed in the xy plane, and the presence / absence of interference in the z-axis direction is not determined, but the present invention is not limited to this.
- the robot may be configured with vertical articulated joints, the geometric model may be expressed three-dimensionally, and interference may be determined in a three-dimensional space.
- the virtual posture calculation unit 36 calculates the virtual posture Pp of the robot 100.
- the virtual posture calculation unit 36 may calculate the virtual posture Pp of the geometric model of the robot 100.
- the present invention can be applied to industrial robots.
Abstract
Description
図1は、本発明の実施の形態1に係るロボット100を備える設備110の構成例を示す平面図である。
ロボット100は、例えば半導体ウェハ、ガラスウェハ等の基板を搬送するロボットである。
図2は、ロボット100の制御系統の構成例を概略的に示すブロック図である。
次に、ロボット100の動作例を説明する。
同様に、領域設定部40による進入禁止領域S1及び進入禁止領域S2の設定も干渉判定部38による干渉判定より前の任意のステップで実行してもよい。
以下では実施の形態2の構成、動作について、実施の形態1との相違点を中心に述べる。
上記実施の形態においては、ロボット100を水平多関節ロボットで構成し、幾何モデルをxy平面において表現し、z軸方向における干渉の有無の判定は行っていないがこれに限られるものではない。これに代えて、ロボットを垂直多関節で構成し、幾何モデルを立体的に表現し、干渉の判定を3次元空間で行ってもよい。
L1 回動軸線
L2 回動軸線
L3 回動軸線
M1 幾何モデル
M2 幾何モデル
M3 幾何モデル
Pp 仮想姿勢
Ps 現在姿勢
Pt 最終姿勢
Ptc 最終候補姿勢
Pv 経由姿勢
Pvc 経由候補姿勢
S1 進入禁止領域
S2 動作領域
Ta 初期軌道
Tb 更新軌道
1 基台
2 第1アーム
2a 第1関節軸
3 第2アーム
3a 第2関節軸
4 ハンド
4a 第3関節軸
5 制御器
12 第1アーム駆動部
13 第2アーム駆動部
14 ハンド駆動部
15 第1アーム角度位置検出部
16 第2アーム角度位置検出部
17 ハンド角度位置検出部
21 制御部
22 記憶部
31 第1アーム制御部
32 第2アーム制御部
33 ハンド制御部
34 最終姿勢決定部
35 初期軌道決定部
36 仮想姿勢算出部
37 幾何モデル表現部
38 干渉判定部
39 経由姿勢決定部
40 領域設定部
41 更新軌道決定部
100 ロボット
110 設備
Claims (7)
- 1以上のリンクが関節によって連結され、先端部にハンドが設けられたロボットアームを備えるアーム型のロボットの障害物自動回避方法であって、
前記ロボットを、幾何形状を有するようモデリングして幾何モデルとして表現する幾何モデル表現ステップと、
前記幾何モデルが進入してはいけない進入禁止領域と、当該進入禁止領域によって規定され、前記幾何モデルが動作する動作領域とを設定する領域設定ステップと、
前記ロボットの最終姿勢を決定する最終姿勢決定ステップと、
前記ロボットが現在姿勢から前記最終姿勢に向かって変化する場合における前記ハンドの初期軌道を決定する初期軌道決定ステップと、
前記初期軌道上の所定の点に対応する前記ロボットの仮想姿勢を算出する仮想姿勢算出ステップと、
前記仮想姿勢における前記幾何モデルが前記進入禁止領域と干渉するか否かを判定する干渉判定ステップと、
前記干渉判定ステップにおいて干渉しないと判定した場合、前記仮想姿勢を経由姿勢として決定し、干渉すると判定した場合、前記進入禁止領域の干渉部分と前記幾何モデルの干渉部分とが相対的に反発する反発力を仮想的に発生させ、仮想反発力によって前記幾何モデルの干渉部分が前記進入禁止領域から前記動作領域に押し出された状態の姿勢を算出し、該算出した姿勢を経由姿勢として決定する経由姿勢決定ステップと、
前記現在姿勢から前記経由姿勢を経由して前記最終姿勢に変化する場合における前記ハンドの軌道を更新軌道として決定する更新軌道決定ステップと、
最新の経由姿勢決定ステップにおいて決定された経由姿勢を前記初期軌道決定ステップにおける前記現在姿勢と仮定して前記初期軌道決定ステップ、前記仮想姿勢算出ステップ、前記干渉判定ステップ、前記経由姿勢決定ステップ、及び前記更新軌道決定ステップを繰り返して実行するステップと、を含む、ロボットの障害物自動回避方法。 - 前記最終姿勢決定ステップは、既知の軌道上に設定される前記ロボットの複数の最終候補姿勢のうち、前記ロボットの現在姿勢と前記最終候補姿勢との前記各関節の角度の変位の絶対値の総和が最小の値である最終候補姿勢を前記最終姿勢として選択し、決定する、請求項1に記載のロボットの障害物自動回避方法。
- 前記経由姿勢決定ステップは、
前記仮想反発力によってある仮想姿勢における前記ロボットの前記各関節の回動軸周りに生じるトルクを算出し、更に該トルクの影響によって変化する前記ロボットの所定時間経過後の仮想姿勢を算出する演算を前記仮想姿勢を起点として繰り返し行うことによって前記ロボットの仮想姿勢の経時変化を算出し、前記ロボットの仮想姿勢の経時変化が収束したときの前記ロボットの仮想姿勢に基づいて前記経由姿勢を決定する、請求項1又は2に記載のロボットの障害物自動回避方法。 - 前記仮想反発力は、前記幾何モデルが進入禁止領域に進入した距離に比例して大きくなるように構成されている、請求項1乃至3の何れかに記載のロボットの障害物自動回避方法。
- 前記ロボットの姿勢が前記最終姿勢に近づくように経時変化せず、停留状態に陥っているか否かを判定する停留状態判定ステップと、
前記停留状態判定ステップにおいて停留状態に陥っていると判定された場合、前記ロボットの前記仮想反発力によって押し出された状態の姿勢以外の経由候補姿勢を生成する経由候補姿勢生成ステップと、
前記経由候補姿勢が前記最終姿勢に近づく姿勢であるか否かを判定する第1判定ステップと、
前記第1判定ステップにおいて、前記経由候補姿勢が前記最終姿勢に近づく方向に変化する姿勢であると判定された場合、該経由候補姿勢に基づいて前記経由姿勢を決定する第1決定ステップとを有する、請求項1乃至4の何れかに記載のロボットの障害物自動回避方法。 - 前記第1判定ステップにおいて、前記経由候補姿勢が前記最終姿勢から遠ざかる方向に変化する姿勢であると判定された場合、確率値に基づいて前記経由候補姿勢を選択するか否かを判定する第2判定ステップと、
前記第2判定ステップにおいて選択すると判定されると、当該経由候補姿勢に基づいて前記経由姿勢を決定する第2決定ステップとを有する、請求項5に記載のロボットの障害物自動回避方法。 - 1以上のリンクが関節によって連結され、先端部にハンドが設けられたロボットアームを備えるアーム型のロボットの制御装置であって、
前記ロボットを、幾何形状を有するようモデリングして幾何モデルとして表現する幾何モデル表現部と、
前記幾何モデルが進入してはいけない進入禁止領域と、当該進入禁止領域によって規定され、前記幾何モデルが動作する動作領域とを設定する領域設定部と、
前記ロボットの最終姿勢を決定する最終姿勢決定部と、
前記ロボットが現在姿勢から前記最終姿勢に向かって変化する場合における前記ハンドの初期軌道を決定する初期軌道決定部と、
前記初期軌道上の所定の点に対応する前記ロボットの仮想姿勢を算出する仮想姿勢算出部と、
前記仮想姿勢における前記幾何モデルが前記進入禁止領域と干渉するか否かを判定する干渉判定部と、
経由姿勢を決定する経由姿勢決定部と、
更新軌道決定部と、を備え、
前記経由姿勢決定部は、前記干渉判定部が干渉しないと判定した場合、前記仮想姿勢を経由姿勢として決定し、干渉すると判定した場合、前記進入禁止領域の干渉部分と前記幾何モデルの干渉部分とが相対的に反発する反発力を仮想的に発生させ、仮想反発力によって前記幾何モデルの干渉部分が前記進入禁止領域から前記動作領域に押し出された状態の姿勢を算出し、該算出した姿勢を経由姿勢として決定し、
前記更新軌道決定部は、前記現在姿勢から前記経由姿勢を経由して前記最終姿勢に変化する場合における前記ハンドの軌道を更新軌道として決定し、
前記経由姿勢決定部が決定した最新の経由姿勢を前記初期軌道決定部の現在姿勢と仮定して、前記初期軌道決定部、前記仮想姿勢算出部、前記干渉判定部、前記経由姿勢決定部、及び前記更新軌道決定部が繰り返し処理する、アーム型のロボットの制御装置。
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2014/006475 WO2016103297A1 (ja) | 2014-12-25 | 2014-12-25 | アーム型のロボットの障害物自動回避方法及び制御装置 |
JP2016565597A JP6378783B2 (ja) | 2014-12-25 | 2014-12-25 | アーム型のロボットの障害物自動回避方法及び制御装置 |
CN201480083989.5A CN107000223B (zh) | 2014-12-25 | 2014-12-25 | 臂型机械手的障碍物自动回避方法及控制装置 |
US15/539,838 US10350756B2 (en) | 2014-12-25 | 2014-12-25 | Method of automatically avoiding obstacle for arm robot and control device |
KR1020177019053A KR101941147B1 (ko) | 2014-12-25 | 2014-12-25 | 암형 로봇의 장애물 자동 회피방법 및 제어장치 |
TW104121463A TWI579669B (zh) | 2014-12-25 | 2015-07-02 | Automatic obstacle avoidance method and control device for arm type robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2014/006475 WO2016103297A1 (ja) | 2014-12-25 | 2014-12-25 | アーム型のロボットの障害物自動回避方法及び制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2016103297A1 true WO2016103297A1 (ja) | 2016-06-30 |
Family
ID=56149401
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2014/006475 WO2016103297A1 (ja) | 2014-12-25 | 2014-12-25 | アーム型のロボットの障害物自動回避方法及び制御装置 |
Country Status (6)
Country | Link |
---|---|
US (1) | US10350756B2 (ja) |
JP (1) | JP6378783B2 (ja) |
KR (1) | KR101941147B1 (ja) |
CN (1) | CN107000223B (ja) |
TW (1) | TWI579669B (ja) |
WO (1) | WO2016103297A1 (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018143003A1 (ja) * | 2017-01-31 | 2018-08-09 | 株式会社安川電機 | ロボットパス生成装置及びロボットシステム |
JP2018196919A (ja) * | 2017-05-24 | 2018-12-13 | ファナック株式会社 | パラレルリンク機構の制御装置及び制御方法、並びにパラレルリンク機構及び制御装置を含むシステム |
JP2021062436A (ja) * | 2019-10-11 | 2021-04-22 | セイコーエプソン株式会社 | 教示方法 |
JP2022511343A (ja) * | 2020-01-05 | 2022-01-31 | 株式会社Mujin | 動的動き調節機構を有するロボットシステム及びそれを動作させる方法 |
JP2023033033A (ja) * | 2021-08-26 | 2023-03-09 | 正▲うえ▼精密工業股▲ふん▼有限公司 | ロボットアームの障害物回避方法及びロボットアームの障害物回避システム |
Families Citing this family (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6309990B2 (ja) * | 2016-03-24 | 2018-04-11 | ファナック株式会社 | 複数の機構ユニットにより構成されたロボットを制御するロボットシステム、該機構ユニット、およびロボット制御装置 |
JP6879464B2 (ja) * | 2017-08-02 | 2021-06-02 | オムロン株式会社 | 干渉判定方法、干渉判定システム及びコンピュータプログラム |
JP7041492B2 (ja) * | 2017-10-31 | 2022-03-24 | 川崎重工業株式会社 | ロボットシステム |
US11458626B2 (en) * | 2018-02-05 | 2022-10-04 | Canon Kabushiki Kaisha | Trajectory generating method, and trajectory generating apparatus |
JP6955702B2 (ja) * | 2018-03-06 | 2021-10-27 | オムロン株式会社 | 情報処理装置、情報処理方法、及びプログラム |
US10899006B2 (en) * | 2018-05-01 | 2021-01-26 | X Development Llc | Robot navigation using 2D and 3D path planning |
JP7077800B2 (ja) * | 2018-06-11 | 2022-05-31 | オムロン株式会社 | 経路計画装置、経路計画方法、及び経路計画プログラム |
CN108858162B (zh) * | 2018-06-28 | 2020-10-30 | 广州视源电子科技股份有限公司 | 四轴机械臂的位置确定方法和装置 |
JP6833777B2 (ja) * | 2018-09-10 | 2021-02-24 | 株式会社東芝 | 物体ハンドリング装置及びプログラム |
DE102018122376B3 (de) | 2018-09-13 | 2019-11-07 | Pilz Gmbh & Co. Kg | Verfahren und Vorrichtung zur kollisionsfreien Bewegungsplanung eines Manipulators |
EP3639983A1 (en) | 2018-10-18 | 2020-04-22 | Technische Universität München | Anti-collision safety measures for a reconfigurable modular robot |
DE102018133472B3 (de) * | 2018-12-21 | 2020-03-12 | Franka Emika Gmbh | Bewegungsüberwachung eines Robotermanipulators |
JP7147571B2 (ja) * | 2019-01-15 | 2022-10-05 | オムロン株式会社 | 経路生成装置、経路生成方法、及び経路生成プログラム |
WO2020157862A1 (ja) * | 2019-01-30 | 2020-08-06 | 日本電気株式会社 | 障害物回避制御装置、障害物回避制御システム、障害物回避制御方法および記録媒体 |
US20220072708A1 (en) * | 2019-02-08 | 2022-03-10 | Nec Corporation | Motion model calculation device, control device, joint mechanism, and motion model calculation method |
JP7222803B2 (ja) * | 2019-04-25 | 2023-02-15 | 株式会社日立製作所 | 軌道計画装置、軌道計画方法及びプログラム |
CN110202575B (zh) * | 2019-06-05 | 2022-07-19 | 武汉工程大学 | 一种用于工业测量的机器人目标轨迹精度补偿方法 |
JP2020199625A (ja) * | 2019-06-13 | 2020-12-17 | ファナック株式会社 | シミュレーション装置 |
JP7384602B2 (ja) * | 2019-09-12 | 2023-11-21 | ファナック株式会社 | ロボット制御装置 |
JP6792184B1 (ja) * | 2019-11-27 | 2020-11-25 | 株式会社安川電機 | シミュレーションシステム、シミュレーション方法、シミュレーションプログラム、ロボットの製造方法、およびロボットシステム |
JP7375587B2 (ja) * | 2020-02-05 | 2023-11-08 | 株式会社デンソー | 軌道生成装置、多リンクシステム、及び軌道生成方法 |
CN112276953B (zh) * | 2020-10-27 | 2021-12-28 | 清华大学深圳国际研究生院 | 连续型超冗余机械臂的臂型协同规划方法、终端设备和存储介质 |
US20220193907A1 (en) * | 2020-12-22 | 2022-06-23 | X Development Llc | Robot planning |
TWI741943B (zh) * | 2021-02-03 | 2021-10-01 | 國立陽明交通大學 | 機器人控制方法、動作計算裝置及機器人系統 |
US11350578B1 (en) * | 2021-02-17 | 2022-06-07 | Firefly Automatix, Inc. | Dynamically calculating a stacking head's path during a stacking operation |
CN113134832A (zh) * | 2021-03-16 | 2021-07-20 | 无锡信捷电气股份有限公司 | 一种桁架机器人安全区域的设定方法 |
US11673264B2 (en) | 2021-03-25 | 2023-06-13 | Mitsubishi Electric Research Laboratories, Inc. | System and method for robotic assembly based on adaptive compliance |
US11787055B2 (en) * | 2021-03-30 | 2023-10-17 | Honda Research Institute Europe Gmbh | Controlling a robot using predictive decision making |
CN113103231A (zh) * | 2021-03-31 | 2021-07-13 | 北京北方华创微电子装备有限公司 | 机械手归位方法及半导体热处理设备 |
CN113910300B (zh) * | 2021-10-25 | 2023-05-23 | 苏州灵猴机器人有限公司 | 一种机器人末端防撞方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61134807A (ja) * | 1984-12-06 | 1986-06-21 | Mitsubishi Heavy Ind Ltd | ロボツトア−ム制御方法 |
JPH09207089A (ja) * | 1996-02-01 | 1997-08-12 | Matsushita Electric Ind Co Ltd | 多関節構造体制御装置 |
JP2003136466A (ja) * | 2001-10-25 | 2003-05-14 | Murata Mach Ltd | 産業用ロボットの制御装置 |
JP2006012074A (ja) * | 2004-06-29 | 2006-01-12 | Fanuc Ltd | ロボットの待機位置復帰プログラム作成装置 |
JP2010155328A (ja) * | 2009-01-01 | 2010-07-15 | Sony Corp | 軌道計画装置及び軌道計画方法、並びにコンピューター・プログラム |
JP2011500349A (ja) * | 2007-10-26 | 2011-01-06 | 本田技研工業株式会社 | リアルタイム自己衝突および障害物回避 |
EP2361735A2 (en) * | 2010-02-26 | 2011-08-31 | Agilent Technologies, Inc. | Robot arm and method of controlling robot arm to avoid collisions |
WO2014056533A1 (en) * | 2012-10-11 | 2014-04-17 | Abb Technology Ltd | A method and an apparatus for automatically generating a collision free return program for returning a robot from a stop position to a predefined restart position |
Family Cites Families (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE4001885A1 (de) * | 1990-01-23 | 1991-07-25 | Kuka Schweissanlagen & Roboter | Mehrachsiger industrieroboter |
JPH0728520A (ja) | 1993-07-14 | 1995-01-31 | Toyota Motor Corp | ロボットの原点復帰制御方法 |
JPH10175188A (ja) * | 1996-12-17 | 1998-06-30 | Fanuc Ltd | ロボットの構造 |
JP2001054889A (ja) * | 1999-08-20 | 2001-02-27 | Denso Corp | 組立用垂直多関節型ロボット |
JP2001154706A (ja) * | 1999-11-29 | 2001-06-08 | Japan Atom Energy Res Inst | 移動体の経路生成法 |
JP4958608B2 (ja) | 2007-04-06 | 2012-06-20 | 三菱電機株式会社 | ロボット制御装置、ロボット制御方法及びロボット搬送装置 |
JP2009090383A (ja) | 2007-10-04 | 2009-04-30 | Nidec Sankyo Corp | ロボットの原点復帰方法 |
JPWO2009069389A1 (ja) * | 2007-11-26 | 2011-04-07 | 株式会社安川電機 | 垂直多関節形ロボット |
FR2930472B1 (fr) | 2008-04-24 | 2010-08-13 | Univ Havre | Robot manipulateur et commande associee pour un positionnement fin de l'extremite terminale |
JP5228783B2 (ja) | 2008-10-15 | 2013-07-03 | 株式会社デンソーウェーブ | ロボットの原点復帰装置 |
JP2010188437A (ja) | 2009-02-16 | 2010-09-02 | Amada Co Ltd | ロボットハンドの歪み検出方法および自動交換システム |
CN101763119B (zh) * | 2009-12-16 | 2012-01-04 | 东南大学 | 基于遥操作移动机器人的辅助避障方法 |
DE102010007458A1 (de) * | 2010-02-10 | 2011-08-11 | KUKA Laboratories GmbH, 86165 | Verfahren für eine kollisionsfreie Bahnplanung eines Industrieroboters |
JP5476225B2 (ja) | 2010-06-23 | 2014-04-23 | 日東精工株式会社 | 干渉判定装置および干渉判定方法 |
CN102126210B (zh) * | 2011-03-22 | 2012-07-11 | 浙江理工大学 | 七自由度气动肌肉柔性机械手臂 |
JP2012216151A (ja) | 2011-04-01 | 2012-11-08 | Mitsubishi Electric Corp | 干渉回避制御装置 |
CN102819264B (zh) * | 2012-07-30 | 2015-01-21 | 山东大学 | 移动机器人路径规划q学习初始化方法 |
JP6110636B2 (ja) | 2012-08-09 | 2017-04-05 | 日本電産サンキョー株式会社 | 産業用ロボット |
CN104029203B (zh) * | 2014-06-18 | 2017-07-18 | 大连大学 | 实现空间机械臂避障的路径规划方法 |
-
2014
- 2014-12-25 WO PCT/JP2014/006475 patent/WO2016103297A1/ja active Application Filing
- 2014-12-25 US US15/539,838 patent/US10350756B2/en active Active
- 2014-12-25 CN CN201480083989.5A patent/CN107000223B/zh active Active
- 2014-12-25 KR KR1020177019053A patent/KR101941147B1/ko active IP Right Grant
- 2014-12-25 JP JP2016565597A patent/JP6378783B2/ja active Active
-
2015
- 2015-07-02 TW TW104121463A patent/TWI579669B/zh active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61134807A (ja) * | 1984-12-06 | 1986-06-21 | Mitsubishi Heavy Ind Ltd | ロボツトア−ム制御方法 |
JPH09207089A (ja) * | 1996-02-01 | 1997-08-12 | Matsushita Electric Ind Co Ltd | 多関節構造体制御装置 |
JP2003136466A (ja) * | 2001-10-25 | 2003-05-14 | Murata Mach Ltd | 産業用ロボットの制御装置 |
JP2006012074A (ja) * | 2004-06-29 | 2006-01-12 | Fanuc Ltd | ロボットの待機位置復帰プログラム作成装置 |
JP2011500349A (ja) * | 2007-10-26 | 2011-01-06 | 本田技研工業株式会社 | リアルタイム自己衝突および障害物回避 |
JP2010155328A (ja) * | 2009-01-01 | 2010-07-15 | Sony Corp | 軌道計画装置及び軌道計画方法、並びにコンピューター・プログラム |
EP2361735A2 (en) * | 2010-02-26 | 2011-08-31 | Agilent Technologies, Inc. | Robot arm and method of controlling robot arm to avoid collisions |
WO2014056533A1 (en) * | 2012-10-11 | 2014-04-17 | Abb Technology Ltd | A method and an apparatus for automatically generating a collision free return program for returning a robot from a stop position to a predefined restart position |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018143003A1 (ja) * | 2017-01-31 | 2018-08-09 | 株式会社安川電機 | ロボットパス生成装置及びロボットシステム |
JPWO2018143003A1 (ja) * | 2017-01-31 | 2019-06-27 | 株式会社安川電機 | ロボットパス生成装置及びロボットシステム |
US11446820B2 (en) | 2017-01-31 | 2022-09-20 | Kabushiki Kaisha Yaska Wa Denki | Robot path generating device and robot system |
JP2018196919A (ja) * | 2017-05-24 | 2018-12-13 | ファナック株式会社 | パラレルリンク機構の制御装置及び制御方法、並びにパラレルリンク機構及び制御装置を含むシステム |
JP2021062436A (ja) * | 2019-10-11 | 2021-04-22 | セイコーエプソン株式会社 | 教示方法 |
JP2022511343A (ja) * | 2020-01-05 | 2022-01-31 | 株式会社Mujin | 動的動き調節機構を有するロボットシステム及びそれを動作させる方法 |
JP7174965B2 (ja) | 2020-01-05 | 2022-11-18 | 株式会社Mujin | 動的動き調節機構を有するロボットシステム及びそれを動作させる方法 |
US11833690B2 (en) | 2020-01-05 | 2023-12-05 | Mujin, Inc. | Robotic system with dynamic motion adjustment mechanism and methods of operating same |
JP2023033033A (ja) * | 2021-08-26 | 2023-03-09 | 正▲うえ▼精密工業股▲ふん▼有限公司 | ロボットアームの障害物回避方法及びロボットアームの障害物回避システム |
JP7307776B2 (ja) | 2021-08-26 | 2023-07-12 | 正▲うえ▼精密工業股▲ふん▼有限公司 | ロボットアームの障害物回避方法及びロボットアームの障害物回避システム |
Also Published As
Publication number | Publication date |
---|---|
KR20170094351A (ko) | 2017-08-17 |
KR101941147B1 (ko) | 2019-04-12 |
US20170348856A1 (en) | 2017-12-07 |
JP6378783B2 (ja) | 2018-08-22 |
TW201624161A (zh) | 2016-07-01 |
CN107000223A (zh) | 2017-08-01 |
CN107000223B (zh) | 2019-11-01 |
US10350756B2 (en) | 2019-07-16 |
JPWO2016103297A1 (ja) | 2017-07-13 |
TWI579669B (zh) | 2017-04-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6378783B2 (ja) | アーム型のロボットの障害物自動回避方法及び制御装置 | |
US11498214B2 (en) | Teaching device, teaching method, and robot system | |
CN110116405B (zh) | 轨迹生成方法和轨迹生成装置 | |
US11813753B2 (en) | Collision avoidance motion planning method for industrial robot | |
JP5998816B2 (ja) | 経路探索方法、経路探索装置、ロボット制御装置、ロボット及びプログラム | |
US11745355B2 (en) | Control device, control method, and non-transitory computer-readable storage medium | |
JP5156836B2 (ja) | リアルタイム自己衝突および障害物回避 | |
CN108772835B (zh) | 一种障碍物与物理极限躲避方法 | |
CN113442129A (zh) | 用于确定工作空间的传感器布置的方法和系统 | |
US20220382253A1 (en) | Machining program conversion device, numerical control device, and machining program conversion method | |
Hryniewicz et al. | Modelling cooperation of industrial robots as multi-agent systems | |
CN114536342A (zh) | 一种多臂系统及其臂间防撞控制方法 | |
JP2018012159A (ja) | ロボットシステム、ロボットシステムの制御方法、プログラム | |
Ikeda et al. | On-line optimization of avoidance ability for redundant manipulator | |
Mohammad Hossein Fallah et al. | Conjugated visual predictive control for constrained visual servoing | |
Kim et al. | Improvement of Door Recognition Algorithm using Lidar and RGB-D camera for Mobile Manipulator | |
Khaksar et al. | Multiquery motion planning in uncertain spaces: incremental adaptive randomized roadmaps | |
WO2023053374A1 (ja) | 制御装置及びロボットシステム | |
JP6932618B2 (ja) | ロボット教示方法、ロボット教示装置、ロボットシステム、プログラム及び記録媒体 | |
EP4252975A1 (en) | Information processing device, and picking device | |
US20240058961A1 (en) | Path generation device, path generation method, and path generation program | |
JP7475841B2 (ja) | 情報処理方法、ロボットシステム、物品の製造方法、および情報処理装置 | |
CN117813603A (zh) | 生成用于神经网络的扩充训练数据的系统和方法 | |
JP2021082222A (ja) | 情報処理方法、ロボットシステム、物品の製造方法、および情報処理装置 | |
CN116766174A (zh) | 扫掠体变形 |
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: 14908908 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2016565597 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 15539838 Country of ref document: US |
|
ENP | Entry into the national phase |
Ref document number: 20177019053 Country of ref document: KR Kind code of ref document: A |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 14908908 Country of ref document: EP Kind code of ref document: A1 |