Method For Safe Coupling And Decoupling Of An Input Device
20170341233 ยท 2017-11-30
Inventors
- Henrik Keller (Augsburg, DE)
- Markus Finke (Kissing, DE)
- Anja Groch (Munchen, DE)
- Maximilian Heinig (Munchen, DE)
- Horacio Martinez (Munchen, DE)
- Christian Meissner (Augsburg, DE)
- Mario Miller (Friedberg, DE)
- Holger Moennich (86316, DE)
- Thomas Neff (Augsburg, DE)
- Tobias Reichl (Munchen, DE)
- Nina Sauthoff (Einbeck, DE)
- Osama Shahin (Augsburg, DE)
- Oliver Thilmann (Augsburg, DE)
- Olaf Wegener (Dortmund, DE)
Cpc classification
A61B34/70
HUMAN NECESSITIES
B25J9/1676
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1666
PERFORMING OPERATIONS; TRANSPORTING
G05B19/409
PHYSICS
International classification
G05B19/409
PHYSICS
A61B34/00
HUMAN NECESSITIES
Abstract
A packaging technique for applying an insulating pack to the housing of a battery cell. The insulating pack is formed from a self-adhesive cutout of insulating material by folding the cutout onto the sides of the housing that are to be covered. The packaging technique involves a packaging method for automatically applying an insulating pack, a battery cell including an insulating pack, a packaging station for carrying out the method, and a preparation device for preparing one or more cutouts of insulating material.
Claims
1-15. (canceled)
16. A method for coupling an input device to a robotic manipulator, wherein the input device is configured to control the robotic manipulator, the method comprising: a) checking whether the pose of an input point of the input device is within an input tolerance range, wherein the input tolerance range of the input device is determined by mapping a tolerance range of a reference point of the robotic manipulator, and the input tolerance range is unchangeable until the input device is coupled to the robotic manipulator; b) moving the reference point of the robotic manipulator to the pose commanded by the input device when the pose of the input point is within the input tolerance range; and c) coupling the input device to the robotic manipulator after the reference point has reached the commanded pose.
17. The method of claim 16, further comprising: d) checking whether the pose of the input point is within an extended input tolerance range and outside the input tolerance range, wherein the extended input tolerance range is greater than the input tolerance range, and wherein the extended input tolerance range comprises the input tolerance range; e) determining an approach pose of the reference point, wherein the approach pose is within the tolerance range of the reference point, and the approach pose has a minimum deviation from the pose of the reference point that is commanded by the input device; f) moving the reference point of the robotic manipulator to the approach pose when the pose of the input point is within the extended input tolerance range and outside the input tolerance range; and g) coupling the input device to the at least one robotic manipulator after the reference point has reached the approach pose.
18. The method of claim 16, wherein, prior to the step of moving the reference point of the robotic manipulator, the method further comprises: h) checking whether the pose of the reference point of the robotic manipulator violates an obstacle space in the input device-commanded pose or the approach pose.
19. The method of claim 16, comprising: terminating movement of the reference point of the robotic manipulator to the input device-commanded pose in step b) when the input point leaves the input tolerance range before reaching the commanded pose; and terminating movement of the reference point of the robotic manipulator to the approach pose in step f) when the input point leaves the extended input tolerance range before reaching the approach pose.
20. The method of claim 16, wherein the shape and/or size of at least one of the tolerance range, the input tolerance range, or the extended input tolerance range is a function of at least one other system variable, wherein the at least one other system variable comprises: a) the speed of the manipulator b) a detection range that enables the detection of at least one of the position or orientation of the reference point of the robotic manipulator, c) forces or torques that act on the reference point of the robotic manipulator, d) an obstacle space determined from environmental data, or e) a boundary of a working space of the robotic manipulator.
21. The method of claim 17, further comprising: automatically determining the extended input tolerance range, wherein the extended input tolerance range corresponds to the input tolerance range scaled by an extension factor.
22. A method for coupling and decoupling an input device to and from a robotic manipulator, wherein the input device is configured to control the robotic manipulator, the method comprising: a) decoupling the input device from the manipulator when a reference point of the manipulator has reached an obstacle space or a boundary of a working space; b) updating a mapping of the pose of an input point of the input device to the pose of the reference point of the manipulator, wherein a current pose of the input point is mapped to the last allowable pose of the reference point of the manipulator; c) checking whether the input device-commanded pose of the reference point of the manipulator in the updated mapping is outside the obstacle space and inside the working space; and d) coupling the input device to the manipulator when the input device-commanded pose of the reference point of the manipulator is outside the obstacle space and inside the working space.
23. The method of claim 22, wherein checking whether the input device-commanded pose of the reference point of the manipulator is outside an obstacle space and inside the working space takes place in discrete time steps.
24. The method of claim 22, wherein checking whether the input device-commanded pose of the reference point of the manipulator is outside the obstacle space and inside the working space is a function of a minimum change in the input device-commanded pose of the reference point of the manipulator.
25. The method of claim 16, wherein a speed of the manipulator is a function of at least one system variable, the at least one system variable comprising at least one of: a) a detection range that enables the detection of at least one of the position or orientation of the reference point of the manipulator; b) forces or torques that act on the reference point of the manipulator; c) an obstacle space determined from environmental data; or d) a boundary of the working space of the manipulator.
26. The method of claim 16, wherein a change in the pose of the input point of the input device to the change in the pose of the reference point of the manipulator has a translation ratio greater than or equal to 1.
27. The method of claim 16, wherein a change in the pose of the input point of the input device to the change in the pose of the reference point of the manipulator has a translation ratio of 2 to 10.
28. The method of claim 16, wherein a change in the pose of the input point of the input device to the change in the pose of the reference point of the manipulator has a translation ratio of 3 to 5.
29. The method of claim 16, further comprising; outputting a haptic, visual, or audible feedback, wherein the feedback indicates at least one of: that an obstacle space of the reference point has been reached; that the input device has been coupled to or decoupled from the manipulator; the distance of the input point of the input device from at least one of the input tolerance range or the extended input tolerance range; or that a corresponding allowable pose of the reference point of the manipulator has been reached.
30. The method of claim 16, further comprising: graphically displaying the input device-commanded pose of the reference point of the manipulator; and virtually superimposing the commanded pose over the actual pose of the reference point of the manipulator.
31. A control device for controlling at least one robotic manipulator with an input device, wherein the control device is configured to receive inputs from the input device and to control the robotic manipulator, the control device including program code stored in a non-transitory, computer-readable storage medium, the program code, when executed on the control device, causing the control device to: check whether the pose of an input point of the input device is within an input tolerance range, wherein the input tolerance range of the input device is determined by mapping a tolerance range of a reference point of the robotic manipulator, and the input tolerance range is unchangeable until the input device is coupled to the robotic manipulator; move the reference point of the robotic manipulator to the pose commanded by the input device when the pose of the input point is within the input tolerance range; and couple the input device to the robotic manipulator after the reference point has reached the commanded pose.
32. Program code stored on a non-transitory, computer-readable storage medium, the program code, when executed on a control device for controlling a robotic manipulator, causing the control device to: check whether the pose of an input point of an input device is within an input tolerance range, wherein the input tolerance range of the input device is determined by mapping a tolerance range of a reference point of the robotic manipulator, and the input tolerance range is unchangeable until the input device is coupled to the robotic manipulator; move the reference point of the robotic manipulator to the pose commanded by the input device when the pose of the input point is within the input tolerance range; and couple the input device to the robotic manipulator after the reference point has reached the commanded pose.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0064] Preferred embodiments of the invention are explained in detail below with reference to the drawings. In the drawings
[0065]
[0066]
[0067]
[0068]
DETAILED DESCRIPTION
[0069]
[0070] The input device 10 can be moved preferably in three translational and three rotational axes. As a result, a user can determine the position and the orientation, i.e., together with the pose, of an input point 12, uniquely defined relative to the input device 10. At least the pose, defined in this way, or a change in the pose of the input point 12 is sent to the control device 30 and received by said control device. The control device 30 converts the change in the pose of the input point 12 into a corresponding change in the pose of a reference point 22 of the manipulator 20. The reference point 22 is fixed relative to the manipulator 20. Preferably the reference point of the manipulator is the hand root point (HWP) of the manipulator or the tool center point (TCP), located at a suitable point of an object guided by the manipulator. The object may be, for example, a medical instrument, a tool, a workpiece or a sensor. For example, the TCP may be defined as a tip of a scalpel, guided by the manipulator.
[0071] The number of axes and links of the input device 10 and the manipulator 20 does not have to match, as shown in
[0072]
[0073] In the pose 12a of the input point 12 and the corresponding pose 22a of the reference point 22, the input device 10 has been decoupled from the manipulator 20. As a result, changes in the pose of the input point 12 of the input device 10 are no longer converted into movements of the manipulator 20. The reference point 22 of the manipulator 20 remains in the pose 22a. If a user moves the input point 12 of the input device 10 in the decoupled state, for example, to the pose 12c of the input point 12, then the pose 22c of the reference point 22 of the manipulator 20 would be commanded. However, the pose 22c of the reference point 22 lies outside the tolerance range 24. In this case coupling is not possible because no safe automatic movement of the reference point 22 of the manipulator 20 from the pose 22a to the pose 22c can be ensured. Consequently, the manipulator 20 does not move; and the reference point 22 remains in the safe pose 22a.
[0074] If at this point the user moves the input point 12 of the input device 10, for example, into the pose 12b, which lies within the input tolerance range 14, then the pose 22b is commanded accordingly. This pose 22b is within the tolerance range 24; and, thus, an automatic movement of the manipulator 20 to this pose 22b is considered to be safe. Correspondingly a movement of the reference point 22 of the manipulator 20 to the commanded pose 22b occurs. For safety reasons such a movement takes place at a defined speed. Therefore, the manipulator 20 moves automatically, so that its reference point 22 comes to meet the input point 12 of the input device 10 at the commanded pose 22b. When the reference point 22 finally reaches the pose 22b, the input device 10 is coupled to the manipulator 20. At this point the user can move the manipulator 20 by remote control (telemanipulation) by manually moving the input device 10 until said input device is decoupled again. By coming to meet the manipulator 20 at the commanded pose, the coupling is faster and easier than in the case, where the user has to hit exactly the current pose or position of the reference point 22 of the manipulator 20 with the input device 10.
[0075]
[0076] If at this point the user moves the input point 12 into the extended input tolerance range 16, for example, here to pose 12e, then the approach pose 22d of the reference point 22 is calculated within the tolerance range 24; where in this case said approach pose exhibits a minimum distance from the commanded pose 22e of the reference point 22. A movement of the reference point 22 to the approach pose 22d can be considered to be safe, since it is within the tolerance range 24. Correspondingly the manipulator 20 is moved in such a way that its reference point 22 is moved to the approach pose 22d.
[0077] If the reference point 22 reaches the approach pose 22d, then the input device 10 is coupled to the manipulator 20; and the pose 12e of the input point 12 is assigned the approach pose 22d of the reference point 22. Then the manipulator 20 is controlled by the input device 10 with this new mapping. At this point the mapping has an offset that corresponds to the deviation of the exactly commanded pose 22e of the reference point 22 from the approach pose 22d. The offset can have both a translational and rotational characteristic. In this coupling process the reference point 22 of the manipulator 20 goes to meet the input point 12 of the input device 10 as soon as the input point 12 begins to enter the extended input tolerance range 16 as far as it is allowed by the tolerance range 24 of the reference point 22 and coupling is allowed with the offset mapping. This arrangement makes it possible to perform a safe coupling of the input device 10 to the manipulator 20 in a faster and easier way.
[0078]
[0079] In
[0080] In
[0081] However, the input device 10 can also be freely operated in the decoupled state. At fixed time intervals the pose of the input point 12 is detected; and initially it is checked whether the commanded pose of the reference point 22 is inside or outside the obstacle space 28. In the case shown in
[0082] In
[0083] The translational movements, described above, are used merely to simplify the description of the coupling process. However, the manipulator can execute rotational movements and/or combinations of translational and rotational movements just as well, and wherein the preferred method for coupling can be used in the same way.
[0084] While the present invention has been illustrated by a description of various embodiments, and while these embodiments have been described in considerable detail, it is not intended to restrict or in any way limit the scope of the appended claims to such detail. The various features shown and described herein may be used alone or in any combination. Additional advantages and modifications will readily appear to those skilled in the art. The invention in its broader aspects is therefore not limited to the specific details, representative apparatus and method, and illustrative example shown and described. Accordingly, departures may be made from such details without departing from the spirit and scope of the general inventive concept.
List of Reference Numbers and Characters:
[0085] 1 manipulator system [0086] 10 input device [0087] 12 input point [0088] 12a, b, c, e, w, x, y, z poses of the input point 12 [0089] 14 input tolerance range [0090] 16 extended input tolerance range [0091] 20 manipulator [0092] 22 reference point [0093] 22a, b, c, d, e, w, x, y, z poses of the reference point 22 [0094] 24 tolerance range of the reference point 22 [0095] 28 obstacle space [0096] 30 control device