WO2022176818A1 - ロボット制御装置、ロボット制御システム、及びコンピュータプログラム - Google Patents
ロボット制御装置、ロボット制御システム、及びコンピュータプログラム Download PDFInfo
- Publication number
- WO2022176818A1 WO2022176818A1 PCT/JP2022/005755 JP2022005755W WO2022176818A1 WO 2022176818 A1 WO2022176818 A1 WO 2022176818A1 JP 2022005755 W JP2022005755 W JP 2022005755W WO 2022176818 A1 WO2022176818 A1 WO 2022176818A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- robot
- unit
- program
- speed
- path
- Prior art date
Links
- 238000004590 computer program Methods 0.000 title claims description 6
- 230000033001 locomotion Effects 0.000 claims abstract description 43
- 230000002093 peripheral effect Effects 0.000 claims abstract description 8
- 230000002452 interceptive effect Effects 0.000 claims abstract description 5
- 230000008859 change Effects 0.000 claims description 36
- 230000004913 activation Effects 0.000 claims description 32
- 238000012546 transfer Methods 0.000 claims description 15
- 238000005516 engineering process Methods 0.000 abstract description 3
- 238000000034 method Methods 0.000 description 26
- 238000012790 confirmation Methods 0.000 description 17
- 230000008569 process Effects 0.000 description 17
- 230000005540 biological transmission Effects 0.000 description 15
- 238000012545 processing Methods 0.000 description 14
- 230000006870 function Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 238000012360 testing method Methods 0.000 description 6
- 239000011159 matrix material Substances 0.000 description 3
- 230000003213 activating effect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000000877 morphologic effect Effects 0.000 description 2
- 210000000707 wrist Anatomy 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000005553 drilling Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000000227 grinding Methods 0.000 description 1
- 238000001746 injection moulding Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000003801 milling Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
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
- 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
-
- 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/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39082—Collision, real time collision avoidance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39091—Avoid collision with moving obstacles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40339—Avoid collision
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40476—Collision, planning for collision free path
Definitions
- the present disclosure relates to a robot control device, a robot control system, and a computer program.
- Patent Document 1 With the technology of Patent Document 1, a three-dimensional model consisting of a robot and its surroundings is created, and the start and end positions of the robot are specified on the created three-dimensional model. Then, the route of the robot is automatically calculated so as to avoid interference with surrounding objects present in the section from the start point position to the end point position on the three-dimensional model. As a result, it is possible to automatically generate an interference avoidance path for the robot regardless of the skill level of the operator.
- the purpose of the present disclosure is to provide technology that can reliably avoid interference between the robot and surrounding objects while confirming the safety of the generated robot path.
- an acquisition unit acquires a robot path generated so as to avoid interference between the robot and its surroundings based on a three-dimensional model of the robot and its surroundings; an interference determination unit for determining whether or not there is a high possibility that the robot will interfere with the surrounding object for each predetermined section when moving the robot along the determined robot path;
- a robot control device comprising: a speed changing unit that reduces the speed of the robot or stops the movement of the robot in a section determined to have a high possibility of interfering with the surrounding object.
- one aspect of the present disclosure is a robot path generation unit that generates the robot path so as to avoid interference between the robot and its surroundings based on a three-dimensional model of the robot and its surroundings; a transfer unit configured to transfer the robot path generated by the robot path generation unit to the robot control apparatus as a robot program; and the robot control apparatus, wherein the robot control apparatus includes: A program activating unit that activates the robot program transferred by the transfer unit, and program management that manages the robot program activated by the program activating unit, and executes determination by the collision determination unit and speed change by the speed change unit. and a robot control system.
- a computer storing a robot program for controlling motion of a robot avoids interference between the robot and its surroundings based on a three-dimensional model of the robot and its surroundings. a step of obtaining the robot path generated as described above, and a step of determining for each predetermined section whether or not there is a high possibility that the robot will interfere with the surrounding objects when moving the robot along the robot path. and a step of reducing the speed of the robot or stopping the movement of the robot for a section determined to have a high possibility of the robot interfering with the surrounding object.
- FIG. 1 is a functional block diagram of a robot control system according to a first embodiment
- FIG. FIG. 4 is a diagram showing an example of a manipulability ellipsoid of a robot
- 7 is a flowchart showing the procedure of robot path confirmation processing according to the first embodiment
- FIG. 7 is a functional block diagram of a robot control system according to a second embodiment
- FIG. 9 is a flow chart showing the procedure of robot path confirmation processing according to the second embodiment.
- FIG. 1 is a functional block diagram of a robot control system 1 according to the first embodiment.
- a robot control system 1 according to this embodiment includes a robot path generation device 2 that generates a robot path, and a robot control device 3 that controls the motion of a robot 30 .
- the robot path generation device 2 may be provided in a numerical control device (CNC) that controls the operation of a machine tool (not shown) provided near the robot 30, or may be provided in a personal computer or the like. good.
- CNC numerical control device
- An example in which the robot path generation device 2 is provided in a numerical control device will be described below.
- the robot control system 1 uses a robot path generation device 2 (numerical control device) and a robot control device 3 that are communicably connected to each other to control the operations of the machine tool and the robot 30 in conjunction with each other. do.
- the machine tool processes a workpiece (not shown) according to a machine tool control signal sent from the robot path generation device 2 (numerical control device).
- Machine tools include, but are not limited to, lathes, drilling machines, milling machines, grinding machines, laser processing machines, injection molding machines, and the like.
- the robot 30 operates under the control of the robot control device 3, and performs a predetermined work on a work machined inside a machine tool such as a lathe.
- the robot 30 is, for example, an articulated robot, and a tool for gripping, processing, and inspecting a work is attached to the tip of its arm.
- the robot 30 will be described as a 6-axis articulated robot, but the robot 30 is not limited to this.
- the robot 30 will be described as a 6-axis articulated robot, but the number of axes is not limited to this.
- the robot path generation device 2 and the robot control device 3 each include arithmetic processing means such as a CPU (Central Processing Unit), auxiliary storage means such as HDD (Hard Disk Drive) and SSD (Solid State Drive) storing various computer programs, Main storage means such as RAM (Random Access Memory) for storing data temporarily required for the arithmetic processing means to execute computer programs, operation means such as a keyboard for operators to perform various operations, and various It is a computer configured by hardware such as display means such as a display for displaying information.
- arithmetic processing means such as a CPU (Central Processing Unit)
- auxiliary storage means such as HDD (Hard Disk Drive) and SSD (Solid State Drive) storing various computer programs
- Main storage means such as RAM (Random Access Memory) for storing data temporarily required for the arithmetic processing means to execute computer programs
- operation means such as a keyboard for operators to perform various operations
- various It is a computer configured by hardware such as display means such as a display for displaying information.
- the robot path generation device 2 realizes a machine tool control function of controlling the operation of the machine tool and a function of generating an operation path of the control axis of the robot 30 with the hardware configuration described above. Specifically, the robot path generation device 2 realizes various functions such as a storage unit 21, a robot path generation unit 22, a transfer unit 23, a program input unit 24, an analysis unit 25, a robot program activation command unit 26, a data transmission/reception unit 27, and the like. do.
- the storage unit 21 has a program storage unit, a machine coordinate value storage unit, a robot coordinate value storage unit, a robot teaching position storage unit, and a three-dimensional model storage unit, all of which are not shown.
- the program storage unit stores, for example, a plurality of numerical control programs created based on operator's operations. More specifically, the program storage unit stores a numerical control block composed of a plurality of command blocks for the machine tool for controlling the operation of the machine tool, a plurality of command blocks for the robot for controlling the operation of the robot, and the like. program is stored.
- the numerical control program stored in the program storage unit is written in a known program language such as G code or M code for controlling the operation of the machine tool.
- the machine coordinate value storage unit stores machine coordinate values that indicate the positions of various axes of the machine tool that operates under the numerical control program (that is, the positions of the tool post, table, etc. of the machine tool). These machine coordinate values are defined under a machine tool coordinate system whose origin is a reference point set at an arbitrary position on or near the machine tool. This machine coordinate value storage unit is updated successively by a process (not shown) so that the latest machine coordinate values that are successively changed under the numerical control program are stored.
- the robot coordinate value storage unit stores the position and orientation of the control point (for example, the arm tip of the robot 30) of the robot 30 operating under the control of the robot controller 3, in other words, the position of each control axis of the robot 30.
- the indicated robot coordinate values are stored. These robot coordinate values are defined under a robot coordinate system different from the machine tool coordinate system.
- This robot coordinate value storage unit is sequentially updated with the robot coordinate values acquired from the robot control device 3 by a process (not shown) so that the latest robot coordinate values that are sequentially changed under the numerical control program are stored. .
- the robot teaching position storage unit stores the teaching positions such as the start point and the end point of the robot 30 input by the operator, specifically, the teaching positions of the robot 30 input from the teach pendant or the like, or the teaching positions input from the keyboard or the like.
- the teaching position of the robot 30 includes robot coordinate values indicating the position of each control axis of the robot 30, and these robot coordinate values are defined under a robot coordinate system different from the machine tool coordinate system.
- the robot coordinate system is a coordinate system whose origin is a reference point set at an arbitrary position on the robot 30 or near the robot 30 .
- the robot coordinate system may coincide with the machine tool coordinate system.
- the origin and coordinate axis direction of the robot coordinate system may be aligned with the origin and coordinate axis direction of the machine tool coordinate system.
- the robot coordinate system can be switched between two or more coordinate formats with different control axes. More specifically, in the numerical control program, the position and orientation of the control points of the robot 30 can be specified in orthogonal coordinate format or each axis coordinate format. Alternatively, it can also be specified by the tool coordinate system format.
- the position and orientation of the control point of the robot 30 are represented by a total of six real coordinates whose components are the rotation angle values (J1, J2, J3, J4, J5, J6) of the six joints of the robot 30. Specified by value.
- the position and orientation of the control point of the robot 30 is represented by three coordinate values (X, Y, Z) along three Cartesian coordinate axes and three rotation angle values (A, B , C) and a total of six real number coordinate values.
- the form of the robot 30 is also uniquely determined.
- the position and posture of the control point of the robot 30 are specified by six coordinate values (X, Y, Z, A, B, C), so the form of the robot 30 is uniquely cannot be determined. Therefore, in the numerical control program for the robot, the form of the robot 30 can be designated by a form value P, which is an integer value of a predetermined number of digits.
- the position and orientation of the control points of the robot 30 and the configuration of the robot 30 are represented by six coordinate values (J1, J2, J3, J4, J5, J6) under each axis coordinate format, and is represented by six coordinate values and one morphological value (X, Y, Z, A, B, C, P).
- the morphological value P is also referred to as a coordinate value for convenience.
- the tool coordinate system of the robot 30 is a coordinate system that defines the position of the tool tip point (TCP) of the robot 30 and the orientation of the tool. It is an operation around the mechanical interface coordinate system (wrist flange surface) of the robot 30, and the tool coordinate system is set by setting the offset value from the origin of this mechanical interface coordinate system and the rotation angle around each coordinate axis. be.
- the 3D model storage unit stores data related to a robot system model configured by arranging 3D models imitating the 3D shapes of peripheral objects such as the robot 30 and machine tools in virtual space.
- peripheral objects include not only machine tools but also objects provided within the operation range of the robot 30, such as workpieces to be processed by the machine tools, workpiece stockers in which a plurality of such workpieces are stored, pallets, and safety fences. is included.
- the robot path generation device 2 according to the present embodiment performs a simulation using the robot system model stored in the three-dimensional model storage unit, thereby determining the control axis of the robot 30 so as to avoid interference on the robot system model. Generate a motion trajectory.
- the robot path generation unit 22 generates the motion paths of the control axes of the robot 30 . More specifically, the robot path generation unit 22 generates the robot 30 and the robot 30 based on the start point and the end point as the robot teaching positions stored in the robot teaching position storage unit and the three-dimensional model of the robot 30 and its surroundings. Generate a robot path to avoid interference with surrounding objects. The robot path generation unit 22 writes the generated robot path to the transfer unit 23 as a robot program.
- the transfer unit 23 transfers the robot path as a robot program to the storage unit 31 of the robot control device 3 .
- the program input unit 24 reads numerical control programs from the program storage unit and sequentially inputs them to the analysis unit 25 .
- the analysis unit 25 analyzes the command type based on the numerical control program input from the program input unit 24 for each command block, and transmits the analysis results to the machine tool control unit and the robot program activation command unit 26 (not shown). More specifically, when the command type of the command block is a command for the machine tool, the analysis unit 25 transmits this to the machine tool control unit, and when the command type of the command block is a command for the robot 30 , this is sent to the robot program activation command unit 26 .
- a machine tool control unit (not shown) generates a machine tool control signal for controlling the operation of the machine tool according to the analysis result sent from the analysis unit 25, and inputs it to actuators that drive various axes of the machine tool.
- the machine tool operates according to a machine tool control signal input from the machine tool control section, and processes a workpiece (not shown).
- the machine tool control section updates the machine coordinate values stored in the machine coordinate value storage section with the latest machine coordinate values.
- the robot program activation command unit 26 executes the robot control device 3 side for the robot program, which is analyzed by the analysis unit 25 to indicate that the command type of the command block is a command to the robot 30, among the programs stored in the storage unit 21.
- a robot program start command is generated at a predetermined timing as a trigger for starting the robot program.
- the robot program activation command generated by the robot program activation command unit 26 is generated by, for example, a G code of a numerical control program. Also, in the robot program activation command generated by the robot program activation command unit 26, it is described whether the mode is the route confirmation mode or the normal operation mode in which the route confirmation is not performed.
- the robot program activation command unit 26 writes the generated robot program activation command to the data transmission/reception unit 27 .
- the robot path is generated by the robot path generation unit 22 described above, transferred to the robot control device 3 side by the transfer unit 23 and stored in the storage unit 31 . Therefore, when a robot program activation command is transmitted from the data transmitting/receiving unit 27 to the robot control device 3 side, the robot program in which the robot path has already been generated corresponding to the robot program activation command is stored in the storage unit 31 of the robot control device 3 side. will be called from and started.
- the data transmission/reception unit 27 exchanges various commands and data with the data transmission/reception unit 32 of the robot control device 3 .
- the data transmission/reception unit 27 transmits the robot program activation command to the data transmission/reception unit 32 of the robot controller 3 .
- the robot control device 3 side transfers and stores the robot program, which defines the robot path, to the storage unit 31. It is activated by the program activation unit 33 and the program management unit 34, and controls the operation of the robot 30 based on the activated robot program.
- the robot controller 3 includes a storage unit 31, a data transmission/reception unit 32, a program activation unit 33, a program management unit 34, an interference determination unit 35, an override change unit 36, a trajectory control unit 36, and a trajectory control unit 36. It realizes various functions such as a unit 37, a kinematics control unit 38, a servo control unit 39, and the like.
- the robot control device 3 includes a storage unit 31, a data transmission/reception unit 32, a program activation unit 33, a program management unit 34, an interference determination unit 35, an override change unit 36, a trajectory control unit 37, a kinematics control unit 38, By using the servo control unit 39 , the motion of the robot 30 is controlled based on commands sent from the robot path generation device 2 .
- the storage unit 31 constitutes an acquisition unit, acquires and stores a robot path as a robot program generated by the robot path generation unit 22 on the robot path generation device 2 side and transferred by the transfer unit 23 .
- the robot program stored in the storage unit 31 is called by the program management unit 34, which will be described later, and is activated and reproduced.
- the data transmission/reception unit 32 inputs the robot program activation command generated by the robot program activation command unit 26 on the robot path generation device 2 side and transmitted from the data transmission/reception unit 27 to the program activation unit 33 described later.
- the program activation unit 33 inputs the robot program activation command input from the data transmission/reception unit 32 to the program management unit 34, which will be described later.
- the program activation unit 33 activates the robot program under the control of the program management unit 34 .
- the program management unit 34 manages robot programs. Specifically, the program management unit 34 calls the robot program corresponding to the robot program activation command input from the program activation unit 33 among the robot programs stored in the storage unit 31, and activates and reproduces the robot program. Also, the program management unit 34 executes commands described in the activated robot program. When the robot program to be activated is the robot program for the route confirmation mode, the program management unit 34 causes the interference determination unit 35 to perform determination and the override change unit 36 to change the speed, which will be described later. When the robot program to be activated is the robot program for the normal operation mode, the program management unit 34 sequentially notifies the trajectory control unit 37 of movement commands for the control axes of the robot 30 .
- the collision determination unit 35 moves the robot 30 according to the robot path of the robot program called and activated by the program management unit 34 among the robot programs stored in the storage unit 31, and the robot 30 interferes with surrounding objects. Whether or not the possibility is high is determined for each predetermined section. Specifically, the interference determination unit 35 determines whether the robot 30 is in contact with a surrounding object when at least one of the vicinity of the shape change point, the vicinity of the coordinate system switching point, and the change of the manipulability ellipsoid of the robot 30 is large. It is determined that there is a high possibility of interference. Note that the setting of the interval is not particularly limited, and may be set for each fixed interval, and is appropriately set according to the content of the robot program.
- the interference determination unit 35 determines that there is a high possibility that the robot 30 will interfere with surrounding objects. judge.
- the robot 30 cannot be moved.
- Such a position where the robot 30 cannot be controlled is called a singular point, and when teaching the robot 30, the hand of the robot 30 is moved avoiding this singular point and its vicinity. Therefore, when the robot 30 changes its form across this singular point, it is presumed that it is necessary to avoid interference with surrounding objects.
- the shape change point can be determined by analyzing the robot program.
- the change rate of the rotation speed (rotation angle) is equal to or greater than each predetermined threshold value, it can be determined that the shape change point is near.
- each axis coordinate system, orthogonal coordinate system, and tool coordinate system of the robot 30 are as described above.
- FIG. 2 is a diagram showing an example of the manipulability ellipsoids M1 and M2 of the robot 30. As shown in FIG.
- the manipulability ellipsoids M1 and M2 of the robot 30 are the matrix A calculated from the transposed matrix of the Jacobian matrix J representing the relationship between the joint velocity d ⁇ /dt and the hand velocity dx/dt of the robot arm 30a of the robot 30.
- the eigenvector v represents the axial size of the manipulability ellipsoid
- the square root of the eigenvalue ⁇ represents the axial size (major axis and minor axis of the ellipsoid).
- a large force can be output in the E direction, which is large in the axial direction, while a large force cannot be output in the D direction, which is small in the axial direction, because the posture of the robot 30 approaches a singular point posture. Therefore, the robot 30 is normally controlled in a direction in which a large force can be output. However, when the robot 30 is about to interfere with a surrounding object, the robot 30 is controlled in a direction different from the direction in which a large force can be output. Therefore, when the rate of change of the major axis and/or the minor axis of the manipulability ellipsoid of the robot 30 is equal to or greater than each predetermined threshold value, the interference determination unit 35 determines that the robot 30 is highly likely to interfere with surrounding objects. do. Note that each threshold value is appropriately set by performing experiments or the like in advance.
- the override changing unit 36 constitutes a speed changing unit, and reduces the speed of the robot 30 in a section determined by the interference determining unit 35 to have a high possibility of the robot 30 colliding with a surrounding object.
- the movement of the robot 30 is stopped (the speed is changed to 0).
- the robot control device 3 of the present embodiment multiplies the operating conditions by an override (magnification: override amount) in order to adjust the operating conditions of the robot 30 without editing the robot program and to perform optimum motion control. It has an override function to control the operation of the robot 30 by using the Therefore, the override changing unit 36 reduces the speed override of the robot 30 to reduce the speed of the robot 30 or stop the movement of the robot 30 .
- the speed of the robot 30 is reduced in a section determined to correspond to at least one of the vicinity of the shape change point, the vicinity of the coordinate system switching point, and the change of the manipulability ellipsoid of the robot 30 is large. Since the movement of the robot 30 is stopped, interference between the robot 30 and surrounding objects can be reliably avoided while confirming the safety of the generated robot path.
- the trajectory control unit 37 calculates time-series data of control points of the robot 30 according to the movement command notified from the program management unit 34 and inputs the data to the kinematics control unit 38 .
- the kinematics control unit 38 calculates the target angle of each joint of the robot 30 from the input time series data and inputs it to the servo control unit 39 .
- the servo control unit 39 generates a robot control signal for the robot 30 by feedback-controlling each servo motor of the robot 30 so that the target angle input from the kinematics control unit 38 is realized. input.
- FIG. 3 is a flowchart showing the procedure of robot path confirmation processing according to the present embodiment. Note that this process may be prefetched and processed prior to the execution of the robot program, or may be executed in advance since the robot program is stored in the storage unit 31 .
- step S11 it is determined whether or not this robot program is a robot program for route confirmation mode. If this determination is YES, the process proceeds to step S2. If NO, the present robot program is a robot program for the normal operation mode, so the process proceeds to step S15, where the moving speed of the robot 30 is set to the normal speed by the speed override. , the process ends.
- step S12 it is determined whether or not the robot 30 is in at least one of the vicinity of the shape change point, the vicinity of the coordinate system switching point, and the change of the operability ellipsoid being large. If the determination is YES, the process advances to step S13 to set the moving speed of the robot 30 to the route confirmation speed. Specifically, by lowering the speed override of the robot 30, the speed of the robot 30 is reduced or the movement of the robot 30 is stopped, and this processing ends. If the determination is NO, the process proceeds to step S14, the moving speed of the robot 30 is set to the normal speed by speed override, and the process ends.
- a section in which there is a high possibility of interference between the robot 30 and surrounding objects that is, a section in which the posture of the robot 30 changes significantly, is determined, and the moving speed override of the robot 30 in that section is determined.
- FIG. 4 is a functional block diagram of a robot control system 1A according to the second embodiment.
- the robot control system 1A according to this embodiment differs from the robot control system 1 according to the first embodiment in that a part of the configuration of the robot control device 3A that controls the motion of the robot 30 is It differs from the robot control device 3 according to the first embodiment.
- the robot control device 3A according to this embodiment changes the speed of the robot 30 by operating the manual pulse generator. Therefore, the robot control device 3 according to the present embodiment includes an operation amount analysis unit 42 for analyzing the operation amount of the manual pulse generator 41, a forward/reverse control unit 43, an analysis unit 44, and a movement magnification change unit 45. , provided.
- the manual pulse generator 41 has a manual handle that can be manually operated by an operator. For example, when an operator rotates a rotary manual handle, the manual pulse generator 41 outputs a pulse train signal corresponding to the number of rotations, and the signal is input to an operation amount analysis section 42 to be described later.
- the operation amount analysis unit 42 analyzes the operator's manual operation amount for the manual handle from the output of the manual pulse generator 41 .
- the operation amount analysis unit 42 outputs the analyzed manual operation amount to the forward/reverse control unit 43, which will be described later.
- the manual operation amount includes the number of rotations (rotation speed) in the forward rotation direction and the number of rotations (rotation speed) in the reverse rotation direction.
- the forward/backward control unit 43 moves the robot 30 forward and backward according to the manual operation amount analyzed by the operation amount analysis unit 42 on the robot path acquired by the transfer unit 23 and stored in the storage unit 31 . / Or trace operation backwards. That is, the forward/backward control unit 43 substitutes a movement speed command obtained by analyzing the robot program by the analysis unit 44, which will be described later, with a movement speed corresponding to the manual operation amount analyzed by the operation amount analysis unit 42. . Specifically, when the manual operation amount analyzed by the operation amount analysis unit 42 is in the forward rotation direction, the forward/reverse control unit 43 outputs a signal corresponding to the number of rotations (rotational speed) to the adder 46.
- the trajectory control unit 37 is notified to move the robot 30 forward at the movement speed corresponding to the manual operation amount to perform the trace operation.
- the forward/reverse control unit 43 outputs a signal corresponding to the number of rotations (rotational speed) to the adder 46.
- the trajectory control unit 37 is notified to move the robot 30 backward at a moving speed corresponding to the manual operation amount instead of the moving speed command obtained by analyzing the robot program.
- the analysis unit 44 analyzes the robot program activated by the program activation unit 33 under the control of the program management unit 34. Specifically, the analysis unit 44 outputs a movement speed command obtained by analyzing the robot program to the adder 46 .
- the movement magnification changer 45 constitutes a speed changer, and reduces the movement speed of the robot 30 or stops the movement of the robot 30 by reducing the movement magnification of the trace operation speed of the robot 30 .
- the speed of the robot 30 is reduced in a section determined to correspond to at least one of the vicinity of the shape change point, the vicinity of the coordinate system switching point, and the change of the manipulability ellipsoid of the robot 30 is large. Since the movement of the robot 30 is stopped, interference between the robot 30 and surrounding objects can be reliably avoided while confirming the safety of the generated robot path.
- FIG. 5 is a flowchart showing the procedure of robot path confirmation processing according to the present embodiment. Note that this process may be prefetched and processed prior to the execution of the robot program, or may be executed in advance since the robot program is stored in the storage unit 31 .
- step S21 it is determined whether or not the robot path is being traced. If this determination is YES, the process proceeds to step S22. If NO, the robot path is not being traced, but normal operation is in progress. exit.
- step S22 it is determined whether or not the robot 30 is in at least one of the vicinity of the shape change point, the vicinity of the coordinate system switching point, and the change in the operability ellipsoid being large. If this determination is YES, the process advances to step S23 to set the moving speed of the robot 30 to the route confirmation speed. Specifically, by reducing the movement magnification of the robot 30, the speed of the robot 30 is reduced, or the movement of the robot 30 is stopped, and this processing ends. If the determination is NO, the process advances to step S24 to set the moving speed of the robot 30 to the normal speed, and the process ends.
- a section in which there is a high possibility of interference between the robot 30 and surrounding objects that is, a section in which the posture of the robot 30 changes greatly, is determined, and the manual pulse generator 41 is operated in that section.
- the movement speed of the robot 30 corresponding to the amount of manual operation is reduced by reducing the movement magnification to be reduced or set to 0, so that interference between the robot 30 and surrounding objects is ensured while confirming the safety of the generated robot path. can be avoided. Therefore, during the operation test of the robot 30, by operating the robot 30 slowly only in a necessary section, the safety of the generated robot path can be confirmed and interference can be reliably avoided, and an efficient operation test can be performed. It is possible.
- the manual handle can be used during automatic operation to move the program forward and backward, errors in the program can be easily checked while actually operating the robot 30. is.
- the robot program including the robot path is automatically generated by the numerical control program, so that the above effects can be obtained regardless of the skill level of the operator.
- the present disclosure is not limited to the above embodiments, and various modifications and variations are possible.
- the present disclosure is realized by the robot control systems 1, 1A including the robot path generation device 2 and the robot control devices 3, 3A, but the present disclosure is not limited to this.
- Various functions of the robot path generation device 2 and the robot control devices 3 and 3A described above can also be realized by a computer program that causes a computer to execute them.
- the movement speed of the robot 30 is changed to a predetermined route confirmation speed, but it is not limited to this.
- the moving speed of the robot 30 is reduced to the first path confirmation speed, and if it is determined to be near the coordinate system switching point, the first If it is determined that the change in the manipulability ellipsoid is large, the speed is reduced to a second route confirmation speed that is different from the route confirmation speed, and if it is determined that the change in the operability ellipsoid is large, the The speed may be reduced to the three-path confirmation speed.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
Description
図1は、第1実施形態に係るロボット制御システム1の機能ブロック図である。本実施形態に係るロボット制御システム1は、ロボット経路を生成するロボット経路生成装置2と、ロボット30の動作を制御するロボット制御装置3と、を備える。
図4は、第2実施形態に係るロボット制御システム1Aの機能ブロック図である。図4に示すように本実施形態に係るロボット制御システム1Aは、第1実施形態に係るロボット制御システム1と比較して、ロボット30の動作を制御するロボット制御装置3Aの構成の一部が、第1実施形態に係るロボット制御装置3と相違する。具体的に本実施形態に係るロボット制御装置3Aは、オーバライド機能によりロボット30の速度を変更する第1実施形態と異なり、手動パルス発生器による操作によりロボット30の速度を変更する。そのため、本実施形態に係るロボット制御装置3は、手動パルス発生器41の操作量を解析する操作量解析部42と、順・逆行制御部43と、解析部44と、移動倍率変更部45と、を備える。
2 ロボット経路生成装置
3 ロボット制御装置
21 記憶部
22 ロボット経路生成部
23 転送部
24 プログラム入力部
25 解析部
26 ロボットプログラム起動指令部
27 データ送受信部
30 ロボット
30a ロボットアーム
31 記憶部
32 データ送受信部(取得部)
33 プログラム起動部
34 プログラム管理部
35 干渉判定部
36 オーバライド変更部(速度変更部)
37 軌跡制御部
38 キネマティクス制御部
39 サーボ制御部
41 手動パルス発生器
42 操作量解析部
43 順・逆行制御部
44 解析部
45 移動倍率変更部(速度変更部)
46 加算器
Claims (8)
- ロボット及びその周辺物の3次元モデルに基づいて前記ロボットと前記周辺物との干渉を回避するように生成されたロボット経路を取得する取得部と、
前記取得部で取得された前記ロボット経路に従って前記ロボットを移動させるときに、前記ロボットが前記周辺物に干渉する可能性が高いか否かを所定区間ごとに判定する干渉判定部と、
前記干渉判定部で前記ロボットが前記周辺物に干渉する可能性が高いと判定された区間について、前記ロボットの速度を低下させる又は前記ロボットの移動を停止させる速度変更部と、を備える、ロボット制御装置。 - 前記速度変更部は、前記ロボットの速度オーバライドを低下させることにより、前記ロボットの速度を低下させる又は前記ロボットの移動を停止させる、請求項1に記載のロボット制御装置。
- 手動パルス発生器の出力から手動操作量を解析する操作量解析部と、
前記取得部で取得された前記ロボット経路上を、前記操作量解析部で解析された手動操作量に応じて前記ロボットを順行及び/又は逆行させてトレース動作させる順・逆行制御部と、をさらに備え、
前記速度変更部は、前記ロボットのトレース動作速度の移動倍率を低下させることにより、前記ロボットの速度を低下させる又は前記ロボットの移動を停止させる、請求項1に記載のロボット制御装置。 - 前記干渉判定部は、前記ロボットが特異点を跨いで形態を変化させるときに、前記ロボットが前記周辺物に干渉する可能性が高いと判定する、請求項1から3いずれかに記載のロボット制御装置。
- 前記干渉判定部は、前記ロボットの座標系が切り替わるときに、前記ロボットが前記周辺物に干渉する可能性が高いと判定する、請求項1から4いずれかに記載のロボット制御装置。
- 前記干渉判定部は、前記ロボットの可操作性楕円体の長径及び/又は短径の各変化率が所定の各閾値以上であるときに、前記ロボットが前記周辺物に干渉する可能性が高いと判定する、請求項1から5いずれかに記載のロボット制御装置。
- 請求項1から6いずれかに記載のロボット制御装置と、
前記ロボット経路を生成するロボット経路生成装置と、を備え、
前記ロボット経路生成装置は、
前記ロボット及びその周辺物の3次元モデルに基づいて、前記ロボットと前記周辺物との干渉を回避するように前記ロボット経路を生成するロボット経路生成部と、
前記ロボット経路生成部で生成された前記ロボット経路をロボットプログラムとして前記ロボット制御装置に転送する転送部と、を備え、
前記ロボット制御装置は、
前記転送部により転送された前記ロボットプログラムを起動するプログラム起動部と、
前記プログラム起動部で起動されるロボットプログラムを管理して、前記干渉判定部による判定と前記速度変更部による速度変更を実行させるプログラム管理部と、をさらに備える、ロボット制御システム。 - ロボットの動作を制御するためのロボットプログラムを記憶するコンピュータに、
前記ロボット及びその周辺物の3次元モデルに基づいて前記ロボットと前記周辺物との干渉を回避するように生成されたロボット経路を取得させるステップと、
前記ロボット経路に従って前記ロボットを移動させるときに、前記ロボットが前記周辺物に干渉する可能性が高いか否かを所定区間ごとに判定させるステップと、
前記ロボットが前記周辺物に干渉する可能性が高いと判定された区間について、前記ロボットの速度を低下させる又は前記ロボットの移動を停止させるステップと、を実行させるためのコンピュータプログラム。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE112022000439.8T DE112022000439T5 (de) | 2021-02-18 | 2022-02-14 | Robotersteuerungsvorrichtung, Robotersteuerungssystem und Computerprogramm |
US18/264,543 US20240042610A1 (en) | 2021-02-18 | 2022-02-14 | Robot control device, robot control system, and non-transitory computer-readable medium storing a computer program |
CN202280014356.3A CN116917089A (zh) | 2021-02-18 | 2022-02-14 | 机器人控制装置、机器人控制***以及计算机程序 |
JP2023500832A JPWO2022176818A1 (ja) | 2021-02-18 | 2022-02-14 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021024063 | 2021-02-18 | ||
JP2021-024063 | 2021-02-18 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022176818A1 true WO2022176818A1 (ja) | 2022-08-25 |
Family
ID=82931717
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2022/005755 WO2022176818A1 (ja) | 2021-02-18 | 2022-02-14 | ロボット制御装置、ロボット制御システム、及びコンピュータプログラム |
Country Status (6)
Country | Link |
---|---|
US (1) | US20240042610A1 (ja) |
JP (1) | JPWO2022176818A1 (ja) |
CN (1) | CN116917089A (ja) |
DE (1) | DE112022000439T5 (ja) |
TW (1) | TW202233369A (ja) |
WO (1) | WO2022176818A1 (ja) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006068857A (ja) * | 2004-09-02 | 2006-03-16 | Fanuc Ltd | ロボット間の干渉防止制御装置 |
JP2018134703A (ja) * | 2017-02-21 | 2018-08-30 | 株式会社安川電機 | ロボットシミュレータ、ロボットシステム及びシミュレーション方法 |
JP2020516475A (ja) * | 2017-04-13 | 2020-06-11 | バテル・メモリアル・インスティテュートBattelle Memorial Institute | 産業ロボットマニピュレータのための教示モード衝突回避システムおよび方法 |
WO2020194752A1 (ja) * | 2019-03-28 | 2020-10-01 | 三菱電機株式会社 | 数値制御装置および数値制御方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5860081B2 (ja) | 2014-02-27 | 2016-02-16 | ファナック株式会社 | ロボットの動作経路を生成するロボットシミュレーション装置 |
-
2022
- 2022-02-08 TW TW111104563A patent/TW202233369A/zh unknown
- 2022-02-14 US US18/264,543 patent/US20240042610A1/en active Pending
- 2022-02-14 DE DE112022000439.8T patent/DE112022000439T5/de active Pending
- 2022-02-14 JP JP2023500832A patent/JPWO2022176818A1/ja active Pending
- 2022-02-14 WO PCT/JP2022/005755 patent/WO2022176818A1/ja active Application Filing
- 2022-02-14 CN CN202280014356.3A patent/CN116917089A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006068857A (ja) * | 2004-09-02 | 2006-03-16 | Fanuc Ltd | ロボット間の干渉防止制御装置 |
JP2018134703A (ja) * | 2017-02-21 | 2018-08-30 | 株式会社安川電機 | ロボットシミュレータ、ロボットシステム及びシミュレーション方法 |
JP2020516475A (ja) * | 2017-04-13 | 2020-06-11 | バテル・メモリアル・インスティテュートBattelle Memorial Institute | 産業ロボットマニピュレータのための教示モード衝突回避システムおよび方法 |
WO2020194752A1 (ja) * | 2019-03-28 | 2020-10-01 | 三菱電機株式会社 | 数値制御装置および数値制御方法 |
Non-Patent Citations (2)
Title |
---|
MINANI MAMORU, NAITOH YASUHIRO, ASAKURA TOSHIYUKI: "Avoidance Manipulability for Redundant Manipulators", NIHON ROBOTTO GAKKAISHI - JOURNAL OF THE ROBOTICS SOCIETY OF JAPAN, ROBOTICS SOCIETY OF JAPAN, TOKYO, JP, vol. 17, no. 6, 15 September 1999 (1999-09-15), JP , pages 887 - 895, XP055959665, ISSN: 0289-1824, DOI: 10.7210/jrsj.17.887 * |
TANAKA H., TAKAHARA M., MINAMI M.: "Trajectory tracking control redundant manipulators based on avoidance manipulability", SICE 2004 ANNUAL CONFERENCE, IEEE, PISCATAWAY, NJ, USA, vol. 3, 4 August 2004 (2004-08-04) - 6 August 2004 (2004-08-06), Piscataway, NJ, USA , pages 1962 - 1967, XP010824786, ISBN: 978-4-907764-22-7 * |
Also Published As
Publication number | Publication date |
---|---|
DE112022000439T5 (de) | 2023-10-19 |
US20240042610A1 (en) | 2024-02-08 |
TW202233369A (zh) | 2022-09-01 |
JPWO2022176818A1 (ja) | 2022-08-25 |
CN116917089A (zh) | 2023-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Bolmsjö et al. | Robotic arc welding–trends and developments for higher autonomy | |
US5880956A (en) | Lead-through robot programming system | |
US8972056B2 (en) | Method of finding feasible joint trajectories for an n-dof robot with rotation invariant process (n>5) | |
WO2022224425A1 (ja) | 数値制御装置及び数値制御システム | |
EP2345512A1 (en) | Method of finding feasible joint trajectories for an n-dof robot with rotation invariant process (N>5) | |
JP7022260B1 (ja) | 数値制御システム | |
WO2022102578A1 (ja) | 数値制御装置、及び数値制御システム | |
WO2022176818A1 (ja) | ロボット制御装置、ロボット制御システム、及びコンピュータプログラム | |
CN115423656A (zh) | 一种机器人协同作业可视化仿真示教***和方法 | |
US20240160181A1 (en) | Motion-path generation device, numerical control device, numerical control system, and non-transitory computer-readable medium storing computer program | |
JP2003165079A (ja) | 産業用ロボット | |
JP7311732B1 (ja) | 数値制御装置及び数値制御システム | |
US20240231308A9 (en) | Command generation device and non-transitory computer-readable medium storing a computer program | |
JP7448736B1 (ja) | 数値制御装置及び数値制御システム | |
WO2022131327A1 (ja) | 数値制御装置及び数値制御システム | |
JP7177301B1 (ja) | 数値制御装置、及び数値制御システム | |
WO2024142289A1 (ja) | プログラミング装置、プログラミング方法及びプログラム | |
JP7332822B1 (ja) | 数値制御装置及び数値制御システム | |
WO2022131173A1 (ja) | 数値制御システム及び産業機械の制御方法 | |
JP7288158B1 (ja) | 数値制御装置 | |
JP7260728B1 (ja) | 数値制御装置及び数値制御システム | |
WO2024100718A1 (ja) | 数値制御装置及び数値制御システム | |
WO2023203617A1 (ja) | ロボット制御装置、数値制御システム及び数値制御方法 | |
WO2022004647A1 (ja) | 数値制御システム | |
WO2022004651A1 (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: 22756136 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2023500832 Country of ref document: JP Kind code of ref document: A |
|
WWE | Wipo information: entry into national phase |
Ref document number: 18264543 Country of ref document: US |
|
WWE | Wipo information: entry into national phase |
Ref document number: 202280014356.3 Country of ref document: CN |
|
WWE | Wipo information: entry into national phase |
Ref document number: 112022000439 Country of ref document: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 22756136 Country of ref document: EP Kind code of ref document: A1 |