Method of improving robot performance based on risk assessment, and apparatus for performing the same
By assessing and adjusting motion parameters based on collision risks, the method enhances both safety and performance of industrial robots, addressing the trade-off between safety and efficiency.
Patent Information
- Application Number
- KR1020250099864
- Authority / Receiving Office
- KR · KR
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2025-07-23
- Publication Date
- 2026-11-06
- Estimated Expiration
- 2045-07-23
AI Technical Summary
Existing industrial robots face a trade-off between safety requirements and work performance, where ensuring safety often restricts their operating speed and efficiency.
A method for improving robot work performance by assessing collision risks with workers, involving setting collision-possible body parts, calculating risk levels, selecting relevant body parts, and adjusting motion parameters based on determined risk levels, utilizing Power and Force Limit (PFL) cooperative operation, and implementing this on a computer-readable medium or separate device.
This approach enhances safety while maintaining or improving the work performance of robots by adjusting motion parameters to mitigate collision risks, ensuring safety without compromising efficiency.
Smart Images

Figure 112025083730585-PAT00021_ABST
Abstract
Description
Technology Field
[0001] The present invention relates to a method for improving the work performance of a robot within a range that satisfies safety, based on the results of an evaluation of the risk that may occur when colliding with a worker, etc. Background Technology
[0002] A robot refers to a machine that automatically processes or operates a given task based on its own capabilities, and the application fields of robots can be classified into industrial, service, medical, space, and underwater uses.
[0003] Among them, industrial robots are applied to industrial automation and refer to automatic control and reprogrammable multi-purpose manipulators that can be programmed with three or more axes and are fixed or mobile robots, and may include hand-guided robots, manipulator parts of mobile robots, and collaborating robots.
[0004] Meanwhile, an industrial robot system can be configured including the above-mentioned industrial robot, an end device, and all machines, equipment, devices, auxiliary axes, or sensors necessary for the robot to perform tasks.
[0005] Industrial robot systems are already widely used in machining industries, such as automobile production, to repeat movements corresponding to the work of a human arm, and their utilization is on the rise due to factors such as rising labor costs.
[0006] However, there are cases where death or serious injury occurs due to unintended contact with workers during the operation of industrial robots, and accordingly, safety requirements for industrial robot systems and work environments are being established.
[0007] Furthermore, to ensure the safety of industrial robot systems and work environments, it is necessary to simulate the robot's movements before actual operation to identify the possibility or risk of collision with workers or surrounding objects.
[0008] However, if the operating speed of the robot is excessively restricted to satisfy the safety requirements for the robot, there may be a problem of reduced work performance. Prior art literature
[0009] Korean Patent Publication No. 2014-0015802 (Date of Publication: February 7, 2014) The problem to be solved
[0010] The technical problem to be solved by the present invention is to provide a method for effectively improving the work performance of a robot within a range that satisfies safety based on a risk assessment, and a device for performing the same. means of solving the problem
[0011] A method according to an embodiment of the present invention for solving the problem described above is a method for improving the work performance of a robot based on a risk assessment, comprising: a step of setting a plurality of collision-possible body parts for a work area of the robot; a step of calculating risk levels for each of the collision-possible body parts using motion parameters of the robot; a step of selecting one of the set collision-possible body parts using body information of a worker; a step of determining the risk level for the work area according to the selected collision-possible body part; and a step of adjusting the motion parameters of the robot based on the determined risk level.
[0012] The robot is capable of Power and Force Limiting (PFL) cooperative operation, and the risk level can be determined for each of the multiple work areas within the robot's work environment.
[0013] Meanwhile, at least one of the kinematic information, dynamic information, and information regarding the work area of the robot is used in the above setting step and the above selection step, and the motion parameter may include at least one of the velocity, path, and attitude related to the motion of the robot.
[0014] At least some of the methods for improving robot work performance based on the above risk assessment may be implemented on a computer-readable recording medium that records a program to be executed on a computer, and may be provided as the program itself.
[0015] Meanwhile, the method for improving robot work performance based on the above-mentioned risk assessment can be performed by a device according to an embodiment of the present invention, and may be implemented in the robot itself or in a separate device outside the robot. Effects of the invention
[0016] According to an embodiment of the present invention, by calculating the collision risk of a robot for a plurality of potential collision body parts and adjusting the motion parameters of the robot based on the risk determined according to the worker's body information, the safety required for the robot can be secured while simultaneously improving the work performance of the robot. Brief explanation of the drawing
[0017] FIG. 1 is a perspective view showing the configuration of a robot according to an embodiment of the present invention. Figure 2a is a table showing an example of permissible limit values for each body part in the Power and Force Limit (PFL) operation mode. Figure 2b is a table showing an example of physical properties for each body part. Figure 3 is a diagram showing an example of a screen provided in a robot motion simulator. FIG. 4 is a flowchart illustrating a method for setting collision information for robot motion simulation according to an embodiment of the present invention. FIGS. 5 to 7 are drawings for explaining embodiments of a method for setting area information for a robot's workspace. FIGS. 8 and 9 are drawings for illustrating embodiments of a method for setting information about a checkpoint to determine the risk of collision. FIGS. 10 to 16 are drawings for explaining embodiments of a method for representing risk assessment results. FIG. 17 is a flowchart illustrating a method for improving robot work performance based on risk assessment according to an embodiment of the present invention. FIGS. 18 and FIGS. 19 are drawings for illustrating an embodiment of a method for setting a plurality of collision-possible body parts. FIG. 20 is a diagram illustrating an example of a method for calculating risk levels for each body part. FIG. 21 is a diagram illustrating an example of a method for calculating risk levels for each body part. FIG. 22 is a diagram illustrating an example of a method for adjusting the motion parameters of a robot based on risk. Specific details for implementing the invention
[0018] The following description merely illustrates the principles of the present invention. Therefore, those skilled in the art may invent various devices that embody the principles of the present invention and are included within the concept and scope of the present invention, even though they are not explicitly described or illustrated in this specification. Furthermore, all conditional terms and embodiments listed in this specification are, in principle, explicitly intended only for the purpose of understanding the concept of the present invention and should be understood not as being limited to the embodiments and conditions specifically listed as such.
[0019] Furthermore, it should be understood that all detailed descriptions enumerating specific embodiments, as well as the principles, aspects, and embodiments of the present invention, are intended to include structural and functional equivalents thereof. In addition, it should be understood that such equivalents include not only currently known equivalents but also equivalents to be developed in the future, that is, all elements invented to perform the same function regardless of structure.
[0020] Accordingly, for example, the block diagrams in this specification should be understood as representing a conceptual view of an exemplary circuit embodying the principles of the present invention. Similarly, all flowcharts, state transition diagrams, pseudocode, etc., should be understood as representing various processes that can be substantially represented on a computer-readable medium and are performed by a computer or processor, regardless of whether the computer or processor is explicitly depicted.
[0021] The functions of various elements illustrated in the drawings, including functional blocks represented as processors or similar concepts, may be provided by the use of dedicated hardware as well as hardware capable of executing software in relation to appropriate software. When provided by a processor, the functions may be provided by a single dedicated processor, a single shared processor, or a plurality of individual processors, some of which may be shared.
[0022] Furthermore, the explicit use of terms presented as processor, control, or similar concepts should not be interpreted as exclusively referring to hardware capable of executing software, but should be understood to implicitly include, without limitation, digital signal processor (DSP) hardware, ROM, RAM, and non-volatile memory for storing software. Other commonly known hardware may also be included.
[0023] In the claims of this specification, the component expressed as a means for performing the function described in the detailed description is intended to include all methods for performing the function, including, for example, a combination of circuit elements performing the function or software of any form including firmware / microcode, and is combined with a suitable circuit for executing said software to perform said function. Since the invention defined by these claims combines the functions provided by the various enumerated means and combines them in the manner required by the claims, any means capable of providing said function should be understood as equivalent to that identified from this specification.
[0024] The aforementioned objectives, features, and advantages will become clearer through the following detailed description in conjunction with the attached drawings, and accordingly, a person skilled in the art to which the present invention pertains will be able to easily implement the technical concept of the present invention. Furthermore, in describing the present invention, if it is determined that a detailed description of known technology related to the present invention may unnecessarily obscure the essence of the present invention, such detailed description will be omitted.
[0025] In the following, embodiments of the present invention are described using a collaborative robot as an example, but the present invention is not limited thereto and may be applicable to industrial robots and various other robots.
[0026] A collaborative robot is a robot designed to interact directly with humans within a defined collaborative work area, and collaborative operation can refer to the working state of a robot system and an operator intentionally designed within the collaborative work area.
[0027] In addition, a collaborative workspace is a work area within a safeguarded space where robots and humans perform tasks simultaneously during production operations; it may refer to an area within a workspace where a robot system (including workpieces) and a person can perform tasks simultaneously during production operations.
[0028] FIG. 1 illustrates the configuration of a robot according to an embodiment of the present invention, wherein the robot (100) may be configured to include a base (Base, 110), a plurality of joints (120 to 128) and a tool flange (Tool Flange, 150).
[0029] Referring to FIG. 1, the base (110) is a part for fixing the robot (100), and a cable connection connector between the robot (100) and the control box may be formed on the base (110).
[0030] The tool flange (150) is a part for mounting a gripper or tool on the robot (100), and input / output ports for controlling the gripper or tool and buttons for direct teaching may be arranged at positions adjacent to the tool flange (150).
[0031] Meanwhile, between the base (110) and the tool flange (150), a base joint (120), a shoulder joint (122), an elbow joint (124), a first wrist joint (126), a second wrist joint (127), and a third wrist joint (128) are provided, so that the robot (100) can perform 6-axis joint movements.
[0032] A robot (100) having a structure as described with reference to FIG. 1 is capable of cooperative operation, and cooperative operation may include one or more of the following methods: safe monitored stop, hand guiding, speed and position monitoring, and Power and Force Limiting (PFL).
[0033] In the safety rated monitoring stop method, the safety rated monitoring stop function is used to stop the robot's movement before the operator enters the cooperative work area to interact with the robot system and complete the task.
[0034] If there is no driver in the cooperative work area, the robot (100) operates non-cooperatively, and when the safety rating monitoring function is activated while the robot system is in the cooperative work area and the robot's movement stops, the driver is allowed to enter the cooperative work area. Meanwhile, after the driver exits the cooperative work area, the movement of the robot system can be resumed without additional interference.
[0035] In the hand guiding method, the operator uses a hand-operated device to transmit operation commands to the robot system, and the robot (100) must complete a safety-rated monitoring stop before the operator is permitted to enter the cooperative work area and perform the hand guiding operation.
[0036] This task is performed by manually operating guiding devices located at or near the robot's end device, and the robot system used for hand guiding must be equipped with additional functions such as force output, a virtual safety area, or tracking technology.
[0037] In the speed and position monitoring method, the robot system and the operator are allowed to move simultaneously in the cooperative work area, and the risk reduction can be achieved by maintaining a minimum protective separation distance between the operator and the robot (100).
[0038] In this case, while the robot (100) is operating, the distance between the robot system and the driver must not become closer than the absolute protection separation distance, and the robot system stops when the separation distance decreases to a value smaller than the protection separation distance. Meanwhile, the robot system can automatically resume operation while maintaining the minimum protection separation distance when the driver moves away from the robot system, and the protection separation distance can decrease simultaneously when the robot system reduces speed.
[0039] In driving modes based on the Power and Force Limiting (PFL) method, physical contact between the robot system (including the workpiece) and the operator may occur intentionally or unintentionally, and cooperative driving with limited power and force requires a robot system designed for this specific type of driving.
[0040] In this case, the risk can be reduced by managing the hazard sources associated with the robot system to below the allowable limit values determined during the risk assessment process through a robot or safety-rated control system that includes fundamental safety measures, and the allowable limit values can be set as the maximum allowable pressure and maximum allowable force that can be withstood by each part of the human body.
[0041] For example, the permissible limit values for each body part in the power and force limit (PFL) operation mode may be set to the maximum permissible pressure and maximum permissible force for each body part as defined in the international standard (ISO TS 15066) as shown in FIG. 2a, but the present invention is not limited thereto and may be changed according to the level of risk to be managed.
[0042] In addition, for risk assessment, standards for physical properties by body part as shown in FIG. 2b may be applied, but the present invention is not limited thereto.
[0043] Meanwhile, during cooperative operation using the power and force limiting (PFL) described above, contact between the cooperative robot and a part of the operator's body may occur as a contact situation intended as part of the work process, an incidental contact situation resulting from non-following the work sequence, or a failure type that causes the contact situation.
[0044] Furthermore, possible contact between the moving parts of a robot system and the human body can be classified into quasi-static contact and transient contact.
[0045] Quasi-static contact is contact between a driver and a robot system component that occurs between a moving part of a robot system and a stationary or moving part of another robot, where a part of the driver's body may be clamped, in which case the robot system may apply pressure and force to the clamped part of the body for a significant period of time until the situation is relieved.
[0046] Meanwhile, dynamic contact is contact between a driver and a part of a robot system that occurs in a place where the driver's body part is not clamped to the moving part of the robot system, but can move to retract or move away from the robot, and the actual contact may occur for a short period of time, which can be defined by the inertia of the robot, the inertia of the body part, and the relative velocity of the two.
[0047] The risk of potential contact between the robot and the driver as described above can be reduced by considering a method in which possible contact between the driver and the robot system does not cause injury to the driver.
[0048] For example, the risk can be reduced by verifying the conditions under which contact occurs, evaluating the potential risk of contact, designing robot systems and work areas so that contact does not occur frequently or can be avoided, and applying risk reduction measures to keep contact situations below a threshold.
[0049] Here, for risk assessment, it must be assumed that the driver is not protected from potential contact through risk reduction means such as personal protective equipment, and criteria such as the driver's exposed body parts, the origin of the contact event, the probability or frequency of occurrence, the type of contact event, the contact area, speed, force, pressure, momentum, mechanical power, energy, and other quantitative items capable of characterizing the physical contact event may be considered.
[0050] Meanwhile, to reduce the risk evaluated as above, passive methods related to the mechanical design of the robot system or active methods related to the control design of the robot system may be performed.
[0051] For example, as passive safety design measures, there may be an increase in the contact surface area, energy absorption, extension of the energy transmission time or reduction of impact force, and limitation of moving mass.
[0052] Specifically, circular edges and corners, smooth surfaces, or flexible surfaces may be used to increase the contact surface area, or fillers, cushioning materials, deformable parts, complex joints, or links may be used to absorb energy, extend energy transmission time, or reduce impact force.
[0053] Active safety design measures may include limiting force and torque, limiting the speed of moving parts, limiting momentum as a function of mass and velocity, limiting mechanical power or energy, using safety-rated flexible axes and space-limiting functions, using safety-rated monitoring stop functions, and using detection to anticipate or recognize contact, but the present invention is not limited thereto.
[0054] Meanwhile, if the risk is not sufficiently reduced by a combination of passive or active risk reduction methods as described above, other risk reduction methods, including barriers or safety devices, may be required.
[0055] As mentioned above, the robot system is designed so that the applicable thresholds for quasi-static and dynamic contacts determined by risk assessment are not exceeded, thereby reducing the risk to the operator to below the threshold.
[0056] A robot having cooperative driving capabilities in Power and Force Limit (PFL) mode may include a function to set allowable threshold values for force, torque, speed, momentum, mechanical power, axis range, or spatial range.
[0057] For example, the elimination of hazards associated with dynamic contact may include speed limits for moving parts (robots, work tools, workpieces, etc.) and appropriate design for physical characteristics such as the surface area of the moving parts that come into contact with the operator.
[0058] In addition, risk reduction associated with quasi-static contact may include speed limits and physical characteristics similar to dynamic contact, and may additionally include design characteristics of robot system components that have the potential to grab or press on the driver or parts of the driver's body.
[0059] In the above description, a robot (100) and a robot system according to an embodiment of the present invention have been described with reference to FIGS. 1 and FIGS. 2, but the present invention is not limited thereto, and the present invention may be applied to various robots based on international standards related to robots and robot systems (ISO 10218-1, ISO 10218-2, ISO TS 15066, ISO 12100, ISO 13850, ISO 13855, IEC 60204-1).
[0060] According to the present invention, in order to ensure safety for the robot system and the work environment, a robot motion simulation may be performed to simulate the motion of the robot (100) and to check the possibility or risk of collision with a worker or surrounding objects.
[0061] For example, in the case of a robot with cooperative driving capabilities in Power and Force Limit (PFL) mode, when robot-related information, tool-related information, checkpoint-related information regarding collision sites, and robot motion-related information are input, information regarding the predicted force and pressure in the event of a collision during the robot's operation can be calculated and displayed in the simulator.
[0062] Figure 3 illustrates an example of a screen provided in a robot motion simulator. Using information about the area where the robot is installed and information about the tool mounted on the robot, the predicted collision force and pressure during robot operation are calculated and displayed on graphs on the left side of the screen, and the corresponding robot operation can be sequentially displayed on the right side of the screen.
[0063] Meanwhile, a Pressure Force Index (PFI) indicating the risk of robot operation is calculated based on the predicted collision force and pressure as described above, and the calculated risk PFI can be displayed together on a graph on the left side of the screen, and as shown in Fig. 3, if the PFI exceeds a limit value (e.g., 1), the risk assessment result can be displayed on the graph along with the corresponding operation of the robot.
[0064] In addition, for robot operations where the risk level PFI exceeds the limit value as described above, the robot's operating speed (e.g., maximum operating speed) to reduce the PFI to below the limit value can be calculated and provided.
[0065] A simulator that performs robot motion simulation as described above may be included in a robot or robot system and store information related to the robot's motion in advance, or it may exist outside the robot or robot system and receive information related to the robot's motion.
[0066] The robot motion simulator described above may be implemented as software and / or hardware resources necessary to realize the technical concept of the present invention, and does not necessarily mean a single physical component or a single device.
[0067] That is, a robot motion simulator may refer to a logical combination of software and / or hardware provided to implement the technical concept of the present invention, and, if necessary, may be implemented as a set of logical configurations to implement the technical concept of the present invention by being installed in separate devices and performing their respective functions.
[0068] FIG. 4 is a flowchart illustrating a method for setting collision information for robot motion simulation according to an embodiment of the present invention, and will be explained by taking as an example that it is performed by a simulation device (400) for robot motion.
[0069] The simulation device (400) obtains robot installation information, danger area information, and information on body parts that may collide with each danger area for the robot's workspace (step S400).
[0070] In step S400, an image of the robot's workspace is acquired, the scale of the acquired image is set, and at least one of the robot's installation angle and installation position can be set.
[0071] In addition, one or more risk regions are set on the acquired image, and for each of the set risk regions, a body part corresponding to at least one of the skull and forehead, face, neck, back and shoulder, chest, abdomen, pelvis, upper arms and elbow joints, lower arms and wrist joints, hands and fingers, thighs and knees, and lower legs may be set.
[0072] With reference to FIGS. 5 to 7, embodiments of a method for setting area information for the robot's workspace in step S400 will be described in more detail.
[0073] Referring to FIG. 5, a 2D image representing the robot's workspace may be input, but the present invention is not limited thereto, and a 3D image representing the robot's workspace in three dimensions may also be input.
[0074] A robot's workspace (510) is displayed on the screen of the simulation device (400), and a user interface (520 to 528) for setting area information for the workspace (510) may be provided.
[0075] After selecting the "Scaling line" button (520) on the screen of the simulation device (400), the user can set the actual size of the workspace (510) displayed on the screen using the scaling bar (530).
[0076] Next, the user can enter the angle at which the robot is installed in the “Origin rotation angle” input field (521), select the “Robot originin” button (522), and then use the cursor to set the position where the robot is installed on the screen.
[0077] Then, if the user selects a body part that can collide in the "Collision part" selection window (523) and selects the "Rectangle" button (524) to set a danger area, the body part that can collide in the danger area can be displayed on the screen along with the danger area.
[0078] The user can set danger zones and collision-capable body parts for each of the danger zones using the method described above.
[0079] As described above, once the area information setting for the robot's workspace (510) is completed, the user can select the "Save Area info" button (527) to save the set area information.
[0080] Referring to Fig. 7, for "Work Area 0", the chest is set as a potential collision body part (evaluation area), and for "Work Area 1" and "Work Area 2", the hand is set as an (evaluation area).
[0081] The simulation device (400) receives a check point for determining the collision risk for a robot (step S410), and calculates coordinate information and shape information for the check point based on at least some of the information obtained in step S400 and the check point set in step S410 (step S420).
[0082] In step S410, an image of a tool mounted on a robot is acquired, and a checkpoint can be set on the acquired image.
[0083] Meanwhile, a checkpoint for determining the risk of collision may be set in the main body of the robot, rather than in the tool, and checkpoint information for the main body of the robot may already be stored in the simulation device (400).
[0084] With reference to FIGS. 8 and 9, embodiments of a method for setting a checkpoint and calculating coordinate information and shape information for the checkpoint will be described in more detail.
[0085] Referring to FIG. 8, a 3D image representing a tool mounted on a robot may be input, but the present invention is not limited thereto and may be a 2D image obtained by photographing a tool mounted on a robot.
[0086] A tool (810) mounted on a robot is displayed on the screen of the simulation device (400), and a user interface (812 to 815, 821 to 829) for setting checkpoints for the tool (810) may be provided.
[0087] In step S420, shape information for a checkpoint can be calculated using information about the surrounding points of the checkpoint.
[0088] For example, similarity to multiple representative shapes is calculated using information about points surrounding a checkpoint, and the shape of the checkpoint can be determined as one of the multiple representative shapes based on the calculated similarity.
[0089] Here, the plurality of representative shapes may include at least one of a half sphere, a corner, a cylinder, and a flat, but the present invention is not limited thereto.
[0090] Meanwhile, using the shape information calculated as described above, a normal vector for the checkpoint can be calculated.
[0091] For example, the user can select desired checkpoints on a 3D image.
[0092] In this case, points located around a checkpoint selected by the user are set, and information about the surrounding points (e.g., location and vector information, etc.) is used to fit each of the multiple representative shapes, thereby calculating the similarity with the representative shapes.
[0093] In this case, the representative shape with the highest similarity among multiple representative shapes is determined, and the information of the determined representative shape can be stored as shape information for the checkpoint.
[0094] Here, the representative shape may be a half sphere, and the radius of the hemisphere with the highest similarity can be obtained as shape information for the checkpoint by using information about the surrounding points of the checkpoint.
[0095] When a user selects a checkpoint (830) on a 3D image of a tool displayed on the screen of a simulation device (400), checkpoint identification information is entered into a checkpoint identification window (826), the location of the checkpoint is automatically entered into a "Collision point xyz" display window (827), and a vertical vector for the checkpoint can be automatically entered into a "Normal vector xyz" display window (828).
[0096] In addition, according to the checkpoint shape information calculated as above, the radius of a hemisphere similar to the checkpoint can be automatically entered into the "Collision radius" display window (829).
[0097] In addition, the user can set additional checkpoints using the method described above, and each time additional checkpoints are set, the location, vertical vector, and shape information (radius) of each checkpoint can be calculated and automatically entered.
[0098] According to another embodiment of the present invention, while photographing the actual tool using a device such as a tablet PC, a checkpoint may be directly selected on the image of the tool displayed on the screen.
[0099] FIG. 9 shows an example of 47 checkpoints set by the method described above, each checkpoint may be processed into a representative shape with high similarity among a sphere, a cylinder, and a plane based on a 3D model, but the present invention is not limited thereto.
[0100] Although the method for setting collision information for robot motion simulation according to one embodiment of the present invention has been described above as being performed by a robot motion simulation device, the present invention is not limited thereto and may be performed on a PC (personal computer), a laptop, a tablet, etc., or on a teaching pendant which is a teaching box provided in a robot system, or on a control station for controlling the robot or on the robot itself.
[0101] Hereinafter, with reference to FIGS. 10 to 16, embodiments of a method for indicating the results of a risk assessment for the operation of a robot will be described.
[0102] First, the risk level of the robot's operation can be calculated by simulating the robot's operation and using the predicted force or pressure at the time of a predicted collision and a preset force limit or pressure limit value.
[0103] More specifically, the risk level for each robot operation can be calculated using the larger value between the value obtained by dividing the predicted force by the force limit value and the value obtained by dividing the predicted pressure by the pressure limit value.
[0104] For example, area information and checkpoint information are set for the robot's workspace according to the collision information setting method described above, and position, vertical vector, and shape information for the checkpoint are calculated, then the collision risk for each operation can be calculated according to the set and calculated information.
[0105] The risk level for each operation can be calculated as the Pressure Force Index (PFI) as shown in Equation 1 below.
[0106]
[0107] In Equation 1, "f_est" is the force value generated during a collision predicted through simulation of robot motion, and can be calculated as shown in Equation 2 below.
[0108]
[0109] In mathematical equation 2, v rel is the relative velocity between the robot and the person, μ is the combined mass of the robot and the person, and k is the combined stiffness of the robot and the person.
[0110] In addition, "p_est" in Equation 1 is a pressure value that occurs during a collision, which is predicted through simulation of robot motion, and can be calculated as shown in Equation 3 below.
[0111]
[0112] And in Equation 1, "f_max" is a force limit value for each body part of a person and "p_max" is a pressure limit value for each body part of a person, and each may have values as described with reference to FIG. 2, but the present invention is not limited thereto and may be set to values required by the standard.
[0113] As described above, when a PFI indicating the collision risk is calculated, if the PFI value exceeds 100, the force or pressure at the time of collision predicted by the simulation device (400) is outside the range of the limit value, and it can be determined that there is a risk sufficient to cause serious injury to the body if the checkpoint collides with a person during the corresponding operation of the robot.
[0114] Meanwhile, as mentioned above, for operations where the PFI value exceeds 100, a risk reduction method to lower the PFI value to 100 or less may be additionally provided.
[0115] Meanwhile, as mentioned above, in order to accurately calculate the physical quantities of contact that occur when a person and a robot come into contact, information regarding the robot, end device, and workpiece, etc., necessary for constructing a mechanical contact model may be provided.
[0116] Here, the robot information may include robot kinematic information for calculating contact physical quantities, dynamic information, and collider shape information.
[0117] For example, kinematic information regarding the robot and contact-related elements may include the robot's DH parameters (Denavit-Hartenberg parameters), position information for the robot, end device, and workpiece in contact with the human body part, as well as velocity and direction components and shape information of the contact point.
[0118] Shape information of a robot, end device, and workpiece in contact with a body part may include the radius of the sphere in the case of a sphere, the radius of the cylinder and the direction of the cylinder's major axis in the case of a cylinder body, the radius of the cylinder and the fillet radius of the cylinder end and the direction of the cylinder's major axis in the case of a cylinder end with a fillet, and the radius of the fillet and the direction of the corner in the case of a square corner with a fillet, and in the case of other shapes, may include parameters (e.g., curvature, area, boundary) that can define the contact shape as geometric 3D information.
[0119] In addition, dynamic information regarding the robot and contact-related elements may include the robot's control force and contact sensing performance (e.g., contact force sensing threshold) under the contact conditions, elements such as links and joints constituting the robot and inertia information of the end device (e.g., weight, center of gravity, moment of inertia), and the robot's effective mass according to the robot's attitude.
[0120] Here, the effective mass of the robot varies depending on the robot's orientation, and the degree to which the robot, end device, and workpiece contribute to the effective mass upon contact may vary depending on the orientation of the robot or end device and the orientation of the workpiece.
[0121] Meanwhile, for information regarding the person being contacted, physical properties such as those shown in FIG. 2b may be used.
[0122] In addition, the physical quantity of contact between a person and a robot may vary depending on the type of contact, the shape and material of the collider, the robot's attitude, collision speed, collision direction, payload, and the body part colliding.
[0123] Here, the contact type can be divided into static and dynamic based on the robot's motion information, and into constrained and unconstrained based on the spatial configuration, and can be defined as, for example, a push (unconstrained static contact), an impact (unconstrained dynamic contact), a pinch (constrained static contact), and a crush (constrained dynamic contact).
[0124] A collider refers to a robot, end device, or workpiece that comes into contact with a human body part, and can be defined, for example, as a spherical, cylindrical end-shaped, or cube corner-shaped object.
[0125] Furthermore, the robot's posture can be divided into a dynamic unconstrained contact posture resulting from the robot's dynamic movement while the body parts are not fixed, a dynamic constrained contact posture resulting from the robot's dynamic movement while the body parts are fixed, and a static constrained contact posture resulting from the robot's static movement while the body parts are fixed.
[0126] Regarding human body parts, for dynamic unrestrained contact, risk can be assessed for the skull, forehead, chest, forearms, and wrists, which are body parts that may include both low mass and high mass, and low elasticity and high elasticity.
[0127] Meanwhile, regarding dynamic and static restraint contact, the risk to the hands and fingers can be assessed.
[0128] Referring to FIG. 10, a graph showing the robot's joint angle and the task velocity of each checkpoint can be provided as a result of the risk assessment.
[0129] And the results of the risk assessment for the work areas can be provided as illustrated in FIGS. 11 to 14.
[0130] Referring to FIG. 11, a risk level (PFI) graph and a comprehensive evaluation result (maximum PFI and pass / fail) for all set work areas (work areas 0, 1, and 2) may be provided.
[0131] Accordingly, the PFL analysis results evaluating the risk of the robot may show that for the "chest" and "hands," which are potential collision body parts in all work areas, the maximum risk (PFI) is 80.5, which does not exceed the threshold (100).
[0132] Referring to FIG. 12, a risk (PFI) graph and evaluation results for "work area 0" may be provided, and accordingly, it may be shown that the maximum risk (PFI) for the "chest," which is a body part susceptible to collision in "work area 0," is 80.5 and does not exceed the reference value (100).
[0133] And with reference to FIG. 13, a risk level (PFI) graph and evaluation results for "Work Area 1" are provided, and for the "hand," which is a body part that may collide in "Work Area 1," the maximum risk level (PFI) is 30.3, and the PFL analysis result is indicated as "PASS."
[0134] In addition, referring to Fig. 14, a risk level (PFI) graph and evaluation results for "Work Area 2" are provided, and for the "hand," which is a body part that may collide in "Work Area 2," the maximum risk level (PFI) is 41.6, and the PFL analysis result is indicated as "PASS."
[0135] Additionally, the entire motion of the robot may be divided into intervals of about 1 second, and the risk level (PFI) calculated for each divided motion may be represented by color as shown in Fig. 15.
[0136] And as the final result of the PFL analysis evaluating the risk of robot operation, as shown in FIG. 16, the collision-prone body parts for each of the work areas evaluated and whether the safety evaluation passed may be provided.
[0137] Hereinafter, with reference to FIGS. 17 to 22, embodiments of a method for improving robot work performance based on risk assessment according to the present invention and an apparatus for performing the same will be described. Meanwhile, among the methods and configurations described below, descriptions of those identical to those described with reference to FIGS. 1 to 16 will be omitted.
[0139] FIG. 17 is a flowchart illustrating a method for improving robot work performance based on risk assessment according to an embodiment of the present invention.
[0140] Referring to FIG. 17, a plurality of collision-possible body parts are set for the robot's work area (step S1700).
[0141] Here, the robot subject to the risk assessment may be a robot capable of Power and Force Limit (PFL) cooperative operation, and the collision-prone body parts may be set to two or more for each work area.
[0142] For example, multiple work areas that may collide with a worker are set in the robot's workspace, and for each work area, the body part that may collide in that work area may be set as multiple body parts rather than being designated as a single body part.
[0143] Specifically, the multiple collision-possible body parts may include at least some of the body parts or body regions defined in FIG. 2a, and may be pre-set as two or more representative body parts considering the elastic modulus and mass shown in FIG. 2b.
[0144] Referring to FIG. 18, for each work area, multiple body parts (e.g., head, chest, upper arms, hands) may be set as body parts to assess risk.
[0145] Meanwhile, in step S1700, at least one of a plurality of preset collision-possible body parts may be excluded by using at least one of the robot's kinematic information, dynamic information, and information regarding the corresponding work area.
[0146] Here, the kinematic information of the robot may include the robot's DH parameters (Denavit-Hartenberg parameters), position, velocity and direction components of the contact point, and shape information for the robot, end device, and workpiece in contact with a human body part, but the present invention is not limited thereto.
[0147] Meanwhile, the dynamic information of the robot may include the robot's control force and contact detection performance under the relevant contact conditions, elements such as links and joints constituting the robot and inertial information of the end device, and the robot's effective mass according to the robot's attitude, but the present invention is not limited thereto.
[0148] For example, as shown in FIG. 19, for "Work Area 0," among the multiple body parts (head, chest, upper arm, hand), "hand" may be excluded from the evaluation area, for "Work Area 1" "head" may be excluded from the evaluation area, and for "Work Area 2" "head" and "chest" may be excluded from the evaluation area.
[0149] This is because, considering the robot's kinematic information, dynamic information, and the corresponding work area, some body parts have a very low probability of colliding with the robot in a specific work area; therefore, body parts with a low probability of collision can be excluded from the evaluation area for that work area.
[0150] Next, using the robot's motion parameters, the risk levels for each body part for each potential collision body part are calculated (Step S1710).
[0151] As explained above with reference to mathematical formulas 1 to 3, the risk level for each body part can be calculated using a predicted force or pressure value based on the robot's motion parameters and a preset force or pressure limit value related to the body part that may collide.
[0152] Meanwhile, the risk level for each body part is calculated for each of the multiple work areas within the robot's workspace, and it can be verified whether the maximum risk value among the calculated risk levels for each body part is below a threshold.
[0153] Referring to FIG. 20 (a), for "work area 0," the risk (PFI) for each of the multiple body parts, "head," "chest," and "upper arm," is calculated, and it can be confirmed that the risk (PFI) for "chest," which is the maximum value among the calculated risk (PFI) values for each body part, is 80.5 and does not exceed the reference value of 100.
[0154] Referring to Fig. 20(b), for "work area 1," the risk (PFI) for "chest," "upper arm," and "hand" is calculated, and it can be confirmed that the risk (PFI) for "chest," which is the maximum value among the calculated risk (PFI) values for each body part, is 73.2 and does not exceed the threshold.
[0155] In addition, referring to Fig. 20 (c), for "work area 2," the risk (PFI) for "upper arm" and "hand" is calculated, and it can be confirmed that among the calculated risk (PFI) values for each body part, the maximum value is the risk (PFI) for "upper arm" which is 60.9 and does not exceed the reference value.
[0156] And with reference to Fig. 20 (d), as a result of the comprehensive risk assessment for the entire evaluation area, "head," "chest," "upper arm," and "hand," it can be confirmed that the maximum value of the risk (PFI) calculated for all work areas is 80.5 and does not exceed 100.
[0157] After that, using the body information of the worker, one of the collision-prone body parts set in step S1700 is selected (step S1720), and the risk level of the work area is determined according to the collision-prone body part selected in step S1720 (step S1730).
[0158] Here, body information about the worker can be obtained using at least one of a camera, an ID card, biometric information, and average height information.
[0159] For example, physical information such as the height of a worker may be obtained based on the captured image by photographing the worker through a camera installed adjacent to the robot's workspace, or physical information such as the height of a worker may be obtained by identifying the worker through biometric information such as an ID card, fingerprint, or iris possessed by the worker.
[0160] Meanwhile, in cases where physical information about a worker cannot be obtained through a camera, ID card, or biometric information as described above, physical information about the worker may be obtained based on a pre-stored average height.
[0161] In step S1720, a body part with a potential collision area can be determined using at least one of the robot's kinematic information, dynamic information, and information about the work area, and body information about the worker.
[0162] Referring to FIG. 21, for "work area 0," among the collision-possible body parts set in step S1700, "head," "chest," and "upper arm," "chest" may be selected as the collision-possible body part according to the worker's body information.
[0163] Meanwhile, among the risk levels for each body part calculated in step S1710 for "work area 0," the risk level for "chest" selected in step S1720 (PFI) can be determined as the risk level for the corresponding work area.
[0164] For "Work Area 1", among the collision-possible body parts set in step S1700, "chest", "upper arm", and "hand", "hand" can be selected as the collision-possible body part according to the worker's body information.
[0165] Meanwhile, among the risk levels for each body part calculated in step S1710 for "Work Area 1," the risk level for "hand" selected in step S1720 (PFI) can be determined as the risk level for the corresponding work area.
[0166] In this case, as the potential collision body part with the maximum risk (PFI) value in "Work Area 1" is changed from "chest" to "hand", the maximum risk (PFI) value for that work area can be reduced from 73.2 to 30.3.
[0167] And for "Work Area 2", among the collision-possible body parts set in step S1700, "hand" can be selected as the collision-possible body part according to the worker's body information.
[0168] Meanwhile, among the risk levels for each body part calculated in step S1710 for "Work Area 2," the risk level for "hand" selected in step S1720 (PFI) can be determined as the risk level for the corresponding work area.
[0169] In this case, as the potential collision body part with the maximum risk (PFI) value in "Work Area 2" is changed from "upper arm" to "hand", the maximum risk (PFI) value for that work area can be reduced from 60.9 to 41.6.
[0170] After that, the robot's motion parameters are adjusted based on the risk level determined in step S1730 (step S1740).
[0171] Here, the motion parameters subject to adjustment may include at least one of speed, path, and attitude related to the motion of the robot, but the present invention is not limited thereto.
[0172] In step S1740, if the risk level for the work area determined in step S1730 is smaller than the maximum risk value among the risk levels for each body part calculated in step S1710, the robot's motion parameters may be adjusted so that the robot's motion speed increases.
[0173] According to one embodiment of the present invention, robot motion parameters such as those above can be adjusted within a range that satisfies certain conditions.
[0174] For example, the motion parameters of the robot are adjusted within a range where the risk to other work areas other than the corresponding work area is not increased, and the risk to the corresponding work area may be adjusted within a range where the risk does not exceed the maximum risk among the risk levels for each body part calculated in step S1710.
[0175] Referring to FIG. 22, the operating speed of the robot in "Work Area 1" can be increased according to the worker's body information, and accordingly, the maximum risk (PFI) value for "Work Area 1" can be increased from 30.3 to 58.6.
[0176] However, even if the operating speed of the robot in "Work Area 1" is increased, the maximum risk (PFI) value for "Work Area 0" is not changed, and the maximum risk (PFI) value for "Work Area 1" may be increased within a range smaller than 73.2, which is the maximum value among the risk (PFI) values for each body part for "Work Area 1" calculated in step S1710.
[0177] In addition, the robot's operating speed can be increased in "Work Area 2" where the maximum risk (PFI) value is reduced according to the worker's body information, and accordingly, the maximum risk (PFI) value for "Work Area 2" can be increased from 41.6 to 48.7.
[0178] However, even if the operating speed of the robot in "Work Area 2" is increased, the maximum risk (PFI) value for "Work Area 0" is not changed, and the maximum risk (PFI) value for "Work Area 2" may be increased within a range smaller than 60.9, which is the maximum value among the risk (PFI) values for each body part for "Work Area 2" calculated in step S1710.
[0179] According to another embodiment of the present invention, the risk level for each of a plurality of work areas within the robot's workspace is recalculated according to the motion parameter adjusted in step S1740, and if the risk level for each of the recalculated work areas is all below a reference value, the adjusted motion parameter may be applied.
[0180] Meanwhile, if any of the risk levels for each of the recalculated work areas exceed a threshold, the adjusted motion parameters are not applied, and the step of readjusting the robot's motion parameters can be repeated.
[0181] With reference to FIG. 17, steps S1700 and S1710 of the method for improving robot work performance based on risk assessment as described above are performed in the process of evaluating safety by pre-simulating the operation of the robot, and steps S1720 to S1740 may be performed in the process of the robot being installed in a workplace and actually operating, but the present invention is not limited thereto.
[0182] The method for improving robot work performance based on risk assessment as described above with reference to FIGS. 17 to 22 may be performed by a robot motion simulation device according to an embodiment of the present invention, or on a PC, laptop, tablet, etc., or on a teaching pendant which is a teaching box provided in a robot system, or on a control station for controlling the robot or on the robot itself.
[0183] The methods according to the present invention described above can be produced as a program to be executed on a computer and stored on a computer-readable recording medium, and examples of computer-readable recording media include ROM, RAM, CD-ROM, magnetic tape, floppy disk, optical data storage device, etc.
[0184] Computer-readable recording media are distributed across networked computer systems, allowing computer-readable code to be stored and executed in a distributed manner. Furthermore, functional programs, codes, and code segments for implementing the above method can be easily inferred by programmers skilled in the art to which the present invention pertains.
[0185] Although preferred embodiments of the present invention have been illustrated and described above, the present invention is not limited to the specific embodiments described above. It is understood that various modifications can be made by those skilled in the art without departing from the essence of the invention as claimed in the claims, and such modifications should not be understood individually from the technical spirit or perspective of the present invention.
Claims
Claim 1 A method for improving the work performance of a robot based on a risk assessment, comprising: a step of setting a plurality of potential collision body parts for a work area of the robot; a step of calculating risk levels for each of the potential collision body parts using motion parameters of the robot; a step of selecting one of the set potential collision body parts using body information of a worker; a step of determining the risk level for the work area according to the selected potential collision body part; a step of adjusting the motion parameters of the robot based on the determined risk level; a step of recalculating the risk level for each of the plurality of work areas within the robot's work space according to the adjusted motion parameters; and a step of applying the adjusted motion parameters when the risk levels for each of the recalculated work areas are all below a reference value. Claim 2 A method for improving robot work performance according to claim 1, characterized in that the robot is capable of Power and Force Limiting (PFL) cooperative operation. Claim 3 A method for improving robot work performance according to claim 1, characterized in that the risk level is determined for each of a plurality of work areas within the robot's workspace. Claim 4 A method for improving robot work performance according to claim 1, wherein the setting step comprises the step of excluding at least one of a plurality of pre-set collision-possible body parts using at least one of the kinematic information, dynamic information, and information regarding the work area of the robot. Claim 5 A method for improving robot work performance according to claim 1, characterized in that the risk level for each body part is calculated using a predicted force or pressure value based on the motion parameters of the robot and a preset force or pressure limit value in relation to the body part that may collide. Claim 6 A method for improving robot work performance, characterized by including, in claim 5, a step of checking whether the maximum risk value among the calculated risk values for each body part is below a reference value. Claim 7 A method for improving robot work performance according to claim 1, characterized in that body information of the worker is obtained using at least one of a camera, an ID card, biometric information, and average height information. Claim 8 A method for improving robot work performance according to claim 1, wherein the selection step comprises a step of determining a body part capable of collision with the work area using at least one of kinematic information, dynamic information, and information about the work area of the robot, and body information about the worker. Claim 9 A method for improving robot work performance according to claim 1, wherein the determination step comprises the step of selecting a value corresponding to the selected potential collision body part among the calculated risk levels for each body part. Claim 10 A method for improving robot work performance according to claim 1, wherein the motion parameter includes at least one of speed, path, and attitude related to the motion of the robot. Claim 11 A method for improving robot work performance according to claim 10, wherein the adjustment step includes a step of increasing the operation speed of the robot when the risk level for the determined work area is smaller than the maximum risk level among the calculated risk levels for each body part. Claim 12 A method for improving robot work performance according to claim 1, characterized in that the operation parameters are adjusted within a range in which the risk to other work areas other than the work area is not increased. Claim 13 A method for improving robot work performance according to claim 1, wherein the operation parameter is adjusted within a range in which the risk level for the work area does not exceed the maximum risk level among the calculated risk levels for each body part. Claim 14 delete Claim 15 A computer program stored on a computer-readable recording medium in combination with hardware to execute the method of any one of claims 1 to 13. Claim 16 A device for performing the method of any one of paragraphs 1 through 13.
Citation Information
Patent Citations
Method of setting collision information for robot motion simulatiuon, and apparatus for performing the same
KR1020250074890A
Systems and methods for safe robot operation
US20140067121A1
