IP Library › Granted Patent US 11,951,624
Granted Patent B2
US 11,951,624 · App. 17/329,297 · Granted Apr 9, 2024

Robotic arm system, control method thereof and computer program product thereof

Inventors: Chien-Yu Wu (Kouhu Township, TW); Shang-Kun Li (Taichung, TW); Shu Huang (Zhudong Township, TW)
Assignee: INDUSTRIAL TECHNOLOGY RESEARCH INSTITUTE
B25J9/1633B25J9/023B25J9/1682B25J13/082
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,951,624
App. No.
17/329,297
Granted
Apr 9, 2024
Kind
B2
Abstract

A robotic arm system includes first robotic arm, second robotic arm and main controller. The first robotic arm and the second robotic arm are configured to grab object. The main controller is configured to: determine whether first force vector of first force applied by the first robotic arm to the object is equal to second force vector of second force applied by the second robotic arm to the object; when the first force vector and the second force vector are not equal, obtain a first difference between the first force vector and the second force vector; and according to the first difference, change at least one of the first force applied by the first robotic arm to the object and the second force applied by the second robotic arm to the object so that the first force vector and the second force vector are equal.

Claims (49)

1. A robotic arm system, comprising:

a first robotic arm configured to grab an object;

a second robotic arm configured to grab the object; and

a main controller configured to:

determine whether a first force vector of a first force applied by the first robotic arm to the object is equal to a second force vector of a second force applied by the second robotic arm to the object;

when a first magnitude of the first force vector and a second magnitude of the second force vector are not equal, obtain a first difference between the first magnitude and the second magnitude; and

according to the first difference, change at least one of the first force applied by the first robotic arm to the object and the second force applied by the second robotic arm to the object so that the first magnitude and the second magnitude are equal;

wherein the main controller is configured to:

determine whether a first direction of the first force vector and a second direction of the second force vector are in opposite directions respectively, an angle difference between the first direction and the second direction is 180 degrees, and the first direction is not collinear with the second direction;

obtain the first difference between the first magnitude and the second magnitude; and

when the first direction and the second direction are in opposite directions respectively, control the first robotic arm or the second robotic arm so that a second difference between a larger one of the first magnitude and the second magnitude and the first difference is equal to a smaller one of the first magnitude and the second magnitude.

2. The robotic arm system according to claim 1 , further comprises:

a force sensor disposed on the first robotic arm and configured to sense the first force.

3. The robotic arm system according to claim 1 , further comprises:

a driver connected to the first robotic arm and configured to drive the first robotic arm to move; and

a first arm controller electrically connected to the driver and configured to:

obtain the first force according to feedback signal of the driver.

4. The robotic arm system according to claim 1 , wherein the main controller is configured to:

map the first force vector and the second force vector to a common coordinate system; and

in the common coordinate system, determine whether the first force vector and the second force vector are equal.

5. The robotic arm system according to claim 1 , the main controller is configured to:

determine whether the first direction of the first force vector and the second direction of the second force vector are in opposite directions respectively;

obtain the first difference between the first magnitude and the second magnitude; and

when the first direction of the first force vector and the second direction of the second force vector are in opposite direction, control the first robotic arm or the second robotic arm so that the sum of the first difference and a smaller one of the first magnitude and the second magnitude is equal to a larger one of the first magnitude and the second magnitude.

6. A control method for a robotic arm system, comprising:

determining whether a first force vector of a first force applied by a first robotic arm to an object is equal to a second force vector of a second force applied by a second robotic arm to the object;

when a first magnitude of the first force vector and a second magnitude of the second force vector are not equal, obtaining a first difference between the first magnitude and the second magnitude; and

according to the first difference, changing at least one of the first force applied by the first robotic arm to the object and the second force applied by the second robotic arm to the object so that the first magnitude and the second magnitude are equal;

determining whether a first direction of the first force vector and a second direction of the second force vector are in opposite directions respectively, an angle difference between the first direction and the second direction is 180 degrees, and the first direction is not collinear with the second direction;

obtaining the first difference between the first magnitude and the second magnitude; and

when the first direction and the second direction are in opposite directions respectively, controlling the first robotic arm or the second robotic arm so that a second difference between a larger one of the first magnitude and the second magnitude and the first difference is equal to a smaller one of the first magnitude and the second magnitude.

7. The control method according to claim 6 , further comprises:

sensing the first force.

8. The control method according to claim 6 , further comprises:

obtaining the first force according to feedback signal of a driver.

9. The control method according to claim 6 , further comprises:

mapping the first force vector and the second force vector to a common coordinate system; and

in the common coordinate system, determining whether the first force vector and the second force vector are equal.

10. The control method according to claim 6 , further comprising:

determining whether the first direction of the first force vector and the second direction of the second force vector are in opposite directions respectively;

obtaining the first difference between the first force vector and the second force vector; and

when the first direction of the first force vector and the second direction of the second force vector are in opposite direction, controlling the first robotic arm or the second robotic arm so that the sum of the first difference and a smaller one of the first magnitude and the second magnitude is equal to a larger one of the first magnitude and the second magnitude.

11. A non-transitory computer program product installed in a robotic arm system to execute a control method, wherein the control method comprises:

determining whether a first force vector of a first force applied by a first robotic arm to an object is equal to a second force vector of a second force applied by a second robotic arm to the object;

when a first magnitude of the first force vector and a second magnitude of the second force vector are not equal, obtaining a first difference between the first magnitude and the second magnitude; and

according to the first difference, changing at least one of the first force applied by the first robotic arm to the object and the second force applied by the second robotic arm to the object so that the first magnitude and the second magnitude are equal;

determining whether a first direction of the first force vector and a second direction of the second force vector are in opposite directions respectively, an angle difference between the first direction and the second direction is 180 degrees, and the first direction is not collinear with the second direction;

obtaining the first difference between the first force vector and the second force vector; and

when the first direction and the second direction are in opposite directions respectively, controlling the first robotic arm or the second robotic arm so that a second difference between a larger one of the first magnitude and the second magnitude and the first difference is equal to a smaller one of the first magnitude and the second magnitude.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded May 26, 2021
From: WU, CHIEN-YU; LI, SHANG-KUN; HUANG, SHU
To: INDUSTRIAL TECHNOLOGY RESEARCH INSTITUTE
Reel/Frame 056360/0506 →
Priority Claims (1)
TW 110101979 · Jan 19, 2021 · national
Continuity (1)
Related Publication 20220226990A1 · Jul 21, 2022