EP4334089A1 - Verfahren und system zum steuern eines teleroboters - Google Patents

Verfahren und system zum steuern eines teleroboters

Info

Publication number
EP4334089A1
EP4334089A1 EP22725197.2A EP22725197A EP4334089A1 EP 4334089 A1 EP4334089 A1 EP 4334089A1 EP 22725197 A EP22725197 A EP 22725197A EP 4334089 A1 EP4334089 A1 EP 4334089A1
Authority
EP
European Patent Office
Prior art keywords
telerobot
actuating means
commanding
virtual
force
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
EP22725197.2A
Other languages
English (en)
French (fr)
Inventor
Juan David Munoz Osorio
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
KUKA Deutschland GmbH
Original Assignee
KUKA Deutschland GmbH
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by KUKA Deutschland GmbH filed Critical KUKA Deutschland GmbH
Publication of EP4334089A1 publication Critical patent/EP4334089A1/de
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1689Teleoperation
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40117Virtual mecanism, like slider to constraint movement in task space
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40137Force sensation feedback from simulated tool
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40194Force reflective, impedance shaping tele operation

Definitions

  • the present invention relates to a method and a system for controlling a tele-robot using an input device which has a movable actuating means, and a computer program or computer program product for carrying out the method.
  • target pose changes of the telerobot for example its end effector or TCP
  • target forces of the positioning means are commanded on the basis of sensor-determined external forces on the telerobot, so that the operator has a haptic ( Force) feedback learns on the actuating means.
  • the object of the present invention is to improve the control of a tele-robot by actuating an actuating means of an input device.
  • a method for controlling a telerobot using an input device that has a movable actuating means the steps being repeated, preferably multiple times, cyclically in one embodiment:
  • commanding a target pose of the telerobot in one embodiment commanding a target pose of a robot-fixed reference of the telerobot, on the basis of a detected position of the actuating means, in one embodiment caused manually by an operator;
  • the telerobot can advantageously be controlled more precisely in one embodiment, by commanding target forces in one embodiment an advantageous, particularly reliable, ergonomic and/or (more) intuitive operation of the actuating means is realized and a teleoperation is thus simplified in one embodiment and/or its reliability is improved.
  • the telerobot has a ((tele)robot) arm with at least three, in particular at least six, in one embodiment at least seven, joints or axes of movement.
  • the robot-fixed reference is stationary with respect to a distal end flange of the telerobot (arm), in one embodiment the robot-fixed reference has an end effector or TCP of the telerobot (arm), can in particular be an end effector or TCP of the telerobot (arm). be.
  • the actuating means is spatially spaced apart from the telerobot and/or a (robot) controller of the telerobot.
  • the input device in particular an input device controller, is signal-connected to the telerobot and/or a (robot) controller of the telerobot, wired in one embodiment, which can increase safety in one embodiment, wireless in another embodiment, which in one embodiment which can increase flexibility and/or reach.
  • the adjusting means is movably mounted, in particular via one or more joints, on a base of the input device, with a position of the adjusting means relative to the base of the input device being detected in one embodiment, preferably by sensors.
  • a pose of the telerobot comprises a one-, two- or three-dimensional position and/or a one-, two- or three-dimensional orientation, in one embodiment a or the robot-fixed reference, in particular an end effector or TCP, of the telerobot. Additionally or alternatively, in one embodiment, a pose of the telerobot includes the joint position of one or more joints of the telerobot.
  • a position of the actuating means comprises a one-, two- or three-dimensional position and/or a one-, two- or three-dimensional orientation of the actuating means relative to one or the base of the input device and/or the joint position of one or more joints, via which the adjusting means is movably mounted relative to a or the base of the input device.
  • a force within the meaning of the present invention can also have, in particular be, an oppositely parallel force couple or torque. Controlling within the meaning of the present invention can also be regulating.
  • drives of the telerobot adjust its axes or joints in order to approach the commanded target pose(s), with corresponding target joint adjustments being determined in one embodiment in a manner known per se using inverse kinematics, possibly under Redundancy resolution in a manner known per se.
  • drives of the input device actuate the actuating means in order to exert the commanded setpoint force, in particular via the actuating means on an operator manually actuating the actuating means.
  • one or more virtual boundary(s) for the telerobot between (respectively) a permissible and a non-permissible area is or are, in particular, is or will be predetermined.
  • the or one or more of the virtual boundary(s) is or are, in particular is or are, in one embodiment (respectively) specified as a virtual, in particular straight or curved, wall in a working space of the telerobot.
  • the teleoperation can be improved, in particular an area surrounding the telerobot can be protected and/or control of the telerobot by an operator using the input device can be improved, in particular guided.
  • the or one or more of the virtual boundary(s) is or are, in particular will be, predefined as a virtual stop of one or more joints of the telerobot.
  • the telerobot can be protected in one embodiment.
  • the commanded target force of the actuator has a restoring force component from this virtual boundary, which counteracts or determines or commands an actuation of the actuator to command a movement of the telerobot away from the boundary in the direction of the impermissible area becomes.
  • the operator who controls the telerobot via or by adjusting the adjusting means(s) is provided with advantageous haptic feedback in the form of an artificially or additionally generated counterforce.
  • the control of the telerobot using the input device or by an operator actuating the actuating means can be improved, in particular the operator can control the telerobot more easily, more reliably, more precisely, more ergonomically and/or control intuitively.
  • the restoring force component simulates, preferably only or exclusively, a contact of the telerobot with an obstacle, in one embodiment a contact of a or the robot-fixed reference of the telerobot with a surrounding obstacle.
  • the surface of the (virtual) obstacle is and is directed away from this (virtual) surface (into the permissible range), or the target force or restoring force component is determined or commanded accordingly.
  • control of the telerobot using the input device or by an operator actuating the actuating means can be improved, in particular the operator can control the telerobot more easily, more reliably, more precisely, more ergonomically and/or control intuitively.
  • the restoring force component is a force of a virtual compression spring
  • this virtual compression spring in a further development only through or upon actuation of the actuating means for commanding a movement of the telerobot away from the boundary in the direction of the inadmissible area and/or a movement of the telerobot away from the boundary in the direction of the inadmissible area is (virtually) stretched or compressed and/or a spring (compression) force of this virtual compression spring of a current and/or a previous position of the actuating means and/or a current and/or a previous pose of the telerobot, in particular the robot-fixed reference, in particular on the basis of a current and/or a previous position of the actuating means and/or a current one and/or a previous pose of the telerobot, in particular the robot-fixed reference.
  • this virtual spring acts only as a compression spring and not as a tension spring.
  • this restoring force component or virtual compression spring conveys or simulates only a force on the telerobot in the opposite direction to a contact or penetration direction, which is directed away from the boundary in the direction of the impermissible area, but not in any other direction, or a corresponding force (component) on the actuating means.
  • the restoring force component can be determined in a particularly simple, reliable and/or precise manner and/or contact of the telerobot with an obstacle can be simulated in a particularly simple and/or realistic manner.
  • the spring (compression) force of the virtual compression spring depends on a predetermined spring stiffness of the virtual compression spring, which in one embodiment can be adjusted by an operator of the input device, is determined in particular on the basis of a predetermined, in one embodiment by an operator of the Input device adjustable spring stiffness of this virtual spring determined.
  • the spring (compression) force of the virtual compression spring in one embodiment (also) depends on a predetermined scaling between adjustments of the actuating means and movements of the telerobot, in particular the robot-fixed reference, which can be adjusted in one embodiment by an operator of the input device, is determined in particular on the basis of a predetermined scaling between adjustments of the actuating means and movements of the telerobot, in particular the robot-fixed reference, which in one embodiment can be set by an operator of the input device.
  • a particularly advantageous spring characteristic of the virtual spring or contact force component or of the simulated contact can be implemented, thereby simplifying teleoperation and/or improving its reliability in one embodiment.
  • commanding a movement of the telerobot from the boundary in the direction of the impermissible area is suppressed during actuation of the actuating means for commanding this movement of the telerobot, or when the actuating means for commanding a movement of the telerobot is actuated, a component of this movement from the boundary blanked out or not commanded in the direction of the forbidden area or commanded only components of this movement in the direction of the forbidden area and/or along the boundary.
  • the teleoperation can be improved, in particular an area surrounding the telerobot can be protected and/or control of the telerobot by an operator using the input device can be improved, in particular guided.
  • the setpoint force has a force feedback component that depends on an external force acting on or on the telerobot, in a further development on its or on its robot-fixed reference, this simulates this in one embodiment, in a Training replicates scaled.
  • the external force on or on the telerobot is determined using at least one distal or end-effector-side force sensor of the telerobot and/or, preferably with model support, on the basis of joint forces of the telerobot.
  • the setpoint force has a damping component that depends on an adjustment speed of the actuating means, which in one embodiment is directed in the opposite direction.
  • the operator can control the telerobot more simply, more reliably, more precisely and/or more ergonomically.
  • a rotation matrix 0 R L which has a coordinate system 0 of Cartesian space and a coordinate system L, which is aligned with the prohibited or limiting direction, in one embodiment with a z-axis aligned with this, transformed into one another, determined, where a rotation axis U and a rotation angle Q of this transformation or rotation matrix in one embodiment
  • the target force f d , HD of the adjusting means becomes a restoring force component according to equation (1).
  • K is a spring stiffness of the virtual spring and X d
  • a virtual boundary is specified as a virtual stop of one or more joints, in one embodiment, the rows or columns of the joints that are at the stop or the virtual boundary are assigned zeros in a one-matrix, for example seven in a telerobot joints and the second and sixth joint at the virtual stop: and performed a Singular Value Decomposition (SVD) of the matrix JP( J.
  • SVD Singular Value Decomposition
  • This impermissible or limiting direction u L is then used in the manner described above in order to determine or command the associated restoring force component in the case of a virtual limitation in the form of a virtual stop of one or more joints of the telerobot.
  • a system in particular hardware and/or software, in particular programming, is set up to carry out a method described here and/or has:
  • system or its means(s) has:
  • a system and/or means within the meaning of the present invention can be designed in terms of hardware and/or software, in particular at least one processing, in particular digital, preferably connected to a memory and/or bus system for data or signals Microprocessor unit (CPU), graphics card (GPU) or the like, and/or have one or more programs or program modules.
  • the processing unit can 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 output signals to a data bus.
  • a storage system can have one or more, in particular different, storage media, in particular optical, magnetic, solid-state and/or other non-volatile media.
  • a computer program product can have, in particular, be a, in particular, computer-readable and/or non-volatile storage medium for storing a program or instructions or with a program or with instructions stored thereon.
  • execution of this program or these instructions by a system or controller causes the system or controller, in particular the computer or computers, to perform a method described here or one or more of its steps, or the program or the instructions are set up to do so.
  • one or more, in particular all, steps of the method are carried out fully or partially automatically, in particular by the system or its means.
  • the system has the telerobot and/or its robot controller and/or the input device.
  • a contact within the meaning of the present invention is understood to mean, in particular in a manner known per se, a one-sided contact or the touching of two surfaces.
  • the target pose in a further development the commanding and/or moving to the target pose, using a position, speed or Force control realized in the joint space or space of the joint coordinates of the telerobot.
  • the telerobot can be operated advantageously, in particular more precisely, more easily and/or more reliably.
  • Fig. 1 a system for controlling a telerobot using a
  • Fig. 2 a method for controlling the telerobot using the
  • Input device according to an embodiment of the present invention.
  • 1, 2 show a system and method according to an embodiment of the present invention for controlling a telerobot (arm) 1 using an input device, which has a base 2.1, an actuating means 3 movable relative to the base 2.1, and an input device controller 2.2 a robot controller 4, which communicates wirelessly or by wire with the input device controller 2.2.
  • the input device controller 2.2 can be integrated into the base 2.1.
  • a current pose of the actuating means 3 relative to the input device 2.1 and, in one embodiment, using at least one distal or end effector-side force sensor 6 of the telerobot (arm) or model-based on the basis of joint forces of the telerobot (arm), an external Force f e determined by sensors on a robot-fixed reference in the form of an end effector 5.
  • a current position X c,HD of the actuating means and a current pose X c,r of the end effector 5 are determined, with the (current) adjustment speed (dX/dt) c,HD in one embodiment being determined by time differentiation of the current position X c,HD determined or, conversely, the current position X c,HD is determined by time integration.
  • a step S20 it is determined whether the telerobot is located at one or more predetermined virtual boundaries or impermissible areas delimited by them. If this is not the case (S20: "N"), a new target force f d, HD of the actuating means 3 and a new target pose X d,r des Telerobot, determined in an embodiment of the end effector 5.
  • a step S50 the respective target pose and target force are commanded.
  • the method then returns to step S10, with the previous current position of the actuating means 3 forming the new previous position of the actuating means 3 and the previous current pose of the end effector 5 forming the new previous pose of the end effector 5.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

Ein Verfahren zum Steuern eines Teleroboters (1) mithilfe einer Eingabevorrichtung, die ein bewegliches Stellmittel (3) aufweist, umfasst die, insbesondere mehrfach wiederholten, Schritte: - Kommandieren (S50) einer Soll-Pose des Teleroboters auf Basis einer erfassten Stellung des Stellmittels; und - Kommandieren (S50) einer Soll-Kraft des Stellmittels; wobei wenigstens eine virtuelle Begrenzung für den Teleroboter zwischen einem zulässigen und einem unzulässigen Bereich vorgegeben ist, und die Soll-Kraft ab dieser Begrenzung eine Rückstellkraftkomponente aufweist, die einer Betätigung des Stellmittels zum Kommandieren einer Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs entgegenwirkt.

Description

Beschreibung
Verfahren und System zum Steuern eines Teleroboters
Die vorliegende Erfindung betrifft ein Verfahren und ein System zum Steuern eines Teleroboters mithilfe einer Eingabevorrichtung, die ein bewegliches Stellmittel aufweist, sowie ein Computerprogramm bzw. Computerprogrammprodukt zur Durchführung des Verfahrens.
Aus betriebsinterner Praxis ist es bekannt, einen Teleroboter mithilfe einer Eingabevorrichtung zu steuern, die ein bewegliches Stellmittel aufweist. Dabei werden Soll-Posenänderungen des Teleroboters, beispielsweise seines Endeffektors oder TCPs, auf Basis einer erfassten manuellen Verstellung des Stellmittels durch einen Bediener kommandiert und umgekehrt Soll-Kräfte des Stellmittels auf Basis sensorisch ermittelter externer Kräfte am Teleroboter kommandiert, so dass der Bediener eine haptische (Kraft)Rückkopplung am Stellmittel erfährt.
Aufgabe der vorliegenden Erfindung ist es, das Steuern eines Teleroboters mithilfe einer Betätigung eines Stellmittels einer Eingabevorrichtung zu verbessern.
Diese Aufgabe wird durch ein Verfahren mit den Merkmalen des Anspruchs 1 gelöst. Ansprüche 8, 9 stellen ein System bzw. Computerprogramm bzw. Computerprogrammprodukt zur Durchführung eines hier beschriebenen Verfahrens unter Schutz. Die Unteransprüche betreffen vorteilhafte Weiterbildungen.
Nach einer Ausführung der vorliegenden Erfindung weist ein Verfahren zum Steuern eines Teleroboters mithilfe eines Eingabevorrichtung, die ein bewegliches Stellmittel aufweist, die, vorzugsweise mehrfach, in einer Ausführung zyklisch, wiederholten, Schritte auf:
- Kommandieren einer Soll-Pose des Teleroboters, in einer Ausführung Kommandieren einer Soll-Pose einer roboterfesten Referenz des Teleroboters, auf Basis einer erfassten, in einer Ausführung manuell durch einen Bediener bewirkten, Stellung des Stellmittels; und
- Kommandieren einer Soll-Kraft des Stellmittels, insbesondere auf das Stellmittel. Durch das Kommandieren von Soll-Posen kann der Teleroboter in einer Ausführung vorteilhaft präzise(r) gesteuert werden, durch das Kommandieren von Soll-Kräften in einer Ausführung eine vorteilhafte(re), insbesondere zuverlässige(re), ergonomische(re) und/oder intuitive(re) Bedienung des Stellmittels realisiert und so in einer Ausführung eine Teleoperation vereinfacht und/oder ihre Zuverlässigkeit verbessert werden.
Der Teleroboter weist in einer Ausführung einen ((Tele)Roboter)Arm mit wenigstens drei, insbesondere wenigstens sechs, in einer Ausführung wenigstens sieben, Gelenken bzw. Bewegungsachsen auf. Die roboterfeste Referenz ist in einer Ausführung ortsfest bezüglich eines distalen Endflanschs des Teleroboter(arm)s, in einer Ausführung weist die roboterfeste Referenz einen Endeffektor oder TCP des Teleroboter(arm)s auf, kann insbesondere ein Endeffektor oder TCP des Teleroboter(arm)s sein.
Das Stellmittel ist in einer Ausführung von dem Teleroboter und/oder einer (Roboter)Steuerung des Teleroboters räumlich beabstandet. In einer Ausführung ist die Eingabevorrichtung, insbesondere eine Eingabevorrichtungssteuerung, mit dem Teleroboter und/oder einer (Roboter)Steuerung des Teleroboters signalverbunden, in einer Weiterbildung drahtgebunden, was in einer Ausführung die Sicherheit erhöhen kann, in einer anderen Weiterbildung drahtlos, was in einer Ausführung die Flexibilität und/oder Reichweite erhöhen kann. Das Stellmittel ist in einer Ausführung beweglich, insbesondere über ein oder mehrere Gelenke, an einer Basis der Eingabevorrichtung gelagert, wobei eine Stellung des Stellmittels relativ zur Basis der Eingabevorrichtung in einer Ausführung, vorzugsweise sensorisch, erfasst wird.
Eine Pose des Teleroboters umfasst in einer Ausführung eine ein-, zwei- oder dreidimensionale Position und/oder eine ein-, zwei oder dreidimensionale Orientierung, in einer Ausführung einer bzw. der roboterfesten Referenz, insbesondere eines Endeffektors oder TCPs, des Teleroboters. Zusätzlich oder alternativ umfasst eine Pose des Teleroboters in einer Ausführung die Gelenkstellung von einem oder mehreren Gelenken des Teleroboters. Eine Stellung des Stellmittels umfasst in einer Ausführung eine ein-, zwei- oder dreidimensionale Position und/oder eine ein-, zwei oder dreidimensionale Orientierung des Stellmittels relativ zu einer bzw. der Basis der Eingabevorrichtung und/oder die Gelenkstellung von einem oder mehreren Gelenken, über die das Stellmittel relativ zu einer bzw. der Basis der Eingabevorrichtung beweglich gelagert ist.
Eine Kraft im Sinne der vorliegenden Erfindung kann auch ein gegensinnig paralleles Kräftepaar bzw. Drehmoment aufweisen, insbesondere sein. Ein Steuern im Sinne der vorliegenden Erfindung kann auch ein Regeln sein.
In einer Ausführung verstellen Antriebe des Teleroboters dessen Achsen bzw. Gelenke, um die kommandierte(n) Soll-Pose(n) anzufahren, wobei entsprechende Soll-Gelenk-Verstellungen in einer Ausführung in an sich bekannter Weise mittels inverser Kinematik ermittelt werden, gegebenenfalls unter Redundanzauflösung in an sich bekannter Weise.
In einer Ausführung aktuieren Antriebe der Eingabevorrichtung das Stellmittel, um die kommandierte Soll-Kraft auszuüben, insbesondere über das Stellmittel auf eine das Stellmittel manuell betätigende Bedienperson.
Nach einer Ausführung der vorliegenden Erfindung ist bzw. sind, insbesondere wird bzw. werden, eine oder mehrere virtuelle Begrenzung(en) für den Teleroboter zwischen (jeweils) einem zulässigen und einem unzulässigen Bereich vorgegeben.
Die bzw. eine oder mehrere der virtuelle(n) Begrenzung(en) ist bzw. sind, insbesondere wird bzw. werden, in einer Ausführung (jeweils) als virtuelle, insbesondere gerade oder gekrümmte, Wand in einem Arbeitsraum des Teleroboters vorgegeben.
Dadurch kann in einer Ausführung die Teleoperation verbessert, insbesondere eine Umgebung des Teleroboters geschützt und/oder ein Steuern des Teleroboters durch einen Bediener mithilfe der Eingabevorrichtung verbessert, insbesondere geführt, werden.
In einer Ausführung ist bzw. sind, insbesondere wird bzw. werden, die bzw. eine oder mehrere der virtuelle(n) Begrenzungen jeweils) als virtueller Anschlag eines oder mehrerer Gelenke des Teleroboters vorgegeben. Dadurch kann in einer Ausführung der Teleroboter geschützt werden.
Nach einer Ausführung der vorliegenden Erfindung weist die kommandierte Soll-Kraft des Stellmittels ab dieser virtuellen Begrenzung eine Rückstellkraftkomponente auf, die einer Betätigung des Stellmittels zum Kommandieren einer Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs entgegenwirkt bzw. derart ermittelt bzw. kommandiert wird.
Dadurch wird in einer Ausführung dem Bediener, der den Teleroboter über das bzw. Verstellen des Stellmittel(s) steuert, eine vorteilhafte haptische Rückmeldung in Form einer künstlich bzw. zusätzlich erzeugten Gegenkraft vermittelt. Hierdurch kann in einer Ausführung das Steuern des Teleroboters mithilfe der Eingabevorrichtung bzw. durch einen das Stellmittel betätigenden Bediener verbessert werden, insbesondere der Bediener den Teleroboter einfach(er), zuverlässig(er), präzise(r), ergonomisch(er) und/oder intuitiv(er) steuern.
In einer Ausführung simuliert die Rückstellkraftkomponente, vorzugsweise nur bzw. ausschließlich, einen Kontakt des Teleroboters mit einem Hindernis, in einer Ausführung einen Kontakt einer bzw. der roboterfesten Referenz des Teleroboters mit einem Umgebungshindernis. Das beinhaltet in einer Ausführung, dass ein Bediener des Stellmittels diese Rückstellkraftkomponente nur als Kraft(komponente) spürt, die, in einer Ausführung skaliert, einer externen Kraft am Teleroboter, insbesondere der roboterfesten Referenz, in einer Richtung entspricht, die senkrecht zu einer (virtuellen) Oberfläche des (virtuellen) Hindernisses steht und von dieser (virtuellen) Oberfläche weg (in den zulässigen Bereich) gerichtet ist, bzw. die Soll-Kraft bzw. Rückstellkraftkomponente entsprechend ermittelt bzw. kommandiert wird.
Hierdurch kann in einer Ausführung das Steuern des Teleroboters mithilfe der Eingabevorrichtung bzw. durch einen das Stellmittel betätigenden Bediener verbessert werden, insbesondere der Bediener den Teleroboter einfach(er), zuverlässig(er), präzise(r), ergonomisch(er) und/oder intuitiv(er) steuern.
In einer Ausführung ist die Rückstellkraftkomponente eine Kraft einer virtuellen Druckfeder, wobei diese virtuelle Druckfeder in einer Weiterbildung nur durch bzw. bei eine(r) Betätigung des Stellmittels zum Kommandieren einer Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs und/oder eine(r) Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs (virtuell) gespannt bzw. gestaucht wird und/oder eine Feder(druck)kraft dieser virtuellen Druckfeder von einer aktuellen und/oder einer vorhergehenden Stellung des Stellmittels und/oder von einer aktuellen und/oder einer vorhergehenden Pose des Teleroboters, insbesondere der roboterfesten Referenz, abhängt, insbesondere auf Basis einer aktuellen und/oder einer vorhergehenden Stellung des Stellmittels und/oder einer aktuellen und/oder einer vorhergehenden Pose des Teleroboters, insbesondere der roboterfesten Referenz, ermittelt wird. Somit wirkt diese virtuelle Feder in einer Ausführung nur als Druck- und nicht als Zugfeder.
In einer Ausführung vermittelt bzw. simuliert diese Rückstellkraftkomponente bzw. virtuelle Druckfeder nur eine Kraft am Teleroboter gegensinnig zu einer Kontakt- bzw. Eindringrichtung, welche von der Begrenzung weg in Richtung des unzulässigen Bereichs gerichtet ist, aber nicht in irgendeiner anderen Richtung, bzw. eine entsprechende Kraft(komponente) am Stellmittel.
Hierdurch kann in einer Ausführung die Rückstellkraftkomponente besonders einfach, zuverlässig und/oder präzise ermittelt und/oder ein Kontakt des Teleroboters mit einem Hindernis besonders einfach und/oder realistisch simuliert werden.
In einer Ausführung hängt die Feder(druck)kraft der virtuellen Druckfeder (auch) von einer vorgegebenen, in einer Ausführung durch einen Bediener der Eingabevorrichtung einstellbaren, Federsteifigkeit der virtuellen Druckfeder ab, wird insbesondere auf Basis einer vorgegebenen, in einer Ausführung durch einen Bediener der Eingabevorrichtung einstellbaren, Federsteifigkeit dieser virtuellen Feder ermittelt.
Zusätzlich oder alternativ hängt die Feder(druck)kraft der virtuellen Druckfeder in einer Ausführung (auch) von einer vorgegebenen, in einer Ausführung durch einen Bediener der Eingabevorrichtung einstellbaren, Skalierung zwischen Verstellungen des Stellmittels und Bewegungen des Teleroboters, insbesondere der roboterfesten Referenz, ab, wird insbesondere auf Basis einer vorgegebenen, in einer Ausführung durch einen Bediener der Eingabevorrichtung einstellbaren, Skalierung zwischen Verstellungen des Stellmittels und Bewegungen des Teleroboters, insbesondere der roboterfesten Referenz, ermittelt. Hierdurch kann in einer Ausführung eine besonders vorteilhafte Federcharakteristik der virtuellen Feder bzw. Kontaktkraftkomponente bzw. des simulierten Kontakts realisiert und dadurch in einer Ausführung eine Teleoperation vereinfacht und/oder ihre Zuverlässigkeit verbessert werden.
In einer Ausführung wird ein Kommandieren einer Bewegung des Teleroboters ab der Begrenzung in Richtung des unzulässigen Bereichs während einer Betätigung des Stellmittels zum Kommandieren dieser Bewegung des Teleroboters unterdrückt bzw. bei einer Betätigung des Stellmittels zum Kommandieren einer Bewegung des Teleroboters eine Komponente dieser Bewegung ab der Begrenzung in Richtung des unzulässigen Bereichs ausgeblendet bzw. nicht kommandiert bzw. nur Komponenten dieser Bewegung in Richtung des zulässigen Bereichs und/oder entlang der Begrenzung kommandiert.
Dadurch kann in einer Ausführung die Teleoperation verbessert, insbesondere eine Umgebung des Teleroboters geschützt und/oder ein Steuern des Teleroboters durch einen Bediener mithilfe der Eingabevorrichtung verbessert, insbesondere geführt, werden.
In einer Ausführung weist die Soll-Kraft eine Kraftrückkopplungskomponente auf, die von einer externen Kraft an dem bzw. auf den Teleroboter, in einer Weiterbildung an dessen bzw. auf dessen roboterfeste Referenz, wirkenden externen Kraft abhängt, diese in einer Ausführung nachbildet, in einer Weiterbildung skaliert nachbildet.
Die externe Kraft an dem bzw. auf den Teleroboter wird in einer Ausführung mithilfe wenigstens eines distalen bzw. endeffektorseitigen Kraftsensors des Teleroboters und/oder, vorzugsweise modellgestützt, auf Basis von Gelenkkräften des Teleroboters ermittelt.
Dadurch kann in einer Ausführung eine vorteilhafte haptische Rückkopplung realisiert und hierdurch die Teleoperation verbessert werden, vorzugsweise der Bediener den Teleroboter einfach(er), zuverlässig(er), präzise(r), ergonomisch(er) und/oder intuitiv(er) steuern. In einer Ausführung weist die Soll-Kraft eine Dämpfungskomponente auf, die von einer Verstellgeschwindigkeit des Stellmittels abhängt, dieser in einer Ausführung entgegengerichtet ist.
Dadurch kann in einer Ausführung der Bediener den Teleroboter einfach(er), zuverlässig(er), präzise(r) und/oder ergonomisch(er) steuern.
In einer Ausführung wird, wenn der Teleroboter in dem zulässigen Bereich bzw. nicht an der Begrenzung oder in dem unzulässigen Bereich ist, eine Soll-Kraft fd, HD des Stellmittels ermittelt, die eine Kraftrückkopplungskomponente, die von einer externen Kraft fe an dem Teleroboter, in einer Ausführung an einer bzw. der roboterfesten Referenz, insbesondere also dem Endeffektor bzw. TCP, abhängt, diese insbesondere (skaliert) nachbildet, und in einer Ausführung zusätzlich eine Dämpfungskomponente, die von einer (aktuellen) Verstellgeschwindigkeit ( dX/dt)c,HD des Stellmittels abhängt, aufweist: fd, HD = fe - D.(dX/dt)c,HD (1) mit dem Dämpfungskoeffizienten D.
In einer Ausführung wird eine Soll-Pose Xd,r des Teleroboters, in einer Ausführung einer bzw. der roboterfesten Referenz, insbesondere also des Endeffektors bzw. TCPs, gemäß Xd,r = (Xc,HD - Xini,HD).s + Xini,r (2) mit der aktuellen Stellung Xc,HD des Stellmittels, der vorhergehenden Stellung Xini,HD des Stellmittels, der vorhergehenden Pose Xini,r des Teleroboters bzw. der roboterfesten Referenz und einer vorgegebenen Skalierung s zwischen Verstellungen des Stellmittels und Bewegungen des Teleroboters bzw. der roboterfesten Referenz ermittelt, wenn der Teleroboter in dem zulässigen Bereich bzw. nicht an der Begrenzung oder in dem unzulässigen Bereich ist.
In einer Ausführung wird für eine oder mehrere virtuelle Begrenzungen jeweils eine unzulässige bzw. Begrenzungsrichtung uL, vorzugsweise senkrecht zu der virtuellen Begrenzung und in Richtung des unzulässigen Bereichs, ermittelt. Ist beispielsweise eine virtuelle Begrenzung in Form einer virtuellen Wand bei ymax im kartesischen Arbeitsraum vorgegeben, so ist diese die unzulässige bzw. Begrenzungsrichtung uL = [0 1 0]T
In einer Ausführung wird eine Rotationsmatrix 0RL, die ein Koordinatensystem 0 des kartesischen Raums und ein Koordinatensystem L, das an der unzulässigen bzw. Begrenzungsrichtung ausgerichtet ist, in einer Ausführung eine mit dieser fluchtende z-Achse aufweist, ineinander transformiert, ermittelt, wobei eine Rotationsachse U und ein Rotationswinkel Q dieser Transformation bzw. Rotationsmatrix in einer Ausführung aus
U = [0 0 1]T x uL (3.1) cos θ = ([0 0 1]T. uL)/|| uL|| (3.2) ermittelt wird und die Rotationsmatrix 0RL vom Koordinatensystem L in das Koordinatensystem 0 transformiert, ihre Transponierte ( 0RL)T entsprechend vom Koordinatensystem 0 in das Koordinatensystem L. Natürlich kann anstelle der z- Achse auch eine andere Achse verwendet und dies in den entsprechenden Gleichungen berücksichtigt werden.
Ab der virtuellen Begrenzung wird in einer Ausführung der Soll-Kraft fd, HD des Stellmittels gemäß Gleichung (1) eine Rückstellkraftkomponente
LeHD = ( 0RL)T · (Xd, HD - Xc,HD) (4.1 )
Lfimp, HD = 0 (4.2)
LeHD [3] < 0 => setze Lfimp,HD [3] = K . LeHD [3] (4.3) fimp,HD = 0RL . Lfimp,HD (4.4) einer virtuellen Druckfeder hinzugefügt: fd, HD = fe + fimp,HD - D.(dX/dt)c,HD (5)
Dabei ist K eine Federsteifigkeit der virtuellen Feder und Xd, HD eine Soll-Stellung des Stellmittels, insbesondere gemäß: Xd, HD = (Xc,r - Xini,r)/s + Xini,HD (6) mit der aktuellen PoseXc,r der roboterfesten Referenz. Man erkennt, dass die Federkraft der virtuellen Druckfeder von der aktuellen und der vorhergehenden Stellung des Stellmittels und der aktuellen und der vorhergehenden Pose des Teleroboters abhängt: K . (Xd, HD - Xc,HD) = K . [(Xc,r - Xini,r)/s + (Xini,HD - Xc,HD)] (7) und nur einer Betätigung des Stellmittels zum Kommandieren einer Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs entgegenwirkt (LeHD [3] < 0). Der Index *[3] bezeichnet die z-Komponente des entsprechenden Vektors. Ist beispielsweise eine virtuelle Begrenzung in Form einer virtuellen Wand im Arbeitsraum bei ymax vorgegeben, so wird ab der Begrenzung, d. h. für yd,r > ymax mit der y-Komponente yd,r der kartesischen Position des Endeffektors bzw. TCPs, ein Kommandieren einer Bewegung des Teleroboters in Richtung des unzulässigen Bereichs während einer Betätigung des Stellmittels zum Kommandieren dieser Bewegung des Teleroboters unterdrückt yd,r > ymax = > setze yd,r = ymax (8) und der Soll-Kraft fd,HD des Stellmittels gemäß Gleichung (1) die Rückstellkraftkomponente fimp,HD = K . [0 (yd,HD - yc,HD) 0]T (9.1) bzw. in allgemeiner Form fimp,HD = K . (Xd,HD - Xc,HD) (9.2) hinzugefügt. Falls eine virtuelle Begrenzung als virtueller Anschlag eines oder mehrerer Gelenke vorgegeben ist, werden in einer Ausführung in einer Eins-Matrix die Zeilen bzw. Spalten der Gelenke mit Null belegt, die am Anschlag bzw. der virtuellen Begrenzung sind, beispielsweise bei einem Teleroboter mit sieben Gelenken und dem zweiten und sechsten Gelenk am virtuellen Anschlag: und eine Singulärwertzerlegung („Singular Value Decomposition“ SVD) der Matrix J. P.( J. P)T mit der Jacobimatrix J der roboterfesten Referenz in eine unitäre Matrix U, die Adjungierte V* einer unitären Matrix V und die Matrix S der Singulärwerte durchgeführt (U. S. V* = J.P.(J.P)T). Für die Singulärwerte gleich Null, d. h. die Werte S[m, m] der Matrix S, die gleich Null sind, ist eine unzulässige bzw. Begrenzungsrichtung durch den zugehörigen Spaltenvektor U[:, m] der Matrix U bestimmt. Der Index *[m,m] bezeichnet den Wert in Spalte m und Zeile m der entsprechenden Matrix, der Index *[:,m] den m. Spaltenvektor.
Zusätzlich wird eine Geschwindigkeitsrichtung gemäß dXe/d t = J. (1 - P).J#.(dX/dt)d,r (11.1) uvel = dXe/dt/||dXe/dt|| (11.2) mit der Pseudoinversen J# und der kartesischen Soll-Geschwindigkeit zur Erreichung der Soll-Pose unter der Annahme, dass keine Gelenkanschläge vorhanden sind, ermittelt und der (jeweilige) Winkel θ zwischen dieser Geschwindigkeitsrichtung und dem bzw. den entsprechenden Spaltenvektor(en) U[:, m] der Matrix U ermittelt: cos θ = (uvel · U[: , m])/||U[:, m]|| (12) Ist dieser Winkel größer als 90°, wird als unzulässige bzw. Begrenzungsrichtung uL der negative (normierte) Spaltenvektor(en) U[:, m] der Matrix U verwendet, andernfalls der (normierte) Spaltenvektor(en) U[:, m] der Matrix U:
Diese unzulässige bzw. Begrenzungsrichtung uL wird dann in oben beschriebener Weise verwendet, um bei einer virtuellen Begrenzung in Form eines virtuellen Anschlags eines oder mehrerer Gelenke des Teleroboters die zugehörige Rückstellkraftkomponente zu ermitteln bzw. kommandieren.
Nach einer Ausführung der vorliegenden Erfindung ist ein System, insbesondere hard- und/oder Software-, insbesondere programmtechnisch, zur Durchführung eines hier beschriebenen Verfahrens eingerichtet und/oder weist auf:
- Mittel zum Vorgeben wenigstens einer virtuellen Begrenzung für den Teleroboter zwischen einem zulässigen und einem unzulässigen Bereich;
- Mittel zum Kommandieren einer Soll-Pose des Teleroboters auf Basis einer erfassten Stellung des Stellmittels; und
- Mittel zum Kommandieren einer Soll-Kraft des Stellmittels, wobei die Soll-Kraft ab der virtuellen Begrenzung eine Rückstellkraftkomponente aufweist, die einer Betätigung des Stellmittels zum Kommandieren einer Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs entgegenwirkt.
In einer Ausführung weist das System bzw. sein(e) Mittel auf:
Mittel zum Unterdrücken eines Kommandierens einer Bewegung des Teleroboters ab der Begrenzung in Richtung des unzulässigen Bereichs während einer Betätigung des Stellmittels zum Kommandieren dieser Bewegung des Teleroboters.
Ein System und/oder ein Mittel im Sinne der vorliegenden Erfindung kann hard- und/oder softwaretechnisch ausgebildet sein, insbesondere wenigstens eine, vorzugsweise mit einem Speicher- und/oder Bussystem daten- bzw. signalverbundene, insbesondere digitale, Verarbeitungs-, insbesondere Mikroprozessoreinheit (CPU), Graphikkarte (GPU) oder dergleichen, und/oder ein oder mehrere Programme oder Programmmodule aufweisen. Die Verarbeitungseinheit kann dazu ausgebildet sein, Befehle, die als ein in einem Speichersystem abgelegtes Programm implementiert sind, abzuarbeiten, Eingangssignale von einem Datenbus zu erfassen und/oder Ausgangssignale an einen Datenbus abzugeben. Ein Speichersystem kann ein oder mehrere, insbesondere verschiedene, Speichermedien, insbesondere optische, magnetische, Festkörper- und/oder andere nicht-flüchtige Medien aufweisen. Das Programm kann derart beschaffen sein, dass es die hier beschriebenen Verfahren verkörpert bzw. auszuführen imstande ist, sodass die Verarbeitungseinheit die Schritte solcher Verfahren ausführen kann und damit insbesondere den Teleroboter steuern kann. Ein Computerprogrammprodukt kann in einer Ausführung ein, insbesondere computerlesbares und/oder nicht-flüchtiges, Speichermedium zum Speichern eines Programms bzw. von Anweisungen bzw. mit einem darauf gespeicherten Programm bzw. mit darauf gespeicherten Anweisungen aufweisen, insbesondere sein. In einer Ausführung veranlasst ein Ausführen dieses Programms bzw. dieser Anweisungen durch ein System bzw. eine Steuerung, insbesondere einen Computer oder eine Anordnung von mehreren Computern, das System bzw. die Steuerung, insbesondere den bzw. die Computer, dazu, ein hier beschriebenes Verfahren bzw. einen oder mehrere seiner Schritte auszuführen, bzw. sind das Programm bzw. die Anweisungen hierzu eingerichtet.
In einer Ausführung werden ein oder mehrere, insbesondere alle, Schritte des Verfahrens vollständig oder teilweise automatisiert durchgeführt, insbesondere durch das System bzw. sein(e) Mittel.
In einer Ausführung weist das System den Teleroboter und/oder dessen Robotersteuerung und/oder die Eingabevorrichtung auf.
Unter einem Kontakt im Sinne der vorliegenden Erfindung wird insbesondere in an sich bekannter Weise ein einseitiger Kontakt bzw. die Berührung von zwei Oberflächen verstanden.
In einer Ausführung wird die Soll-Pose, in einer Weiterbildung das Kommandieren und/oder Anfahren der Soll-Pose, mithilfe einer Positions-, Geschwindigkeits- oder Kraftregelung im Gelenkraum bzw. Raum der Gelenkkoordinaten des Teleroboters realisiert. Dadurch kann der Teleroboter in einer Ausführung vorteilhaft, insbesondere präzise(r), einfach(er) und/oder zuverlässige(r), betrieben werden. Weitere Vorteile und Merkmale ergeben sich aus den Unteransprüchen und den Ausführungsbeispielen. Hierzu zeigt, teilweise schematisiert:
Fig. 1 : ein System zum Steuern eines Teleroboters mithilfe einer
Eingabevorrichtung nach einer Ausführung der vorliegenden Erfindung; und
Fig. 2: ein Verfahren zum Steuern des Teleroboters mithilfe der
Eingabevorrichtung nach einer Ausführung der vorliegenden Erfindung.
Fig. 1 , 2 zeigen ein System bzw. Verfahren nach einer Ausführung der vorliegenden Erfindung zum Steuern eines Teleroboter(arm)s 1 mithilfe einer Eingabevorrichtung, die eine Basis 2.1 , ein relativ zur Basis 2.1 bewegliches Stellmittel 3 und eine Eingabevorrichtungssteuerung 2.2 aufweist, über eine Robotersteuerung 4, die drahtlos oder drahtgebunden mit der Eingabevorrichtungssteuerung 2.2 kommuniziert. Die Eingabevorrichtungssteuerung 2.2 kann in die Basis 2.1 integriert sein.
In einem Schritt S10 werden eine aktuelle Pose des Stellmittels 3 relativ zur Eingabevorrichtung 2.1 sowie, in einer Ausführung mithilfe wenigstens eines distalen bzw. endeffektorseitigen Kraftsensors 6 des Teleroboter(arm)s oder modellgestützt auf Basis von Gelenkkräften des Teleroboter(arm)s, eine externe Kraft fe an einer roboterfesten Referenz in Form eines Endeffektors 5 sensorisch ermittelt. Zusätzlich werden eine aktuelle Stellung Xc,HD des Stellmittels und eine aktuelle Pose Xc,r des Endeffektors 5 ermittelt, wobei die (aktuelle) Verstellgeschwindigkeit ( dX/dt)c,HD in einer Ausführung durch Zeitdifferentiation der aktuellen Stellung Xc,HD ermittelt oder umgekehrt die aktuelle Stellung Xc,HD durch Zeitintegration ermittelt wird.
In einem Schritt S20 wird ermittelt, ob der Teleroboter sich an einer oder mehreren vorgegebenen virtuellen Begrenzungen oder durch diese abgegrenzten unzulässigen Bereichen befindet. Ist dies nicht der Fall (S20: „N“) werden in einem Schritt S30 gemäß obiger Gleichungen (1), (2) eine neue Soll-Kraft fd, HD des Stellmittels 3 und eine neue Soll- Pose Xd,r des Teleroboters, in einer Ausführung des Endeffektors 5, ermittelt.
Andernfalls (S20: „Y“) werden in einem Schritt S34 gemäß obiger Gleichungen (2)-(13) eine neue Soll-Kraft fd, HD des Stellmittels 3 und eine neue Soll-Pose Xd,r des Teleroboters, in einer Ausführung des Endeffektors 5, ermittelt, insbesondere also ein Kommandieren einer Bewegung des Teleroboters während einer Betätigung des Stellmittels zum Kommandieren dieser Bewegung des Teleroboters unterdrückt (vgl. Gleichung (8)) und die Soll-Kraft mit der bzw. den entsprechenden Rückstellkraftkomponente(n) ermittelt (vgl. Gleichung (5)), so dass ein Bediener des bzw. am Stellmittel 3 einen Kontakt des Teleroboters mit einem virtuellen Hindernis spürt.
In einem Schritt S50 werden die jeweilige Soll-Pose und Soll-Kraft kommandiert.
Dann kehrt das Verfahren zurück zu Schritt S10, wobei die bisherige aktuelle Stellung des Stellmittels 3 die neue vorhergehende Stellung des Stellmittels 3 und die bisherige aktuelle Pose des Endeffektor 5 die neue vorhergehende Pose des Endeffektors 5 bilden.
Obwohl in der vorhergehenden Beschreibung exemplarische Ausführungen erläutert wurden, sei darauf hingewiesen, dass eine Vielzahl von Abwandlungen möglich ist. Außerdem sei darauf hingewiesen, dass es sich bei den exemplarischen Ausführungen lediglich um Beispiele handelt, die den Schutzbereich, die Anwendungen und den Aufbau in keiner Weise einschränken sollen. Vielmehr wird dem Fachmann durch die vorausgehende Beschreibung ein Leitfaden für die Umsetzung von mindestens einer exemplarischen Ausführung gegeben, wobei diverse Änderungen, insbesondere in Hinblick auf die Funktion und Anordnung der beschriebenen Bestandteile, vorgenommen werden können, ohne den Schutzbereich zu verlassen, wie er sich aus den Ansprüchen und diesen äquivalenten Merkmalskombinationen ergibt. Bezugszeichenliste
1 Teleroboter(arm)
2.1 Eingabevorrichtungsbasis
2.2 Eingabevorrichtungssteuerung 3 Stellmittel
4 Robotersteuerung
5 Endeffektor (roboterfeste Referenz)
6 Kraftsensor

Claims

Patentansprüche
1. Verfahren zum Steuern eines T eleroboters (1 ) mithilfe einer Eingabevorrichtung, die ein bewegliches Stellmittel (3) aufweist, mit den, insbesondere mehrfach wiederholten, Schritten:
- Kommandieren (S50) einer Soll-Pose des Teleroboters auf Basis einer erfassten Stellung des Stellmittels; und
- Kommandieren (S50) einer Soll-Kraft des Stellmittels; wobei wenigstens eine virtuelle Begrenzung für den Teleroboter zwischen einem zulässigen und einem unzulässigen Bereich vorgegeben ist, und die Soll-Kraft ab dieser Begrenzung eine Rückstellkraftkomponente aufweist, die einer Betätigung des Stellmittels zum Kommandieren einer Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs entgegenwirkt.
2. Verfahren nach Anspruch 1 , dadurch gekennzeichnet, dass die Rückstellkraftkomponente einen Kontakt des Teleroboters mit einem Hindernis simuliert.
3. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Rückstellkraftkomponente eine Kraft einer virtuellen Druckfeder ist, insbesondere einer virtuellen Druckfeder, die nur durch eine Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs und/oder eine Betätigung des Stellmittels zum Kommandieren einer Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs gespannt wird und/oder deren Federkraft von einer aktuellen und/oder einer vorhergehenden Stellung des Stellmittels und/oder von einer aktuellen und/oder einer vorhergehenden Pose des Teleroboters und/oder von einer vorgegebenen Federsteifigkeit der virtuellen Druckfeder und/oder von einer vorgegebenen Skalierung zwischen Verstellungen des Stellmittels und Bewegungen des Teleroboters abhängt.
4. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass ein Kommandieren einer Bewegung des Teleroboters ab der Begrenzung in Richtung des unzulässigen Bereichs während einer Betätigung des Stellmittels zum Kommandieren dieser Bewegung des Teleroboters unterdrückt wird.
5. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die virtuelle Begrenzung als virtuelle Wand in einem Arbeitsraum des Teleroboters oder als virtueller Anschlag wenigstens eines Gelenks des Teleroboters vorgegeben ist.
6. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Soll-Kraft eine Kraftrückkopplungskomponente aufweist, die von einer externen Kraft an dem Teleroboter abhängt, diese insbesondere, gegebenenfalls skaliert, nachbildet.
7. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Soll-Kraft eine Dämpfungskomponente aufweist, die von einer Verstellgeschwindigkeit des Stellmittels abhängt.
8. System zum Steuern eines Teleroboters (1) mithilfe einer Eingabevorrichtung, die ein bewegliches Stellmittel (3) aufweist, das zur Durchführung eines Verfahrens nach einem der vorhergehenden Ansprüche eingerichtet ist und/oder aufweist:
- Mittel zum Vorgeben wenigstens einer virtuellen Begrenzung für den Teleroboter zwischen einem zulässigen und einem unzulässigen Bereich;
- Mittel zum Kommandieren einer Soll-Pose des Teleroboters auf Basis einer erfassten Stellung des Stellmittels; und
- Mittel zum Kommandieren einer Soll-Kraft des Stellmittels, wobei die Soll-Kraft ab der virtuellen Begrenzung eine Rückstellkraftkomponente aufweist, die einer Betätigung des Stellmittels zum Kommandieren einer Bewegung des Teleroboters von der Begrenzung weg in Richtung des unzulässigen Bereichs entgegenwirkt.
9. Computerprogramm oder Computerprogrammprodukt, wobei das Computerprogramm oder Computerprogrammprodukt, insbesondere auf einem computerlesbaren und/oder nicht-flüchtigen Speichermedium gespeicherte, Anweisungen enthält, die bei der Ausführung durch einen oder mehrere Computer oder ein System nach Anspruch 8 den oder die Computer oder das System dazu veranlassen, ein Verfahren nach einem der Ansprüche 1 bis 7 durchzuführen.
EP22725197.2A 2021-05-04 2022-04-22 Verfahren und system zum steuern eines teleroboters Pending EP4334089A1 (de)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102021204495.6A DE102021204495A1 (de) 2021-05-04 2021-05-04 Verfahren und System zum Steuern eines Teleroboters
PCT/EP2022/060748 WO2022233606A1 (de) 2021-05-04 2022-04-22 Verfahren und system zum steuern eines teleroboters

Publications (1)

Publication Number Publication Date
EP4334089A1 true EP4334089A1 (de) 2024-03-13

Family

ID=81841836

Family Applications (1)

Application Number Title Priority Date Filing Date
EP22725197.2A Pending EP4334089A1 (de) 2021-05-04 2022-04-22 Verfahren und system zum steuern eines teleroboters

Country Status (5)

Country Link
EP (1) EP4334089A1 (de)
KR (1) KR20240004894A (de)
CN (1) CN117597217A (de)
DE (1) DE102021204495A1 (de)
WO (1) WO2022233606A1 (de)

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7706920B2 (en) 2007-09-19 2010-04-27 Disney Enterprises, Inc. Smooth clipping of data streams
CN106456265B (zh) * 2014-03-17 2019-07-30 直观外科手术操作公司 使用逆运动学在关节极限下的遥控操作手术系统和控制方法
DE102014226239A1 (de) 2014-12-17 2016-06-23 Kuka Roboter Gmbh Verfahren zum sicheren Einkoppeln eines Eingabegerätes
DE102015100694A1 (de) 2015-01-19 2016-07-21 Technische Universität Darmstadt Teleoperationssystem mit intrinsischem haptischen Feedback durch dynamische Kennlinienanpassung für Greifkraft und Endeffektorkoordinaten
DE102015009048B3 (de) 2015-07-13 2016-08-18 Kuka Roboter Gmbh Steuern eines nachgiebig geregelten Roboters
DE102020113409B4 (de) 2019-05-17 2022-03-17 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zum Steuern eines Slave-Systems mittels eines Master-Systems
DE102019118260B3 (de) 2019-07-05 2020-08-20 Franka Emika Gmbh Taktile Rückmeldung eines Endeffektors eines Robotermanipulators über verschiedene Orientierungsbereiche

Also Published As

Publication number Publication date
CN117597217A (zh) 2024-02-23
KR20240004894A (ko) 2024-01-11
DE102021204495A1 (de) 2022-11-10
WO2022233606A1 (de) 2022-11-10

Similar Documents

Publication Publication Date Title
EP3323026B1 (de) Ermitteln eines eingabebefehls für einen roboter, der durch manuelles ausüben einer kraft auf den roboter eingegeben wird
EP2851162B1 (de) Verfahren zum manuell geführten Verstellen der Pose eines Manipulatorarms eines Industrieroboters und zugehöriger Industrieroboter
EP2987592B1 (de) Verfahren zum programmieren eines industrieroboters und zugehöriger industrieroboter
EP3109012B1 (de) Umschalten einer steuerung eines roboters in einen handführ-betriebsmodus
EP2977148B1 (de) Verfahren und vorrichtung zum steuern eines roboters
EP3408061A1 (de) Verfahren und system zur bahnplanung eines redundanten roboters
EP3170628A1 (de) Steuerung eines roboters mit dämpfungsantriebsgrösse ermittlung
DE102018200864B3 (de) Verfahren und System zum Steuern eines Roboters
EP3840920A1 (de) Roboterregelung
DE19810341A1 (de) Verfahren zur automatischen Kollisionsvermeidung eines Manipulators in einem durch Hindernisse beschränkten Arbeitsraum
EP3990231B1 (de) System zum vornehmen einer eingabe an einem robotermanipulator
EP4084937B1 (de) Bewegen einer roboterfesten referenz
EP4334089A1 (de) Verfahren und system zum steuern eines teleroboters
DE102018207919B3 (de) Robotersteuerung
DE102020209866B3 (de) Verfahren und System zum Betreiben eines Roboters
DE102020215904B3 (de) Verfahren und System zum Betreiben eines Roboters
WO2019086339A1 (de) Verfahren und steuermittel zum steuern einer roboteranordnung
DE102019219930B3 (de) Verfahren und System zum Steuern eines Roboters
DE102018207921B3 (de) Steuern eines Roboters
WO2020169302A1 (de) Verfahren und system zum durchführen einer vorgegebenen aufgabe durch einen roboter
DE102017011130B4 (de) Verfahren und System zum Steuern eines Roboters
DE102022200943B3 (de) Steuern eines Teleroboters
WO2022233607A1 (de) Verfahren und system zum steuern eines teleroboters
DE102021111569A1 (de) Verfahren und System zum Steuern eines Teleroboters
DE102018208088A1 (de) Verfahren und Steuerung zum Steuern eines Roboters

Legal Events

Date Code Title Description
STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: UNKNOWN

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE

PUAI Public reference made under article 153(3) epc to a published international application that has entered the european phase

Free format text: ORIGINAL CODE: 0009012

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE

17P Request for examination filed

Effective date: 20231103

AK Designated contracting states

Kind code of ref document: A1

Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR