WO2014064926A1 - ロボットの異常表示方法 - Google Patents

ロボットの異常表示方法 Download PDF

Info

Publication number
WO2014064926A1
WO2014064926A1 PCT/JP2013/006250 JP2013006250W WO2014064926A1 WO 2014064926 A1 WO2014064926 A1 WO 2014064926A1 JP 2013006250 W JP2013006250 W JP 2013006250W WO 2014064926 A1 WO2014064926 A1 WO 2014064926A1
Authority
WO
WIPO (PCT)
Prior art keywords
abnormality
detection
robot
collision
display
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
PCT/JP2013/006250
Other languages
English (en)
French (fr)
Inventor
広之 中田
敦実 橋本
将 古和
保義 本内
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Panasonic Corp
Original Assignee
Panasonic Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Panasonic Corp filed Critical Panasonic Corp
Priority to JP2014543148A priority Critical patent/JP5927440B2/ja
Priority to EP13849941.3A priority patent/EP2913163B1/en
Priority to CN201380047719.4A priority patent/CN104718055B/zh
Publication of WO2014064926A1 publication Critical patent/WO2014064926A1/ja
Priority to US14/583,297 priority patent/US9701022B2/en
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Program-controlled manipulators
    • B25J9/16—Program controls
    • B25J9/1674—Program controls characterised by safety, monitoring, diagnostic
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06—Safety devices
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Program-controlled manipulators
    • B25J9/16—Program controls
    • B25J9/1674—Program controls characterised by safety, monitoring, diagnostic
    • B25J9/1676—Avoiding collision or forbidden zones
    • G—PHYSICS
    • G06—COMPUTING OR CALCULATING; COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10—Complex mathematical operations
    • G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/37—Measurements
    • G05B2219/37622—Detect collision, blocking, stall by change, lag in position
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/37—Measurements
    • G05B2219/37624—Detect collision, blocking by measuring change of velocity or torque
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00—Robots
    • Y10S901/49—Protective device

Definitions

  • the present invention relates to an abnormality display method for a robot driven by a motor via a reduction gear.
  • the high accuracy of sensorless collision detection increases the possibility of erroneously detecting a robot abnormal state as a collision even when it is not an actual collision.
  • the collision detection function may detect an abnormality before other abnormality detection functions, and an erroneous display such as “collision occurrence” may occur even though no collision has occurred.
  • the high accuracy of the sensorless collision detection has an advantage of detecting the failure promptly, but also causes the failure cause to be difficult to understand. The reason why erroneous collision detection occurs will be described below with reference to FIGS.
  • FIG. 1 is a schematic configuration diagram showing a vertical articulated 6-axis robot as a typical example of a robot.
  • the vertical articulated 6-axis robot includes a robot mechanism (101), a robot control device (102), and an operation display device (103).
  • FIG. 2 is a flowchart showing the entire process of abnormality display.
  • the entire process of abnormality display is performed in the robot controller (102).
  • a motor lock detection process for detecting an abnormality when a robot failure occurs in addition to the collision detection process, a motor lock detection process for detecting an abnormality when a robot failure occurs, an overload detection process, and a position deviation over detection process are added.
  • the entire process of abnormal display shown in FIG. 2 is repeated every period ⁇ T, and the period ⁇ T assumes several milliseconds.
  • step 2-1 motor lock detection processing is performed.
  • step 2-6 when motor lock is detected, “motor lock detected” is displayed as an abnormality display on the operation display device (103) of FIG. If the motor lock is detected, an abnormal state has already occurred and an abnormality is displayed, so the abnormality display process is terminated in step 2-6. If the motor lock is not detected in step 2-6, the process proceeds to step 2-2.
  • step 2-2 overload detection processing is performed.
  • step 2-7 when an overload is detected, “overload detection” is displayed as an abnormality display on the operation display device (103) of FIG. If an overload is detected, an abnormal state has already occurred and an abnormality is displayed, so the abnormality display process is terminated in step 2-7. If no overload is detected in step 2-7, the process proceeds to step 2-3.
  • step 2-3 position deviation over detection processing is performed.
  • step 2-8 when a position deviation over is detected, “position deviation over detection” is displayed as an abnormality display on the operation display device (103) of FIG. If a position deviation over is detected, an abnormal state has already occurred and an abnormal display has been made, so the abnormal display process is terminated in step 2-8. If no position deviation over is detected in step 2-8, the process proceeds to step 2-4.
  • step 2-4 a collision detection process described below with reference to FIG. 3 is executed.
  • a dynamics calculation method There are two methods for obtaining the collision force without a sensor: a dynamics calculation method and a disturbance estimation observer method.
  • the dynamics calculation method first, the reduction gear output torque is obtained by subtracting the torque lost due to friction and the inertia of the motor and reduction gear from the torque generated by the driving current of the motor.
  • the collision force is obtained by subtracting the robot dynamic torque obtained by the robot dynamics calculation from the reducer output torque.
  • the disturbance estimation observer method obtains a collision force using a disturbance estimation observer. (For example, refer to Patent Document 1).
  • a dynamics calculation method having excellent estimation accuracy will be described as an example.
  • FIG. 3 is a control block diagram of the dynamic calculation method.
  • 6 is a position control block.
  • a position command ⁇ com (3) obtained by integrating the velocity component d ⁇ com (1) of the position command by the integration element 40 and a motor position ⁇ m (4) are input to the position control block (6).
  • the speed loop command ⁇ com (7) is output from the position proportional gain (5).
  • 10 is a speed control block.
  • a speed loop command ⁇ com (7) and a motor position ⁇ m (4) are input to the speed control block (10). Then, a difference value between the speed loop command ⁇ com (7) and the motor speed ⁇ m (2) obtained by differentiating the motor position ⁇ m (4) by the differential element (32) is obtained, and the speed proportional gain (8) and the speed integral gain ( The motor current Im (11) is output via 9).
  • 18 is a block showing a motor and external force. Assuming that the reduction gear is a rigid body, ⁇ m (13) is expressed by equation (1) when viewed from the motor drive side, and expressed by equation (2) when viewed from the load side.
  • K ⁇ K ⁇ ⁇ sgn (3)
  • K ⁇ is the magnitude of dynamic friction
  • the collision torque ⁇ dis (16) can be obtained by transforming into the following equation (4) from the equations (1) and (2).
  • reference numeral 30 represents Expression (4) as a collision torque estimation block.
  • the estimated dynamic torque value ⁇ dyno (29) is obtained by the dynamic calculation by the dynamic torque calculation block (26).
  • the dynamic torque calculation block (26) differentiates the motor position ⁇ m (4) of all axes constituting the robot, the motor speed ⁇ m (2) obtained by differentiating the motor position ⁇ m (4), and the motor speed ⁇ m (2).
  • the dynamic calculation is executed using the motor acceleration ⁇ m (90) and the machine parameters of the robot (arm length, arm mass, center of gravity position, inertia around the center of gravity position).
  • the collision torque estimation block (30) outputs the collision torque estimated value ⁇ diso (28) to the collision determination block (31).
  • the collision determination block (31) detects a collision according to the following equation (5) using a predetermined collision detection threshold ⁇ th.
  • Step 2-5 if Expression (5) is established, “collision detection” is displayed as an abnormality display on the operation display device (103) of the robot of FIG. 1, and the abnormality display processing is terminated. In step 2-5, if the equation (5) is not established, the abnormality display process is terminated without displaying the abnormality. Then, the entire abnormal display process is started for each period ⁇ T.
  • the collision torque estimated value ⁇ diso (28) can be obtained with high accuracy.
  • Lagrange method and a Newton Euler method as a method for obtaining the dynamic torque in the dynamic torque calculation block (26).
  • Lagrangian method a 6-axis vertical articulated robot requires a product-sum operation of almost 100,000 times. However, this amount of calculation can be calculated within a few milliseconds based on the current processing capability of the CPU.
  • the Newton Euler method the product-sum calculation amount is less than 10,000 times, so the calculation time is not a problem. Since the Newton Euler method is a so-called recurrence method that uses the result of the previous equation in the following equation, there is a possibility that a cumulative error of operation may occur. However, if processing is performed with data of 32 bits or more, there is no problem in the accumulated error of calculation.
  • the current CPU can calculate the dynamic torque ⁇ dyn (14) with an error within 10% of the maximum motor torque ratio. If the terms other than the dynamic torque ⁇ dyn (14) on the right side of the equation (4) can also be calculated with an error within 10% of the motor maximum torque ratio, the collision torque estimated value ⁇ diso (28) % Error can be obtained.
  • the collision detection function can detect a collision if an abnormality with a motor maximum torque ratio of about 20% is observed for several milliseconds.
  • the collision detection threshold value ⁇ th is set low (about 20% of the maximum motor torque ratio)
  • a failure other than a collision will be detected quickly.
  • the motor-generated torque ⁇ m is increased by an amount corresponding to the increase in the dynamic friction torque ⁇ .
  • the motor current Im on the right side of the equation (4) increases.
  • the dynamic friction torque ⁇ used on the right side of the equation (4) is calculated using a value measured in advance in the normal state, the collision torque ⁇ dis on the left side of the equation (4) increases despite no collision. To do. If the magnitude of the collision torque ⁇ dis exceeds the maximum motor torque ratio of 20% even for a few milliseconds, it will be erroneously detected as a collision detection.
  • the cause of the increase in the motor torque Im on the right side of the equation (4) and the increase in the collision torque ⁇ dis cannot be specified. That is, it cannot be distinguished whether it is caused by an actual collision of a robot or an increase in friction torque due to a failure of a motor or a speed reducer. Therefore, if the collision detection threshold ⁇ th is set low (collision detection sensitivity is increased) in order to reduce the damage at the time of the robot collision, the probability of occurrence of erroneous collision detection is also increased.
  • the motor lock detection function detects the situation in which the motor has been operating but it has hardly moved. Even if the motor generated torque ⁇ m (shown by the equation (1)) exceeds the predetermined motor torque threshold ⁇ mth (91), if the friction torque increased due to the failure is large, the motor speed ⁇ m (2) becomes the predetermined motor speed. Does not rise above the threshold ⁇ mth. When this state continues for a predetermined motor lock detection time threshold LKth or more, the motor lock detection function is determined to be abnormal.
  • FIG. 5A is a graph showing the motor speed ⁇ m (2) and the motor generated torque ⁇ m (13) in a normal state. After a time LK0 (95) smaller than the motor lock detection time threshold LKth (93) has elapsed after the motor generated torque ⁇ m (13) exceeds the motor torque threshold ⁇ mth (91), the motor speed ⁇ m (2) is The speed threshold value ⁇ mth (92) is exceeded. In this case, the motor lock is not detected.
  • FIG. 5B is a graph showing a motor speed ⁇ m (2) and a motor generated torque ⁇ m (13) at the time of abnormality that a motor lock is detected due to an increase in friction torque due to a failure of a motor or a speed reducer.
  • the motor is compared with the normal state (indicated by the dotted line) due to the increase in friction torque due to the failure of the motor or the speed reducer.
  • the increase in speed ⁇ m (2) is slow. Therefore, even if the motor speed ⁇ m (2) reaches the motor lock detection time threshold LKth (93), it does not reach the motor speed threshold ⁇ mth (92). In this case, motor lock is detected.
  • FIG. 4 is a flowchart of the motor lock detection.
  • the motor lock detection process is executed every fixed period ⁇ T.
  • Step 4-1 it is determined whether or not the motor generated torque ⁇ m is equal to or greater than the motor torque threshold ⁇ mth (91). If the motor generated torque ⁇ m is equal to or greater than the motor torque threshold ⁇ mth (91), it is determined as “Y”, and the process proceeds to Step 4-2.
  • step 4-2 it is determined whether or not the motor speed ⁇ m (2) is equal to or less than the motor speed threshold ⁇ mth (92). If the motor speed ⁇ m (2) is equal to or less than the motor speed threshold ⁇ mth (92), it is determined as “Y”, and the process proceeds to Step 4-3.
  • step 4-3 the motor lock duration time LKdet is calculated by equation (5), and the process proceeds to step 4-5.
  • LKdet LKdet + ⁇ T (6)
  • ⁇ T is a motor lock detection processing cycle.
  • step 4-3 the length of time in which both step 4-1 and step 4-2 are determined to be “Y” is measured by adding the motor lock detection processing period ⁇ T.
  • step 4-1 or step 4-2 determines whether the determination in step 4-1 or step 4-2 is “N”. If the determination in step 4-1 or step 4-2 is “N”, the process proceeds to step 4-4, the motor lock duration time LKdet is reset to 0, and the motor lock detection process ends.
  • step 4-5 it is determined whether or not the motor lock duration time LKdet is equal to or greater than the motor lock detection time threshold value LKth (93).
  • step 4-7 If the motor lock duration time LKdet is equal to or greater than the motor lock detection time threshold value LKth (93), it is determined “Y”, and the process proceeds to step 4-6. In this case, it is determined that the motor is locked, and the motor is stopped in step 4-6. Subsequently, in step 4-7, an abnormality display of “motor lock detection” is performed, and the motor lock detection process is terminated.
  • the abnormality display is displayed on the operation display device (103) shown in FIG.
  • step 4-5 If the determination in step 4-5 is “N”, it is determined that the motor is not locked, and the motor lock detection process is terminated.
  • the motor lock detection time threshold value LKth (93) needs to be larger than the required time LK0 (95) at the normal time.
  • the motor lock detection time threshold LKth (93) is several hundred milliseconds to several seconds, which is slower than the collision detection function detecting within several milliseconds.
  • the collision detection threshold ⁇ th is set low (collision detection sensitivity is set high)
  • the collision is detected first before the motor lock is detected even though the collision is not actually detected, and the abnormality display is also “ Only “collision detection” is displayed.
  • the motor lock detection at step 2-6 continues to be determined as “N”
  • the collision detection at step 2-5 determines “Y”.
  • the overload detection function detects an overload abnormality so that the accumulated time value of the current that drives the motor does not exceed the limit value of the motor time characteristic curve.
  • the motor generated torque is proportional to the current that drives the motor, and the limit value of the motor time characteristic curve indicates the upper limit of the winding temperature of the motor.
  • FIG. 7 is a graph showing the relationship between the motor current for driving the motor and time.
  • the limit value (dotted line) of the motor time limit curve shown in FIG. 7 is about 100 seconds when the maximum current ratio is 40%, 25 seconds when the maximum current ratio is 50%, and about 8 when the maximum current ratio is 70%. Seconds. Overload detection is performed so that it is below this limit value.
  • FIG. 6 is a flowchart of overload detection.
  • the overload detection process is executed every fixed period ⁇ T.
  • step 6-1 the overload detection value OLdet is obtained by the following equation (8).
  • OLdet OLdet + (
  • Imth is an overload detection current threshold
  • ⁇ T is an overload detection cycle.
  • Step 6-2 it is determined whether or not the overload detection value OLdet is equal to or greater than the overload threshold OLth. That is, it is determined whether the condition of the following formula (9) is satisfied.
  • Step 6-3 the motor is stopped, and subsequently, in step 6-4, "abnormal display” indicating “overload detection” is performed, and the overload detection processing is terminated.
  • the “abnormal display” is displayed on the operation display device (103) shown in FIG.
  • step 6-2 If the determination in step 6-2 is “N”, it is determined that there is no overload condition, and the overload detection process is terminated.
  • the overload detection threshold characteristic (solid line) is set so as to be lower than the limit value (dotted line), which indicates that the calculation method of the overload detection value OLdet represented by the equation (8) is appropriate.
  • overload detection takes several seconds even when the motor current is 100% of the maximum current ratio.
  • the time required for this overload detection is slower than the collision detection function detects within a few milliseconds. That is, when a motor or reduction gear failure occurs from the state where no overload abnormality has occurred, the motor rotation becomes heavier and the motor current (motor generated torque) increases by about 20% in terms of the maximum current ratio. Thus, even if a motor or speed reducer failure occurs, it takes a few seconds or more to detect an overload abnormality, and there is a very high possibility that a false collision detection will occur first. Referring to FIG. 2, while it is determined “N” in the overload detection in step 2-7 and continues, “Y” is determined in the collision detection in step 2-5.
  • the motor torque ⁇ m (90) generated by differentiating the motor position ⁇ m (4) twice is used for the dynamic torque calculation block (26). Therefore, the change in the motor position ⁇ m (4) greatly affects the motor acceleration ⁇ m (90).
  • differentiation in digital control is generally performed by the difference between the current sample value and the previous sample value one cycle before the sample. Therefore, an example is shown.
  • FIG. 9 is a graph showing a motor position waveform when an abnormality occurs in the motor position detector.
  • FIG. 10 is a graph showing a speed waveform when an abnormality occurs in the motor position detector.
  • FIG. 11 is a graph showing an acceleration waveform when an abnormality occurs in the motor position detector.
  • the error e ⁇ m (86) of the motor position ⁇ m (4) at 300 milliseconds when the abnormality occurred is calculated based on the value after 500 milliseconds (12.5 revolutions), it is about 4.7% (about 0.8. 15 rotations).
  • the error e ⁇ m (87) of the motor speed ⁇ m (2) is also about 120% when calculated based on the value after 500 milliseconds (50 revolutions / second).
  • the error e ⁇ m (88) of the motor acceleration ⁇ m (90) is about ⁇ 33333% when calculated on the basis of the value (100 rotations / second 2 ) after 500 milliseconds. Therefore, the accuracy of the dynamic torque ⁇ dyn (14) obtained by the dynamic torque calculation block (26) is greatly affected, and there is a high possibility of causing a collision detection error.
  • the cause of the motor position ⁇ m (4) not changing cannot be specified. That is, it is unclear whether the collision actually occurred and the robot stopped, or because the motor position detector (99) was abnormal and the motor position ⁇ m (4) was not updated. Therefore, if the collision detection function is to work effectively, the occurrence of erroneous collision detection cannot be avoided.
  • a function that detects that there is an abnormality in the motor position detector (99) that detects the motor position ⁇ m (4) includes a position deviation over detection function.
  • FIG. 12 is a flowchart of the position deviation over detection.
  • the position deviation over detection process is executed every fixed period ⁇ T.
  • Step 12-1 the position deviation over detection value ⁇ det is calculated as an absolute value of the difference between the position command ⁇ com (3) and the motor position ⁇ m (4) as shown in the following equation (10).
  • Step 12-2 the position deviation over detection value ⁇ det is compared with the position deviation over detection threshold ⁇ th to determine whether or not the following equation (11) is satisfied.
  • step 12-4 “abnormal position deviation over” abnormality is displayed, and the position deviation over detection process is terminated.
  • the abnormality display is displayed on the operation display device (103) shown in FIG.
  • step 12-2 If the determination in step 12-2 is “N”, it is determined that the position deviation is not over, and the position deviation over detection process is terminated.
  • the position deviation over detection threshold ⁇ th in the equation (11) is set to about several rotations so that a position deviation due to control delay is not erroneously detected.
  • the position deviation due to the control delay is one rotation and the position deviation over detection threshold ⁇ th is set to two rotations.
  • the position deviation over detection value ⁇ det is about 1.15 rotations.
  • the condition of Expression (11) is not satisfied, and the position deviation over is not detected.
  • the collision detection is erroneously detected. In other words, the collision is detected first even though there is no actual collision, and the abnormality display is displayed only as “collision detection”. Referring to FIG. 2, while the position deviation over detection in step 2-8 continues to be determined as “N”, the collision detection in step 2-5 determines “Y”.
  • the single abnormality display process shown in FIG. 20 is executed as the abnormality display process at the time of collision detection in step 2-5 in FIG.
  • step 2-4 the collision detection in step 2-4 is detected first. "Is displayed abnormally only.
  • the present invention solves the above-described problems, and provides a robot abnormality display method capable of displaying information useful for grasping the situation at the time of occurrence of erroneous collision detection.
  • the robot abnormality display method of the present invention is a robot abnormality detection method that detects a plurality of abnormalities including at least a collision detection based on a value detected during operation of the robot, and displays the occurrence of the abnormality.
  • This is an abnormal display method. Furthermore, it has the collision detection process which detects the collision of a robot. Furthermore, it has the collision detection display process which displays that the collision was detected as an abnormal display. Furthermore, an abnormality display step of displaying that an abnormality has occurred as an abnormality display also for at least one of a plurality of abnormality detection items different from the collision detection.
  • the robot abnormality display method of the present invention may be performed by selecting abnormality display of a plurality of abnormality detection items in the abnormality display step.
  • each of the plurality of abnormality detection items includes an abnormality determination threshold for determining an abnormality, and a robot collision smaller than the abnormality determination threshold.
  • a display enable / disable threshold for displaying that an abnormality has occurred is displayed in addition to displaying that a collision has been detected.
  • an abnormality determination value based on a value detected during the operation of the robot may exceed the display availability threshold value and display that an abnormality has occurred as an abnormality display.
  • each of the plurality of abnormality detection items includes an abnormality determination threshold for determining an abnormality, and a robot collision smaller than the abnormality determination threshold. It is preferable that a display availability threshold value for displaying that an abnormality has occurred is displayed together with displaying that a collision has been detected. Furthermore, it is preferable that priorities are set for a plurality of abnormality detection items. Furthermore, it is preferable to determine whether or not the abnormality determination value based on the value detected during the operation of the robot has exceeded the display availability threshold value in descending order of priority. Furthermore, it is preferable to perform abnormality display only for abnormality detection items that exceed the display availability threshold. Further, for an abnormality detection item having a lower priority than an abnormality detection item that has performed an abnormality display, it is not necessary to determine whether or not the abnormality determination value has exceeded the display availability threshold and perform abnormality display.
  • the robot abnormality display method of the present invention may determine a display availability threshold for each abnormality detection item based on a set collision detection threshold.
  • the ratio of the abnormality determination value based on the value detected during the operation of the robot with respect to the abnormality determination threshold for each abnormality detection item may be obtained. Furthermore, it is preferable to perform abnormality display together with collision detection only for abnormality detection items having the highest abnormality determination value ratio.
  • an abnormality determination threshold value for determining an abnormality may be set in each of the plurality of abnormality detection items. Further, for each of a plurality of abnormality detection items, a ratio of abnormality determination values based on values detected during operation of the robot with respect to the abnormality determination threshold value may be obtained. Furthermore, it is good to display the ratio of the abnormality determination value for each abnormality detection item in addition to displaying that the collision has been detected when a robot collision is detected.
  • an abnormality determination threshold value for determining an abnormality may be set in each of the plurality of abnormality detection items. Further, for each of a plurality of abnormality detection items, a ratio of abnormality determination values based on values detected during operation of the robot with respect to the abnormality determination threshold value may be obtained. Further, in addition to displaying that a collision has been detected when a robot collision is detected, it is preferable to display the ratio of the abnormality determination value of each abnormality detection item only when the abnormality determination value exceeds the display availability threshold.
  • the robot abnormality display method includes, as a plurality of abnormality detection items, at least of detection of lock of a motor driving the robot, detection of overload of the motor, and detection of position deviation of the robot. It is good to include one.
  • the robot abnormality display method of the present invention when the collision detection occurs, the situation of other abnormality detection means is also displayed, which helps to grasp the operation state of the robot when the collision erroneous detection occurs. Is.
  • FIG. 1 is a diagram showing a schematic configuration of a vertical articulated 6-axis robot as a representative example to which the present invention is applied.
  • FIG. 2 is a flowchart showing the entire abnormal display process according to the embodiment of the present invention.
  • FIG. 3 is a control block diagram of the dynamic calculation method in the embodiment of the present invention.
  • FIG. 4 is a flowchart showing motor lock detection in the embodiment of the present invention.
  • FIG. 5A is a graph showing temporal changes in motor speed and motor torque at normal times.
  • FIG. 5B is a graph showing temporal changes in motor speed and motor torque when motor lock is detected.
  • FIG. 6 is a flowchart showing overload detection in the embodiment of the present invention.
  • FIG. 1 is a diagram showing a schematic configuration of a vertical articulated 6-axis robot as a representative example to which the present invention is applied.
  • FIG. 2 is a flowchart showing the entire abnormal display process according to the embodiment of the present invention.
  • FIG. 3 is a control block diagram
  • FIG. 7 is a graph showing a motor time characteristic curve (limit of increase in winding temperature of the motor).
  • FIG. 8 is a graph showing overload detection threshold characteristics.
  • FIG. 9 is a diagram showing a motor position waveform when an abnormality occurs in the motor position detector.
  • FIG. 10 is a diagram showing a motor speed waveform when a motor position detector abnormality occurs.
  • FIG. 11 is a diagram showing a motor acceleration waveform when a motor position detector abnormality occurs.
  • FIG. 12 is a flowchart showing position deviation over detection in the embodiment of the present invention.
  • FIG. 13 is a flowchart showing the first multiple abnormality display process in the first embodiment of the present invention.
  • FIG. 14 is a flowchart showing a second multiple abnormality display process according to Embodiment 2 of the present invention.
  • FIG. 15 is a flowchart showing third multiple abnormality display processing according to Embodiment 3 of the present invention.
  • FIG. 16 is a flowchart showing a fourth multiple abnormality display process according to Embodiment 4 of the present invention.
  • FIG. 17 is a flowchart showing a fifth multiple abnormality display process in the fifth embodiment of the present invention.
  • FIG. 18 is a flowchart showing a sixth multiple abnormality display process according to Embodiment 6 of the present invention.
  • FIG. 19 is a flowchart showing a seventh multiple abnormality display process in the seventh embodiment of the present invention.
  • FIG. 20 is a flowchart showing a conventional single abnormality display process.
  • Embodiment 1 of the present invention will be described below with reference to the drawings.
  • symbol is attached
  • the first multiple abnormality display process shown in the flowchart of FIG. 13 is executed as the collision detection occurrence abnormality display process of step 2-5 of FIG. 2 described in the background art.
  • step 13-3 to step 13-8 processing (step 13-3 to step 13-8) for selecting and displaying at least one abnormality display among a plurality of abnormality detection items different from the collision detection is provided.
  • a display possibility threshold value smaller than the abnormality determination threshold value is set.
  • an abnormality determination value (motor lock detection value LKdet, excessive value based on values detected during the operation of the robot (for example, motor generation torque ⁇ m, motor speed ⁇ m, motor current Im, motor position ⁇ m).
  • LKdet excessive value based on values detected during the operation of the robot
  • the load detection value OLdet and the position deviation over detection value ⁇ det exceed the display enable / disable threshold, an abnormality is displayed as an abnormality display.
  • step 13-1 it is determined whether or not a robot collision detection has occurred.
  • step 13-1 when a robot collision is detected, it is determined as “Y”, and the process proceeds to step 13-2.
  • step 13-2 an abnormality display of “collision detection” is performed, and the process proceeds to step 13-3.
  • step 13-1 if no robot collision is detected, it is determined as “N”, and nothing is performed thereafter, and the first multiple abnormality display process is terminated.
  • Step 13-3 it is determined whether or not the motor lock detection value LKdet exceeds the motor lock detection display enable / disable threshold value LKthd.
  • step 13-3 if the motor lock detection value LKdet exceeds the motor lock detection display enable / disable threshold LKthd, it is determined “Y”, and the process proceeds to step 13-4.
  • step 13-3 if the motor lock detection value LKdet does not exceed the motor lock detection display enable / disable threshold LKthd, it is determined “N”, and the process proceeds to step 13-5.
  • the motor lock detection display enable / disable threshold value LKthd is set to be smaller than the motor lock detection time threshold value LKth as shown in the following equation (12).
  • Step 13-4 “Motor lock detection” is additionally displayed as an abnormality display, and the process proceeds to Step 13-5.
  • Step 13-5 it is determined whether or not the overload detection value OLdet exceeds the overload detection display availability threshold OLthd. In step 13-5, if the overload detection value OLdet exceeds the overload detection display enable / disable threshold OLthd, it is determined “Y”, and the process proceeds to step 13-6. In step 13-5, if the overload detection value OLdet does not exceed the overload detection display enable / disable threshold value OLthd, it is determined “N”, and the process proceeds to step 13-7.
  • the overload detection display availability threshold value OLthd is set to be smaller than the overload threshold value OLth as shown in the following formula (13).
  • Step 13-6 “Overload detection” is additionally displayed as an abnormality display, and the process proceeds to Step 13-7.
  • Step 13-7 it is determined whether or not the position deviation over detection value ⁇ det exceeds the position deviation over detection display enable / disable threshold value ⁇ thd.
  • step 13-7 if the position deviation over detection value ⁇ det exceeds the position deviation over detection display enable / disable threshold value ⁇ thd, it is determined “Y”, and the process proceeds to step 13-8.
  • step 13-7 it is determined “N” if the position deviation over detection value ⁇ det does not exceed the position deviation over detection display enable / disable threshold value ⁇ thd, and the first multiple abnormality display process is terminated.
  • the position deviation over-detection display possibility threshold ⁇ thd is set to be smaller than the position deviation over-detection threshold ⁇ th as shown by the following equation (14).
  • step 13-8 "Position deviation over detection" is additionally displayed as an abnormality display, and the first multiple abnormality display process is terminated.
  • “Motor lock detection” is displayed in addition to “collision detection” as the abnormality display at that time.
  • “overload detection” is displayed in addition to “collision detection”
  • position deviation over detection is displayed in addition to “collision detection”, it can be estimated that an abnormality of the motor position detector has occurred.
  • priorities are set for a plurality of abnormality detection items. Then, in descending order of priority, abnormality determination values (motor lock detection value LKdet, overload, etc.) based on values detected during robot operation (for example, motor torque ⁇ m, motor speed ⁇ m, motor current Im, motor position ⁇ m). It is determined whether or not the detection value OLdet and the position deviation over-detection value ⁇ det have exceeded the display availability threshold. Only abnormality detection items that exceed the display availability threshold value are displayed abnormally.
  • abnormality determination values for example, motor torque ⁇ m, motor speed ⁇ m, motor current Im, motor position ⁇ m.
  • step 14-3 and 14- For the abnormality detection item having a lower priority than the abnormality detection item for which abnormality display has been performed, it is not determined whether or not the abnormality determination value has exceeded the display availability threshold and the abnormality display is not performed (steps 14-3 and 14-). 5. The process is terminated by moving to any one of steps 14-7).
  • the plurality of abnormality detection items are “motor lock detection”, “overload detection”, and “position deviation over detection” in order from the highest priority.
  • step 14-1 it is determined whether or not a robot collision detection has occurred. If the robot collision is detected in step 14-1, it is determined “Y”, and the process proceeds to step 14-2. In step 14-1, if the robot collision detection does not occur, it is determined as “N”, and nothing is performed thereafter, and the second plural abnormality display process is terminated.
  • Step 14-2 it is determined whether or not the motor lock detection value LKdet exceeds the motor lock detection display enable / disable threshold LKthd for the motor lock detection with the highest priority.
  • step 14-2 if the motor lock detection value LKdet exceeds the motor lock detection display enable / disable threshold LKthd, it is determined “Y”, and the process proceeds to step 14-3.
  • step 14-2 if the motor lock detection value LKdet does not exceed the motor lock detection display enable / disable threshold LKthd, it is determined “N”, and the process proceeds to step 14-4.
  • Step 14-3 “collision detection” and “motor lock detection” are displayed abnormally, and the second multiple abnormality display processing is terminated.
  • Step 14-4 it is determined whether or not the overload detection value OLdet exceeds the overload detection display enable / disable threshold value OLthd for the next highest priority overload detection. In step 14-4, if the overload detection value OLdet exceeds the overload detection display enable / disable threshold value OLthd, it is determined “Y”, and the process proceeds to step 14-5. In step 14-4, if the overload detection value OLdet does not exceed the overload detection display enable / disable threshold value OLthd, it is determined “N”, and the process proceeds to step 14-6.
  • step 14-5 “collision detection” and “overload detection” are displayed abnormally, and the second multiple abnormality display process is terminated.
  • Step 14-6 it is determined whether or not the position deviation over detection value ⁇ det exceeds the position deviation over detection display enable / disable threshold value ⁇ thd for the position deviation over detection with the lowest priority.
  • step 14-6 if the position deviation over detection value ⁇ det exceeds the position deviation over detection display enable / disable threshold value ⁇ thd, it is determined “Y”, and the process proceeds to step 14-7.
  • step 14-6 it is determined “N” if the position deviation over detection value ⁇ det does not exceed the position deviation over detection display enable / disable threshold value ⁇ thd, and the process proceeds to step 14-8.
  • step 14-7 “collision detection” and “position deviation over detection” are displayed abnormally, and the second multiple abnormality display processing is terminated.
  • step 14-8 only “collision detection” is displayed as abnormal, and the second multiple abnormality display processing is terminated.
  • each abnormality detection item is based on the collision detection threshold for each abnormality detection item that is set with respect to the first multiple abnormality display process of FIG. 13 in the first embodiment.
  • a process for determining a display possibility threshold for the item is added.
  • step 15-1 it is determined whether or not a robot collision detection has occurred.
  • step 15-1 if a robot collision is detected, it is determined “Y”, the process proceeds to step 15-2, an abnormality display of “collision detection” is performed, and the process proceeds to step 15-A.
  • step 15-1 if the collision detection of the robot does not occur, it is determined as “N”, and nothing is performed thereafter, and the third multiple abnormality display process is terminated.
  • Step 15-A is a process added to determine the display availability threshold for each abnormality detection item based on the set collision detection threshold.
  • step 15-A based on the collision detection threshold ⁇ th, as shown in the following formulas (15-1) to (15-3), the motor lock detection display availability threshold LKthd, the overload detection display availability threshold OLthd, A position deviation over detection display enable / disable threshold value ⁇ thd is calculated.
  • LKthd kthA1 ⁇ ⁇ th + kthB1 (15-1)
  • OLthd kthA2 ⁇ ⁇ th + kthB2
  • ⁇ thd kthA3 ⁇ ⁇ th + kthB3
  • kthA1, kthA2, and kthA3 collision detection threshold ( ⁇ th) proportional coefficients
  • KthB1, kthB2, and kthB3 are addition coefficients.
  • the reason why the abnormality detection display possibility threshold is obtained based on the collision detection threshold ⁇ th as described above is that when the collision detection threshold ⁇ th is large (the collision detection sensitivity is low), the possibility of erroneous collision detection is reduced. If collision detection is not performed, the other abnormality detection display may be rather complicated to judge the situation when collision detection occurs. That is, the higher the collision detection threshold ⁇ th is, the higher the abnormality detection display availability threshold is set to prevent multiple abnormality display.
  • step 15-A the motor lock detection display enable / disable threshold value LKthd, the overload detection display enable / disable threshold value OLthd, and the position deviation over-detection display enable / disable threshold value ⁇ thd calculated in step 15-A are set to step 15-3, step 15-5, step 15- 7 is used for determination.
  • the processing after step 15-3 is the same as the processing after step 13-3 in FIG. 13 in the first embodiment.
  • a display availability threshold value for each abnormality detection item is determined based on the set collision detection threshold value with respect to the second multiple abnormality display process of FIG. 14 in the second embodiment. (Step 16-A) is added.
  • step 16-A is the same as the processing in step 15-A in FIG. 15 in the third embodiment.
  • the processing after step 16-3 is the same as the processing after step 14-3 of FIG. 14 in the second embodiment.
  • each abnormality detection item is based on values (for example, motor torque ⁇ m, motor speed ⁇ m, motor current Im, motor position ⁇ m) detected during the operation of the robot with respect to the abnormality determination threshold.
  • the ratio of the abnormality determination value (motor lock detection value LKdet, overload detection value OLdet, position deviation over detection value ⁇ det) is obtained. Only the abnormality detection item with the highest ratio of the abnormality determination value has a process of performing abnormality display together with collision detection.
  • step 17-1 it is determined whether or not a robot collision detection has occurred.
  • step 17-1 when a robot collision is detected, it is determined “Y”, and the process proceeds to step 17-2.
  • step 17-1 if the collision detection of the robot does not occur, it is determined as “N”, and the fifth multiple abnormality display process is ended.
  • step 17-2 the ratio of the abnormality determination value to the abnormality determination threshold is calculated.
  • the motor lock detection abnormality determination value ratio LKrat, the overload detection abnormality determination value ratio OLrat, and the position deviation over detection abnormality determination value ratio ⁇ rat are expressed by the following equations (16-1) to (16-3).
  • LKrat LKdet ⁇ LKth (16-1)
  • OLrat OLdet ⁇ OLth (16-2)
  • ⁇ rat ⁇ det ⁇ ⁇ th (16-3)
  • LKdet is a motor lock detection value
  • LKth is a motor lock detection threshold
  • OLdet is an overload detection value
  • OLth is an overload detection threshold
  • ⁇ det is a position deviation over detection value
  • ⁇ th is a position deviation over detection threshold.
  • Step 17-3 it is determined whether or not the motor lock detection abnormality determination value ratio LKrat is the maximum among the abnormality determination value ratios obtained in Step 17-2.
  • step 17-3 if the motor lock detection abnormality determination value ratio LKrat is maximum, it is determined “Y”, and the process proceeds to step 17-4.
  • step 17-3 if the motor lock detection abnormality determination value ratio LKrat is not the maximum, it is determined “N”, and the process proceeds to step 17-5.
  • Step 17-4 “collision detection” and “motor lock detection” are displayed abnormally, and the fifth multiple abnormality display process is terminated.
  • Step 17-5 it is determined whether or not the overload detection abnormality determination value ratio OLrat is maximum among the abnormality determination value ratios obtained in Step 17-2. In step 17-5, it is determined “Y” that the overload detection abnormality determination value ratio OLrat is maximum, and the process proceeds to step 17-6. In step 17-5, when the overload detection abnormality determination value ratio OLrat is not the maximum, it is determined “N”, and the process proceeds to step 17-7.
  • step 17-6 “collision detection” and “overload detection” are displayed abnormally, and the fifth multiple abnormality display process is terminated.
  • step 17-7 “collision detection” and “position deviation over detection” are displayed abnormally, and the fifth multiple abnormality display process is terminated.
  • the reason why only the item with the highest abnormality judgment value ratio is displayed is that, unless an actual collision is detected, the possibility of occurrence of abnormality in the item with the largest abnormality judgment value ratio is highest.
  • step 18-1 it is determined whether or not a robot collision detection has occurred.
  • step 18-1 if a robot collision is detected, it is determined “Y”, the process proceeds to step 18-2, an abnormality display of “collision detection” is performed, and the process proceeds to step 18-3.
  • Step 18-1 if the collision detection of the robot does not occur, it is determined as “N”, and nothing is performed thereafter, and the sixth multiple abnormality display process is terminated.
  • step 18-3 the abnormality determination value ratio with respect to the abnormality determination threshold is calculated.
  • the motor lock detection abnormality determination value ratio LKrat, the overload detection abnormality determination value ratio OLrat, and the position deviation overdetection abnormality determination value ratio ⁇ rat are expressed by the above-described equations (16-1) to (16) described in the fifth embodiment. 16-3). Thereafter, the process proceeds to Step 18-4.
  • Step 18-4 “Motor lock detection ratio LKrat”, “Overload detection ratio OLrat”, and “Position deviation over detection ratio ⁇ rat” are additionally displayed in the abnormality display, and the sixth multiple abnormality display process is terminated. .
  • the display of each abnormality determination value ratio is an actual calculated number.
  • a process for obtaining the ratio of the abnormality determination value to the abnormality determination threshold for each abnormality detection item is added to the first multiple abnormality display process of FIG. 13 in the first embodiment. Is. When the collision of the robot is detected, the process of displaying each abnormality detection item together with the display of the collision detection is changed to the process of displaying the ratio of the abnormality determination value to the abnormality determination threshold.
  • step 19-1 it is determined whether or not a robot collision detection has occurred.
  • step 19-1 if a robot collision is detected, it is determined “Y”, the process proceeds to step 19-2, an abnormality display of “collision detection” is performed, and the process proceeds to step 19-A.
  • step 19-1 if the collision detection of the robot does not occur, it is determined as “N”, and nothing is performed thereafter, and the sixth multiple abnormality display process is terminated.
  • step 19-A an abnormality determination value ratio with respect to the abnormality determination threshold is calculated.
  • the motor lock detection abnormality determination value ratio LKrat, the overload detection abnormality determination value ratio OLrat, and the position deviation overdetection abnormality determination value ratio ⁇ rat are expressed by the above-described equations (16-1) to (16) described in the fifth embodiment. 16-3).
  • step 19-3 it is determined whether or not the motor lock detection value LKdet exceeds the motor lock detection display enable / disable threshold value LKthd. In step 19-3, if the motor lock detection value LKdet exceeds the motor lock detection display enable / disable threshold LKthd, it is determined “Y”, and the process proceeds to step 19-4. In step 19-3, if the motor lock detection value LKdet does not exceed the motor lock detection display enable / disable threshold LKthd, it is determined “N”, and the process proceeds to step 19-5.
  • step 19-4 “Motor lock detection ratio LKrat” is added and displayed in the abnormality display, and the process proceeds to step 19-5.
  • the display of the motor lock detection ratio LKrat is an actual calculated number.
  • Step 19-5 it is determined whether or not the overload detection value OLdet exceeds the overload detection display availability threshold OLthd. In step 19-5, if the overload detection value OLdet exceeds the overload detection display enable / disable threshold value OLthd, it is determined “Y”, and the process proceeds to step 19-6. In step 19-5, if the overload detection value OLdet does not exceed the overload detection display possibility threshold OLthd, it is determined as “N”, and the process proceeds to step 19-7.
  • step 19-6 “Overload detection ratio OLrat” is added and displayed in the abnormality display, and the process proceeds to step 19-7.
  • the display of the overload detection ratio OLrat is an actual calculated number.
  • Step 19-7 it is determined whether or not the position deviation over detection value ⁇ det exceeds the position deviation over detection display enable / disable threshold value ⁇ thd.
  • step 19-7 if the position deviation over detection value ⁇ det exceeds the position deviation over detection display enable / disable threshold value ⁇ thd, it is determined “Y”, and the process proceeds to step 19-8.
  • step 19-7 it is determined “N” if the position deviation over detection value ⁇ det does not exceed the position deviation over detection display enable / disable threshold value ⁇ thd, and the first multiple abnormality display process is terminated.
  • step 19-8 “position deviation over detection rate ⁇ rat” is added to the abnormality display and displayed, and the sixth multiple abnormality display process is terminated.
  • the display of the position deviation over detection rate ⁇ rat is an actual calculated number.
  • the abnormality detection when a robot collision is detected, the abnormality detection is displayed as an abnormality display, and at least one abnormality display among a plurality of abnormality detection items different from the collision detection is displayed. Since the processing to be performed is provided, information useful for grasping the situation at the time of occurrence of erroneous collision detection can be obtained, which is industrially useful.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • General Physics & Mathematics (AREA)
  • Computational Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Analysis (AREA)
  • Pure & Applied Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Theoretical Computer Science (AREA)
  • Operations Research (AREA)
  • Algebra (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Manipulator (AREA)

Abstract

　ロボットのセンサレス衝突検出において、従来のロボットの異常表示方法では、衝突誤検出が発生した際に「衝突検出」とのみ異常表示され、どのような状況で衝突誤検出が発生したのかが不明であった。ロボットの衝突を検出した場合、異常表示として衝突検出したことを表示するともに、衝突検出とは異なる複数の異常検出項目のうち少なくとも１つ以上の異常表示を選択して行うことで、衝突誤検出発生時の状況を把握するために有用な情報を得ることができる。

Description

ロボットの異常表示方法
　本発明は、減速機を介してモータにより駆動されるロボットの異常表示方法に関する。
　近年、ロボット市場がグローバルに拡大するにつれ、ロボットが故障した場合や異常が発生した場合の対応が大きな課題となっている。すなわち、ロボットの異常表示が、実際の故障状態を把握できない状態であると、異常発生現場へサービスマンが直接行って状況を確認し、その後に対策を実施する必要がある。この方法では、全世界への異常状態解消の迅速な対応が困難となる。
　一方で、ロボット自体の故障ではなく、ユーザの教示ミス等が原因で発生する、ロボットのロボット周辺物との衝突への対応も必要である。ロボットや周辺物が衝突により破壊すると、修理等のためサービスマンの派遣が必要となり、復旧に時間を要する。すなわち、衝突時の破壊防止のため、衝突検出の高精度化が求められている。しかし、高精度の衝突センサをロボットに搭載すると、ロボットにとっては余分な重量負荷となり、かつ、コストも上昇する。そこで、近年では、センサレス衝突検出の高精度化が進展している。
　しかしながら、センサレス衝突検出の高精度化により、実際の衝突ではない場合も、ロボットの異常状態を誤って衝突と検出する可能性が高くなる。すなわち、ロボットの故障発生時に、他の異常検出機能よりも先に衝突検出機能が異常を検出し、衝突が発生していないにもかかわらず「衝突発生」といった誤った表示を行う可能性が有る。このように、センサレス衝突検出の高精度化により、故障を速やかに検出するという利点がある反面、故障原因をわかり難くする原因ともなっている。誤った衝突検出が発生する理由を図１～図１２を用いて、以下に説明する。
　図１は、ロボットの代表例として垂直多関節６軸ロボットを示す概略構成図である。図１に示すように、垂直多関節６軸ロボットは、ロボットメカニズム（１０１）と、ロボット制御装置（１０２）と、操作表示装置（１０３）とを有する。
　図２は、異常表示の全体処理を示すフローチャートである。異常表示の全体処理は、ロボット制御装置（１０２）内で行われる。図２では、衝突検出処理以外にも、ロボット故障発生時の異常を検出するモータロック検出処理や、過負荷検出処理や、位置偏差オーバー検出処理を加えている。図２に示される異常表示の全体処理は、周期ΔＴ毎に繰り返され、周期ΔＴは数ミリ秒を想定している。
　図２において、ステップ２－１では、モータロック検出処理を行う。ステップ２－６では、モータロックが検出されると、図１の操作表示装置（１０３）に異常表示として「モータロック検出」を表示する。モータロックが検出された場合、既に異常状態が発生し異常表示もされているので、ステップ２－６で異常表示処理を終了させる。ステップ２－６でモータロックが検出されなかった場合、ステップ２－２に進む。
　次に、ステップ２－２では、過負荷検出処理を行う。ステップ２－７では、過負荷が検出されると、図１の操作表示装置（１０３）に異常表示として「過負荷検出」を表示する。過負荷が検出された場合は、既に異常状態が発生し異常表示もされているので、ステップ２－７で異常表示処理を終了させる。ステップ２－７で過負荷が検出されなかった場合、ステップ２－３に進む。
　次に、ステップ２－３では、位置偏差オーバー検出処理を行う。ステップ２－８では、位置偏差オーバーが検出されると、図１の操作表示装置（１０３）に異常表示として「位置偏差オーバー検出」を表示する。位置偏差オーバーが検出された場合は、既に異常状態が発生し異常表示もされているので、ステップ２－８で異常表示処理を終了させる。ステップ２－８で位置偏差オーバーが検出されなかった場合、ステップ２－４に進む。
　次に、ステップ２－４では、図３を用いて下記で説明する衝突検出処理を実行する。
　衝突力をセンサレスで求める方法としては、動力学演算方式と外乱推定オブザーバ方式がある。動力学演算方式は、まず、モータの駆動電流で発生したトルクからモータ及び減速機のイナーシャと摩擦で損失するトルクを差し引いて減速機出力トルクを求める。次に、減速機出力トルクから、ロボットの動力学演算で求めたロボットの動力学トルクを差し引いて衝突力を求める。（例えば、非特許文献１参照。）。外乱推定オブザーバ方式は、外乱推定オブザーバを用いて衝突力を求める。（例えば、特許文献１参照。）。以下、図３を用いて、推定精度に優れる動力学演算方式を例に説明する。
　図３は、動力学演算方式の制御ブロック線図である。図３において、６は位置制御ブロックである。位置制御ブロック（６）には、位置指令の速度成分ｄθｃｏｍ（１）を積分要素４０によって積分した位置指令θｃｏｍ（３）と、モータ位置θｍ（４）とが入力される。そして、位置指令θｃｏｍ（３）とモータ位置θｍ（４）との差分値に基づいて、位置比例ゲイン（５）から速度ループ指令ωｃｏｍ（７）を出力する。
　図３において、１０は速度制御ブロックである。速度制御ブロック（１０）には、速度ループ指令ωｃｏｍ（７）と、モータ位置θｍ（４）とが入力される。そして、速度ループ指令ωｃｏｍ（７）と、モータ位置θｍ（４）を微分要素（３２）によって微分したモータ速度ωｍ（２）との差分値を求め、速度比例ゲイン（８）および速度積分ゲイン（９）を介して、モータ電流Ｉｍ（１１）を出力する。
　図３において、１８はモータと外力を示したブロックである。τｍ（１３）はモータ発生トルクであり、減速機が剛体であると仮定すると、モータ駆動側から見れば式（１）で表され、負荷側から見れば式（２）で表される。
　τｍ＝Ｋｔ×Ｉｍ　（１）
　τｍ＝τｄｙｎ＋τｄｉｓ＋Ｊｍ×αｍ＋Ｄ×ωｍ＋τμ　（２）
ただし、式（１）と式（２）における記号は以下の通りである。
　Ｋｔ（１２）：モータトルク定数
　Ｉｍ（１１）：モータ電流
　αｍ（９０）：モータ加速度（ωｍの微分値）
　ωｍ（２）　：モータ速度
　Ｊｍ（８９）：モータイナーシャ（ロータ＋減速機１次側）
　Ｄ（２０）　：粘性摩擦係数
　τμ（１５）：動摩擦トルク
　τｄｙｎ（１４）：動力学トルク（重力トルク、慣性力、遠心力、コリオリ力の和）
　τｄｉｓ（１６）：衝突トルク
　動摩擦トルクτμ（１５）は以下の式（３）で計算できる。
　τμ＝Ｋμ×ｓｇｎ　（３）
　ただし、Ｋμは動摩擦の大きさであり、ｓｇｎは、ωｍ＞０の時は「１」、ωｍ＝０の時は「０」、ωｍ＜０の時は「－１」である。
　衝突トルクτｄｉｓ（１６）は、式（１）と式（２）より、以下の式（４）に変形して求めることが出来る。
　τｄｉｓ＝Ｋｔ×Ｉｍ－（Ｊｍ×αｍ＋Ｄ×ωｍ＋τμ＋τｄｙｎ）　　（４）
　図３において、３０は、式（４）を衝突トルク推定ブロックとして表したものである。
　衝突トルク推定ブロック（３０）において、動力学トルク推定値τｄｙｎｏ（２９）は、動力学トルク演算ブロック（２６）が動力学演算することで求められる。動力学トルク演算ブロック（２６）は、ロボットを構成する全軸のモータ位置θｍ（４）と、モータ位置θｍ（４）を微分したモータ速度ωｍ（２）と、モータ速度ωｍ（２）を微分したモータ加速度αｍ（９０）と、ロボットの機械パラメータ（アーム長、アーム質量、重心位置、重心位置周りのイナーシャ）を用いて、動力学演算を実行する。この動力学トルク推定値τｄｙｎｏ（２９）を用いて、衝突トルク推定ブロック（３０）は、衝突トルク推定値τｄｉｓｏ（２８）を衝突判定ブロック（３１）へ出力する。
　衝突判定ブロック（３１）は、所定の衝突検出閾値τｔｈを用いて、以下の式（５）に従い衝突を検出する。
　｜τｄｉｓｏ｜　＞　τｔｈ　　（５）
　ステップ２－５では、式（５）が成立すれば、図１のロボットの操作表示装置（１０３）に異常表示として「衝突検出」を表示し、異常表示処理を終了させる。また、ステップ２－５では、式（５）が成立していなければ、異常表示をせずに異常表示処理を終了させる。そして、また、周期ΔＴごとに異常表示の全体処理を開始する。
　以上の衝突検出では、前述のように、動力学トルク推定値τｄｙｎｏ（２９）が正確に計算できれば、精度良く衝突トルク推定値τｄｉｓｏ（２８）を求めることができる。
　動力学トルク演算ブロック（２６）で動力学トルクを求める方法としては、ラグランジュ法とニュートンオイラー法とがある。ラグランジュ法では、６軸の垂直多関節ロボットでは、１０万回弱の積和演算が必要である。しかし、この演算量は、現在のＣＰＵの処理能力からすれば、数ミリ秒以内で演算することも可能である。ニュートンオイラー法では、積和演算量が１万回弱で済むので、演算時間は問題無い。ニュートンオイラー法は、前式の結果を次式に用いる、いわゆる漸化式方式であるので、演算の累積誤差が発生する恐れがある。しかし、３２ｂｉｔ以上のデータで処理すれば演算の累積誤差も問題無い。よって、どちらの方法を用いたとしても、現在のＣＰＵでは、動力学トルクτｄｙｎ（１４）をモータ最大トルク比１０％以内の誤差で計算可能である。式（４）の右辺で動力学トルクτｄｙｎ（１４）以外の項も、モータ最大トルク比１０％以内の誤差で計算可能であれば、衝突トルク推定値τｄｉｓｏ（２８）は、モータ最大トルク比２０％以内の誤差で求めることができる。
　また、式（５）による衝突検出では、式（４）で求めた衝突トルク推定値τｄｉｓｏ（２８）の瞬時値を用いている。そのため、計算時間である数ミリ秒経てば、動力学トルクτｄｙｎ（１４）の判定が可能である。すなわち、衝突検出機能では、モータ最大トルク比２０％程度の異常が数ミリ秒観測されれば、衝突を検出することが可能である。
　しかし、衝突検出閾値τｔｈを低く（モータ最大トルク比２０％程度に）設定すれば、衝突以外の故障でもいち早く検出してしまう。例えば、モータ（ベアリング、ブレーキ）や減速機の故障により、実際の動摩擦トルクが増加した場合について、検討する。この場合、正常時と同じようにロボットを動作させようとすると、動摩擦トルクτμの増大分だけモータ発生トルクτｍを増大させる必要がある。モータ発生トルクτｍを増加させるため、式（４）の右辺のモータ電流Ｉｍが増加する。しかし、式（４）の右辺で用いる動摩擦トルクτμは、予め正常時に測定した値を用いて計算するため、式（４）の左辺である衝突トルクτｄｉｓは、衝突していないにも関わらず増大する。そして、衝突トルクτｄｉｓの大きさがモータ最大トルク比２０％を数ミリ秒でも越えると、衝突検出として誤検出してしまう。
　衝突力をセンサレスで求める方法では、式（４）の右辺のモータ電流Ｉｍが増加し、衝突トルクτｄｉｓが増大することの原因が特定できない。すなわち、ロボットの実衝突に起因するのか、モータや減速機の故障による摩擦トルク増大に起因するのかが、区別ができない。そのため、ロボット衝突時の損傷を少しでも少なくするために、衝突検出閾値τｔｈを低く（衝突検出感度を高く）設定すると、衝突誤検出の発生確率も高めてしまう。
　一方、衝突検出機能とは別に、モータ（ベアリング、ブレーキ）や減速機の故障によりモータの回転が重くなったことを検出する機能としては、モータロック検出機能や過負荷検出機能がある。
　モータロック検出機能では、モータを動作させようとしているのに殆ど動かない状態が継続した状況を検出する。モータ発生トルクτｍ（式（１）で示す）が、所定のモータトルク閾値τｍｔｈ（９１）以上になっても、故障により増大した摩擦トルクが大きいと、モータ速度ωｍ（２）が所定のモータ速度閾値ωｍｔｈ以上に上がらない。この状態が、所定のモータロック検出時間閾値ＬＫｔｈ以上に継続した場合に、モータロック検出機能が異常と判定する。
　モータロック検出機能について、図５Ａおよび図５Ｂを用いて説明する。図５Ａは、正常時のモータ速度ωｍ（２）とモータ発生トルクτｍ（１３）とを示すグラフである。モータ発生トルクτｍ（１３）がモータトルク閾値τｍｔｈ（９１）を越えてから、モータロック検出時間閾値ＬＫｔｈ（９３）より小さい時間ＬＫ０（９５）が経過した後は、モータ速度ωｍ（２）がモータ速度閾値ωｍｔｈ（９２）を越えている。この場合は、モータロックは検出されない。
　図５Ｂは、モータや減速機の故障による摩擦トルクの増大でモータロックが検出されるという異常時のモータ速度ωｍ（２）とモータ発生トルクτｍ（１３）とを示すグラフである。図５Ｂでは、モータ発生トルクτｍ（１３）がモータトルク閾値τｍｔｈ（９１）を越えてからも、モータや減速機の故障による摩擦トルクの増大のせいで、正常時（点線で示す）に比べモータ速度ωｍ（２）の増加が遅くなる。そのため、モータ速度ωｍ（２）は、モータロック検出時間閾値ＬＫｔｈ（９３）になっても、モータ速度閾値ωｍｔｈ（９２）に達しない。この場合、モータロックが検出される。
　図４は、上記モータロック検出のフローチャートである。モータロック検出処理は一定周期ΔＴ毎に実行される。
　ステップ４－１では、モータ発生トルクτｍがモータトルク閾値τｍｔｈ（９１）以上になっているか否かを判定する。モータ発生トルクτｍがモータトルク閾値τｍｔｈ（９１）以上になっていると、「Ｙ」と判定し、ステップ４－２へ進む。
　ステップ４－２では、モータ速度ωｍ（２）がモータ速度閾値ωｍｔｈ（９２）以下であるか否かを判定する。モータ速度ωｍ（２）がモータ速度閾値ωｍｔｈ（９２）以下であると、「Ｙ」と判定し、ステップ４－３へ進む。
　ステップ４－３では、式（５）によって、モータロック継続時間ＬＫｄｅｔを算出し、ステップ４－５に進む。
　ＬＫｄｅｔ＝ＬＫｄｅｔ＋ΔＴ　　（６）
　ここで、ΔＴは、モータロック検出処理周期である。
　すなわち、ステップ４－３では、ステップ４－１およびステップ４－２がともに「Ｙ」と判定されている時間の長さを、モータロック検出処理周期ΔＴずつ加算して測定するものである。
　なお、ステップ４－１あるいはステップ４－２の判定が「Ｎ」なら、ステップ４－４に進み、モータロック継続時間ＬＫｄｅｔを０にリセットし、モータロック検出の処理を終える。
　ステップ４－５では、モータロック継続時間ＬＫｄｅｔがモータロック検出時間閾値ＬＫｔｈ（９３）以上になったか否かを判定する。
　ＬＫｄｅｔ≧ＬＫｔｈ　　（７）
　モータロック継続時間ＬＫｄｅｔがモータロック検出時間閾値ＬＫｔｈ（９３）以上であると、「Ｙ」と判定し、ステップ４－６へ進む。この場合、モータロック状態であると判定され、ステップ４－６でモータを停止する。続いて、ステップ４－７で「モータロック検出」の異常表示を行い、モータロック検出の処理を終了する。なお、異常表示は、図１に示す操作表示装置（１０３）に表示する。
　ステップ４－５の判定が「Ｎ」なら、モータロック状態では無いと判定し、モータロック検出の処理を終了する。
　このモータロック検出機能では、正常時は、モータトルク閾値τｍｔｈ（９１）以上のモータトルクで、モータ速度閾値ωｍｔｈ（９２）以上のモータ速度に到達するまでには、所要時間ＬＫ０（９５）を要する。そのためモータロック検出時間閾値ＬＫｔｈ（９３）は、正常時の所要時間ＬＫ０（９５）よりも大きくする必要が有る。ロボットの大きさにより異なるが、モータロック検出時間閾値ＬＫｔｈ（９３）は、数百ミリ秒から数秒であり、衝突検出機能が数ミリ秒内で検出することに比べれば遅い。すなわち、衝突検出閾値τｔｈを低く（衝突検出感度を高く）設定すると、実際に衝突していないにも関わらず、モータロックが検出される前に衝突が先に検出されてしまい、異常表示も「衝突検出」とのみ表示されることになる。図２において説明すると、ステップ２－６によるモータロック検出では「Ｎ」と判定されて続けている間に、ステップ２－５による衝突検出では「Ｙ」と判定される。
　次に、過負荷検出機能について説明する。
　過負荷検出機能では、モータを駆動させる電流の時間積算値が、モータ時限特性曲線の限界値を超えない様に、過負荷異常を検出する。モータ発生トルクはモータを駆動させる電流に比例し、モータ時限特性曲線の限界値とは、モータの巻線温度の上限を示す。図７は、モータを駆動させるモータ電流と時間の関係を示すグラフである。例えば、図７に示すモータ時限曲線の限界値（点線）は、最大電流比４０％の時は約１００秒、最大電流比５０％の時は２５秒、最大電流比７０％の時は約８秒である。この限界値以下になる様に過負荷検出を行う。
　図６は、過負荷検出のフローチャートである。過負荷検出処理は一定周期ΔＴ毎に実行される。
　ステップ６－１で、過負荷検出値ＯＬｄｅｔを以下の式（８）で求める。
　ＯＬｄｅｔ＝ＯＬｄｅｔ＋（｜Ｉｍ｜－Ｉｍｔｈ）×ΔＴ　　（８）
　ここで、Ｉｍｔｈは過負荷検出電流閾値であり、ΔＴは過負荷検出周期である。
　次に、ステップ６－２では、過負荷検出値ＯＬｄｅｔが過負荷閾値ＯＬｔｈ以上であるか否かを判定する。すなわち、下記式（９）の条件が成立するかどうかを判定する。
　ＯＬｄｅｔ　≧　ＯＬｔｈ　　（９）
　式（９）が成立すると、「Ｙ」と判定し、過負荷状態であると判定され、ステップ６－３へ進む。ステップ６－３では、モータを停止し、続いて、ステップ６－４で「過負荷検出」であることを示す「異常表示」を行い、過負荷検出の処理を終了する。なお、「異常表示」は、図１に示す操作表示装置（１０３）に表示する。
　ステップ６－２の判定が「Ｎ」なら、過負荷状態では無いとの判定し、過負荷検出の処理を終了する。
　図８に、式（９）でＯＬｄｅｔ＝ＯＬｔｈとなる過負荷検出閾値特性を実線で示す。図８の過負荷検出閾値特性（実線）は、Ｉｍｔｈ＝３３、ＯＬｔｈ＝１００の場合を示している。過負荷検出閾値特性（実線）は限界値（点線）を下回る様に設定されており、式（８）で示す過負荷検出値ＯＬｄｅｔの演算方法が妥当である事を示している。
　図８に示すように、モータ電流が最大電流比１００％でも過負荷検出には数秒かかることがわかる。この過負荷検出にかかる時間は、衝突検出機能が数ミリ秒内で検出することに比べれば遅い。つまり、過負荷異常が発生していない状態からモータや減速機の故障が発生すると、モータ回転が重くなり、モータ電流（モータ発生トルク）が最大電流比で２０％程度増加する。このようにモータや減速器の故障が発生しても、過負荷異常が検出されるには最低でも数秒以上かかり、先に衝突誤検出が発生する可能性が極めて高い。図２において説明すると、ステップ２－７による過負荷検出では「Ｎ」と判定されて続けている間に、ステップ２－５による衝突検出では「Ｙ」と判定される。
　次に、図３に示す衝突検出処理における誤検出について説明する。
　すなわち、モータ位置θｍ（４）を検出するモータ位置検出器（９９）に異常が有った場合でも、衝突検出として誤検出する可能性がある。
　動力学トルク演算ブロック（２６）には、モータ位置θｍ（４）を２回微分して生成するモータ加速度αｍ（９０）を用いている。そのため、モータ位置θｍ（４）の変化は、モータ加速度αｍ（９０）に大きく影響する。
　一般的に、デジタル制御における微分は、現サンプル値とサンプル１周期前の前サンプル値の差分によって行われることが一般的である。そこで、一例を示す。
　図９は、モータ位置検出器に異常が発生した時のモータ位置波形を示すグラフである。図１０はモータ位置検出器に異常が発生した時の速度波形を示すグラフである。図１１はモータ位置検出器に異常が発生した時の加速度波形を示すグラフである。モータ位置θｍ（４）が０の位置での停止状態から、０．５秒でモータ速度ωｍ（２）が５０回転／秒（＝３０００ｒｐｍ）に等加速度（１００回転／秒２）で到達する場合の波形を示している。ここで、サンプル周期は５ミリ秒であり、５００ミリ秒後のモータ位置θｍ（４）は図９に示すように、約１２．５回転である。図９は、３００ミリ秒の時点でモータ位置検出器（９９）に異常が発生し、モータ位置θｍ（４）の読み取りができなかった場合である。この場合、前回サンプル値（２９５ｍ秒時点）でのモータ位置θｍ（４）の値が更新されず、そのままの状態になっている。
　５００ミリ秒後の値（１２．５回転）を基準に、異常が発生した３００ミリ秒時のモータ位置θｍ（４）の誤差ｅθｍ（８６）を計算すると、約４．７％（約０．１５回転分）である。図１０において、モータ速度ωｍ（２）の誤差ｅωｍ（８７）も、５００ミリ秒後の値（５０回転／秒）を基準に算出すると、約１２０％になる。さらに図１１において、モータ加速度αｍ（９０）の誤差ｅαｍ（８８）も、５００ミリ秒後の値（１００回転／秒２）を基準に算出すると、約－３３３３％となる。従って、動力学トルク演算ブロック（２６）で求める動力学トルクτｄｙｎ（１４）の精度に大きな影響を与え、衝突誤検出を引き起こす可能性が高い。
　衝突力をセンサレスで求める方法において、モータ位置θｍ（４）が変わらないことの原因は特定できない。すなわち、実際に衝突が発生してロボットが停止したことによるのか、モータ位置検出器（９９）に異常が有ってモータ位置θｍ（４）が更新されなかったからなのかは不明である。そのため、衝突検出機能を有効に働かせようとすると、衝突誤検出の発生を免れることはできない。
　一方、衝突検出機能とは別に、モータ位置θｍ（４）を検出するモータ位置検出器（９９）に異常が有ったことを検出する機能としては、位置偏差オーバー検出機能がある。
　次に、位置偏差オーバー検出機能について説明する。
　図１２は、位置偏差オーバー検出のフローチャートである。位置偏差オーバー検出処理は一定周期ΔＴ毎に実行される。
　ステップ１２－１では、下記の式（１０）に示すように、位置偏差オーバー検出値θｄｅｔを、位置指令θｃｏｍ（３）とモータ位置θｍ（４）の差分の絶対値として算出する。
　　θｄｅｔ＝｜θｃｏｍ－θｍ｜　　（１０）
　ステップ１２－２では、位置偏差オーバー検出値θｄｅｔと位置偏差オーバー検出閾値θｔｈとを比較し、下記の式（１１）の条件を満たすかどうかを判定する。
　　θｄｅｔ≧θｔｈ　　（１１）
　位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出閾値θｔｈ以上であると、「Ｙ」と判定し、ステップ２－３へ進む。この場合、位置偏差オーバー状態であると判定され、ステップ１２－３でモータを停止する。続いて、ステップ１２－４で「位置偏差オーバー」の異常表示を行い、位置偏差オーバー検出の処理を終了する。なお、異常表示は、図１に示す操作表示装置（１０３）に表示する。
　ステップ１２－２の判定が「Ｎ」なら、位置偏差オーバー状態では無いと判定し、位置偏差オーバー検出の処理を終了する。
　この位置偏差オーバー検出において、制御遅れによる位置偏差を誤検出しないように、式（１１）における位置偏差オーバー検出閾値θｔｈは、数回転程度に設定される。
　例えば、制御遅れによる位置偏差が１回転であって、位置偏差オーバー検出閾値θｔｈを２回転に設定していたとする。この時、図９で異常が発生した３００ミリ秒時のモータ位置θｍ（４）の誤差（約０．１５回転分）が加算されても、位置偏差オーバー検出値θｄｅｔは１．１５回転程度であり、式（１１）の条件は成立せず、位置偏差オーバーは検出されない。しかし、動力学トルク演算ブロック（２６）で求める動力学トルクτｄｙｎ（１４）の精度には大きな影響を与えるため、誤って衝突検出が検出される。すなわち、実際に衝突していないにも関わらず、衝突が先に検出されてしまい、異常表示も「衝突検出」とのみ表示されることになる。図２において説明すると、ステップ２－８による位置偏差オーバー検出では「Ｎ」と判定されて続けている間に、ステップ２－５による衝突検出では「Ｙ」と判定される。
　図２のステップ２－５の衝突検出発生時の異常表示処理として、従来は、図２０で示す単一異常表示処理を実行する。
　これまで説明した様に、図２に示すステップ２－１～２－３における異常検出には時間がかかるため、ステップ２－４における衝突検出が先に検出され、ステップ２－５で「衝突検出」とのみ異常表示される。
特許第３３６７６４１号公報
小菅一弘、他１名、"マニピュレータの動的衝突検出"、日本機械学会［Ｎｏ．９９－９］ロボティクス・メカトロニクス講演会‘９９講演論文集　２Ａ１－１１－０３０
　従来の衝突力をセンサレスで求める方法では、衝突検出がロボットの実際の衝突によるのか、その他の原因によるものなのかが、区別できない。そして、衝突検出が実際の衝突によるものではない場合も「衝突検出」とのみ表示され、どのような状況で衝突誤検出が発生したのか不明である。
　本発明は、上記課題を解決するものであり、衝突誤検出発生時の状況を把握するのに有用な情報を表示することができるロボットの異常表示方法を提供する。
　上記課題を解決するために、本発明のロボットの異常表示方法は、ロボットの動作時に検出した値に基づいて少なくとも衝突検出を含む複数の異常を検出し、異常が発生したことを表示するロボットの異常表示方法である。さらに、ロボットの衝突を検出する衝突検出工程を有する。さらに、異常表示として衝突検出したことを表示する衝突検出表示工程を有する。さらに、衝突検出とは異なる複数の異常検出項目のうち少なくとも１つについても異常表示として異常が発生したことを表示する異常表示工程を有する。
　また、好ましくは、本発明のロボットの異常表示方法は、上記に加えて、異常表示工程において、複数の異常検出項目の異常表示を選択して行うとよい。
　また、好ましくは、本発明のロボットの異常表示方法は、上記に加えて、複数の異常検出項目の各々には、異常と判定するための異常判定閾値と、異常判定閾値より小さくロボットの衝突を検出した場合に衝突検出したことを表示することと併せて異常が発生したことを表示するための表示可否閾値とが設定されている。さらに、複数の異常検出項目のうち、ロボットの動作時に検出した値に基づく異常判定値が表示可否閾値を超えたものは異常表示として異常が発生したことを表示するとよい。
　また、好ましくは、本発明のロボットの異常表示方法は、上記に加えて、複数の異常検出項目の各々には、異常と判定するための異常判定閾値と、異常判定閾値より小さくロボットの衝突を検出した場合に衝突検出したことを表示することと併せて異常が発生したことを表示するための表示可否閾値とが設定されているとよい。さらに、複数の異常検出項目には優先順位が設定されているとよい。さらに、優先順位が高いものから順にロボットの動作時に検出した値に基づく異常判定値が表示可否閾値を超えたか否かを判定するとよい。さらに、表示可否閾値を超えた異常検出項目のみ異常表示を行うとよい。さらに、異常表示を行った異常検出項目より優先順位が低い異常検出項目については、異常判定値が表示可否閾値を超えたか否かの判定および異常表示を行わないとよい。
　また、好ましくは、本発明のロボットの異常表示方法は、上記に加えて、設定された衝突検出閾値に基づいて各異常検出項目についての表示可否閾値を決定するとよい。
　また、好ましくは、本発明のロボットの異常表示方法は、上記に加えて、各異常検出項目について異常判定閾値に対するロボットの動作時に検出した値に基づく異常判定値の割合を求めるとよい。さらに、異常判定値の割合が最も高い異常検出項目のみ衝突検出とともに異常表示を行うとよい。
　また、好ましくは、本発明のロボットの異常表示方法は、上記に加えて、複数の異常検出項目の各々には、異常と判定するための異常判定閾値が設定されているとよい。さらに、複数の異常検出項目のそれぞれについて、異常判定閾値に対するロボットの動作時に検出した値に基づく異常判定値の割合を求めるとよい。さらに、ロボットの衝突を検出した場合に衝突検出したことを表示することと併せて各異常検出項目のそれぞれについて、異常判定値の割合を表示するとよい。
　また、好ましくは、本発明のロボットの異常表示方法は、上記に加えて、複数の異常検出項目の各々には、異常と判定するための異常判定閾値が設定されているとよい。さらに、複数の異常検出項目のそれぞれについて、異常判定閾値に対するロボットの動作時に検出した値に基づく異常判定値の割合を求めるとよい。さらに、ロボットの衝突を検出した場合に衝突検出したことを表示することと併せて、異常判定値が表示可否閾値を超えたもののみ各異常検出項目の異常判定値の割合を表示するとよい。
　また、好ましくは、本発明のロボットの異常表示方法は、上記に加えて、複数の異常検出項目として、ロボットを駆動するモータのロック検出とモータの過負荷検出とロボットの位置偏差検出との少なくとも１つを含むとよい。
　以上のように、本発明のロボットの異常表示方法においては、衝突検出発生時、他の異常検出手段の状況も併せて表示することにより、衝突誤検出発生時のロボットの動作状況の把握に役立つものである。
図１は、本発明を適用する代表例としての垂直多関節６軸ロボットの概略構成を示す図である。 図２は、本発明の実施の形態における異常表示全体処理を示すフローチャートである。 図３は、本発明の実施の形態における動力学演算方式の制御ブロック線図である。 図４は、本発明の実施の形態におけるモータロック検出を示すフローチャートである。 図５Ａは、正常時のモータ速度とモータトルクの時間変化を示すグラフである。 図５Ｂは、モータロック検出時のモータ速度とモータトルクの時間変化を示すグラフである。 図６は、本発明の実施の形態における過負荷検出を示すフローチャートである。 図７は、モータ時限特性曲線（モータの巻線温度上昇の限界）を示すグラフである。 図８は、過負荷検出閾値特性を示すグラフである。 図９は、モータ位置検出器異常発生時のモータ位置波形を示す図である。 図１０は、モータ位置検出器異常発生時のモータ速度波形を示す図である。 図１１は、モータ位置検出器異常発生時のモータ加速度波形を示す図である。 図１２は、本発明の実施の形態における位置偏差オーバー検出を示すフローチャートである。 図１３は、本発明の実施の形態１における第１の複数異常表示処理を示すフローチャートである。 図１４は、本発明の実施の形態２における第２の複数異常表示処理を示すフローチャートである。 図１５は、本発明の実施の形態３における第３の複数異常表示処理を示すフローチャートである。 図１６は、本発明の実施の形態４における第４の複数異常表示処理を示すフローチャートである。 図１７は、本発明の実施の形態５における第５の複数異常表示処理を示すフローチャートである。 図１８は、本発明の実施の形態６における第６の複数異常表示処理を示すフローチャートである。 図１９は、本発明の実施の形態７における第７の複数異常表示処理を示すフローチャートである。 図２０は、従来の単一異常表示処理を示すフローチャートである。
　（実施の形態１）
　以下、本発明の実施の形態１について、図面を用いて説明する。なお、背景技術で説明したものと同様の事項については、同一の符号を付して詳細な説明を省略する。
　本実施の形態１では、背景技術でも説明した図２のステップ２－５の衝突検出発生異常表示処理として、図１３のフローチャートに示す第１の複数異常表示処理を実行する。
　図１３に示す第１の複数異常表示処理では、ロボットの衝突を検出した場合、異常表示として衝突検出したことを表示する。さらに、衝突検出とは異なる複数の異常検出項目のうち、少なくとも１つ以上の異常表示を選択して行う処理（ステップ１３－３～ステップ１３－８）を備えている。
　さらに、衝突検出とは異なる複数の異常検出ステップ（ステップ１３－３、ステップ１３－５、ステップ１３－７）の各々には、異常判定閾値よりも小さい表示可否閾値が設定されている。
　そして、複数の異常検出項目のうち、ロボットの動作時に検出した値（例えば、モータ発生トルクτｍ、モータ速度ωｍ、モータ電流Ｉｍ、モータ位置θｍ）に基づく異常判定値（モータロック検出値ＬＫｄｅｔ、過負荷検出値ＯＬｄｅｔ、位置偏差オーバー検出値θｄｅｔ）が表示可否閾値を超えたものは、異常表示として異常が発生したことを表示する。（ステップ１３－４、ステップ１３－６、ステップ１３－８）
　図１３において、ステップ１３－１では、ロボットの衝突検出が発生したか否かを判定する。ステップ１３－１において、ロボットの衝突検出が発生すると「Ｙ」と判定し、ステップ１３－２に進む。ステップ１３－２では、「衝突検出」の異常表示を行い、ステップ１３－３へ進む。ステップ１３－１において、ロボットの衝突検出が発生しないと、「Ｎ」と判定し、その後は何も実施せず、第１の複数異常表示処理を終了する。
　ステップ１３－３では、モータロック検出値ＬＫｄｅｔがモータロック検出表示可否閾値ＬＫｔｈｄを上回っているか否かを判定する。ステップ１３－３において、モータロック検出値ＬＫｄｅｔがモータロック検出表示可否閾値ＬＫｔｈｄを上回っていると「Ｙ」と判定し、ステップ１３－４に進む。ステップ１３－３において、モータロック検出値ＬＫｄｅｔがモータロック検出表示可否閾値ＬＫｔｈｄを上回っていないと、「Ｎ」と判定し、ステップ１３－５に進む。
　ここで、モータロック検出表示可否閾値ＬＫｔｈｄは、下記式（１２）で示すように、モータロック検出時間閾値ＬＫｔｈより小さく設定するものとする。
　０　＜　ＬＫｔｈｄ　＜　ＬＫｔｈ　　（１２）
　ステップ１３－４では、異常表示として「モータロック検出」を追加して表示し、ステップ１３－５へ進む。
　ステップ１３－５では、過負荷検出値ＯＬｄｅｔが過負荷検出表示可否閾値ＯＬｔｈｄを上回っているか否かを判定する。ステップ１３－５において、過負荷検出値ＯＬｄｅｔが過負荷検出表示可否閾値ＯＬｔｈｄを上回っていると「Ｙ」と判定し、ステップ１３－６に進む。ステップ１３－５において、過負荷検出値ＯＬｄｅｔが過負荷検出表示可否閾値ＯＬｔｈｄを上回っていないと「Ｎ」と判定し、ステップ１３－７に進む。
　ここで、過負荷検出表示可否閾値ＯＬｔｈｄは、下記式（１３）で示すように、過負荷閾値ＯＬｔｈより小さく設定するものとする。
　０　＜　ＯＬｔｈｄ　＜　ＯＬｔｈ　　（１３）
　ステップ１３－６では、異常表示として「過負荷検出」を追加して表示し、ステップ１３－７へ進む。
　ステップ１３－７では、位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出表示可否閾値θｔｈｄを上回っているか否かを判定する。ステップ１３－７において、位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出表示可否閾値θｔｈｄを上回っていると「Ｙ」と判定し、ステップ１３－８に進む。ステップ１３－７において、位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出表示可否閾値θｔｈｄを上回っていないと「Ｎ」と判定し、第１の複数異常表示処理を終了する。
　ここで、位置偏差オーバー検出表示可否閾値θｔｈｄは、下記式（１４）で示すように、位置偏差オーバー検出閾値θｔｈより小さく設定するものとする。
　０　＜　θｔｈｄ　＜　θｔｈ　　（１４）
　ステップ１３－８では、異常表示として「位置偏差オーバー検出」を追加して表示し、第１の複数異常表示処理を終了する。
　このように、衝突検出時に、衝突検出とは異なる複数の異常表示をさせることにより、衝突誤検出発生時の状況を把握するために有用な情報を得ることができる。
　例えば、実際に衝突していないのにロボットが異常停止し、その時の異常表示が「衝突検出」の他に「モータロック検出」が表示されているとする。この場合、モータブレーキや減速機の異常が原因でモータが殆ど動作しない現象であると推定できる。また、「衝突検出」の他に「過負荷検出」が表示されていれば、モータベアリングや減速機の異常が原因で摩擦が大きい状態で動作していたと推定できる。また、「衝突検出」の他に「位置偏差オーバー検出」が表示されていれば、モータ位置検出器の異常が発生したと推定できる。
　（実施の形態２）
　本実施の形態２では、図２のステップ２－５の衝突検出発生時異常表示処理として、図１４のフローチャートに示す第２の複数異常表示処理を実行する。
　図１４に示す第２の複数異常表示処理では、複数の異常検出項目には優先順位が設定されている。そして、優先順位が高いものから順に、ロボットの動作時に検出した値（例えば、モータトルクτｍ、モータ速度ωｍ、モータ電流Ｉｍ、モータ位置θｍ）に基づく異常判定値（モータロック検出値ＬＫｄｅｔ、過負荷検出値ＯＬｄｅｔ、位置偏差オーバー検出値θｄｅｔ）が表示可否閾値を超えたか否かを判定する。そして、表示可否閾値を超えた異常検出項目のみ異常表示を行う。そして、異常表示を行った異常検出項目より優先順位が低い異常検出項目については、異常判定値が表示可否閾値を超えたか否かの判定および異常表示を行わない（ステップ１４－３、ステップ１４－５、ステップ１４－７のいずれかへ移行することで処理を終了させる）。
　図１４では、複数の異常検出項目は、優先順位の高い方から順に「モータロック検出」、「過負荷検出」、「位置偏差オーバー検出」としている。
　図１４において、ステップ１４－１では、ロボットの衝突検出が発生したか否かを判定する。ステップ１４－１において、ロボットの衝突検出が発生すると「Ｙ」と判定し、ステップ１４－２へ進む。ステップ１４－１において、ロボットの衝突検出が発生しないと「Ｎ」と判定し、その後は何も実施せず、第２の複数異常表示処理を終了する。
　ステップ１４－２では、一番優先順位の高いモータロック検出について、モータロック検出値ＬＫｄｅｔがモータロック検出表示可否閾値ＬＫｔｈｄを上回っているか否かを判定する。ステップ１４－２において、モータロック検出値ＬＫｄｅｔがモータロック検出表示可否閾値ＬＫｔｈｄを上回っていると「Ｙ」と判定し、ステップ１４－３に進む。ステップ１４－２において、モータロック検出値ＬＫｄｅｔがモータロック検出表示可否閾値ＬＫｔｈｄを上回っていないと「Ｎ」と判定し、ステップ１４－４に進む。
　ステップ１４－３では、「衝突検出」と「モータロック検出」を異常表示し、第２の複数異常表示処理を終了する。
　ステップ１４－４では、次に優先順位の高い過負荷検出について、過負荷検出値ＯＬｄｅｔが過負荷検出表示可否閾値ＯＬｔｈｄを上回っているか否かを判定する。ステップ１４－４において、過負荷検出値ＯＬｄｅｔが過負荷検出表示可否閾値ＯＬｔｈｄを上回っていると「Ｙ」と判定し、ステップ１４－５に進む。ステップ１４－４において、過負荷検出値ＯＬｄｅｔが過負荷検出表示可否閾値ＯＬｔｈｄを上回っていないと「Ｎ」と判定し、ステップ１４－６に進む。
　ステップ１４－５では、「衝突検出」と「過負荷検出」を異常表示し、第２の複数異常表示処理を終了する。
　ステップ１４－６では、一番優先順位が低い位置偏差オーバー検出について、位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出表示可否閾値θｔｈｄを上回っているか否かを判定する。ステップ１４－６において、位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出表示可否閾値θｔｈｄを上回っていると「Ｙ」と判定し、ステップ１４－７に進む。ステップ１４－６において、位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出表示可否閾値θｔｈｄを上回っていないと「Ｎ」と判定し、ステップ１４－８に進む。
　ステップ１４－７では、「衝突検出」と「位置偏差オーバー検出」を異常表示し、第２の複数異常表示処理を終了する。
　ステップ１４－８では、「衝突検出」のみ異常表示し、第２の複数異常表示処理を終了する。
　（実施の形態３）
　本実施の形態３では、図２のステップ２－５の衝突検出発生時異常表示処理として、図１５のフローチャートに示す第３の複数異常表示処理を実行する。
　図１５の第３の複数異常表示処理では、実施の形態１における図１３の第１の複数異常表示処理に対し、設定された各異常検出項目についての衝突検出閾値に基づいて、各異常検出項目についての表示可否閾値を決定する処理を加えている。
　図１５において、ステップ１５－１で、ロボットの衝突検出が発生したか否かを判定する。ステップ１５－１において、ロボットの衝突検出が発生すると「Ｙ」と判定し、ステップ１５－２に進み「衝突検出」の異常表示を行い、さらにステップ１５－Ａへ進む。ステップ１５－１において、ロボットの衝突検出が発生しないと「Ｎ」と判定し、その後は何も実施せず、第３の複数異常表示処理を終了する。
　ステップ１５－Ａは、設定された衝突検出閾値に基づいて各異常検出項目についての表示可否閾値を決定するために加えた処理である。ステップ１５－Ａでは、衝突検出閾値τｔｈに基づいて、下記式（１５－１）～（１５－３）に示すように、モータロック検出表示可否閾値ＬＫｔｈｄと、過負荷検出表示可否閾値ＯＬｔｈｄと、位置偏差オーバー検出表示可否閾値θｔｈｄを算出する。
　ＬＫｔｈｄ　＝　ｋｔｈＡ１×τｔｈ　＋　ｋｔｈＢ１　　（１５－１）
　ＯＬｔｈｄ　＝　ｋｔｈＡ２×τｔｈ　＋　ｋｔｈＢ２　　（１５－２）
　θｔｈｄ　＝　ｋｔｈＡ３×τｔｈ　＋　ｋｔｈＢ３　　（１５－３）
　ただし、ｋｔｈＡ１とｋｔｈＡ２とｋｔｈＡ３とは衝突検出閾値（τｔｈ）比例係数である。また、ｋｔｈＢ１とｋｔｈＢ２とｋｔｈＢ３とは加算係数である。
　上記のように衝突検出閾値τｔｈに基づいて異常検出表示可否閾値を求める理由は、衝突検出閾値τｔｈが大きい（衝突検出感度が低い）時は、衝突誤検出の可能性が低下するからである。衝突誤検出をしなければ、他の異常検出表示はかえって衝突検出発生時の状況判断を複雑にする恐れが有る。すなわち、衝突検出閾値τｔｈが高くなるほど、異常検出表示可否閾値も高くし、複数異常表示をさせないようにする。
　そして、ステップ１５－Ａで算出したモータロック検出表示可否閾値ＬＫｔｈｄと、過負荷検出表示可否閾値ＯＬｔｈｄと、位置偏差オーバー検出表示可否閾値θｔｈｄを、ステップ１５－３、ステップ１５－５、ステップ１５－７の判定に用いる。
　なお、ステップ１５－３以後の処理は、実施の形態１における図１３のステップ１３－３以後の処理と同様である。
　（実施の形態４）
　本実施の形態４では、図２のステップ２－５の衝突検出発生時異常表示処理として、図１６のフローチャートに示す第４の複数異常表示処理を実行する。
　図１６の第４の複数異常表示処理では、実施の形態２における図１４の第２の複数異常表示処理に対し、設定された衝突検出閾値に基づいて各異常検出項目についての表示可否閾値を決定する処理（ステップ１６－Ａ）を加えている。
　なお、ステップ１６－Ａの処理は、実施の形態３における図１５のステップ１５－Ａの処理と同様である。ステップ１６－３以後の処理は、実施の形態２における図１４のステップ１４－３以後の処理と同様である。
　（実施の形態５）
　本実施の形態５では、図２のステップ２－５の衝突検出発生時異常表示処理として、図１７のフローチャートに示す第５の複数異常表示処理を実行する。
　図１７の第５の複数異常表示処理では、各異常検出項目について、異常判定閾値に対するロボットの動作時に検出した値（例えば、モータトルクτｍ、モータ速度ωｍ、モータ電流Ｉｍ、モータ位置θｍ）に基づく異常判定値（モータロック検出値ＬＫｄｅｔ、過負荷検出値ＯＬｄｅｔ、位置偏差オーバー検出値θｄｅｔ）の割合を求める。異常判定値の割合が最も高い異常検出項目のみを衝突検出とともに異常表示を行う処理を有している。
　図１７において、ステップ１７－１で、ロボットの衝突検出が発生したか否かを判定している。ステップ１７－１において、ロボットの衝突検出が発生すると「Ｙ」と判定し、ステップ１７－２へ進む。ステップ１７－１において、ロボットの衝突検出が発生しないと「Ｎ」と判定し、第５の複数異常表示処理を終了する。
　ステップ１７－２では、異常判定閾値に対する異常判定値の割合を計算する。ステップ１７－２では、モータロック検出異常判定値割合ＬＫｒａｔと、過負荷検出異常判定値割合ＯＬｒａｔと、位置偏差オーバー検出異常判定値割合θｒａｔを、下記式（１６－１）～（１６－３）で算出する。
　ＬＫｒａｔ　＝　ＬＫｄｅｔ　÷　ＬＫｔｈ　　（１６－１）
　ＯＬｒａｔ　＝　ＯＬｄｅｔ　÷　ＯＬｔｈ　　（１６－２）
　θｒａｔ　＝　θｄｅｔ　÷　θｔｈ　　（１６－３）
　なお、ＬＫｄｅｔはモータロック検出値であり、ＬＫｔｈはモータロック検出閾値である。また、ＯＬｄｅｔは過負荷検出値であり、ＯＬｔｈは過負荷検出閾値である。また、θｄｅｔは位置偏差オーバー検出値であり、θｔｈは位置偏差オーバー検出閾値である。
　ステップ１７－３では、ステップ１７－２で求めた異常判定値割合の内、モータロック検出異常判定値割合ＬＫｒａｔが最大かどうかを判定する。ステップ１７－３において、モータロック検出異常判定値割合ＬＫｒａｔが最大であると「Ｙ」と判定し、ステップ１７－４へ進む。ステップ１７－３において、モータロック検出異常判定値割合ＬＫｒａｔが最大でないと「Ｎ」と判定し、ステップ１７－５へ進む。
　ステップ１７－４では、「衝突検出」と「モータロック検出」を異常表示し、第５の複数異常表示処理を終了する。
　ステップ１７－５では、ステップ１７－２で求めた異常判定値割合の内、過負荷検出異常判定値割合ＯＬｒａｔが最大かどうかを判定する。ステップ１７－５において、過負荷検出異常判定値割合ＯＬｒａｔが最大であると「Ｙ」と判定し、ステップ１７－６へ進む。ステップ１７－５において、過負荷検出異常判定値割合ＯＬｒａｔが最大でないと「Ｎ」と判定し、ステップ１７－７へ進む。
　ステップ１７－６では、「衝突検出」と「過負荷検出」を異常表示し、第５の複数異常表示処理を終了する。
　ステップ１７－７では、「衝突検出」と「位置偏差オーバー検出」を異常表示し、第５の複数異常表示処理を終了する。
　異常判定値割合が最大の項目のみ表示する理由は、実際の衝突を検出しなければ、異常判定値割合が最大の項目における異常発生の可能性が一番高いからである。
　（実施の形態６）
　本実施の形態６では、図２のステップ２－５の衝突検出発生時異常表示処理として、図１８のフローチャートに示す第６の複数異常表示処理を実行する。
　図１８において、ステップ１８－１で、ロボットの衝突検出が発生したか否かを判定している。ステップ１８－１において、ロボットの衝突検出が発生すると「Ｙ」と判定し、ステップ１８－２に進み「衝突検出」の異常表示を行い、さらにステップ１８－３へ進む。ステップ１８－１において、ロボットの衝突検出が発生しないと「Ｎ」と判定し、その後は何も実施せず、第６の複数異常表示処理を終了する。
　ステップ１８－３では、異常判定閾値に対する異常判定値割合を計算する。なお、モータロック検出異常判定値割合ＬＫｒａｔと、過負荷検出異常判定値割合ＯＬｒａｔと、位置偏差オーバー検出異常判定値割合θｒａｔは、実施の形態５で説明した既出の式（１６－１）～（１６－３）により算出する。その後ステップ１８－４へ進む。
　ステップ１８－４では、異常表示に「モータロック検出割合　ＬＫｒａｔ」、「過負荷検出割合　ＯＬｒａｔ」、「位置偏差オーバー検出割合　θｒａｔ」を追加して表示し、第６の複数異常表示処理を終了する。なお、各異常判定値割合の表示は、実際の計算数字である。
　衝突検出発生時に、他の異常判定値割合を表示することで、衝突を検出しなければ、どの項目の異常発生の可能性がどの程度高いかを知ることができる。
　（実施の形態７）
　本実施の形態７では、図２のステップ２－５の衝突検出発生時異常表示処理として、図１９のフローチャートに示す第７の複数異常表示処理を実行する。
　図１９の第７の複数異常表示処理では、実施の形態１における図１３の第１の複数異常表示処理に対し、各異常検出項目について異常判定閾値に対する異常判定値の割合を求める処理を加えたものである。ロボットの衝突を検出した場合に、衝突検出したことを表示することと併せて各異常検出項目を表示する処理を、異常判定閾値に対する異常判定値の割合を表示する処理に変更している。
　図１９において、ステップ１９－１で、ロボットの衝突検出が発生したか否かを判定している。ステップ１９－１において、ロボットの衝突検出が発生すると「Ｙ」と判定し、ステップ１９－２に進み「衝突検出」の異常表示を行い、さらにステップ１９－Ａへ進む。ステップ１９－１において、ロボットの衝突検出が発生しないと「Ｎ」と判定し、その後は何も実施せず、第６の複数異常表示処理を終了する。
　ステップ１９－Ａでは、異常判定閾値に対する異常判定値割合を計算する。なお、モータロック検出異常判定値割合ＬＫｒａｔと、過負荷検出異常判定値割合ＯＬｒａｔと、位置偏差オーバー検出異常判定値割合θｒａｔは、実施の形態５で説明した既出の式（１６－１）～（１６－３）により算出する。
　ステップ１９－３では、モータロック検出値ＬＫｄｅｔがモータロック検出表示可否閾値ＬＫｔｈｄを上回っているか否かを判定する。ステップ１９－３において、モータロック検出値ＬＫｄｅｔがモータロック検出表示可否閾値ＬＫｔｈｄを上回っていると「Ｙ」と判定し、ステップ１９－４に進む。ステップ１９－３において、モータロック検出値ＬＫｄｅｔがモータロック検出表示可否閾値ＬＫｔｈｄを上回っていないと「Ｎ」と判定し、ステップ１９－５に進む。
　ステップ１９－４では、異常表示に「モータロック検出割合　ＬＫｒａｔ」を追加して表示し、ステップ１９－５へ進む。なお、モータロック検出割合ＬＫｒａｔの表示は、実際の計算数字である。
　ステップ１９－５では、過負荷検出値ＯＬｄｅｔが過負荷検出表示可否閾値ＯＬｔｈｄを上回っているか否かを判定する。ステップ１９－５において、過負荷検出値ＯＬｄｅｔが過負荷検出表示可否閾値ＯＬｔｈｄを上回っていると「Ｙ」と判定し、ステップ１９－６に進む。ステップ１９－５において、過負荷検出値ＯＬｄｅｔが過負荷検出表示可否閾値ＯＬｔｈｄを上回っていないと「Ｎ」と判定し、ステップ１９－７に進む。
　ステップ１９－６では、異常表示に「過負荷検出割合　ＯＬｒａｔ」を追加して表示し、ステップ１９－７へ進む。なお、過負荷検出割合ＯＬｒａｔの表示は、実際の計算数字である。
　ステップ１９－７では、位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出表示可否閾値θｔｈｄを上回っているか否かを判定する。ステップ１９－７において、位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出表示可否閾値θｔｈｄを上回っていると「Ｙ」と判定し、ステップ１９－８に進む。ステップ１９－７において、位置偏差オーバー検出値θｄｅｔが位置偏差オーバー検出表示可否閾値θｔｈｄを上回っていないと「Ｎ」と判定し、第１の複数異常表示処理を終了する。
　ステップ１９－８では、異常表示に「位置偏差オーバー検出割合　θｒａｔ」を追加して表示し、第６の複数異常表示処理を終了する。なお、位置偏差オーバー検出割合θｒａｔの表示は、実際の計算数字である。
　衝突検出発生時に、検出表示可否閾値を越えた異常のみ異常判定値割合を表示することで、衝突を検出しなければ、どの項目の異常発生の可能性がどの程度高いかを絞り込んで表示することができる。
　本発明のロボットの異常表示方法は、ロボットの衝突を検出した場合、異常表示として衝突検出したことを表示するとともに、衝突検出とは異なる複数の異常検出項目のうち少なくとも１つ以上の異常表示を選択して行う処理を備えているので、衝突誤検出発生時の状況を把握するのに有用な情報を得ることができ、産業上有用である。
　１　位置指令の速度成分　ｄθｃｏｍ
　２　モータ速度　ωｍ
　３　位置指令　θｃｏｍ
　４　モータ位置　θｍ
　５　位置比例ゲイン　ＫＰＰ
　６　位置制御ブロック
　７　速度ループ指令　ωｃｏｍ
　８　速度比例ゲイン　ＫＰ
　９　速度積分ゲイン　ＫＩ／ｓ
　１０　速度制御ブロック
　１１　モータ電流　Ｉｍ
　１２　モータトルク定数　Ｋｔ
　１３　モータ発生トルク　τｍ
　１４　動力学トルク（重力トルク、慣性力、遠心力、コリオリ力の和）　τｄｙｎ
　１５　動摩擦トルク　τμ
　１６　衝突トルク　τｄｉｓ
　１７　モータ伝達関数ブロック
　１８　モータ及び外力を示すブロック
　１９　モータトルク定数　Ｋｔ
　２０　粘性摩擦係数　Ｄ
　２１　モータ回転方向判定ブロック
　２２　モータ方向信号　ｓｇｎ
　２３　動摩擦係数　Ｋμ
　２４　動摩擦トルク推定値　τμｏ
　２５　他軸モータ位置
　２６　動力学トルク演算ブロック
　２７　他軸動力学トルク推定値
　２８　衝突トルク推定値　τｄｉｓｏ
　２９　動力学トルク推定値　τｄｙｎｏ
　３０　衝突トルク推定ブロック
　３１　衝突判定ブロック
　３２　微分要素
　４０　積分要素
　８６　モータ位置の誤差　ｅθｍ
　８７　モータ速度の誤差　ｅωｍ
　８８　モータ加速度の誤差　ｅαｍ
　８９　モータイナーシャ　Ｊｍ
　９０　モータ加速度　αｍ
　９１　モータトルク閾値　τｍｔｈ
　９２　モータ速度閾値　ωｍｔｈ
　９３　モータロック検出時間閾値　ＬＫｔｈ
　９５　モータ速度に到達するまでの正常な所用時間　ＬＫ０
　９９　モータ位置検出器

Claims (9)

  1. 　ロボットの動作時に検出した値に基づいて少なくとも衝突検出を含む複数の異常を検出し、異常が発生したことを表示するロボットの異常表示方法であって、
    　前記ロボットの衝突を検出する衝突検出工程と、
    　異常表示として衝突検出したことを表示する衝突検出表示工程と、
    　前記衝突検出とは異なる複数の異常検出項目のうち少なくとも１つについても異常表示として異常が発生したことを表示する異常表示工程と、を備えたロボットの異常表示方法。
  2. 　前記異常表示工程において、前記複数の異常検出項目の異常表示を選択して行う請求項１記載のロボットの異常表示方法。
  3. 　前記複数の異常検出項目の各々には、異常と判定するための異常判定閾値と、前記異常判定閾値より小さくロボットの衝突を検出した場合に衝突検出したことを表示することと併せて異常が発生したことを表示するための表示可否閾値とが設定されており、
    　前記複数の異常検出項目のうち、ロボットの動作時に検出した値に基づく異常判定値が前記表示可否閾値を超えたものは異常表示として異常が発生したことを表示する請求項２記載のロボットの異常表示方法。
  4. 　前記複数の異常検出項目の各々には、異常と判定するための異常判定閾値と、前記異常判定閾値より小さくロボットの衝突を検出した場合に衝突検出したことを表示することと併せて異常が発生したことを表示するための表示可否閾値とが設定されており、
    　前記複数の異常検出項目には優先順位が設定されており、
    　前記優先順位が高いものから順にロボットの動作時に検出した値に基づく前記異常判定値が前記表示可否閾値を超えたか否かを判定し、
    　前記表示可否閾値を超えた異常検出項目のみ異常表示を行い、
    　前記異常表示を行った異常検出項目より前記優先順位が低い異常検出項目については、前記異常判定値が前記表示可否閾値を超えたか否かの判定および異常表示を行わない請求項２記載のロボットの異常表示方法。
  5. 　設定された衝突検出閾値に基づいて各異常検出項目についての前記表示可否閾値を決定する請求項３または４記載のロボットの異常表示方法。
  6. 　前記複数の異常検出項目のそれぞれについて、異常判定閾値に対するロボットの動作時に検出した値に基づく異常判定値の割合を求め、
    　前記異常判定値の割合が最も高い異常検出項目のみ衝突検出とともに異常表示を行う請求項２記載のロボットの異常表示方法。
  7. 　前記複数の異常検出項目の各々には、異常と判定するための異常判定閾値が設定されており、
    　前記複数の異常検出項目のそれぞれについて、異常判定閾値に対するロボットの動作時に検出した値に基づく異常判定値の割合を求め、
    　ロボットの衝突を検出した場合に衝突検出したことを表示することと併せて、前記複数の異常検出項目のそれぞれについて、前記異常判定値の割合を表示する請求項１記載のロボットの異常表示方法。
  8. 　前記複数の異常検出項目の各々には、異常と判定するための異常判定閾値が設定されており、
    　前記複数の異常検出項目のそれぞれについて、異常判定閾値に対するロボットの動作時に検出した値に基づく異常判定値の割合を求め、
    　ロボットの衝突を検出した場合に衝突検出したことを表示することと併せて、前記異常判定値が表示可否閾値を超えたもののみ各異常検出項目の前記異常判定値の割合を表示する請求項１記載のロボットの異常表示方法。
  9. 　前記複数の異常検出項目として、ロボットを駆動するモータのロック検出と前記モータの過負荷検出と前記ロボットの位置偏差検出との少なくとも１つを含む請求項１から８のいずれか１項に記載のロボットの異常表示方法。
PCT/JP2013/006250 2012-10-25 2013-10-23 ロボットの異常表示方法 Ceased WO2014064926A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2014543148A JP5927440B2 (ja) 2012-10-25 2013-10-23 ロボットの異常表示方法
EP13849941.3A EP2913163B1 (en) 2012-10-25 2013-10-23 Robot malfunction indication method
CN201380047719.4A CN104718055B (zh) 2012-10-25 2013-10-23 机器人的异常显示方法
US14/583,297 US9701022B2 (en) 2012-10-25 2014-12-26 Robot malfunction indication method

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2012235308 2012-10-25
JP2012-235308 2012-10-25

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US14/583,297 Continuation US9701022B2 (en) 2012-10-25 2014-12-26 Robot malfunction indication method

Publications (1)

Publication Number Publication Date
WO2014064926A1 true WO2014064926A1 (ja) 2014-05-01

Family

ID=50544311

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2013/006250 Ceased WO2014064926A1 (ja) 2012-10-25 2013-10-23 ロボットの異常表示方法

Country Status (5)

Country Link
US (1) US9701022B2 (ja)
EP (1) EP2913163B1 (ja)
JP (1) JP5927440B2 (ja)
CN (1) CN104718055B (ja)
WO (1) WO2014064926A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016059970A (ja) * 2014-09-16 2016-04-25 株式会社デンソーウェーブ 摺動部材の劣化判定システム
CN107107349A (zh) * 2014-12-26 2017-08-29 川崎重工业株式会社 机械臂系统
JPWO2017047009A1 (ja) * 2015-09-16 2018-06-28 パナソニックＩｐマネジメント株式会社 ロボットの衝突検出方法

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2952300A1 (en) * 2014-06-05 2015-12-09 Aldebaran Robotics Collision detection
JP6591818B2 (ja) * 2015-07-30 2019-10-16 ファナック株式会社 産業用ロボットシステムおよびその制御方法
JP6584662B2 (ja) * 2016-06-07 2019-10-02 三菱電機株式会社 異常診断装置及び異常診断方法
JP6526097B2 (ja) * 2017-04-21 2019-06-05 ファナック株式会社 ロボットシステム
WO2019104189A1 (en) * 2017-11-27 2019-05-31 Intuition Robotics, Ltd System and method for optimizing resource usage of a robot
CN108015774B (zh) * 2017-12-15 2020-10-13 北京艾利特科技有限公司 一种无需传感器的机械臂碰撞检测方法
JP6846717B2 (ja) * 2018-02-14 2021-03-24 ファナック株式会社 ロボットのジョイントの異常検出装置及び異常検出方法
JP6703021B2 (ja) * 2018-02-20 2020-06-03 ファナック株式会社 サーボ制御装置
CN112105489B (zh) * 2018-05-11 2023-06-20 日产自动车株式会社 异常检测装置和异常检测方法
EP3795310A4 (en) 2018-05-16 2021-07-14 Panasonic Intellectual Property Management Co., Ltd. ROBOT DEVICE
CN109079856A (zh) * 2018-10-30 2018-12-25 珠海格力智能装备有限公司 机器人的碰撞检测方法和装置
CN109732644A (zh) * 2019-01-14 2019-05-10 深圳市大象机器人科技有限公司 一种基于动量模型的机器人在线碰撞检测方法和系统
JP7328439B2 (ja) * 2020-03-10 2023-08-16 ファナック株式会社 ロボット制御装置
CN111645070B (zh) * 2020-05-19 2022-06-14 华为技术有限公司 机器人的安全防护方法、装置与机器人
CN112799325B (zh) * 2020-12-31 2022-09-06 泉芯集成电路制造(济南)有限公司 一种机械臂运动监控方法、装置及相关设备

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3367641B2 (ja) 1998-07-31 2003-01-14 株式会社安川電機 ロボットの制御装置
JP2011000699A (ja) * 2009-06-16 2011-01-06 Kazunari Kuroki ロボット用ドライブレコーダ装置
JP2012139772A (ja) * 2010-12-28 2012-07-26 Yaskawa Electric Corp ロボットシステム及びロボットの異常検出方法

Family Cites Families (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63245389A (ja) * 1987-03-31 1988-10-12 株式会社東芝 ロボツトの制御方法
JP2608161B2 (ja) * 1990-03-29 1997-05-07 ファナック株式会社 産業用ロボットの停止制御方法
JPH0498402A (ja) * 1990-08-10 1992-03-31 Tokico Ltd 工業用ロボット
JPH07104835A (ja) * 1993-10-07 1995-04-21 Hitachi Ltd 移動式点検ロボットシステムの制御，解析，操作装置
JPH08229864A (ja) 1995-03-01 1996-09-10 Daikin Ind Ltd 産業用ロボットの衝突検知方法およびその装置
JPH10315173A (ja) * 1997-05-13 1998-12-02 Sankyo Seiki Mfg Co Ltd ロボットの異常検出装置
US6129099A (en) * 1997-09-17 2000-10-10 Foster; James B. Pallet washing apparatus and method
JPH11165291A (ja) * 1997-12-02 1999-06-22 Yaskawa Electric Corp 安全監視装置および方法
JP2001333594A (ja) 2000-05-22 2001-11-30 Sony Corp アクチュエータの負荷検出システム、及び、脚式移動ロボット
JP3717801B2 (ja) * 2001-05-07 2005-11-16 オリンパス株式会社 制御システム
JP2006263916A (ja) * 2001-05-08 2006-10-05 Mitsubishi Electric Corp ロボット制御装置
DE10245594A1 (de) * 2002-09-30 2004-04-08 Dürr Systems GmbH Verfahren zur Kollisionserkennung
JP4223911B2 (ja) 2003-09-25 2009-02-12 株式会社神戸製鋼所 衝突検知方法及び衝突検知装置
JP4305323B2 (ja) * 2004-08-11 2009-07-29 ソニー株式会社 ロボット装置の動作制御装置及び動作制御方法
JP3933158B2 (ja) * 2004-10-21 2007-06-20 松下電器産業株式会社 ロボットの衝突検出方法
JP2007286904A (ja) * 2006-04-17 2007-11-01 Fanuc Ltd 電動機の制御装置及び制御方法
US8712571B2 (en) * 2009-08-07 2014-04-29 Taiwan Semiconductor Manufacturing Company, Ltd. Method and apparatus for wireless transmission of diagnostic information
DE102010007458A1 (de) 2010-02-10 2011-08-11 KUKA Laboratories GmbH, 86165 Verfahren für eine kollisionsfreie Bahnplanung eines Industrieroboters
JP5471636B2 (ja) * 2010-03-12 2014-04-16 株式会社デンソーウェーブ ロボットシステム
JP4955791B2 (ja) * 2010-04-20 2012-06-20 ファナック株式会社 ロボットシステム
EP2572838A1 (en) 2010-08-31 2013-03-27 Kabushiki Kaisha Yaskawa Denki Robot, robot system, robot control device, and state determining method
CN102323822B (zh) * 2011-05-09 2013-07-03 无锡引域智能机器人有限公司 一种避免工业机器人碰撞工人的方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3367641B2 (ja) 1998-07-31 2003-01-14 株式会社安川電機 ロボットの制御装置
JP2011000699A (ja) * 2009-06-16 2011-01-06 Kazunari Kuroki ロボット用ドライブレコーダ装置
JP2012139772A (ja) * 2010-12-28 2012-07-26 Yaskawa Electric Corp ロボットシステム及びロボットの異常検出方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
KOSUGA KAZUHIRO ET AL.: "Lecture theses of Robotics and Mechatronics Lecture Meeting in 1999 2A1-11-030", 1999, THE JAPAN SOCIETY OF MECHANICAL ENGINEERS, article "Dynamic Collision Detection of Manipulator"
See also references of EP2913163A4

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016059970A (ja) * 2014-09-16 2016-04-25 株式会社デンソーウェーブ 摺動部材の劣化判定システム
CN107107349A (zh) * 2014-12-26 2017-08-29 川崎重工业株式会社 机械臂系统
EP3238893A4 (en) * 2014-12-26 2018-09-26 Kawasaki Jukogyo Kabushiki Kaisha Robot system
CN107107349B (zh) * 2014-12-26 2019-11-22 川崎重工业株式会社 机械臂系统
JPWO2017047009A1 (ja) * 2015-09-16 2018-06-28 パナソニックＩｐマネジメント株式会社 ロボットの衝突検出方法

Also Published As

Publication number Publication date
US20150112480A1 (en) 2015-04-23
EP2913163A4 (en) 2016-10-19
EP2913163B1 (en) 2019-10-09
JP5927440B2 (ja) 2016-06-01
US9701022B2 (en) 2017-07-11
JPWO2014064926A1 (ja) 2016-09-08
CN104718055B (zh) 2016-06-29
EP2913163A1 (en) 2015-09-02
CN104718055A (zh) 2015-06-17

Similar Documents

Publication Publication Date Title
JP5927440B2 (ja) ロボットの異常表示方法
US10690558B2 (en) Robot collision detection method
JP6374439B2 (ja) パラレルリンクロボットの関節部の異常検出装置及び異常検出方法
US8442685B2 (en) Robot control apparatus
JP4335286B2 (ja) 部品保護機能を備えたロボット制御装置及びロボット制御方法
CN109219738B (zh) 异常诊断装置及异常诊断方法
JP6324641B1 (ja) 異常診断装置及び異常診断方法
CN102150023B (zh) 用于检测机器人制动器的方法
JP2013169609A (ja) ロボットの衝突検出方法
JP7275008B2 (ja) 診断装置、モータ駆動装置および診断方法
US9952249B2 (en) Inertia estimating method and inertia estimation apparatus of position control apparatus
JP7176255B2 (ja) 電動機制御装置及び衝突検出方法
JP3933158B2 (ja) ロボットの衝突検出方法
US20190260313A1 (en) Motor control device
JP5471636B2 (ja) ロボットシステム
JPH11282540A (ja) ロボットの制御装置とその制御方法
JP6763286B2 (ja) モータ制御システム
JP5633623B2 (ja) ロボットシステム
JP4223911B2 (ja) 衝突検知方法及び衝突検知装置
WO2024224966A1 (ja) ロボット制御方法
JP2001353687A (ja) ロボットの制御装置とその制御方法
JP5849455B2 (ja) ロボット
TW202219674A (zh) 檢測傳達電動機輸出之旋轉力的動力傳達機構之異常的異常檢測裝置

Legal Events

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

Ref document number: 13849941

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2014543148

Country of ref document: JP

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 2013849941

Country of ref document: EP

NENP Non-entry into the national phase

Ref country code: DE