Encoder abnormality detection method
AssigneePanasonic Intellectual Property Management Co., Ltd.
InventorYasuhiro Kinugasa
Life of this patent
Estimating the term…
Abstract
In a robot including a motor and an encoder for detecting the rotational position of the motor, the controller outputs a speed command indicating the rotational position of the motor and sends commanded-position information indicating the rotational position of the motor according to the speed command to a safety unit for detecting a fault in the encoder. When the controller is holding modified point-of-origin information of the motor and the safety unit is holding the original point-of-origin information, the controller sends commanded-position information generated based on the original point-of-origin information to the safety unit.
Claims7
A method for detecting a fault in an encoder, the encoder being configured to detect a rotational position of a motor, the motor being configured to drive an output shaft of an operating device, the operating device including:
- a fault detection unit configured to detect the fault in the encoder;
- a controller configured
- to output a speed command indicating the rotational position of the motor and
- to send to the fault detection unit commanded-position information indicating the rotational position of the motor according to the speed command;
- and
- a driver configured
- to receive the speed command from the controller and an output signal from the encoder and
- to control driving of the motor based on the speed command and the output signal,
- the method comprising:
- an information transmission step of causing the controller to send to the fault detection unit the commanded-position information, the commanded-position information being compensated for a time delay due to a delay in drive control of the motor;
- an information acquisition step of causing the fault detection unit to receive the commanded-position information from the controller and the output signal from the encoder;
- and
- a fault determination step of causing the fault detection unit
- to compare the commanded-position information compensated for the time delay and detected-position information of the motor calculated based on the output signal and
- to determine that the encoder is faulty when there is a difference of not less than a predetermined value between the commanded-position information compensated for the time delay and the output signal,
- wherein in the fault determination step, a presence or absence of the fault in the encoder determined by the fault detection unit is based on a comparison result between the detected-position information and a sum of the commanded-position information and an integrated value of an amount of change of the commanded-position information.
A method for detecting a fault in an encoder, the encoder being configured to detect a rotational position of a motor, the motor being configured to drive an output shaft of an operating device, the operating device including:
- a fault detection unit configured to detect the fault in the encoder;
- a controller configured
- to output a speed command indicating the rotational position of the motor and
- to send to the fault detection unit commanded-position information indicating the rotational position of the motor according to the speed command;
- and
- a driver configured
- to receive the speed command from the controller and an output signal from the encoder and
- to control driving of the motor based on the speed command and the output signal,
- the method comprising:
- an information transmission step of causing the controller to send to the fault detection unit the commanded-position information, the commanded-position information being compensated for a time delay due to a delay in drive control of the motor;
- an information acquisition step of causing the fault detection unit to receive the commanded-position information from the controller and the output signal from the encoder;
- and
- a fault determination step of causing the fault detection unit
- to compare the commanded-position information compensated for the time delay and detected-position information of the motor calculated based on the output signal and
- to determine that the encoder is faulty when there is a difference of not less than a predetermined value between the commanded-position information compensated for the time delay and the output signal, wherein
- the operating device further includes a safety circuit configured to emergency-stop the operating device,
- the controller is configured to send the safety circuit an emergency stop signal in case of an emergency, and
- in the fault determination step, when detecting the emergency stop signal sent from the controller, the fault detection unit does not determine that the encoder is faulty even if the difference between the commanded-position information and the output signal is not less than the predetermined value.
Dependencies are inferred from the claim text.