Confirmation device for operation speed monitoring function of human collaborative robot, and confirmation program for operation speed monitoring function of human collaborative robot
The confirmation device and program for human collaborative robots address the issue of malfunctioning in polluted environments by verifying the operation speed monitoring function through user-guided procedures, ensuring safe operation by confirming its normalcy.
Patent Information
- Application Number
- JP2023073124
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-04-27
- Publication Date
- 2024-11-08
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
Human collaborative robots are prone to malfunctioning in environments with higher levels of pollution than intended, leading to potential safety issues due to errors in their motion speed monitoring functions.
A confirmation device and program that verify the operation speed monitoring function of human collaborative robots by displaying images and executing procedures to confirm the function's normal operation, even in polluted environments, using multiple speed thresholds and axis checks.
Ensures the motion speed monitoring function operates correctly in polluted conditions, preventing unnecessary stops and ensuring safe operation by confirming the function's integrity through user-guided procedures.
Smart Images

Figure 2024158162000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to a device for checking whether a function for monitoring the motion speed of a human-cooperative robot is normal. [Background technology]
[0002] For example, in a teaching task in which a teaching device is used to teach the operation of a manipulator (industrial robot), there is a robot device in which, among multiple joints, joints for which a confirmation operation has already been performed are operated at a set normal speed, and joints for which a confirmation operation has not yet been performed are operated at a speed lower than a safe speed determined based on the normal speed (see Patent Document 1). [Prior art documents] [Patent documents]
[0003] [Patent Document 1] Patent No. 6381203 Summary of the Invention [Problem to be solved by the invention]
[0004] Generally, a collaborative robot that works with humans has an operation speed monitoring function that generates an error and stops the robot when the operation speed exceeds an upper speed limit. For example, the environmental resistance of a collaborative robot intended for use in an office is lower than that of an industrial robot intended for use in a factory. However, a collaborative robot is easy to carry and is used by users who are not familiar with robots, so it is more likely to be used in an environment that is dirtier than the intended environment than an industrial robot. In such a case, the inventors of the present application have noticed that the operation speed monitoring function may fail.
[0005] The present invention has been made to solve these problems, and its main objective is to make it possible to confirm whether or not the operation speed monitoring function is normal when the collaborative robot is used in an environment that is more polluted than the environment in which it is intended. [Means for solving the problem]
[0006] The first means for solving the above problem is A confirmation device is applied to a human collaborative robot having a motion speed monitoring function that generates an error and stops the human collaborative robot when the motion speed of the human collaborative robot, which is assumed to work with humans and be used in an environment with a predetermined degree of dirtiness, and confirms whether the motion speed monitoring function is normal, A display unit for displaying an image; a determination unit that determines whether or not a soiled use has been performed in which the human-collaborative robot is used in an environment with a soiling degree higher than the predetermined soiling degree; a procedure notifying unit that causes the display unit to display an image showing a confirmation procedure for confirming whether the operation speed monitoring function is normal or not when the determination unit determines that the soiled use has been performed; and a result notification unit that causes the display unit to display an image indicating whether the operation speed monitoring function is normal or not based on a result of the execution of the confirmation procedure; Equipped with.
[0007] According to the above configuration, it is assumed that the human-collaborative robot will work in collaboration with humans and be used in an environment with a predetermined degree of contamination. The human-collaborative robot has a motion speed monitoring function that generates an error and stops the human-collaborative robot when the motion speed of the human-collaborative robot exceeds an upper speed limit. A confirmation device for the motion speed monitoring function of the human-collaborative robot is applied to the human-collaborative robot and confirms whether the motion speed monitoring function is normal.
[0008] Here, the display unit displays an image. The determination unit determines whether or not a soiled use has been performed in which the human-collaborative robot is used in an environment with a soiling degree higher than the predetermined soiling degree. Whether or not a soiled use has been performed can be determined by any method, such as determining based on an operation mode of the human-collaborative robot, determining based on an input result by having a user input the environment in which the human-collaborative robot was used, or determining based on an input result by having a user input the soiling degree of the environment in which the human-collaborative robot was used.
[0009] The procedure notification unit causes the display unit to display an image showing a confirmation procedure for confirming whether or not the operation speed monitoring function is normal when the determination unit determines that the soiled use has been performed. Therefore, the user can execute the confirmation procedure according to the image showing the confirmation procedure displayed by the display unit. The confirmation procedure can be executed by any procedure, such as setting an upper speed limit value lower than a normal operation speed and operating the human-cooperative robot at the normal operation speed to confirm whether or not the operation speed monitoring function works normally, or operating the human-cooperative robot for a moment at an operation speed exceeding the upper speed limit to confirm whether or not the operation speed monitoring function works normally. The result notification unit causes the display unit to display an image showing whether or not the operation speed monitoring function is normal based on a result of the execution of the confirmation procedure. Therefore, the user can confirm whether or not the operation speed monitoring function is normal from the image showing whether or not the operation speed monitoring function is normal displayed by the display unit. Therefore, when the collaborative robot is used in an environment with a higher degree of soiling than the assumed environment, it is possible to confirm whether or not the operation speed monitoring function is normal.
[0010] In a second means, the collaborative robot is capable of executing a master-slave robot operation function in which the posture of the industrial robot is controlled so as to match the posture of the collaborative robot when an external force applied by a user changes, and the predetermined degree of contamination is lower than the degree of contamination of the environment in which the industrial robot is used, and the determination unit determines that the contamination use has been executed when execution of the master-slave robot operation function has ended.
[0011] According to the above configuration, the human collaborative robot can execute a master-slave robot operation function (master-slave robot operation mode) in which the posture of the industrial robot is controlled so as to match the posture of the human collaborative robot when an external force applied by a user changes. The predetermined degree of contamination is lower than the degree of contamination of the environment in which the industrial robot is used. In this case, the human collaborative robot is brought to the environment in which the industrial robot is used and the master-slave robot operation function is executed, so that the human collaborative robot is used in an environment with a degree of contamination higher than the predetermined degree of contamination.
[0012] In this regard, the determination unit determines that the soiled use has been performed when the execution of the master-slave robot operation function has ended. Therefore, even if the user does not input the environment in which the human-cooperative robot has been used, it is possible to confirm whether the operation speed monitoring function is normal or not when the master-slave robot operation function is executed and the human-cooperative robot has been used in an environment with a soiling degree higher than a predetermined soiling degree.
[0013] In a third means, the speed upper limit value includes a first speed upper limit value and a second speed upper limit value that is automatically set lower than the first speed upper limit value, and the motion speed monitoring function includes a first motion speed monitoring function that generates a first error to stop the human-cooperative robot when the motion speed of the human-cooperative robot exceeds the first speed upper limit value, and a second motion speed monitoring function that is less reliable than the first motion speed monitoring function and that generates a second error to stop the human-cooperative robot when the motion speed of the human-cooperative robot exceeds the second speed upper limit value, and the procedure notification unit prohibits the second speed upper limit value from being automatically set lower than the first speed upper limit value when causing the display unit to display an image showing a confirmation procedure for checking whether the first motion speed monitoring function is normal.
[0014] According to the above configuration, the speed upper limit value includes a first speed upper limit value and a second speed upper limit value that is automatically set lower than the first speed upper limit value. Therefore, the motion speed of the human collaborative robot exceeds the second speed upper limit value before the first speed upper limit value. The motion speed monitoring function includes a first motion speed monitoring function that generates a first error to stop the human collaborative robot when the motion speed of the human collaborative robot exceeds the first speed upper limit value, and a second motion speed monitoring function that is less reliable than the first motion speed monitoring function and generates a second error to stop the human collaborative robot when the motion speed of the human collaborative robot exceeds the second speed upper limit value. Therefore, there is a risk that the second motion speed monitoring function is activated at the time when the motion speed of the human collaborative robot exceeds the second speed upper limit value, and the human collaborative robot is stopped, making it impossible to confirm whether the first motion speed monitoring function is normal or not.
[0015] In this regard, the procedure notification unit prohibits the second speed upper limit from being automatically set lower than the first speed upper limit when causing the display unit to display an image showing a check procedure for checking whether or not the first operation speed monitoring function is normal. This makes it possible to set the first speed upper limit lower than the second speed upper limit, and by executing the check procedure for checking whether or not the first operation speed monitoring function is normal, it is possible to check whether or not the first operation speed monitoring function is normal.
[0016] In a fourth means, the human-collaborative robot includes a plurality of links connected to be rotatable relative to one another, and a plurality of axes that rotate adjacent links relative to one another, and the motion speed monitoring function is a function that generates an error and stops the human-collaborative robot when any of the motion speeds of the plurality of axes exceeds an upper speed limit value set for each axis, and the procedure notification unit drives the plurality of axes of the human-collaborative robot one by one to display the image showing the confirmation procedure on the display unit so as to allow the user to confirm whether the motion speed monitoring function is normal or not.
[0017] According to the above configuration, the collaborative robot includes a plurality of links connected to be capable of relative rotation, and a plurality of axes that rotate adjacent links relative to each other. The motion speed monitoring function is a function that generates an error and stops the collaborative robot when the motion speed of any of the plurality of axes exceeds a speed upper limit value set for the respective axis. In this case, if the motion speed monitoring function is checked to see if it is normal by simultaneously driving the plurality of axes, the collaborative robot will continue to operate if the motion speed of the axis whose motion speed monitoring function is normal does not exceed the speed upper limit value, which may increase the chances of the collaborative robot not stopping when the motion speed monitoring function fails.
[0018] In this regard, the procedure notification unit causes the display unit to display the image indicating the confirmation procedure so as to drive the multiple axes of the human-cooperative robot one by one to check whether the motion speed monitoring function is normal or not. Therefore, the human-cooperative robot does not stop only when the motion speed monitoring function of one driven axis is broken, and it is possible to suppress an increase in the number of occasions where the human-cooperative robot does not stop.
[0019] In a fifth aspect, the procedure notification unit causes the display unit to display the image indicating the confirmation procedure so as to set the upper speed limit to a settable minimum value. With this configuration, the collaborative robot can be caused to exceed the upper speed limit when the operating speed is low, so that it is possible to check in a safe state whether the operating speed monitoring function is normal.
[0020] In a sixth aspect, the collaborative robot includes two operated parts that need to be operated simultaneously by a user to operate the collaborative robot, and the procedure notification unit stops the collaborative robot if at least one of the two operated parts is not operated when the display unit displays an image showing the confirmation procedure. With this configuration, even if the operation speed monitoring function has a malfunction and the collaborative robot does not stop during the execution of the confirmation procedure, the user can immediately stop the collaborative robot by ceasing the operation of at least one of the two operated parts.
[0021] The seventh measure is: A verification program for verifying whether or not a motion speed monitoring function is normal, the verification program being applied to a human collaborative robot having a motion speed monitoring function that generates an error and stops the human collaborative robot when the motion speed of the human collaborative robot, which is assumed to work in collaboration with a human and be used in an environment with a predetermined degree of dirtiness, exceeds an upper speed limit, the verification program comprising: A process of determining whether or not a soiled use has been performed in which the human-collaborative robot is used in an environment with a soiling degree higher than the predetermined soiling degree; When it is determined that the soiled use has been performed, a process of displaying an image showing a confirmation procedure for confirming whether or not the operation speed monitoring function is normal on a display unit that displays images; A process of displaying, on the display unit, an image indicating whether or not the operation speed monitoring function is normal based on a result of the execution of the confirmation procedure; to be executed by the computer.
[0022] According to the above configuration, in the confirmation program for causing a computer to execute the process, it is possible to achieve the same advantageous effects as the first means. [Brief description of the drawings]
[0023] [Figure 1] Schematic diagram of a master-slave robot system. [Diagram 2] FIG. 2 is a block diagram showing the configuration of an operating device. [Diagram 3] Image showing how to enable the master / slave robot movement function. [Figure 4] An image showing that the master-slave robot movement function has been enabled. [Diagram 5] 1 is a flowchart showing a procedure for checking the SLS function. [Figure 6] Image showing how to disable the master / slave robot movement function. [Figure 7] An image instructing you to check the emergency stop function. [Figure 8] Image showing steps to check emergency stop function. [Figure 9]Image showing an error with the emergency stop function. [Figure 10] An image showing that the emergency stop function has been confirmed to be working properly. [Figure 11] An image instructing you to check the SLS function. [Figure 12] Image showing steps to set SLS value. [Figure 13] An image showing how to operate each axis using the manual operation keys. [Figure 14] Image showing an error in the SLS function. [Figure 15] An image confirming that the SLS function is normal. [Figure 16] Image showing steps to reset SLS values. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0024] Hereinafter, an embodiment of a verification device for monitoring the operation speed, which is applied to a master-slave robot system including a master robot and a slave robot, will be described with reference to the drawings.
[0025] As shown in FIG. 1, the master-slave robot system 10 includes a master robot 20 and a slave robot 30. The IEC (International Electrotechnical Commission) standard IEC60664-1 specifies the degree of pollution of the environment in which the devices are used. Pollution degree 1 is a state in clean air, such as a clean room. Pollution degree 2 is an environment in which electrical devices, home appliances, and office machines are used inside a control panel. Pollution degree 3 is an environment such as an environment inside a general factory. Pollution degree 4 is an environment such as outdoors. The master robot 20 is a human-collaborative robot that is assumed to work with humans and to be used in an environment of pollution degree 2 (a predetermined pollution degree). The slave robot 30 is an industrial robot that is assumed to be used in an environment of pollution degree 3 (a pollution degree higher than the predetermined pollution degree). In other words, the pollution degree of the environment in which the master robot 20 is used is lower than the pollution degree of the environment in which the slave robot 30 is used. If the master robot 20 is used in an environment with a degree of pollution higher than pollution degree 2, there is a risk that a circuit board inside the master robot 20 may short-circuit due to dust or the like, causing the master robot 20 to malfunction.
[0026] The master robot 20 (main robot) is, for example, a six-axis vertical articulated robot, and includes a base 21 and an arm 22. Adjacent links of the arm 22 are connected via rotation axes (joints) so as to be capable of relative rotation. Each axis (each joint) is driven by a corresponding motor via a reducer or the like.
[0027] Specifically, the master robot 20 has a shoulder 22a connected to a base 21 (link) so as to be rotatable in the horizontal direction via a first axis (J1) which is a rotation axis perpendicular to the installation surface. A lower end of a lower arm 22b extending upward is connected to the shoulder 22a (link) so as to be rotatable in the vertical direction via a second axis (J2) which is a rotation axis parallel to the installation surface. A first upper arm 22c is connected to a tip end of the lower arm 22b (link) so as to be rotatable in the vertical direction via a third axis (J3) which is a rotation axis parallel to the installation surface.
[0028] The second upper arm 22d is connected to the tip of the first upper arm 22c (link) so as to be torsionally rotatable via a fourth axis (J4) which is a rotation axis perpendicular to the third axis. The wrist 22e is connected to the tip of the second upper arm 22d (link) so as to be torsionally rotatable via a fifth axis (J5) which is a rotation axis parallel to the installation surface. The flange 22f is connected to the wrist 22e (link) so as to be torsionally rotatable via a sixth axis (J6) which is a rotation axis perpendicular to the fifth axis.
[0029] A hand 23 is attached to the tip of the arm 22, more specifically to a flange 22f (link). The hand 23 has, for example, a pair of claws, and performs an opening and closing operation by expanding and contracting the distance between the pair of claws.
[0030] Inside the base 21, there are provided a memory unit 25 that stores various parameters such as an upper speed limit value described below, and a control unit 26 that controls the operations of the master robot 20 and the hand 23. The control unit 26 is configured as a computer equipped with a CPU, ROM, RAM, a driving circuit, an input / output interface, etc.
[0031] An encoder (not shown) that detects the rotation angle (rotation position) of each axis J1 to J6 (each motor) of the master robot 20 is provided on each axis J1 to J6 (each joint). That is, the encoder detects the position and direction of the control point of the arm 22 (hereinafter referred to as the "posture of the arm 22"). The control point can be selected from the center of the tip (flange 22f) of the arm 22 and the middle of the pair of claws (TCP: Tool Center Position).
[0032] Each axis J1 to J6 of the master robot 20 is provided with a brake (not shown). The brake applies pressure to each axis J1 to J6 to restrict the rotation angle of each axis J1 to J6 from being changed. The master robot 20 is also provided with an emergency stop button (not shown). When the emergency stop button is pressed, the master robot 20 outputs an emergency stop signal to the controller 40 indicating that the emergency stop button has been pressed.
[0033] The master robot 20 has an operation speed monitoring function that generates an error and stops the master robot 20 when the operation speed of the master robot 20 exceeds an upper speed limit. The operation speed monitoring function is a function that generates an error and stops the master robot 20 when the rotation speed (operation speed) of each of the axes J1 to J6 (multiple axes) exceeds the upper speed limit set for each axis. The rotation speed of each of the axes J1 to J6 can be calculated based on the detection value of an encoder that detects the rotation angle of each of the axes J1 to J6. For example, a situation may occur in which the operation speed of the master robot 20 exceeds the upper speed limit due to a failure of each motor provided on each axis or a short circuit in the circuit driving each motor.
[0034] The motion speed monitoring function includes a first motion speed monitoring function that generates a first error to stop the master robot 20 when the motion speed of the master robot 20 exceeds a first speed upper limit, and a second motion speed monitoring function that is less reliable than the first motion speed monitoring function and generates a second error to stop the master robot 20 when the motion speed of the master robot 20 exceeds a second speed upper limit. The master robot 20 includes a safety-related part that is an electrical control system related to safety, and a non-safety-related part that is the other part. The safety-related part accepts motion commands from the non-safety-related part and operates the master robot 20 only while it recognizes a safety signal indicating safety. The first motion speed monitoring function is executed by the safety-related part, and the second motion speed monitoring function is executed by the non-safety-related part. For this reason, the reliability of the second motion speed monitoring function is lower than the reliability of the first motion speed monitoring function.
[0035] The initial value of the first speed upper limit value is set higher than the initial value of the second speed upper limit value. Specifically, the initial value of the first speed upper limit value of each of the axes J1 to J6 is set higher than the initial value of the second speed upper limit value of each of the axes J1 to J6. The second speed upper limit value is automatically set lower than the first speed upper limit value. Therefore, when the first speed upper limit value is lowered, the second speed upper limit value is automatically set to be lower than the lowered first speed upper limit value. The motion speed of the master robot 20 is usually controlled to be lower than the second speed upper limit value.
[0036] The first error and the second error are errors with different numbers. The first error is a unique number indicating that the error was output by the first operation speed monitoring function. The second error is a unique number indicating that the error was output by the second operation speed monitoring function.
[0037] The control unit 26 controls the posture of the arm 22 according to the external force acting on the arm 22. More specifically, the control unit 26 performs flexible control by generating torques that compensate only for gravity and frictional force acting on the arm 22 using motors corresponding to each axis, and moves the arm 22 according to the external force. Then, the control unit 26 holds the posture of the arm 22 when the external force acting on the arm 22 is no longer present. That is, the master robot 20 can change and hold the posture of the arm 22 according to an external force applied by the user. In this embodiment, the user can directly grasp and move the arm 22 by direct teach, and can hold the posture of the arm 22 (direct teach mode). The control unit 26 transmits the detection results of the encoders of the axes J1 to J6 of the master robot 20 to the control unit 36 of the slave robot 30.
[0038] A slave robot 30 is connected to the master robot 20 by a cable 29. The slave robot 30 (subordinate robot) is, for example, a robot of the same type as the master robot 20 (for example, a six-axis vertical articulated type) but larger than the master robot 20. The slave robot 30 is installed inside a safety fence G. The slave robot 30 has the same configuration as the master robot 20, except that it is larger than the master robot 20 and has a slightly different shape from the master robot 20. The slave robot 30 has a base 31 and an arm 32. A hand (not shown) is attached to the tip of the arm 32. Each axis (corresponding axis) of the slave robot 30 corresponds to each axis J1 to J6 of the master robot 20.
[0039] A control unit 36 that controls the operations of the slave robot 30 and the hand is provided inside the base 31. The control unit 36 is configured as a computer equipped with a CPU, ROM, RAM, a drive circuit, an input / output interface, etc. The control units 26 and 36 are capable of communicating with each other via a cable 29, and transmit and receive information to and from each other.
[0040] An encoder (not shown) that detects the rotation angle of each axis (each joint) of the slave robot 30 is provided. That is, the encoder detects the position and direction of the control point of the arm 32 (hereinafter, referred to as the "posture of the arm 32"). The control point can be selected from the center of the tip of the arm 32 and, for example, the middle of a pair of claws (TCP: Tool Center Position).
[0041] A brake (not shown) is provided on each axis of the slave robot 30. The brake applies pressure to each axis to regulate the angle of each axis from being changed.
[0042] The control unit 36 controls the motors corresponding to each axis of the slave robot 30 so that the angle of each axis (each joint) of the slave robot 30 matches the angle of the corresponding axis (each joint) of the master robot 20. That is, the control unit 36 controls the posture of the slave robot 30 to match that of the master robot 20 by a user performing an operation to change the posture of the master robot 20 by applying an external force to the master robot 20. This enables the master robot 20 to execute a master-slave robot operation function (master-slave robot operation mode) in which the posture of the slave robot 30 is changed by an external force applied by the user and the posture of the slave robot 30 is controlled to match that of the master robot 20.
[0043] In detail, the control unit 36 feedback controls the motors corresponding to each axis of the slave robot 30 based on the detection results of the encoders of each axis of the master robot 20 and the encoders of each axis of the slave robot 30. That is, each axis of the slave robot 30 performs a movement that imitates the movement of each axis of the master robot 20. The control unit 36 transmits the detection results of the encoders of each axis of the slave robot 30 to the control unit 26 of the master robot 20. The control unit 26 of the master robot 20 and the control unit 36 of the slave robot 30 constitute a control unit.
[0044] By executing the master-slave robot operation mode, the angles θ1 to θ6 of each axis of the master robot 20 are made to coincide with the angles θ1 to θ6 of each axis of the slave robot 30.
[0045] The operator 40 is connected to the master robot 20. The operator 40 (a confirmation device for monitoring the operating speed of a collaborative robot) is a teaching pendant, a tablet terminal, a smartphone, a notebook PC, a PC, or the like. For example, the operator 40 includes a display unit 41 configured with a touch panel that receives touch operations by a user and displays information. A control program for controlling the master-slave robot system 10 is installed in the operator 40, and the operator 40 enables the user to control the master-slave robot system 10 by executing the control program. For example, the operator 40 operates the master robot 20 via the control unit 26 by manual operation by the user (manual operation mode). Alternatively, the operator 40 automatically operates the master robot 20 via the control unit 26 by executing a taught operating program.
[0046] The controller 40 is equipped with an enable button 42 and a forward button 43 (two operated parts) displayed on a display unit 41. The controller 40 permits the master robot 20 to be manually operated only while the enable button 42 and the forward button 43 are pressed (operated) by the user, and stops the master robot 20 when at least one of the enable button 42 and the forward button 43 is no longer pressed. Note that at least one of the enable button 42 and the forward button 43 may be a physical switch provided on the controller 40. For example, instead of the enable button 42, an enable switch (not shown) may be provided on the back of the controller 40.
[0047] Furthermore, the operating device 40 executes a control program to enable a user to set and check the master-slave robot system 10. The control program (a program for checking the operation speed monitoring function of the human-collaborative robot) includes a function for setting whether the master-slave robot operation function is enabled or disabled, a function for setting an SLS value (Safely-Limited Speed, first upper speed limit value), a function for checking the emergency stop function, and a function for checking the SLS function (first operation speed monitoring function).
[0048] As shown in FIG. 2, the controller 40 includes a determination unit 45, a procedure notification unit 46, and a result notification unit 47. The controller 40 executes a control program to realize the functions of the determination unit 45, the procedure notification unit 46, and the result notification unit 47. The determination unit 45 determines whether or not a soiled use has been performed in which the master robot 20 is used in an environment with a soiling degree higher than a predetermined soiling degree. When the determination unit 45 determines that a soiled use has been performed, the procedure notification unit causes the display unit 41 to display an image indicating a check procedure for checking whether or not the SLS function (operation speed monitoring function) is normal. The result notification unit 47 causes the display unit 41 to display an image indicating whether or not the SLS function is normal, based on the result of the check procedure being executed.
[0049] As shown in Fig. 3, when the user performs an operation to enable the master-slave robot operation function on the image for enabling the function, the controller 40 enables the master-slave robot operation function. Then, as shown in Fig. 4, the controller 40 causes the display unit 41 to display an image indicating that the master-slave robot operation function has been enabled.
[0050] 5 is a flowchart showing the procedure for checking the SLS function. This series of processes is executed by the operation device 40, except for the processes of S12 and SS21. This series of processes is started in a state in which the master / slave robot operation mode is being executed, that is, in a state in which the master / slave robot operation function is enabled.
[0051] First, it is determined whether or not an operation to disable the master-slave robot operation function has been performed (S10). Specifically, as shown in FIG. 6, it is determined whether or not a user has performed an operation to disable the master-slave robot operation function in an image for disabling the master-slave robot operation function. That is, it is determined whether or not a dirty use has been performed in which the master robot 20 is used in an environment of a dirt level 3, which is higher than a dirt level 2 (predetermined dirt level), due to the execution of the master-slave robot operation mode. Then, when the execution of the master-slave robot operation function is completed, it is determined that a dirty use has been performed. Then, when the user touches the "OK" button in the image in FIG. 6, it is determined that a disabling operation has been performed. In this determination, when it is determined that there has been no operation to disable the master-slave robot operation function (S10: NO), the determination of S10 is repeated.
[0052] On the other hand, when it is determined in the judgment of S10 that an operation to disable the master / slave robot operation function has been performed (S10: YES), an image prompting the user to confirm the emergency stop function is displayed (S11). Specifically, as shown in Fig. 7, an image instructing the user to confirm the emergency stop function before disabling the master / slave robot operation function is displayed by the display unit 41. When the user touches the "OK" button in the image of Fig. 7, an image showing the procedure for confirming the emergency stop function is displayed by the display unit 41, as shown in Fig. 8.
[0053] Next, the user performs an operation to confirm the emergency stop function (S12). Specifically, the user presses the emergency stop button of the master robot 20, and then touches the "OK" button in the image of FIG.
[0054] Next, it is determined whether the emergency stop function is normal (S13). Specifically, if an emergency stop signal indicating that the emergency stop button has been pressed is output, it is determined that the emergency stop function is normal, and if the emergency stop signal is not output, it is determined that the emergency stop function is not normal. In this determination, if it is determined that the emergency stop function is not normal (S13: NO), an image indicating an error in the emergency stop function is displayed on the display unit 41 (S14). Specifically, as shown in FIG. 9, it displays an error number "XXXXX" corresponding to the emergency stop function error and a failure to check the emergency stop function. In this case, it is possible to execute the process from S11 again, and if it is determined again that the emergency stop function is not normal (S13: NO), it is determined that there is an error in the emergency stop function. Then, this series of processes is ended (END). In addition, in this case, the operating device 40 stores data indicating the occurrence of the error and the error content as an error log (error history).
[0055] On the other hand, if it is determined in the judgment of S13 that the emergency stop function is normal (S13: YES), an image indicating that it has been confirmed that the emergency stop function is normal is displayed on the display unit 41 (S15), as shown in FIG. 10.
[0056] Next, the master / slave robot operation function is disabled (S16). Specifically, the master / slave robot operation mode is terminated. This allows the master / slave robot system 10 to execute operation modes other than the master / slave robot operation mode. However, here, execution of operation modes other than the manual operation mode is prohibited, and only the manual operation mode is allowed to be executed. An image for confirming the SLS function is displayed (S17). Specifically, as shown in FIG. 11, the master / slave robot operation function is disabled and an image for instructing confirmation of the SLS function is displayed on the display unit 41 at the same time. Automatic setting of the second speed upper limit value lower than the SLS value is prohibited (S18). This prohibits the second speed upper limit value from being automatically set to be lower than the lowered SLS value even if the SLS value is lowered. In addition, the second speed upper limit value is set to the value at the time of shipment from the factory.
[0057] When the user touches the "OK" button in the image of FIG. 11, an image showing the procedure for setting the SLS value is displayed on the display unit 41 as shown in FIG. 12 (S19). The image of FIG. 12 includes, for example, content instructing the user to set the SLS value to 10% of the factory default value. 10% of the factory default value is the minimum value to which the SLS value can be set. The image of FIG. 12 includes the factory default SLS values ω1 to ω6 [deg / s] of each axis J1 to J6, and the SLS values ω1a to ω6a [deg / s] (minimum settable value) to be set for each axis J1 to J6.
[0058] Next, an image for operating in the manual operation mode is displayed (S20). Specifically, as shown in Fig. 13, an image for instructing to operate each axis one by one with a manual operation key (not shown) is displayed on the display unit 41. Note that the speed at which each axis J1 to J6 is operated may be automatically set by the operation device 40 to a speed exceeding the SLS value set to the lowest settable value, or may be set by the user.
[0059] Next, the user operates a single axis in the manual operation mode (S21). Specifically, the user operates one of the axes J1 to J6 by operating the manual operation key. At this time, the controller 40 allows the user to manually operate the master robot 20 only while the enable button 42 and the forward button 43 are pressed, and stops the master robot 20 when at least one of the enable button 42 and the forward button 43 is no longer pressed.
[0060] Next, it is determined whether an SLS value exceeding error has occurred (S22). Specifically, it is determined whether the first error has been generated by the SLS function (first motion speed monitoring function) of the master robot 20, causing the master robot 20 to stop. This determination is performed until each axis J1 to J6 rotates by a determination motion angle (predetermined angle) set for each axis J1 to J6. The determination motion angle is set, for example, to three times (approximately three times) the actual rotation angle of each axis J1 to J6 when the first error occurred. Note that the user knows this determination motion angle from a description in the manual, etc., and rotates each axis J1 to J6 to the determination motion angle if the determination is not completed. In this determination, if it is determined that an SLS value exceeding error has not occurred (S22: NO), an image indicating an error in the SLS function is displayed on the display unit 41 (S23). For example, when the n-axis is manually operated by the user, as shown in Fig. 14, a message is displayed indicating that confirmation of the SLS function of the n-axis has failed, and an error number "YYYYn" corresponding to the error in the SLS function of the n-axis is displayed. Then, this series of processes is terminated (END). In this case, the controller 40 also stores data indicating the occurrence of the error and the content of the error as an error log (error history).
[0061] On the other hand, if it is determined in the judgment of S22 that an SLS value exceeding error has occurred (S22: YES), an image indicating that the SLS function of the n-axis has been confirmed to be normal is displayed on the display unit 41 (S24), as shown in FIG. 15.
[0062] Next, it is determined whether or not the confirmation of the SLS function of all axes has been completed (S25). Specifically, if there is no axis without an SLS value exceeding error (the process of S23 is not executed) and an SLS value exceeding error has occurred in all axes, it is determined that the confirmation of the SLS function of all axes has been completed. In this determination, if it is determined that the confirmation of the SLS function of all axes has not been completed (S25: NO), the process is executed again from S21. In the process of S21, the user operates the manual operation key to operate one axis that has not yet been operated among the axes J1 to J6. That is, the operation device 40 drives the axes J1 to J6 (multiple axes) of the master robot 20 one by one, and causes the display unit 41 to display an image indicating the confirmation procedure so that the user can confirm whether the SLS function (operation speed monitoring function) is normal or not.
[0063] On the other hand, when it is determined in the judgment of S25 that the confirmation of the SLS function of all axes has been completed (S25: YES), an image showing the procedure for resetting the SLS value is displayed on the display unit 41 (S26), as shown in FIG. 16. The image in FIG. 16 includes the content instructing to reset the SLS value. The image in FIG. 16 includes the SLS values ω1 to ω6 [deg / s] of the respective axes J1 to J6 at the time of shipment from the factory. When the user resets the SLS value, the operation device 40 releases the prohibition on automatically setting the second speed upper limit value lower than the SLS value. In addition, the prohibition on execution of operation modes other than the manual operation mode is released. After that, this series of processes is terminated (END). In addition, the operation device 40 stores data indicating that the emergency stop function and the SLS function have been confirmed to be normal as an operation log (operation history).
[0064] The process of S10 corresponds to the process performed by the determination unit 45, the processes of S17, S19, and S20 correspond to the process performed by the procedure notification unit 46, and the processes of S22 to S24 correspond to the process performed by the result notification unit 47.
[0065] The present embodiment described above in detail has the following advantages.
[0066] The display unit 41 displays an image. The determination unit 45 determines whether or not a dirty use has been performed in which the master robot 20 is used in an environment with a dirt degree 3, which is higher than the dirt degree 2 (predetermined dirt degree). When the determination unit 45 determines that a dirty use has been performed, the procedure notification unit 46 causes the display unit 41 to display an image (FIGS. 11 to 13) showing a check procedure for checking whether or not the SLS function (operation speed monitoring function) is normal. Therefore, the user can perform the check procedure according to the image showing the check procedure displayed by the display unit 41. The result notification unit 47 causes the display unit 41 to display an image (FIGS. 14 and 15) showing whether or not the SLS function is normal based on the result of the check procedure. Therefore, the user can check whether or not the SLS function is normal from the image displayed by the display unit 41 showing whether or not the SLS function is normal. Therefore, when the collaborative robot is used in an environment with a dirt degree higher than the assumed environment, it is possible to check whether or not the SLS function is normal.
[0067] The determination unit 45 determines that a soiled use has been performed when the master-slave robot operation function has been changed from enabled to disabled (execution of the master-slave robot operation function has ended). Therefore, even if the user does not input the environment in which the master robot 20 was used, when the master-slave robot operation function is executed and the master robot 20 is used in an environment of soiling degree 3, which is higher than soiling degree 2, it is possible to confirm whether the SLS function is normal or not.
[0068] The procedure notification unit 46 prohibits the second speed upper limit from being automatically set lower than the SLS value (first speed upper limit) when the display unit 41 displays an image showing a confirmation procedure for confirming whether the SLS function (first operation speed monitoring function) is normal. This makes it possible to set the SLS value lower than the second speed upper limit, and by executing a confirmation procedure for confirming whether the SLS function is normal, it is possible to confirm whether the SLS function is normal. Note that, according to the above configuration, it is possible to avoid a situation where the second operation speed monitoring function is activated at the time when the operation speed of the master robot 20 exceeds the second speed upper limit, stopping the master robot 20 and making it impossible to confirm whether the SLS function is normal.
[0069] If multiple axes are driven simultaneously to check whether the SLS function (operation speed monitoring function) is normal, the master robot 20 will continue to operate unless the operation speed of an axis with a normal SLS function exceeds the SLS value (upper speed limit), which may increase the chances of the master robot 20 not stopping when the SLS function fails. In this regard, the procedure notification unit 46 causes the display unit 41 to display an image ( FIG. 13 ) showing the checking procedure so that the multiple axes of the master robot 20 are driven one by one to check whether the SLS function is normal. Therefore, the master robot 20 will not stop only when the SLS function of one driven axis has failed, which can prevent an increase in the chances of the master robot 20 not stopping.
[0070] The procedure notification unit 46 causes the display unit 41 to display an image (FIG. 12) indicating the checking procedure so as to set the SLS value to 10% of the factory default (the lowest settable value). With this configuration, the operating speed of the master robot 20 can be made to exceed the SLS value even when it is low, so that it is possible to check in a safe state whether the SLS function is normal or not.
[0071] The controller 40 is equipped with an enable button 42 and a forward button 43 (two operated units) that the user must operate simultaneously to operate the master robot 20. The procedure notification unit 46 stops the master robot 20 if at least one of the enable button 42 and the forward button 43 is not operated when an image showing the confirmation procedure (FIGS. 11 to 13) is displayed on the display unit 41. With this configuration, even if the SLS function fails and the master robot 20 does not stop during the execution of the confirmation procedure, the user can immediately stop the master robot 20 by releasing at least one of the enable button 42 and the forward button 43.
[0072] The above embodiment can be modified as follows: The same parts as those in the above embodiment are denoted by the same reference numerals and the description thereof will be omitted.
[0073] The enable button 42 may be omitted, and the user may operate the master robot 20 simply by operating the forward button 43.
[0074] Instead of the processes of S20 and S21 in FIG. 5, the controller 40 may automatically set the speed at which each of the axes J1 to J6 is operated to a speed that exceeds the SLS value, which is set to the lowest settable value, and automatically operate each axis one at a time.
[0075] The procedure notification unit 46 may cause the display unit 41 to display an image indicating the confirmation procedure so as to set the SLS value to a value other than the minimum settable value, such as 20% of the factory default value. Then, the controller 40 may automatically set the motion speed of the master robot 20 to a motion speed exceeding the SLS value, or allow the user to set it.
[0076] In the operation device 40, the function of automatically setting the second upper speed limit value lower than the first upper speed limit value may be omitted.
[0077] The determination unit 45 can determine whether the above-mentioned soiled use has been performed by any method, such as having the user input the environment in which the master robot 20 was used and determining based on the input result, or having the user input the degree of soiling of the environment in which the master robot 20 was used and determining based on the input result. In other words, the soiled use is not limited to the master-slave robot operation mode, but may be other uses in which the master robot 20 was used in an environment with a degree of soiling higher than a predetermined degree of soiling. Then, when the determination unit 45 determines that the soiled use has been performed, the controller 40 may execute the process from S11 onwards in Fig. 5.
[0078] The predetermined pollution level assumed as the pollution level of the environment in which the master robot 20 is used is not limited to pollution level 2, but may be, for example, pollution level 1. In addition, the predetermined pollution level is not limited to the pollution level defined by the IEC standard, but may be a pollution level defined by another standard, or may be a pollution level defined independently by the user.
[0079] The operator 40 can also check whether a second motion speed monitoring function (motion speed monitoring function), which generates a second error to stop the master robot 20 when the motion speed of the master robot 20 exceeds a second speed upper limit, is normal. In this case, the operator 40 can execute the same process in the flowchart of FIG. 5 by replacing the SLS function with the second motion speed monitoring function and by replacing the SLS value (first speed upper limit) with the second speed upper limit. Note that the process of S18 can be omitted. The master robot 20 may be equipped with only one of the SLS function (first motion speed monitoring function) and the second motion speed monitoring function, and the operator 40 may be a confirmation device that checks whether the motion speed monitoring function is normal.
[0080] The functions of the control unit 26 and the control unit 36 can also be realized by a single control unit provided in the master robot 20 or the slave robot 30 to control the master robot 20 and the slave robot 30.
[0081] The master robot 20 and the slave robot 30 may be robots that have the same shape but differ in size. Also, the master robot 20 and the slave robot 30 may be robots that have the same shape and size.
[0082] The confirmation program for the function of monitoring the operating speed of the master robot 20 (human-collaborative robot) may be stored in a computer-readable non-transitory tangible recording medium (recording medium) as instructions executed by a computer.
[0083] The above-described embodiments and their modifications can be combined to the extent possible. [Explanation of symbols]
[0084] 10...master-slave robot system, 20...master robot (master robot), 30...slave robot (slave robot), 40...operator (device for checking operation speed monitoring function), 41...display unit, 45...judgment unit, 46...procedure notification unit, 47...result notification unit.
Claims
1. A confirmation device is applied to a human collaborative robot having a motion speed monitoring function that generates an error and stops the human collaborative robot when the motion speed of the human collaborative robot, which is assumed to work with humans and be used in an environment with a predetermined degree of dirtiness, and confirms whether the motion speed monitoring function is normal, A display unit for displaying an image; a determination unit that determines whether or not a soiled use has been performed in which the human-collaborative robot is used in an environment with a soiling degree higher than the predetermined soiling degree; a procedure notifying unit that causes the display unit to display an image showing a confirmation procedure for confirming whether the operation speed monitoring function is normal or not when the determination unit determines that the soiled use has been performed; and a result notification unit that causes the display unit to display an image indicating whether the operation speed monitoring function is normal or not based on a result of the execution of the confirmation procedure; A confirmation device for monitoring the operating speed of a collaborative robot.
2. The collaborative robot is capable of executing a master-slave robot operation function in which a posture of the industrial robot is changed by an external force applied by a user so as to match the posture of the collaborative robot, The predetermined degree of contamination is lower than the degree of contamination of an environment in which the industrial robot is used, The device for checking a motion speed monitoring function of a collaborative robot according to claim 1 , wherein the determination unit determines that the soiling use has been performed when the execution of the master-slave robot motion function has ended.
3. the speed upper limit value includes a first speed upper limit value and a second speed upper limit value that is automatically set lower than the first speed upper limit value, the motion speed monitoring function includes a first motion speed monitoring function that generates a first error to stop the human-cooperative robot when the motion speed of the human-cooperative robot exceeds the first speed upper limit, and a second motion speed monitoring function that is less reliable than the first motion speed monitoring function and that generates a second error to stop the human-cooperative robot when the motion speed of the human-cooperative robot exceeds the second speed upper limit, 3. The device for checking a motion speed monitoring function of a human-collaborative robot according to claim 1 or 2, wherein the procedure notifying unit prohibits the second upper speed limit value from being automatically set lower than the first upper speed limit value when causing the display unit to display an image showing a checking procedure for checking whether or not the first motion speed monitoring function is normal.
4. The collaborative robot includes a plurality of links connected to be capable of relative rotation, and a plurality of shafts that rotate adjacent links relative to each other, the motion speed monitoring function is a function of generating an error and stopping the collaborative robot when any of the motion speeds of the multiple axes exceeds a speed upper limit value set for each axis, 3. The device for checking a motion speed monitoring function of a human-collaborative robot according to claim 1 or 2, wherein the procedure notification unit causes the display unit to display the image indicating the checking procedure so as to check whether the motion speed monitoring function is normal by driving the multiple axes of the human-collaborative robot one by one.
5. 3. The device for checking a motion speed monitoring function of a collaborative robot according to claim 1, wherein the procedure notification unit causes the display unit to display the image indicating the checking procedure so as to set the upper speed limit value to a settable minimum value.
6. two operated units that a user needs to operate simultaneously in order to operate the collaborative robot; 3. The device for verifying a motion speed monitoring function of a human-collaborative robot according to claim 1 or 2, wherein the procedure notification unit stops the human-collaborative robot if at least one of the two operated units is not operated when an image showing the verification procedure is displayed on the display unit.
7. A verification program for verifying whether or not a motion speed monitoring function is normal, the verification program being applied to a human collaborative robot having a motion speed monitoring function that generates an error and stops the human collaborative robot when the motion speed of the human collaborative robot, which is assumed to work in collaboration with a human and be used in an environment with a predetermined degree of dirtiness, exceeds an upper speed limit, the verification program comprising: A process of determining whether or not a soiled use has been performed in which the human-collaborative robot is used in an environment with a soiling degree higher than the predetermined soiling degree; When it is determined that the soiled use has been performed, a process of displaying an image showing a confirmation procedure for confirming whether or not the operation speed monitoring function is normal on a display unit that displays images; A process of displaying, on the display unit, an image indicating whether or not the operation speed monitoring function is normal based on a result of the execution of the confirmation procedure; A verification program for the collaborative robot's operating speed monitoring function that causes a computer to execute the above.
Citation Information
Patent Citations
Measuring instrument for meandering metalic strip
JP1988081203A
