Patent Application
20220111520
The present invention relates to a method for carrying out a predetermined task using a robot, which is redundant with regard to this task, to a system for operating the robot which is configured to carry out the method, and to a computer program product for carrying out the method.
Robots can carry out tasks with regard to which they are redundant. If a task comprises, for example, a predetermined three-dimensional position and three-dimensional orientation of a robot end flange or a robot-guided tool connected thereto, a robot with seven or more consecutive joints is redundant with regard to this task.
On the other hand, hand guiding of robots is known in which the robot follows or evades/tries to evade a force exerted manually thereon.
In previous in-house approaches to hand guiding robots when carrying out a predetermined task, with regard to which the robot is redundant, the precision of carrying out the task in particular is often unsatisfactory.
The object of the present invention is to improve carrying out predetermined tasks using robots which are redundant with regard to these tasks, preferably to increase the precision of carrying out these tasks with or in spite of hand guiding of the robot.
This object is achieved by a method, and a system or computer program product for carrying out a method as described herein.
According to one embodiment of the present invention, a robot is redundant with regard to a predetermined task. In one embodiment, the robot has more degrees of freedom, in particular joints or axes, than required or determined by the task or for carrying out the task.
If xd∈task or {dot over (x)}d∈
task denote a predetermined task, for example a pose or position and/or orientation of a robot-fixed reference or its change over time, and q∈
DoF denotes joint coordinates, for example angular positions and orientations, of the robot, then ask <DoF applies accordingly to the ((task-)redundant) robot in an embodiment.
In a further development, the robot has at least six, in particular at least seven, joints or axes, in particular swivel joints or axes (Dof≥6 or Dof≥7), which follow one another in one embodiment, so that said robot can in particular move to any predetermined three-dimensional positions and orientations (Dof≥6) or, with regard to any predetermined six-dimensional poses of robot-fixed references, can always be used redundantly (Dof≥7) and thus very flexibly.
According to one embodiment of the present invention, when carrying out the predetermined task programmed or stored in advance or commanded by an input command in an embodiment, the robot carries out, in particular commands, a motion in a/the zero space (of the robot with regard to the task), which motion is referred to herein as an admittance motion and is dependent on a force exerted externally, in particular manually, on the robot and on a predetermined, in one embodiment configured or parameterized, virtual mass, virtual stiffness and/or virtual damping and is determined on the basis of the force exerted externally on the robot and the predetermined virtual mass, stiffness or damping in one embodiment. In one embodiment, joints or drives of the robot, in one embodiment electric motors, are actuated or commanded in such a way that the robot carries out the task and the admittance motion or is actuated or commanded to carry out the task and the admittance motion.
As a result, in one embodiment, the robot can be hand-guided when carrying out the predetermined task (by externally impressing the force), thereby utilizing its redundancy, in particular for collision avoidance or the like, and thereby advantageously increasing the precision of carrying out the task.
For a more compact representation, an anti-parallel force pair or torque is generally referred to as a force within the meaning of the present invention.
The Jacobian matrix (of the task) is defined in one embodiment in the customary manner by
with the time derivatives
A generalized or pseudo inverse J# of the Jacobian matrix inversely maps {dot over (x)}d to {dot over (q)}d
{dot over (q)}
d
=J
#
·{dot over (x)}
d (2)
and can be defined or determined in an embodiment according to
J
#
=W
−1
·J
T·(J·W−1·JT)−1 (3)
with the inverse ( )−1 of a weighting matrix W, for example the unit or mass matrix, and the transpose ( )T.
In one embodiment, the zero space (of the task) is defined in the customary manner by the zero space operator or projector
N=(1=J#J) (4)
In one embodiment, a target admittance motion, in a further development in the joint coordinate space of the robot and/or with the aid of an admittance control, is determined on the basis of the force Text exerted externally, in particular transformed into the joint coordinate space, on the robot and/or the predetermined virtual mass M, stiffness K and/or damping D, in an embodiment according to
{umlaut over (q)}
a
=M
−1(Text−D·{dot over (q)}a−K·qa) (5)
or, in particular by integration or in a control loop, according to
and this determined target admittance motion is projected into the zero space, in one embodiment by left multiplication of the zero space operator N according to Eq. (4).
In one embodiment, K and/or D can be equal to or not equal to zero or the corresponding terms are omitted and/or M can be the identity matrix or different therefrom and from zero.
Such a target admittance motion conveys a motion that a virtual mass, spring and/or damper system, in particular a virtual mass damper system {umlaut over (q)}a=M−1·(Text−D··{dot over (q)}a) or a virtual mass ({umlaut over (q)}aM−1·Text) would carry out as a result of the external force Text. As a result, an advantageous behavior of the robot during hand guiding can be implemented in one embodiment.
The force exerted externally on the robot is determined in one embodiment in the joint coordinate space and/or on the basis of forces in the joints of the robot and/or an in particular mathematical or numerical model of the robot; in one embodiment by determining forces in the joints of the robot, in particular by measuring with the aid of sensors, in particular force sensors, or by estimating detected currents in joint drives or the like, in particular with the aid of secondary encoders; and in one embodiment, those internal forces which are determined based on models and/or on the basis of positions and/or motions of the robot, are subtracted from the forces which result from the dynamics, in particular the weight and motions of the robot, in an embodiment according to
T
ext
=T
i−(Mm·{umlaut over (q)}i+h(qi,{dot over (q)}i)) (6)
with the determined forces Ti in the joints, the current joint coordinates qi or their time derivatives, as well as the mass matrix Mm and the vector h of the generalized forces, in particular gyroscopic, gravitational and/or frictional forces, of the robot or its model. As already mentioned, torques are also generally referred to herein as forces. In general, the force exerted externally on the robot is determined in one embodiment on the basis of forces in the joints of the robot that are determined by means of sensors.
As a result, in one embodiment, the force exerted externally on the robot can be determined particularly advantageously, in particular (more) precisely, and hand guiding can thereby be improved.
In one embodiment, the task is or will be specified in the (Cartesian) workspace of the robot.
Additionally or alternatively, in one embodiment the task comprises one or more poses of a robot-fixed reference and/or one or more changes to a pose of a robot-fixed reference, and in one embodiment the task comprises a predetermined motion and/or a predetermined holding of a pose of the robot-fixed reference.
In one embodiment, a pose has a one-, two- or three-dimensional position and/or a one-, two- or three-dimensional orientation, which can in particular be (defined by) such or determine such.
In this way, tasks can advantageously be predetermined or carried out.
In one embodiment, the robot-fixed reference is arranged on a robot-guided tool, in a further development between a tool tip and a robot end flange on which the tool is connected to the robot.
In one embodiment, a robot can be moved in a hand-guided manner while maintaining a fixed point, in particular a trocar point, of a robot-guided, in particular medical, tool with high precision.
In one embodiment, the robot-fixed reference is the “Tool Center Point” (TCP) of the robot.
As a result, it can be positioned with high precision in one embodiment.
Additionally or alternatively, in one embodiment, a target task motion, in particular in the joint coordinate space of the robot, is determined on the basis of the predetermined task, in particular its Jacobian matrix, in particular its generalized or pseudo inverse, in an embodiment according to
{dot over (q)}
task
J
#
·{dot over (x)}
d (7)
In one embodiment, the robot is controlled with the aid of a velocity and/or position control on the basis of the target task motion and/or the target admittance motion projected into the zero space, in particular on the basis of a target velocity according to
whereby this target velocity can be integrated into a target position in one embodiment. In one embodiment, joints or drives of the robot are thus actuated or commanded on the basis of the target task motion and/or the target admittance motion projected into the zero space.
The present invention can be used with particular advantage in medical robotics. Correspondingly, in one embodiment the robot guides a medical tool, in one embodiment a micro-invasive or non-surgical tool/tool that is not used in surgery. Equally, the present invention can be used with particular advantage in telemanipulation or the robot can be used as a telemanipulator.
According to one embodiment of the present invention, a system for operating the robot, in particular in hardware and/or software, in particular in terms of programming, is configured to carry out a method described here and/or has means for carrying out the task and carrying out an admittance motion that is dependent on a force exerted externally on the robot and on a predetermined virtual mass, stiffness and/or damping in the zero space when the task is carried out.
In one embodiment, the system or its means comprises:
A means within the meaning of the present invention may be designed in hardware and/or in software, and in particular may comprise a data-connected or signal-connected, in particular, digital, processing unit, in particular microprocessor unit (CPU), graphic card (GPU) having a memory and/or bus system or the like and/or one or multiple programs or program modules. The processing unit may be designed to process commands that are implemented as a program stored in a memory system, to detect input signals from a data bus and/or to output signals to a data bus. A storage system may comprise one or a plurality of, in particular different, storage media, in particular optical, magnetic, solid-state and/or other non-volatile media. The program may be designed in such a way that it embodies or is capable of carrying out the methods described herein, so that the processing unit is able to carry out the steps of such methods and thus, in particular, is able to control or regulate the robot. For the sake of a more compact representation, in the present case regulation is also generally referred to as controlling. In one embodiment, a computer program product may comprise, in particular, a non-volatile storage medium for storing a program or comprise a program stored thereon, an execution of this program prompting a system or a controller, in particular a computer, to carry out the method described herein or one or multiple of steps thereof.
In one embodiment, one or multiple, in particular all, steps of the method are carried out completely or partially automatically, in particular by the system or its means.
In one embodiment, the system comprises the robot and/or its controller.
In one embodiment, time derivatives can be implemented by corresponding differences, for example the task {dot over (x)}d by a differential command Δxd, the target velocity {dot over (q)}d by a differential command Δqd, etc.
Further advantages and features will be apparent from the accompanying drawings and the description thereof.
The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate exemplary embodiments of the invention and, together with a general description of the invention given above, and the detailed description given below, serve to explain the principles of the invention.
The robot 10 guides a tool 12 which is fastened to the robot end flange 11 and comprises a distal tool tip 13.
A predetermined task is, for example, to keep the three-dimensional Cartesian position of the tool-fixed point X constant. Another predefined task can be, for example, a predefined TCP pose or TCP path.
In a first step S10, the controller 2 determines forces, in particular torques Ti about the (rotational) axes, in the joints of the robot, for example by means of force, in particular torque sensors in the joints (not shown).
In a second step S20, the controller 2 uses this to determine a force Text exerted externally on the robot, for example according to Eq. (6) or in another way.
In a third step S30, the controller 2 determines a target admittance motion {dot over (q)}a or {umlaut over (q)}a on the basis of this force Text exerted externally on the robot and a predetermined virtual mass M and damping D, with the aid of an admittance control, for example according to Eq. (5), (5′) with K=0 or in another way.
In a fourth step S40, the controller 2 projects this target admittance motion into the zero space of the task, adds a task target motion that it determines on the basis of the generalized or pseudo inverse of the Jacobian matrix of the predetermined task, for example according to Eq. (7) or in another way, and feeds the resulting or according to Eq. (8) determined target motion ad, possibly after integration into a target position qd in the joint coordinate space, to a velocity or position control, which commands the corresponding joint angle or controls drives of the robot 10 (not shown) accordingly.
As a result, when carrying out the task in the zero space, the robot 10 carries out an admittance motion {dot over (q)}a that is dependent on the force exerted externally on the robot and on the predetermined virtual mass and damping.
Although embodiments have been explained in the preceding description, it is noted that a large number of modifications are possible. It is also noted that the embodiments are merely examples that are not intended to restrict the scope of protection, the applications and the structure in any way. Rather, the preceding description provides a person skilled in the art with guidelines for implementing at least one embodiment, with various changes, in particular with regard to the function and arrangement of the described components, being able to be made without departing from the scope of protection as it arises from the claims and from these equivalent combinations of features.
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 de-tail. 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
| Number | Date | Country | Kind |
|---|---|---|---|
| 10 2019 202 456.4 | Feb 2019 | DE | national |
This application is a national phase application under 35 U.S.C. § 371 of International Patent Application No. PCT/EP2020/051708, filed Jan. 24, 2020 (pending), which claims the benefit of priority to German Patent Application No. DE 10 2019 202 456.4, filed Feb. 22, 2019, the disclosures of which are incorporated by reference herein in their entirety.
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/EP2020/051708 | 1/24/2020 | WO | 00 |
