Back to results
US 11,660,754 B2Granted
Detection system and detection method for sensors of robot
AssigneeTechman Robot Inc.
InventorsChun-Wen Lai, I-Bing Su
Life of this patent
Estimating the term…
Abstract
A detection system and detection method for the sensors of a robot. A detection system installs three sensors at the motor side and power output terminal of the robot. A detection unit detects the normal or abnormal state of three sensors to index the abnormal sensor for maintenance, and two normal sensors are selected for keeping the robot safety operation without stop.
Claims14
A detection method of robotic sensors comprising:
- initializing a detection operation;
- reading three sets of detection signals generated by a first set of sensors and a third set of sensors at a motor side of a motor, and a second set of sensors at a power output terminal;
- converting the three sets of detection signals into a first angle, a second angle and a third angle of the motor in rotation;
- arranging the first angle, the second angle and the third angle in a descending order, with large angle a>medium angle b>small angle c;
- computing an angle difference D1=a−b and an angle difference D2=b−c;
- if a difference between the angle differences is less than a first predetermined standard deviation C1, that is, (D1−D2)<C1, determining that the first set of sensors, the second set of sensors and the third set of sensors are all normal;
- if the difference between the angle differences is not less than the first predetermined standard deviation C1, determining at least one member of a group comprising the first set of sensors, the second set of sensors and the third set of sensors is abnormal;
- when the abnormal set of sensors is not in use, continuing to operate the robot normally;
- and upon detecting two or more sets of sensors being abnormal, turning off a power of the robot, and shutting down operations of the robot.
6 more elements
Dependencies are inferred from the claim text.