A failure diagnosis device applicable to a mechanical device provided with motors independent of One another as sources to drive motion axes, respectively, and configured to acquire a moving position of each motion axis and a disturbance torque value applied to the motion axis every predetermined period, and to diagnose a failure of the mechanical device, includes a failure diagnosis unit configured to diagnose the motion axis as a failure when the disturbance torque value is larger than a predetermined failure determination threshold, and a re-determination unit configured to conduct re-determination of the failure on the motion axis, which is diagnosed as the failure by the failure diagnosis unit, based on a previous maintenance record and a previous inspection result.

A failure diagnosis device applicable to a mechanical device provided with a motor as a source to drive a motion axis, and configured to acquire a moving position of the motion axis and a disturbance torque value applied to the motion axis every predetermined period, and to diagnose that a failure is occurring when the disturbance torque value is larger than a failure determination threshold, includes a disturbance torque selector configured to calculate a change from a reference value of each of the acquired disturbance torque values, and to accumulate the disturbance torque values except each disturbance torque value having the change from the reference value equal to or larger than a predetermined threshold, and a failure diagnosis unit configured to diagnose a failure of the mechanical device by using the disturbance torque values accumulated by the disturbance torque selector.

A control system according to an embodiment includes a motor configured to drive a link, a first sensor configured to detect information about the driving by the motor or information about a relation between the driving means and the load member as first sensor information, a second sensor configured to detect information about a displacement of the link as second sensor information, and a control unit configured to perform feedback control of the driving means so as to follow a command value in a two-inertial system model including an inertial system on a load side and an inertial system on a driving side. The control unit includes a disturbance observer configured to estimate a disturbance, and a filter configured to convert an estimated value of the disturbance into a driving force of the motor.

A failure diagnostic device for performing a failure diagnosis on a multi-axis robot includes a position detector that detects a movement position of each of joint shafts included in the multi-axis robot, a torque detector that detects a disturbance torque applied to the joint shaft, a routine-operation determination circuit that determines whether or not the multi-axis robot is executing a predefined routine operation, from the movement position detected by the position detector, a reference-value calculation circuit that calculates a disturbance-torque reference value from the disturbance torque detected during execution of the routine operation, a torque correction circuit that corrects the disturbance torque detected while the multi-axis robot executes an operation different from the routine operation by using the disturbance-torque reference value, calculated by the reference-value calculation circuit, to thereby acquire a corrected disturbance torque, and a failure diagnostic circuit that performs a failure diagnosis.

According to one embodiment, a robot control device is used for a robot arm including a link and a motor for rotationally driving the link. The robot control device includes a derivation part. The derivation part derives a first estimated value including a variation of a rotation angle of the link and a second estimated value including a variation of a rotation angle of the motor, based on an angular velocity and a current reference value of the motor. Furthermore, the derivation part derives an external force generated to the robot arm, based on a difference between the first estimated value and the second estimated value.

Provided is a robot including: a robot body that is provided with at least one arm; a gas spring that functions as a balancer for the arm of the robot body; an internal-pressure detecting unit that detects a cylinder internal pressure of the gas spring; and a control device that controls the robot body. The control device calculates, as an estimated disturbance value, the difference between a torque command value for a servomotor that drives the arm and a torque of the servomotor that is required to actually operate the arm, determines that the robot body has had a collision when the estimated disturbance value exceeds a predetermined threshold, and corrects the estimated disturbance value or the threshold on the basis of the cylinder internal pressure detected by the internal-pressure detecting unit.

The invention provides a control device comprising: an actual value obtaining part, obtaining a torque actual value and a velocity actual value, wherein the torque actual value represents a torque generated by the driving source and the velocity actual value represents a velocity of the motion body; an inferring part, which calculates an external force inferred value and a velocity inferred value every other operation period based on the torque actual value by using an operation formula of a predetermined model representing driving of the motion body, wherein the external force inferring value represents an external force generated by the control system; and an output part, evaluating a reliability of the external force inferred value based on the velocity inferred value calculated together if the inferring part calculates the external inferred value, and effectively outputting the external force inferred value when it is judged that there is a designated reliability.

A failure diagnosis device for a mechanical device provided with a motor as a source to drive a motion axis, and configured to acquire a moving position of the motion axis and a disturbance torque value applied to the motion axis every predetermined period, and to diagnose that a failure is occurring when the disturbance torque value is larger than a failure determination threshold, includes a maintenance effect determination unit configured to calculate a change in the disturbance torque value before and after conducting of a maintenance task when the maintenance task is conducted on the motion axis, and a failure diagnosis unit configured to re-set the failure determination threshold only when the change in the disturbance torque value is larger than a predetermined threshold.

A method for controlling a manipulator includes determining by a control device one or more contact force values between the manipulator and a first workpiece. Each of the contact force values is based on an actual driving force of the manipulator and a drive force according to a dynamic model of the manipulator. The method also includes at least one of a) measuring in multiple stages an orientation and location of the first workpiece based on at least one of the one or more determined contact force values or b) joining a second workpiece and the first workpiece under a compliant regulation, where a joining state of the first and second workpieces is monitored based on at least one of an end pose of the manipulator obtained under the compliant regulation, a speed of a temporal change of the manipulator, or at least one of the one or more determined contact force values.

A failure diagnostic device for performing a failure diagnosis on a multi-axis robot includes a position detector that detects a movement position of each of joint shafts included in the multi-axis robot, a torque detector that detects a disturbance torque applied to the joint shaft, a routine-operation determination circuit that determines whether or not the multi-axis robot is executing a predefined routine operation, from the movement position detected by the position detector, a reference-value calculation circuit that calculates a disturbance-torque reference value from the disturbance torque detected during execution of the routine operation, a torque correction circuit that corrects the disturbance torque detected while the multi-axis robot executes an operation different from the routine operation by using the disturbance-torque reference value, calculated by the reference-value calculation circuit, to thereby acquire a corrected disturbance torque, and a failure diagnostic circuit that performs a failure diagnosis.