IP Library Granted Patent US 11,724,391
Granted Patent B2
US 11,724,391 · App. 17/349,286 · Granted Aug 15, 2023

Method and apparatus for determining status of a robot

Inventors: Nam In Kim (Gyeonggi-do, KR); Jin Sung Park (Gyeonggi-do, KR); Keun Young Song (Gyeonggi-do, KR); In Cheol Kim (Seoul, KR); Byoung Guk Seo (Chungcheongnam-do, KR); Il Sung Kim (Gyeonggi-do, KR); Soung Sun Park (Gyeonggi-do, KR); Ei Sam Jeong (Gyeonggi-do, KR)
Assignee: SK ENPULSE CO., LTD.
B25J9/1653B25J9/163B25J13/088H02P21/50H02P23/14
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 11,724,391
App. No.
17/349,286
Granted
Aug 15, 2023
Kind
B2
Abstract

A method for determining the status of a robot according to an embodiment includes acquiring first data and second data related to an operation of the robot, acquiring a resonance frequency by analyzing the operation of the robot in a frequency region based on the first data related to the operation of the robot, acquiring a first comparison result by comparing the acquired resonance frequency with a reference resonance frequency, when the first comparison result is a threshold value or more, generating a Lissajous figure by DQ transforming a three-phase signal based on the second data related to the operation of the robot, acquiring a second comparison result by comparing the generated Lissajous figure with a reference Lissajous figure, and determining the status of the robot based on at least one of the first comparison result and the second comparison result.

Claims (26)

1. A method for determining the status of a robot, the method comprising:

acquiring first data and second data related to an operation of the robot;

acquiring a resonance frequency by analyzing the operation of the robot in a frequency region based on the first data related to the operation of the robot;

acquiring a first comparison result by comparing the acquired resonance frequency with a reference resonance frequency;

when the first comparison result is a threshold value or more, generating a Lissajous figure by DQ transforming a three-phase signal based on the second data related to the operation of the robot;

acquiring a second comparison result by comparing the generated Lissajous figure with a reference Lissajous figure; and

determining the status of the robot based on at least one of the first comparison result and the second comparison result.

2. The method according to claim 1 , wherein the first data related to the operation of the robot comprises data on a torque of a motor, a velocity and a position of a driving unit related to the operation of the robot.

3. The method according to claim 2 , wherein the acquiring of the resonance frequency comprises performing fast Fourier transform (FFT) on a torque change of the motor related to the operation of the robot on the basis of data on the torque of the motor related to the operation of the robot to acquire at least one resonance frequency component for the operation of the robot.

4. The method according to claim 3 , wherein the acquiring of the resonance frequency comprises determining a section to perform the FFT with respect to the torque change of the motor related to the operation of the robot on the basis of data on the velocity and position of the driving unit related to the operation of the robot.

5. The method according to claim 2 , wherein the determining of the status of the robot comprises determining the status of the robot in an operation process of the robot on the basis of data on the velocity and position of the driving unit related to the operation of the robot.

6. The method according to claim 1 , wherein the second data related to the operation of the robot comprises data on a three-phase current or voltage input to the motor related to the operation of the robot.

7. The method according to claim 6 , wherein the DQ transforming of the three-phase signal comprises:

DQ transforming the three-phase current or voltage input to the motor related to the operation of the robot to acquire a d-axis component and a q-axis component; and

generating the Lissajous figure based on the acquired d-axis component and the q-axis component.

8. The method according to claim 1 , further comprising updating the reference resonance frequency through iterative learning for the operation of the robot.

9. A apparatus for determining the status of a robot, the apparatus comprising:

a data acquisition unit configured to acquire first data and second data related to an operation of the robot; and

a status determination unit configured to acquire a resonance frequency by analyzing the operation of the robot in a frequency region based on the first data related to the operation of the robot, acquire a first comparison result by comparing the acquired resonance frequency with a reference resonance frequency, when the first comparison result is a threshold value or more, generate a Lissajous figure by DQ transforming a three-phase signal based on the second data related to the operation of the robot, acquire a second comparison result by comparing the generated Lissajous figure with a reference Lissajous figure, and determine the status of the robot based on at least one of the first comparison result and the second comparison result.

10. The apparatus according to claim 9 , wherein the first data related to the operation of the robot comprises data on a torque of a motor, a velocity and a position of a driving unit related to the operation of the robot.

11. The apparatus according to claim 10 , wherein the status determination unit performs fast Fourier transform (FFT) on a torque change of the motor related to the operation of the robot on the basis of data on the torque of the motor related to the operation of the robot to acquire at least one resonance frequency component for the operation of the robot.

12. The apparatus according to claim 11 , wherein the status determination unit determines a section to perform the FFT with respect to the torque change of the motor related to the operation of the robot on the basis of data on the velocity and position of the driving unit related to the operation of the robot.

13. The apparatus according to claim 10 , wherein the status determination unit determines the status of the robot in an operation process of the robot on the basis of data on the velocity and position of the driving unit related to the operation of the robot.

14. The apparatus according to claim 9 , wherein the second data related to the operation of the robot comprises data on a three-phase current or voltage input to the motor related to the operation of the robot.

15. The apparatus according to claim 14 , wherein the status determination unit DQ transforms the three-phase current or voltage input to the motor related to the operation of the robot to acquire a d-axis component and a q-axis component, and generate a Lissajous figure based on the acquired d-axis component and the q-axis component.

16. The apparatus according to claim 9 , wherein the data acquisition unit updates the reference resonance frequency through iterative learning for the operation of the robot.

Assignments (3)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Nov 6, 2025
From: SK ENPULSE CO., LTD.
To: ISC CO., LTD.
Reel/Frame 072805/0006 →
CHANGE OF NAME Recorded Mar 6, 2023
From: SKC SOLMICS CO., LTD
To: SK ENPULSE CO., LTD .
Reel/Frame 063274/0727 →
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Jun 16, 2021
From: KIM, NAM IN; PARK, JIN SUNG; SONG, KEUN YOUNG; KIM, IN CHEOL; SEO, BYOUNG GUK; KIM, IL SUNG; PARK, SOUNG SUN; JEONG, EI SAM
To: SKC SOLMICS CO., LTD
Reel/Frame 056602/0813 →
Priority Claims (1)
KR 10-2020-0072793 · Jun 16, 2020 · national
Continuity (1)
Related Publication 20210387339A1 · Dec 16, 2021