Trajectory planning with flexible replanning functionality—changed end point

Patent metadata

Field	Value
Publication number	US-12147234-B2
Application number	US-202218071036-A
Country	US
Kind code	B2
Filing date	Nov 29, 2022
Priority date	Nov 30, 2021
Publication date	Nov 19, 2024
Grant date	Nov 19, 2024

Abstract

An improved method for controlling a lifting device, which moves a load along a first movement direction and along a second movement direction within a specified working area of the lifting device from a starting point to an end point. Individual movements are planned for the first movement direction and for the second movement direction, by which the load is moved further along the movement directions and brought to a newly specified end point.

First claim

The invention claimed is:

1. A method for controlling a lifting device, the method comprising:
moving a load along a first movement direction and along a second movement direction within a specified working area of the lifting device in accordance with a specified trajectory from a starting point to an end point;
at a command time point during the movement of the load, changing the end point to a new end point;
taking into account specified kinematic constraints of the lifting device, an individual movement is planned for the first movement direction and for the second movement direction respectively;
determining individual movements for further movement of the load along the respective movement direction from the command time point onwards;
ending the individual movements in a projection of a new end point onto the respective movement direction; and
moving the load based on executing a specified movement sequence further along the first movement direction and further along the second movement direction in accordance with a replanning trajectory resulting from the specified movement sequence of the planned individual movements.

2. The method according to claim 1 , wherein the individual movements planned for the first movement direction and for the second movement direction are planned as individual movements that are independent of one another.

3. The method according to claim 1 , wherein the planned individual movements each comprise a position profile that is capable of continuously differentiated at least four times in time.

4. The method according to claim 3 , wherein the position profiles for generating the temporally at least four times continuous differentiability are filtered by a filter with a specifiable time constant.

5. The method according to claim 4 , wherein the specifiable time constant of the filter is selected as a function of a geometry of the lifting device in order to comply with the specified kinematic constraints of the lifting device in a combined execution of the individual movements.

6. The method according to claim 1 , wherein, in a case of an obstacle located between a position taken on by the load at the command time point and the new end point, a further individual movement is planned for the second movement direction which in combination with the individual movement planned along the first movement direction moves the load around the obstacle, and wherein the second individual movement is executed in accordance with the specified movement sequence before the individual movement already planned for the second movement direction.

7. The method according to claim 1 , wherein the movement sequence is specified such that individual movements along the first movement direction and individual movements along the second movement direction are started alternately.

8. The method according to claim 1 , wherein the movement sequence is specified such that an individual movement along the first movement direction and an individual movement along the second movement direction are executed overlapping in time.

9. The method according to claim 1 , wherein, before the execution of at least one planned individual movement, it is checked whether the expected replanning trajectory leads to a collision of the load with an obstacle specified in a working area.

10. The method according to claim 9 , wherein, in order to check whether the expected replanning trajectory leads to the collision of the load with the obstacle specified in the working area, projections of a keypoint derived from the specified obstacle onto the movement directions are determined, wherein a collision time is determined at which the load reaches the projection onto the first movement direction with the individual movement planned for the first movement direction, and a collision time is determined at which the load reaches the projection onto the second movement direction with the individual movement planned for the second movement direction, and wherein the determined collision times are compared with one another.

11. The method according to claim 10 , wherein the collision times are determined using a root finding method.

12. The method according to claim 10 , wherein, in an event of the determined collision with an obstacle, at least one individual movement is not executed, and wherein instead a specified braking operation is performed for at least a duration of a specified minimum braking time along that movement direction for which the at least one individual movement that was not executed had been planned.

13. The method according to claim 12 , wherein instead of the at least one individual movement which has not been executed, a new individual movement is planned for the corresponding movement direction, wherein it is checked whether the replanning trajectory resulting from the newly planned individual movement leads to a collision of the load with the obstacle specified in the specified working area, and wherein the new individual movement is executed when no collision is detected, or wherein the specified braking operation is continued for at least one further minimum braking time and a replanning of an individual movement and a check of the replanning trajectory resulting from the replanned individual movement are performed again when a new collision with an obstacle is detected.

14. The method according to claim 9 , wherein, in order to check whether the expected replanning trajectory leads to a collision of the load with an obstacle specified in the working area,
a projection of a keypoint derived from the specified obstacle onto one of the movement directions is determined, wherein a collision time is determined at which the load reaches the determined projection with the individual movement planned for the movement direction, wherein a position of the load on the other movement direction take on by the load at the determined collision time is determined, and wherein the determined position is compared with a projection of the keypoint onto the movement direction for which the position of the load was determined.

15. The method according to claim 1 , wherein the position of the load is measured and is used for at least one of planning and executing the individual movements.

16. The method according to claim 1 , wherein the load is additionally moved along a third movement direction by the lifting device, wherein the load is moved within a specified three-dimensional (3D) working space in accordance with a three-dimensional trajectory and wherein, for replanning the trajectory, at least one individual movement is also planned for the third movement direction and is executed in accordance with a specified movement sequence in addition to the individual movements planned for the first movement direction and for the second movement direction.

17. A lifting device for moving a load from a starting point to an end point in accordance with a specified trajectory within a specified working area of the lifting device, the lifting device comprising:
a load receiving structure for receiving the load which is connected by at least one retaining structure to a running structure, wherein the running structure is movable along a first movement direction by a running element drive and the load receiving structure is movable along a second movement direction by a lifting drive; and
a computing unit in a form of an electronic control unit is provided in the lifting device, the computing unit designed to:
read in at a command time point during the movement of the load a new end point specified in the specified

Assignees

• B & R Ind Automation Gmbh

Inventors

• Stöger Andreas
• Frauscher Thomas J
• Rams Hubert

Classifications

• G05D1/617

  Safety or protection, e.g. defining protection zones around obstacles or avoiding hazards (arrangements for controlling the position or course of two or more vehicles for avoiding collisions therebetween G05D1/693; arrangements for reacting to or preventing system or operator failure G05D1/80) · CPC title

• G05D1/65

  Following a desired speed profile · CPC title

• G05D1/0223

  involving speed control of the vehicle (vehicle fittings for automatically controlling, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator B60K31/00) · CPC title

• B66C19/002

  Container cranes (B66C19/007 takes precedence) · CPC title

• B66C13/48

  Automatic control of crane drives for producing a single or repeated working cycle; Program control · CPC title