EP3484672A1 - Résolution redondante pour manipulateur redondant - Google Patents

Résolution redondante pour manipulateur redondant

Info

Publication number
EP3484672A1
EP3484672A1 EP17740292.2A EP17740292A EP3484672A1 EP 3484672 A1 EP3484672 A1 EP 3484672A1 EP 17740292 A EP17740292 A EP 17740292A EP 3484672 A1 EP3484672 A1 EP 3484672A1
Authority
EP
European Patent Office
Prior art keywords
manipulator
task
redundant
controlling
axes
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.)
Ceased
Application number
EP17740292.2A
Other languages
German (de)
English (en)
Inventor
Vito Magnanimo
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 EP3484672A1 publication Critical patent/EP3484672A1/fr
Ceased legal-status Critical Current

Links

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/1628—Programme controls characterised by the control loop
    • B25J9/1643—Programme controls characterised by the control loop redundant control
    • 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/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676—Avoiding collision or forbidden zones
    • 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/39—Robotics, robotics to robotics hand
    • G05B2219/39086—Reduce impact effect by impact configuration of redundant manipulator
    • 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/40336—Optimize multiple constraints or subtasks
    • 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/40369—Generate all possible arm postures associated with end effector position

Definitions

  • the invention relates to a method for controlling a redundant manipulator, as well as a manipulator system and a control device, which is set up for controlling a redundant manipulator according to the method.
  • the method includes determining a trajectory of the manipulator and reducing the effective mass of the manipulator.
  • Manipulators are machines that can physically interact with their environment. They are used in industrial manufacturing, automation and in the home environment, for example in the field of ambient assisted living. Typical manipulators are articulated arm or industrial robots that have several freely programmable axes of motion. They serve to guide and / or edit end effectors, such as tools or workpieces.
  • Redundant manipulators are characterized by the fact that they have at least one degree of freedom more than is necessary for the execution of the actual task. If, for example, an end effector is to be positioned freely in space, six degrees of freedom are required for this purpose. Therefore, typical industrial robots have six freely programmable axes of motion to position an end effector freely in space. A corresponding redundant industrial robot comprises at least seven degrees of freedom, i. at least seven axes of motion.
  • Motion axes can be designed as linear axes or axes of rotation.
  • the number of axes of movement of a redundant manipulator depends on the application. If, for example, only one linear movement in one direction is to be carried out by means of the manipulator, a movement axis for carrying out the actual task is sufficient.
  • a manipulator which should only execute a linear movement in one direction, which has two linear axes, would be a redundant manipulator.
  • the manipulator moves trajectories.
  • the planning of the trajectory is typically of one Assumed control device which is adapted to control the manipulator.
  • axis angles (or axis positions) and / or axis angular velocities are specified for each movement axis.
  • the actual trajectory (trajectory) is calculated by the control device.
  • the control device sends corresponding control commands to the manipulator to start the previously calculated trajectory by means of the manipulator.
  • the manipulator then assumes the commanded axis angle (or axis position) for the respective movement axis.
  • Motion axes clearly determinable when a trajectory is to be traversed by means of the manipulator.
  • redundant manipulators there are several solutions or axis angle combinations or configurations in order to start the planned trajectory.
  • the redundancy resolution in conventional redundant manipulator path planning methods often results in undesirable non-fluid motions.
  • MTK systems human-robot collaboration systems
  • Manipulators / robots In MRK systems, e.g. The high performance of a manipulator combined with the sensory abilities of a human being. Possible applications can be found, for example, in industrial production, such as in automobile production or ambient assisted living. Typical applications are lifting and mounting devices in which a
  • MRK systems assume that the person who collaborates with the manipulator is not himself endangered by the manipulator.
  • machine safety of Category 3 according to ISO 13849 is to be achieved in MRK systems.
  • an MRI system is considered safe.
  • the speed of the manipulator is often throttled, so that in collisions between humans and manipulators no Injury or serious injury to a human being.
  • this greatly limits the scope and, above all, the efficiency.
  • extensive security measures are necessary.
  • the object of the present invention is to at least partially eliminate the aforementioned disadvantages and to provide a method for controlling a manipulator (or a manipulator system and / or a control device), which enables efficient movement sequences and at the same time minimizes a potential hazard by the manipulator.
  • a manipulator or a manipulator system and / or a control device
  • the object is achieved at least in part by a method according to claim 1, by a control device according to claim 9, a computer-readable medium according to claim 10 and by a manipulator system according to claim 11.
  • the object is achieved by a method for controlling a redundant manipulator, wherein the manipulator has a plurality of axes of movement and the method comprises the following steps:
  • Determining a primary task for controlling the manipulator comprising traversing a trajectory of the manipulator, in particular a trajectory of the tool center point of the manipulator;
  • the secondary task comprises a reduction of the effective mass and / or the effective inertia, in particular the effective mass and / or the effective inertia of an end effector of the manipulator;
  • the primary task involves tracing a trajectory.
  • the trajectory can either be predetermined or planned by a control device.
  • Specified trajectories are, for example, when a trajectory has been "taught” by manually manipulating or guiding the manipulator, and the trajectory recorded trajectory recorded.
  • Trajectory can then be traversed again.
  • the starting point can correspond to the current position of the Manipulator or the Tool Center Point (TCP) of the manipulator so that only one desired end point has to be specified.
  • TCP describes the tool position / workpiece position of a manipulator and is an imaginary reference point of the tool / workpiece. Starting from the planned or predetermined trajectory, which is typically present in Cartesian coordinates, the axis angles of the axes of motion are then calculated.
  • This calculation can be done by means of inverse kinematics.
  • the inverse kinematics allows for a manipulator to determine the axle angle of the
  • Motion axes based on the pose (position and orientation) of the end effector (or Tool Center Point).
  • the last term of the kinematic chain i. the end effector
  • the other links of the kinematic chain ie the axes of movement of the manipulator, must then assume an associated pose according to their degrees of freedom. This can be compared with the human arm, which forms a kinematic chain with its joints: If one puts the hand in a certain pose, for example, if an object is grasped, the wrist, elbow and shoulder automatically assume a certain position as well. Exactly these positions (or axis angle) must be determined via the inverse kinematics.
  • the secondary task comprises a reduction of the effective
  • Effective mass / effective inertia is a directional measure of the kinetic energy that a manipulator has in a defined direction, typically the direction of movement given by the trajectory.
  • the manipulation of the manipulator is typically carried out by means of a control device which is assigned to the manipulator.
  • a controller may include hardware and / or software.
  • the (first) secondary task may include other (second or third, etc.) conditions in addition to a reduction of the effective mass. These are, for example, the achievement of a short cycle time for traversing the trajectory according to the primary task, the compliance with certain axle angles and / or a working space and / or the energy-efficient traversing of the trajectory. Other secondary tasks can also be determined. A weighting of the secondary tasks, for example, allows a substantial reduction of the effective mass, while sufficiently short cycle times can be realized. Especially with contrary secondary tasks, the weighting can achieve at least partial fulfillment of all secondary tasks.
  • the primary task may be independent of the at least one secondary task, the primary task preferably having a higher priority than the at least one secondary task. The independence of the primary and secondary tasks simplifies the calculation of the axis angle and / or axis angular velocities and in particular leads to fluid movements of the manipulator, since no conflicts due to undesirable dependencies
  • q be the vector of the axis angle ai to a 7 of the axes of movement Ai to A7 of a manipulator with seven axes of movement, which are designed as hinges.
  • the algorithm is general and can be applied to any redundant manipulator.
  • the manipulator may include at least two redundant axes of motion, wherein the method may include determining at least two secondary tasks which secondary tasks are independent of each other. For example, the solution of the first secondary task does not affect the solution of the second secondary task. This can be achieved analogously to the algorithm described above, but sets at least two redundant
  • redundant manipulators are distinguished by the fact that they have at least one more degree of freedom than is necessary for the execution of the primary task, it can generally be determined that, depending on the type of redundant manipulator, "x" degrees of freedom (or, respectively, “X” axes of motion) and for solving the one or more secondary tasks “y" degrees of freedom (or “y” redundant axes of motion) are provided.
  • secondary tasks may be included, which are solved by means of two or more degrees of freedom, without influencing or disturbing the solution of the primary task and / or further secondary tasks.
  • the redundant manipulator may include "x + y" degrees of freedom, or "x + y" axes of motion, and for the solution of the primary task "x"
  • a manipulator may include "6 + 2" degrees of freedom, with two degrees of freedom for solving a secondary task, or for solving two independent secondary tasks can be used.
  • Other exemplary manipulators may include "6 + 3", “5 + 2" or any other combination of "x + y" degrees of freedom.
  • At least one further secondary task can be to maintain at least one predefined angular range for at least one axis of the
  • manipulator As a result, for example, areas of space that are typically occupied by people and / or other objects during assembly can be blocked for the manipulator.
  • the specification of angular ranges allows, for example, to avoid unfavorable axis positions with low load or high load.
  • at least one further secondary task may comprise the minimization of the energy expended for tracing the trajectory.
  • energy-efficient manipulator systems can be realized.
  • Other secondary tasks such as the reduction of cycle times or compliance with limit speeds, can also be defined.
  • the axis angle velocities ⁇ x ⁇ 7 for the n alternatives can be calculated such that a predefined maximum speed of the manipulator is not exceeded when the manipulator is being controlled.
  • the maximum speed may be the actual maximum speed of the manipulator or another specified speed which, for example, must not be exceeded in order to comply with safety regulations.
  • the effective mass m u can be determined as a function of the direction of movement u of the end effector, and the vector q of the axis angles of the axes of motion and the matrix A v of the pseudo kinetic energy of the manipulator in translational movements.
  • the effective mass m u is then given
  • the effective inertia I u can be determined as a function of the direction of movement u of the end effector and the (angular velocity) vector q of the axis axes of the axes of motion and the matrix ⁇ of the pseudo kinetic energy of the manipulator based on the angular velocities.
  • the effective inertia Iu then arises
  • control device which comprises at least one program memory and a processor, and which is set up to control at least one redundant manipulator according to the method described above.
  • the controller may include hardware as well as software.
  • the control device may be configured to control a plurality of manipulators.
  • the control device may consist of several components (hardware and / or software), which together form a Form control. It is not necessary to integrate the components in just one housing.
  • the object is further achieved by a computer-readable medium on which program instructions are stored, which is a control device of a
  • the computer readable medium may be an optical, magnetic or other storage medium.
  • a manipulator system which comprises at least one redundant manipulator and at least one control device, wherein the redundant manipulator is preferably an MRK-capable manipulator.
  • Control device is set up to carry out the method described above.
  • FIG. 1 is a schematic representation of an MRK-capable manipulator system
  • Fig. 2 is a schematic representation of a manipulator system with a
  • Fig. 3 is a schematic flow diagram of a method for controlling a
  • FIG. 1 shows a manipulator system 1, which has a redundant
  • Manipulator 10 and a control device 20 includes.
  • the control device 20 is set up to control the manipulator 10.
  • the manipulator 10 comprises seven axes of movement Ai to A7.
  • Manipulator 10 a redundant manipulator.
  • the manipulator includes one
  • End effector 12 which is designed in the present illustration as a gripper.
  • the end effector 12 is a Tool Center Point (TCP), i. an imaginary reference point, associated with, by means of the TCP, the movement path 30 of the manipulator 10 can be described.
  • TCP 15 corresponds to a gripping point of the
  • the manipulator system 1 is an MRK-enabled
  • the illustrated axes of movement Ai to A7 are designed as rotation axes, which can assume different axial angles c to a 7 .
  • the respective axial angles a x to a 7 determine the orientation of the individual axes of movement Ai to A7, wherein the axes of movement Ai to A7 form a kinematic chain, at the end of which
  • End effector 12 is. About the axis angle, a pose of the manipulator 10 is determined and the end effector 12 is positioned and oriented in space.
  • FIG. 2 shows the manipulator system 1, wherein the redundant manipulator 10 is shown in different poses q, q '.
  • the TCP 15 of the end effector 12 is positioned the same in the poses shown.
  • the effective mass is dependent on the poses q, q 'and the direction of movement u, the poses q, q' being determined by the respective axis angles cu to a 7 .
  • n different alternatives can be calculated in which the manipulator assumes a pose in which the TCP lies on the trajectory. If, according to a secondary task, the effective mass is to be reduced, a corresponding pose can be selected from the n alternatives with low effective mass.
  • a primary task ei for controlling the manipulator 10 is determined, wherein the primary task ei includes traversing a movement path 30 of the manipulator 10.
  • the trajectory can be predetermined or planned by a control unit. In particular, a predetermined and / or planned trajectory can be optimized.
  • a second method step 120 at least one secondary task e 2 for controlling the manipulator is determined, wherein the secondary task e 2 comprises a reduction of the effective mass and / or the effective inertia.
  • the reduction does not have to be aimed at achieving an absolute minimum, but can, for example, be based on adherence to defined upper limits of the effective
  • Mass / inertia be limited.
  • n alternatives of possible axis angles ai to j of the movement axes Ai to A7 of the manipulator 10 are calculated to fulfill the primary task ei.
  • a fourth method step 140 the manipulator 10 is then connected taking into account the n alternatives and the secondary

Landscapes

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

Abstract

L'invention concerne un procédé de commande d'un manipulateur redondant (10). Le manipulateur (10) comprend une pluralité d'axes de déplacement (A1 - A7) et le procédé comprend les étapes suivantes consistant à : déterminer une tâche primaire de commande du manipulateur (10), la tâche principale incluant le parcours d'une trajectoire (30) par le manipulateur (10) ; déterminer au moins une tâche secondaire de commande du manipulateur (10), la tâche secondaire incluant une réduction de la masse effective (mu) et/ou de l'inertie effective (Iu) ; calculer n alternatives d'angles d'axes possibles (α1-α7) des axes de déplacement (A1-A7) du manipulateur (10) pour effectuer la tâche primaire, et calculer les vitesses d'angle d'axes des n alternatives ; et commander le manipulateur (10) avec prise en compte des n alternatives et de la tâche secondaire.
EP17740292.2A 2016-07-15 2017-07-12 Résolution redondante pour manipulateur redondant Ceased EP3484672A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102016212958.9A DE102016212958A1 (de) 2016-07-15 2016-07-15 Redundanzauflösung für einen redundanten Manipulator
PCT/EP2017/000828 WO2018010842A1 (fr) 2016-07-15 2017-07-12 Résolution redondante pour manipulateur redondant

Publications (1)

Publication Number Publication Date
EP3484672A1 true EP3484672A1 (fr) 2019-05-22

Family

ID=59363088

Family Applications (1)

Application Number Title Priority Date Filing Date
EP17740292.2A Ceased EP3484672A1 (fr) 2016-07-15 2017-07-12 Résolution redondante pour manipulateur redondant

Country Status (3)

Country Link
EP (1) EP3484672A1 (fr)
DE (1) DE102016212958A1 (fr)
WO (1) WO2018010842A1 (fr)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109129487B (zh) * 2018-09-26 2021-05-11 华南理工大学 在周期噪声下基于泰勒型离散周期节律神经网络的冗余度机械臂重复运动规划方法
CN110014427B (zh) * 2019-03-26 2021-11-02 华侨大学 一种基于伪逆的冗余度机械臂高精度运动规划方法
CN110134062B (zh) * 2019-04-17 2020-12-08 华中科技大学 一种基于强化学习的多轴数控机床加工路径优化方法
DE102019118263B3 (de) * 2019-07-05 2020-08-20 Franka Emika Gmbh Ausgeben einer Güteinformation über eine Krafterfassung am Robotermanipulator
DE102021212134B3 (de) 2021-10-27 2023-02-02 Kuka Deutschland Gmbh Verfahren und System zum Betreiben eines Roboters

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5294873A (en) * 1992-10-27 1994-03-15 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Kinematic functions for redundancy resolution using configuration control
DE102011106321A1 (de) * 2011-07-01 2013-01-03 Kuka Laboratories Gmbh Verfahren und Steuermittel zum Steuern eines Roboters

Also Published As

Publication number Publication date
DE102016212958A1 (de) 2018-01-18
WO2018010842A1 (fr) 2018-01-18

Similar Documents

Publication Publication Date Title
EP2868445B1 (fr) Procédé de programmation de déroulements de mouvement d'un robot industriel redondant et robot industriel associé
DE102014222809B3 (de) Event-basierte Redundanzwinkelkonfiguartion für Gelenkarmroboter
EP1950010B1 (fr) Robot et procédé de programmation d'un robot
EP2987592B1 (fr) Procede de programmation d'un robot industriel et robot industriel correspondant
WO2018010842A1 (fr) Résolution redondante pour manipulateur redondant
EP3323026B1 (fr) Détermination d'une instruction d'entrée pour un robot, qui est entrée en exerçant manuellement une force sur le robot
DE112011101930B4 (de) Verfahren, Steuerungssystem und Bewegungvorgabemittel zum Programmieren oder Vorgeben von Bewegungen oder Abläufen eines Industrieroboters
EP2212753B1 (fr) Procédé pour permettre à un manipulateur de parcourir une trajectoire donnée, ainsi que dispositif de commande pour la mise en oeuvre d' un tel procédé
EP2546711B2 (fr) Procédé de programmation d'un robot
DE102019126465B4 (de) Verfahren und Vorrichtung zur Trajektorienbestimmung für serielle Manipulatoren
DE102008062622B9 (de) Verfahren und Vorrichtung zur Befehlseingabe in eine Steuerung eines Manipulators
DE102018009169B4 (de) Steuervorrichtung zum Begrenzen der Geschwindigkeit eines Roboters
EP3020516B1 (fr) Determination d'espace de prehension d'un objet a l'aide d'un robot
DE102006007623B4 (de) Roboter mit einer Steuereinheit zum Steuern einer Bewegung zwischen einer Anfangspose und einer Endpose
DE102007059480B4 (de) Verfahren und Vorrichtung zur Posenüberwachung eines Manipulators
WO2016050238A1 (fr) Procédé et dispositif de commande/régulation d'un manipulateur de robot
DE102007060680A1 (de) Verfahren und Einrichtung zur Steuerung eines Manipulators
DE102018007842B4 (de) Steuergerät zum Überwachen der Bewegungsrichtung eines Betätigungswerkzeugs
DE102016211470B4 (de) Verfahren zur planung einer bewegungsbahn eines manipulators
DE102014226787B3 (de) Sicherer Roboter mit Bahnfortschrittsvariablen
DE102010008240B4 (de) Verfahren zum Betrieb eines mehrachsigen, vorzugsweise sechsachsigen, Roboters
DE102017204211B4 (de) Robotersteuerung und Robotersteuerungsverfahren
DE102017213651A1 (de) Handhabungseinrichtung mit einem Roboter sowie Verfahren und Computerprogramm
DE102019125326B3 (de) Prognostizierter Bremsbereich eines Robotermanipulators
EP3710900B1 (fr) Procédé et système pour la prescription ou l'apprentissage d'une instruction pour robot

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: 20190114

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

AX Request for extension of the european patent

Extension state: BA ME

DAV Request for validation of the european patent (deleted)
DAX Request for extension of the european patent (deleted)
STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: EXAMINATION IS IN PROGRESS

17Q First examination report despatched

Effective date: 20210609

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

Free format text: STATUS: EXAMINATION IS IN PROGRESS

P01 Opt-out of the competence of the unified patent court (upc) registered

Effective date: 20230528

REG Reference to a national code

Ref country code: DE

Ref legal event code: R003

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

Free format text: STATUS: THE APPLICATION HAS BEEN REFUSED

18R Application refused

Effective date: 20240306