EP4334089A1 - Verfahren und system zum steuern eines teleroboters - Google Patents
Verfahren und system zum steuern eines telerobotersInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000006835 compression Effects 0.000 claims description 16
- 238000004590 computer program Methods 0.000 claims description 9
- 238000013016 damping Methods 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 description 15
- 239000012636 effector Substances 0.000 description 14
- 230000001276 controlling effect Effects 0.000 description 7
- 238000007906 compression Methods 0.000 description 4
- 238000011161 development Methods 0.000 description 4
- 230000018109 developmental process Effects 0.000 description 4
- 238000012545 processing Methods 0.000 description 3
- 230000001419 dependent effect Effects 0.000 description 2
- 101100502819 Mus musculus Fimp gene Proteins 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000035515 penetration Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1689—Teleoperation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40117—Virtual mecanism, like slider to constraint movement in task space
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40137—Force sensation feedback from simulated tool
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40194—Force 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)
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 (6)
Country | Link |
---|---|
US (1) | US20240217107A1 (ko) |
EP (1) | EP4334089A1 (ko) |
KR (1) | KR20240004894A (ko) |
CN (1) | CN117597217A (ko) |
DE (1) | DE102021204495A1 (ko) |
WO (1) | WO2022233606A1 (ko) |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7706920B2 (en) | 2007-09-19 | 2010-04-27 | Disney Enterprises, Inc. | Smooth clipping of data streams |
EP3119319B1 (en) * | 2014-03-17 | 2020-07-15 | Intuitive Surgical Operations, Inc. | Tele-operative surgical systems and methods of control at joint limits using inverse kinematics |
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 |
-
2021
- 2021-05-04 DE DE102021204495.6A patent/DE102021204495A1/de active Pending
-
2022
- 2022-04-22 KR KR1020237041668A patent/KR20240004894A/ko unknown
- 2022-04-22 US US18/558,436 patent/US20240217107A1/en active Pending
- 2022-04-22 CN CN202280047486.7A patent/CN117597217A/zh active Pending
- 2022-04-22 WO PCT/EP2022/060748 patent/WO2022233606A1/de active Application Filing
- 2022-04-22 EP EP22725197.2A patent/EP4334089A1/de active Pending
Also Published As
Publication number | Publication date |
---|---|
US20240217107A1 (en) | 2024-07-04 |
DE102021204495A1 (de) | 2022-11-10 |
CN117597217A (zh) | 2024-02-23 |
WO2022233606A1 (de) | 2022-11-10 |
KR20240004894A (ko) | 2024-01-11 |
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 | |
EP3170628A1 (de) | Steuerung eines roboters mit dämpfungsantriebsgrösse ermittlung | |
WO2017129352A1 (de) | Verfahren und system zur bahnplanung eines redundanten roboters | |
DE102018200864B3 (de) | Verfahren und System zum Steuern eines Roboters | |
DE19810341A1 (de) | Verfahren zur automatischen Kollisionsvermeidung eines Manipulators in einem durch Hindernisse beschränkten Arbeitsraum | |
DE102020209866B3 (de) | Verfahren und System zum Betreiben eines Roboters | |
EP3990231B1 (de) | System zum vornehmen einer eingabe an einem robotermanipulator | |
EP4084937B1 (de) | Bewegen einer roboterfesten referenz | |
WO2022233606A1 (de) | Verfahren und system zum steuern eines teleroboters | |
DE102018207919B3 (de) | Robotersteuerung | |
DE102020215904B3 (de) | Verfahren und System zum Betreiben eines Roboters | |
EP3703914A1 (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 | |
DE102023117136A1 (de) | Prädiktives regelungsverfahren zum regeln der drehmomentänderungsrate und zur schwingungsunterdrückung |
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 |
|
P01 | Opt-out of the competence of the unified patent court (upc) registered |
Free format text: CASE NUMBER: APP_33453/2024 Effective date: 20240605 |
|
DAV | Request for validation of the european patent (deleted) | ||
DAX | Request for extension of the european patent (deleted) |