# US 2024/0269850 A1 · Predefining a permissible maximum speed of a robotic device

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2024/0269850 A1
- Document ID: US20240269850A1
- Status: Published application
- Kind: A1
- Application number: 18/681,107
- Filed: 2022-08-03
- Published: 2024-08-15
- Earliest claimed: 2021-08-06
- Applicants: Fraunhofer-Gesellschaft zur Förderung der Angewandten Forschung E.V.
- Inventors: Roland BEHRENS; Sebastian HERBSTER
- Web page: https://patentgrep.com/patent/US20240269850A1

## CPC

- B25J 9/1676: {Avoiding collision or forbidden zones}
- B25J 9/163: {learning, adaptive, model based, rule based expert control}
- B25J 9/1651: {acceleration, rate control}
- B25J 9/1653: {parameters identification, estimation, stiffness, accuracy, error analysis}
- B25J 9/1671: {characterised by simulation, either to verify existing program or to create and verify new program, CAD/CAM oriented, graphic oriented programming systems}
- G05B 2219/40198: Contact with human allowed if under pain tolerance limit
- G05B 2219/40202: Human robot coexistence
- G05B 2219/40215: Limit link kinetic energy to amount another element can dissipate upon impact
- G05B 2219/40319: Simulate contact of object and obstacle, reduce to pairs with only one contact
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)

## Abstract

Predefining a permissible maximum speed for a robotic device may include predefining a contact point between a human operator and the robotic device for a collision between the human operator and the robotic device, a geometry of the robotic device at the contact point, and a spatial boundary condition of the collision. The method may also include determining whether the collision is a clamp-free collision or a clamped collision using a computing unit. The method may also include calculating, by the computing unit, the permissible maximum speed of the robotic device at the contact point with a free-impact model, and with a clamping-impact model or with a quasi-static-clamping model. The method may also include using the computing unit to output a signal dependent on the calculated permissible maximum speed for the robotic device to predefine the permissible maximum speed of the robotic device.

## Claims

### Claim at position 1

1-12. (canceled)

### Claim 13

A method for predefining a permissible maximum speed for a robotic device, comprising:
predefining a contact point between a human operator and the robotic device for a collision between the human operator and the robotic device, a geometry of the robotic device at the contact point, and a spatial boundary condition of the collision;
under consideration of the spatial boundary condition, determining whether the collision is a clamp-free collision or a clamped collision using a computing unit;
calculating, by the computing unit, the permissible maximum speed of the robotic device at the contact point with a free-impact model if the collision is a clamp-free collision, and with a clamping-impact model or with a quasi-static-clamping model if the collision is a clamped collision, wherein the models in each case are different models;
outputting, by the computing unit, a signal dependent on the calculated permissible maximum speed for the robotic device.

### Claim 14 (depends on 13)

The method according to claim 13, wherein the output signal represents a location-dependent speed specification along a machine path predefined for the robotic device, said speed specification being generated in particular by scaling a speed specification predefined originally for the predefined machine path in dependence on the calculated maximum speed, wherein the scaling may comprise a uniform scaling or a scaling adapted locally to the predefined machine path under consideration of a predefined process speed for the robotic device at one or more sub-sections of the machine path.

### Claim 15 (depends on 13)

The method according to claim 13, wherein the permissible maximum speed is calculated in real time and the output signal represents an instantaneous permissible maximum speed for the robotic device.

### Claim 16 (depends on 13)

The method according to claim 13, wherein if the collision is a clamped collision, the permissible maximum speed is calculated with the clamping-impact mode and with the quasi-static-clamping model, and the lower of the calculated maximum speeds is selected as the permissible maximum speed for the output.

### Claim 17 (depends on 13)

The method according to claim 13, wherein in the quasi-static-clamping model the permissible maximum speed is calculated in dependence on:
a) a predefined kinematic structure of the robotic device;
b) a joint configuration at the time of the collision, in particular with a position of one or more axes of the robotic device and speeds assigned to the respective axes;
c) a stiffness characteristic curve of a human body site at the contact point of the collision;
d) a stiffness characteristic curve of a machine point at the contact point of the collision;
e) a resultant stiffness characteristic curve calculated with the stiffness characteristic curve of the human body site and the stiffness characteristic curve of the machine point;
f) a predefined permissible maximum deformation, in particular with a force threshold value and/or an energy threshold value and/or a deformation threshold value;
g) a permissible penetration depth calculated with the stiffness characteristic curve of the machine point and the resultant stiffness characteristic curve;
h) a reaction force of the robotic device;
i) a reaction distance of the robotic device calculated with the stiffness characteristic curve of the machine point and the permissible penetration depth;
j) a permissible braking distance of the robotic device calculated with the predefined permissible maximum deformation and the reaction force; and
k) an actual braking distance of the robotic device.

### Claim 18 (depends on 17)

The method according to claim 17, wherein the permissible maximum speed for the robotic device is ascertained iteratively by a bisection method until the actual braking distance matches the permissible braking distance.

### Claim 19 (depends on 13)

The method according to claim 13, wherein if the collision involves contact points at different human body sites, the output signal is dependent on the permissible maximum speed which corresponds to the shortest actual braking distance.

### Claim 20 (depends on 13)

The method according to claim 13, wherein if the collision involves contact points at different machine points, the permissible maximum speed for all contact points is calculated and the output signal is dependent on the lowest permissible maximum speed.

### Claim 21 (depends on 13)

The method according to claim 13, wherein in the case of the free-impact model and the clamping-impact model, the permissible maximum speed is calculated in each case in dependence on:
a) the predefined kinematic structure of the robotic device;
b) the joint configuration at the time of the collision, in particular with a position of one or more axes of the robotic device and speeds assigned to the respective axes;
c) the stiffness characteristic curve of the human body site at the contact point of the collision;
d) the stiffness characteristic curve of the machine point at the contact point of the collision;
e) the resultant stiffness characteristic curve calculated with the stiffness characteristic curve of the human body site and the stiffness characteristic curve of the machine point;
f) the permissible maximum deformation predefined with a force threshold value and/or an energy threshold value;
l) an effective mass of the machine point at the contact point of the collision;
m) an effective stiffness of the robotic device; and, only in the case of the free-impact model:
n) an effective mass of the human body site at the contact point of the collision.

### Claim 22 (depends on 21)

The method according to claim 21, wherein the free-impact model comprises or is a three-mass oscillator model and/or the clamping-impact model comprises or is a two-mass oscillator model.

### Claim 23

A control unit for predefining a permissible maximum speed of a robotic device, comprising:
a detection unit for detecting a contact point between a human operator and the robotic device for a collision between a human operator and robotic device, a geometry of the robotic device at the contact point, and a spatial boundary condition of the collision;
a computing unit for determining, under consideration of the spatial boundary condition, whether the collision is a clamp-free collision or a clamped collision, and for calculating the permissible maximum speed of the robotic device at the contact point with a free-impact model if the collision if a clamp-free collision and with a clamping-impact model or with a quasi-static-clamping model if the collision is a clamped collision, wherein the models are different models in each case, and for outputting a signal dependent on the calculated permissible maximum speed for the robotic device.

### Claim 24 (depends on 23)

A robotic device with a control unit according to claim 23.
