IP Library Granted Patent US 10,994,415
Granted Patent B2
US 10,994,415 · App. 15/773,630 · Granted May 4, 2021

Robot with control system for discrete manual input of positions and/or poses

Inventor: Sami Haddadin (Hannover, DE)
Assignee: FRANKA EMIKA GMBH
B25J9/163B25J9/1633B25J9/1656B25J9/1664G05B19/423G05B2219/36427G05B2219/36433G05B2219/40471G05B2219/40472G05B2219/40474Y02P90/02
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 10,994,415
App. No.
15/773,630
Granted
May 4, 2021
Kind
B2
Abstract

The invention relates to a robot, a robot control system, and a method for controlling a robot. The robot comprises a movable, multi-membered robot structure ( 102 ) that can be driven by means of actuators ( 101 ), at least one marked structural element S being defined on the movable robot structure ( 102 ), with at least one point P S marked on the structural element S. The robot is designed such that, in an input mode, it learns positions POS PS of the point PS and/or poses of the structural element S in a work space of the robot, the user exerting an input force F EING on the movable robot structure in order to move the structural element S, which is conveyed to the point P S as F EING,PS , and/or to the structural element S as torque M EING,S . A control device ( 103 ) of the robot is designed such that, in the input mode, the actuators ( 101 ) are controlled on the basis of a pre-defined space-fixed virtual 3D grid that at least partially fills the work space, such that the structural element S is moved with a pre-defined force F GRID (POS PS ), according to the current position POS PS of the point P S in the 3D grid, to the adjacent grid point of the 3D grid or in a grid point space defined around the adjacent grid point of the 3D grid, the point P S of the structural element S remaining on said adjacent grid point or in said grid point space in the event of the following holding true: |F EING,PS |<|F GRID (POS PS ) and/or, in the input mode, the actuators ( 101 ) are controlled on the basis of a pre-defined virtual discrete 3D orientation space O, where the 3D orientation space O=: (α i , β j , γ k ) where i=1, 2, . . . , I, j=1, 2, . . . J, k=1, 2, . . . , K is defined or can be defined by a pre-defined angle α i , β j , γ k , in such a way that the structural element S is moved with a pre-defined torque)(SO ROM according to the current orientation OR S of the structural element, towards the adjacent discrete orientation of the 3D orientation space O=: (α i , β j , γ k ), S, the structural element remaining in said adjacent discrete orientation of the 3D orientation space O in the event that the following holds true: |M EING,S |<|M O (OR S ).

Claims (37)

1. A robot having a movable, multi-membered robot structure that can be driven by means of actuators, wherein

at least one structural element S is defined on the movable robot structure, with at least one point P S marked on the structural element S,

the robot is designed such that, in an input mode, the robot learns positions POS PS of the point P S and/or poses of the structural element S in a work space of the robot, wherein the user exerts an input force {right arrow over (F)} EING on the movable robot structure in order to move the structural element S, which force is conveyed to the point P S as {right arrow over (F)} EING,PS , and/or to the structural element S as torque {right arrow over (M)} EING,S ,

a virtual 3D grid is defined, that at least partially fills the work space,

a virtual discrete 3D orientation space O is defined, wherein the 3D orientation space O is or can be defined by a triplets of discrete angles: (αi, βi, γk), where i=1, 2, . . . , I, j=1, 2, . . . J, k=1, 2, . . . ,K, and

a control device of the robot is designed such that,

in the input mode, the actuators are controlled such that the structural element S is moved with a pre-defined force F GRID ({right arrow over (P)}OS PS ), according to the current position POS PS of the point P S in the 3D grid, to the adjacent grid point of the 3D grid or in a grid point volume defined around the adjacent grid point of the 3D grid,

wherein the point P S of the structural element S remains on said adjacent grid point or in said grid point volume in the event of the following holding true: |{right arrow over (F)} EING,PS |<|{right arrow over (F)} GRID (POS PS )| and/or,

in the input mode, the actuators are controlled that the structural element S is moved with a predefined torque M O (OR s ) according to the current orientation OR S of the structural element, towards the adjacent discrete orientation of the 3D orientation space {right arrow over (O)}=: (α i , β h , γ k ),

wherein the structural element S remains in said adjacent discrete orientation of the 3D orientation space {right arrow over (O)} in the event that the following holds true: |{right arrow over (M)} EING,S |<|{right arrow over (M)} O (OR S )|.

2. The robot of claim 1 ,

wherein the predetermined force {right arrow over (F)} GRID (POS PS ) periodically varies within the 3D grid.

3. The robot of claim 1 ,

wherein the control device is designed in such a way that if at least two adjacent grid points or grid point volumes are positioned at the same distance from the current position POS PS of point P S , one of these grid points/grid point volumes is selected as the adjacent grid point/grid point volume according to a predetermined method.

4. The robot of claim 1 , wherein the control device is configured in such a way that in the work space a virtual 3D potential field is defined, the local minima of which are identical to the grid points of the 3D grid, wherein the force {right arrow over (F)} GRID (POS PS ) is determined based on the negative gradient of said potential field.

5. The robot of claim 1 , wherein the control device is configured in such a way that if at least two adjacent orientations O=: (α i , β j , γ k ) have the same differences with respect to the current orientation {right arrow over (O)}R S of structural element S, one of these orientations O=: (α i , β i , γ k ) is selected according to a predetermined method.

6. The robot of claim 1 , wherein the orientation space O =: (α i , β i , γ k ) is defined depending on the current position POS PS of point P S : O=O(POS PS )=(α i (POS PS ), β j (POS PS ), γ k (POS PS )).

7. A method for controlling a robot, which has a movable, multi-membered robot structure, that can be driven by means of actuators, wherein

at least one structural element S is defined on the movable robot structure, with at least one point P S marked on the structural element S,

the robot, in an input mode, learns positions POS PS of the point P S and/or poses of the structural element S in a work space of the robot, wherein the user exerts an input force {right arrow over (F)} EING on the movable robot structure in order to move the structural element S, which force is conveyed to the point P S as {right arrow over (F)} EING,PS , and/or to the structural element S as torque {right arrow over (M)} EING,S ,

a virtual 3D grid is defined, that at least partially fills the work space,

a virtual discrete 3D orientation space O is defined, wherein the 3D orientation space O is or can be defined by a triplets of discrete angles: (αi, βi, γk), where i=1, 2, . . . , I, j=1, 2, . . . J, k=1, 2, . . . , K, and

a control device

in the input mode, controls the actuators such that the structural element S is moved with a pre-defined force {right arrow over (F)} GRID (POS PS ), according to the current position POS PS of the point P S in the 3D grid, to the adjacent grid point of the 3D grid or in a grid point volume defined around the adjacent grid point of the 3D grid,

wherein the point P S of the structural element S remains on said adjacent grid point or in said grid point volume in the event of the following holding true: |{right arrow over (F)} EING,PS |<|{right arrow over (F)} GRID (POS PS )| and/or,

in the input mode, controls the actuators such that the structural element S is moved with a predefined torque {right arrow over (M)} O ({right arrow over (O)}R S ) according to the current orientation {right arrow over (O)}R S of the structural element, towards the adjacent discrete orientation of the 3D orientation space O=: (α i , β j , γ k ), wherein the structural element S remains in said adjacent discrete orientation of the 3D orientation space O in the event that the following holds true: |{right arrow over (M)} EING,S |<{right arrow over (M)} O ({right arrow over (O)}R S ).

8. The method of claim 7 , wherein in the work space a virtual 3D potential field is defined, the local minima of which are identical to the grid points of the 3D grid, wherein the force {right arrow over (F)} GRID (POS PS ) is determined based on the negative gradient of said potential field.

9. The method of claim 7 , wherein the local minima of the 3D potential field have a constant potential within a predetermined space region around each grid point of the 3D grid, wherein the space region has a maximum extension which is smaller than the grid spacing between two adjacent grid points.

10. The method of claim 7 , wherein, if at least two adjacent orientations have the same difference with respect to the current orientation OR s of structural element S, one of these orientations O=: (α i , β j , γ k ) is selected according to a predetermined method.

11. The method of claim 8 , wherein the local minima of the 3D potential field have a constant potential within a predetermined space region around each grid point of the 3D grid, wherein the space region has a maximum extension which is smaller than the grid spacing between two adjacent grid points.

12. The method of claim 11 , wherein, if at least two adjacent orientations have the same difference with respect to the current orientation OR s of structural element S, one of these orientations O=: (α i , β j , γ k ) is selected according to a predetermined method.

13. The method of claim 8 , wherein, if at least two adjacent orientations have the same difference with respect to the current orientation OR s of structural element S, one of these orientations O=: (α i , β j , γ k ) is selected according to a predetermined method.

14. The method of claim 9 , wherein, if at least two adjacent orientations have the same difference with respect to the current orientation OR of structural element S, one of these orientations O=: (α i , β j , γ k ) is selected according to a predetermined method.

15. The robot of claim 2 , wherein the control device is designed in such a way that if at least two adjacent grid points or grid point volumes are positioned at the same distance from the current position POS PS of point P S , one of these grid points/grid point volumes is selected as the adjacent grid point/grid point volume according to a predetermined method.

16. The robot of claim 15 , wherein the control device is configured in such a way that in the work space a virtual 3D potential field is defined, the local minima of which are identical to the grid points of the 3D grid, wherein the force {right arrow over (F)} GRID (POS PS ) is determined based on the negative gradient of said potential field.

17. The robot of claim 2 , wherein the control device is configured in such a way that in the work space a virtual 3D potential field is defined, the local minima of which are identical to the grid points of the 3D grid, wherein the force {right arrow over (F)} GRID (POS PS ) is determined based on the negative gradient of said potential field.

18. The robot of claim 3 , wherein the control device is configured in such a way that in the work space a virtual 3D potential field is defined, the local minima of which are identical to the grid points of the 3D grid, wherein the force {right arrow over (F)} GRID (POS PS ) is determined based on the negative gradient of said potential field.

Assignments (5)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Oct 7, 2025
From: FRANKA ROBOTICS GMBH
To: FR ADMINISTRATION GMBH
Reel/Frame 072494/0070 →
CHANGE OF NAME Recorded Aug 14, 2025
From: AGILE ROBOTS HANOVER GMBH
To: FRANKA ROBOTICS GMBH
Reel/Frame 072475/0941 →
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Aug 8, 2025
From: FRANKA EMIKA GMBH
To: AGILE ROBOTS HANOVER GMBH
Reel/Frame 071968/0642 →
CHANGE OF ADDRESS Recorded Dec 2, 2021
From: FRANKA EMIKA GMBH
To: FRANKA EMIKA GMBH
Reel/Frame 058295/0960 →
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded May 31, 2019
From: HADDADIN, SAMI
To: FRANKA EMIKA GMBH
Reel/Frame 049332/0237 →
Priority Claims (1)
DE 10 2015 118 918.6 · Nov 4, 2015 · national
Continuity (1)
Related Publication 20190061148A1 · Feb 28, 2019