DE102006007623B4 - Robot with a control unit for controlling a movement between an initial pose and an end pose - Google Patents

Robot with a control unit for controlling a movement between an initial pose and an end pose Download PDF

Info

Publication number
DE102006007623B4
DE102006007623B4 DE102006007623.0A DE102006007623A DE102006007623B4 DE 102006007623 B4 DE102006007623 B4 DE 102006007623B4 DE 102006007623 A DE102006007623 A DE 102006007623A DE 102006007623 B4 DE102006007623 B4 DE 102006007623B4
Authority
DE
Germany
Prior art keywords
map
control unit
robot
pose
movement
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.)
Active
Application number
DE102006007623.0A
Other languages
German (de)
Other versions
DE102006007623A1 (en
Inventor
Michael Müller
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 Laboratories 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 Laboratories GmbH filed Critical KUKA Laboratories GmbH
Priority to DE102006007623.0A priority Critical patent/DE102006007623B4/en
Priority to PCT/EP2007/001310 priority patent/WO2007093413A1/en
Publication of DE102006007623A1 publication Critical patent/DE102006007623A1/en
Application granted granted Critical
Publication of DE102006007623B4 publication Critical patent/DE102006007623B4/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B25J9/1666Avoiding collision or forbidden zones
    • 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/37Measurements
    • G05B2219/37277Inductive proximity sensor
    • 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/40442Voxel map, 3-D grid map
    • 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/40455Proximity of obstacles
    • 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/40465Criteria is lowest cost function, minimum work path
    • 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/40544Detect proximity of object
    • 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/40564Recognize shape, contour of object, extract position and orientation
    • 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/40607Fixed camera to observe workspace, object, workpiece, global

Abstract

Roboter, insbesondere Industrie- oder Gelenkroboter, mit wenigstens zwei Bewegungsfreiheitsgraden (a1, a2) und einer Steuereinheit (12) zum Steuern einer Bewegung eines Greifarms des Roboters zwischen einer Anfangsposition (14) und einer Endpose (16), wobei die Steuereinheit (12) eine Speichereinheit (30) zum Speichern einer Landkarte (32) umfasst, in der zumindest eine Störkontur (34) verzeichenbar ist, dadurch gekennzeichnet, dass die Steuereinheit (12) dazu vorgesehen ist, einen Bewegungspfad (36) des Greifarms zwischen der Anfangspose (14) und der Endpose (16) selbsttägig in Abhängigkeit von der Landkarte (32) und in Schritten, die der Schrittweite der Landkarte (32) entsprechen, zu generieren und dass die Steuereinheit (12) derart programmiert ist, dass sie die Landkarte (32) zum Generieren des Bewegungspfades (36) in wenigstens zwei Bereiche (38, 40) mit unterschiedlicher Detailgenauigkeit aufteilt, sie den Bewegungspfad in einem ersten Bereich (40) aus ersten Segmenten und in einem zweiten Bereich (38) aus zweiten Segmenten generiert, wobei der erste Bereich (40) weniger Störkonturen aufweist als der zweite Bereich (38), und wobei die ersten Segmente im ersten Bereich (40) länger sind als die zweiten Segmente im zweiten Bereich (38).Robots, in particular industrial or articulated robots, having at least two degrees of freedom of movement (a1, a2) and a control unit (12) for controlling a movement of a robotic arm of the robot between an initial position (14) and an end pose (16), the control unit (12) a memory unit (30) for storing a map (32) in which at least one interference contour (34) is charac - terised, characterized in that the control unit (12) is provided for defining a movement path (36) of the gripping arm between the initial pose (14 ) and the end pose (16) are generated on a daily basis as a function of the map (32) and in steps corresponding to the step size of the map (32) and that the control unit (12) is programmed to display the map (32). for generating the movement path (36) into at least two areas (38, 40) with different levels of detail, it divides the movement path in a first area (40) of first segments and in a second region (38) of second segments, wherein the first region (40) has fewer interference contours than the second region (38), and wherein the first segments in the first region (40) are longer than the second segments in the second region ( 38).

Description

Die Erfindung betrifft einen Roboter, insbesondere von einem Industrie- oder Gelenkroboter, mit wenigstens zwei Bewegungsfreiheitsgraden und einer Steuereinheit zum Steuern einer Bewegung zwischen einer Anfangspose und einer Endpose und ein Verfahren zum Steuern einer Bewegung eines Roboters, zwischen einer Anfangspose und einer Endpose in wenigstens zwei Bewegungsfreiheitsgraden, wobei ein Bewegungspfad zwischen der Anfangspose und der Endpose generiert wird.The invention relates to a robot, in particular of an industrial or articulated robot, having at least two degrees of freedom of movement and a control unit for controlling a movement between an initial pose and an end pose and a method for controlling a movement of a robot between an initial pose and an end pose in at least two Degrees of freedom of movement, whereby a movement path is generated between the initial pose and the final pose.

Aus dem Stand der Technik ist ein Roboter, beispielsweise ein Industrie- oder Gelenkroboter, mit wenigstens zwei Bewegungsfreiheitsgraden bekannt. Der Roboter umfasst eine Steuereinheit zum Steuern einer Bewegung zwischen einer Anfangspose und einer Endpose entlang eines vorprogrammierten Bewegungspfads, der sich aus stückweise linearen oder kreisbogenförmigen Pfadsegmenten zusammensetzt. Zum Programmieren des Bewegungspfads ist es bekannt, dass ein Bediener in einem Teach-In Vorgang einen Greifarm des Roboters manuell auf dem Pfad führt und dabei Störkonturen in der Reichweite des Greifarms umgeht. Die Steuereinheit speichert einzelne Überschleifpunkte des Pfads und reproduziert die Bewegung näherungsweise durch eine stückweise geradlinige Bewegung, die die Überschleifpunkte verbindet. Alternativ können die einzelnen Überschleifpunkte beim Programmieren der Steuereinheit eingegeben werden. Als ”geradlinig” oder ”linear” sollen in diesem Zusammenhang insbesondere auch solche Bewegungen bezeichnet werden, die in einem achsbezogenen Koordinatensystem des Roboters gerade verlaufen. In dem achsbezogenen Koordinatensystem des Roboters können neben linearen auch rotatorische Achsen in kartesischen Koordinaten dargestellt sein. From the prior art, a robot, for example an industrial or articulated robot, with at least two degrees of freedom of movement is known. The robot includes a controller for controlling movement between an initial pose and an end pose along a preprogrammed motion path comprised of piecewise linear or arcuate path segments. For programming the movement path, it is known that an operator in a teach-in operation manually guides a gripper arm of the robot on the path while avoiding interfering contours within the reach of the gripper arm. The control unit stores individual blending points of the path and approximately reproduces the motion by a piecewise rectilinear motion connecting the blending points. Alternatively, the individual rounding points can be entered when programming the control unit. In this context, "movements that are straight in an axis-related coordinate system of the robot" should also be referred to as "straight-line" or "linear". In the axis-related coordinate system of the robot, not only linear but also rotatory axes can be represented in Cartesian coordinates.

Aus der EP 0 543 236 A2 ist ein Fernsteuerbetriebssystem bekannt, bei dem eine Trajektorie eines Manipulatorkopfes automatisch auf Basis einer Umgebung des Manipulators erzeugt wird. Auf Basis von Trajektorientemplates werden jeweils Interferenzen des Manipulators mit einem Hindernis untersucht und Templates ohne Interferenz priorisiert.From the EP 0 543 236 A2 a remote control operating system is known in which a trajectory of a manipulator head is automatically generated based on an environment of the manipulator. On the basis of trajectories, interferences of the manipulator with an obstacle are examined and templates without interference are prioritized.

Die US 6,604,005 B1 offenbart ein Verfahren zur Bahnplanung, die ein Fortpflanzen von Kostenwellen in einem Konfigurationsraum beinhaltet, der einen Arbeitsraum repräsentiert.The US 6,604,005 B1 discloses a method for path planning that involves propagating cost waves in a configuration space that represents a workspace.

Aus der EP 0 439 655 A1 ein Robotersteuerungsverfahren zur Kollisionsvermeidung zwischen einem aufgabenorientiert programmierten Roboter und Objekten mit unterschiedlichem Mobilitätsgrad bekannt, bei dem verbotene Objektbereiche abgespeichert sind, denen eine Priorität zugeordnet ist, die dem Mobilitätsgrad eines korrespondierenden Objekts entspricht.From the EP 0 439 655 A1 a robot control method for collision avoidance between a task-oriented programmed robot and objects with different degree of mobility is known, are stored in the prohibited object areas, which is assigned a priority that corresponds to the degree of mobility of a corresponding object.

Die DE 10 2004 019 888 A1 offenbart ein Verfahren zur Begrenzung der Bewegung eines Roboters, bei dem eine virtuelle Sicherheitsbegrenzung und mindestens zwei einen Teil des Roboters enthaltende Raumbereiche definiert sind und durch Bewegungsbahnberechnungen vorhergesagte Stellungen dieser Raumbereiche mit der Sicherheitsbegrenzung abgeglichen werden.The DE 10 2004 019 888 A1 discloses a method for limiting the movement of a robot in which a virtual safety boundary and at least two space areas containing a part of the robot are defined, and positions predicted by trajectory calculations are aligned with the safety boundary.

Der Erfindung liegt insbesondere die Aufgabe zugrunde, einen gattungsgemäßen Roboter mit einer Steuereinheit auszustatten, die eine ungewollte Kollision des Roboters mit Gegenständen in seiner Reichweite wirkungsvoll verhindert, und eine zum Generieren eines Bewegungspfades aufzuwendende Rechenzeit reduziert.The invention is in particular the object of equipping a generic robot with a control unit, which effectively prevents an unwanted collision of the robot with objects in its range, and reduces a computing time expended for generating a movement path.

Die Aufgabe wird gelöst durch einen Roboter, insbesondere einen Industrie- oder Gelenkroboter, nach Anspruch 1 mit wenigstens zwei Bewegungsfreiheitsgraden und einer Steuereinheit zum Steuern einer Bewegung zwischen einer Anfangspose und einer Endpose, wobei die Steuereinheit eine Speichereinheit zum Speichern einer Landkarte umfasst, in der zumindest eine Störkontur verzeichenbar ist, sowie durch ein Verfahren nach Anspruch 18 zum Steuern eines solchen Roboters.The object is achieved by a robot, in particular an industrial or articulated robot, according to claim 1 having at least two degrees of freedom of movement and a control unit for controlling a movement between an initial pose and an end pose, wherein the control unit comprises a memory unit for storing a map, in the at least a Störkontur is verzeichenbar, and by a method according to claim 18 for controlling such a robot.

Die Erfindung geht aus von einem Roboter, insbesondere von einem Industrie- oder Gelenkroboter, mit wenigstens zwei Bewegungsfreiheitsgraden und einer Steuereinheit zum Steuern einer Bewegung zwischen einer Anfangspose und einer Endpose.The invention is based on a robot, in particular an industrial or articulated robot, having at least two degrees of freedom of movement and a control unit for controlling a movement between an initial pose and an end pose.

Es wird vorgeschlagen, dass die Steuereinheit eine Speichereinheit zum Speichern einer Landkarte umfasst, in der zumindest eine Störkontur verzeichnet werden kann. Die Steuereinheit kann zu beliebigen Punkten bzw. Posen der Bewegung überprüfen, ob der Punkt oder die Pose innerhalb oder außerhalb einer Störkontur liegt. Erkennt die Steuereinheit, dass der Punkt oder die Pose innerhalb der Störkontur liegt, kann sie ein Warnsignal erzeugen oder eine Bewegung blockieren. Dadurch kann eine Kollision mit einem von der Störkontur dargestellten Gegenstand sicher vermieden werden.It is proposed that the control unit comprises a memory unit for storing a map, in which at least one interference contour can be recorded. The control unit can check at any points or poses of the movement, whether the point or the pose lies inside or outside a disturbing contour. If the control unit detects that the point or pose is within the interference contour, it may generate a warning signal or block movement. As a result, a collision with an object represented by the interference contour can be reliably avoided.

Eine erfindungsgemäß ausgestaltete Steuereinheit kann prinzipiell zur Steuerung jedes Roboters genutzt werden, der sich im Bereich von statischen oder zumindest nur langsam veränderlichen Gegenständen bewegt. Wegen des vergleichsweise großen Rechenzeitaufwands bei den notwendigen Koordinatentransformationen ist die erfindungsgemäße Lösung jedoch besonders vorteilhaft im Zusammenhang mit Gelenkrobotern oder SCARA-Robotern in der industriellen Anwendung einsetzbar.An inventively designed control unit can in principle be used to control each robot, which moves in the range of static or at least only slowly changing objects. Because of the comparatively large computational time required for the necessary coordinate transformations, however, the solution according to the invention is particularly advantageous in the art Can be used in conjunction with articulated robots or SCARA robots in industrial applications.

Als ”Landkarte” soll in diesem Zusammenhang eine mehrdimensionale Datenstruktur bezeichnet werden, die auch eine Überlagerung oder Projektion einer oder mehrerer eindimensionaler Datenstrukturen sein kann. Die Landkarte ist eine Abbildung, die jeder Pose des Roboters einen Wert zuordnet, aus dem entnommen werden kann, ob sich der Roboter bzw. einer seiner Greifarme innerhalb oder außerhalb der Störkontur befindet. Ein schneller Zugriff auf die Landkarte kann erreicht werden, wenn die Dimension der Landkarte kleiner oder gleich einer Zahl der Bewegungsfreiheitsgrade des Roboters ist.In this context, a "map" is to be understood as a multidimensional data structure, which may also be an overlay or projection of one or more one-dimensional data structures. The map is an illustration that assigns to each pose of the robot a value from which it can be deduced whether the robot or one of its gripper arms is located inside or outside the interference contour. Quick access to the map can be achieved if the dimension of the map is less than or equal to a number of degrees of freedom of movement of the robot.

Die Landkarte wird besonders vorteilhaft in einem Initialisierungsprozess des Roboters generiert, um die beim Ermitteln eines Bewegungspfades aufzuwendende Rechenzeit möglichst gering zu halten.The map is generated particularly advantageously in an initialization process of the robot in order to minimize the time required to calculate a movement path.

Erfindungsgemäß wird vorgeschlagen, dass die Steuereinheit dazu vorgesehen ist, einen Bewegungspfad zwischen der Anfangspose und der Endpose selbsttätig in Abhängigkeit von der Landkarte zu generieren. Dadurch kann ein Bedienkomfort deutlich erhöht werden, da nur noch ein Anfangs- und Endpunkt der Bewegung programmiert werden muss, sofern sich die Umgebung des Roboters und damit die zu berücksichtigende Störkontur nicht ändert. Es kann eine systematische Trennung zwischen den anwendungspezifischen Bewegungsdaten bzw. den Koordinaten der anzusteuernden Posen und den oftmals anwendungsunabhängigen Störkonturen erreicht werden. Unter „vorgesehen” soll in diesem Zusammenhang auch „ausgelegt” und „ausgestattet” verstanden werden.According to the invention, it is proposed that the control unit is provided to automatically generate a movement path between the initial pose and the final pose as a function of the map. As a result, ease of use can be significantly increased since only one start and end point of the movement must be programmed, provided that the environment of the robot and thus the interference contour to be considered does not change. A systematic separation between the application-specific movement data or the coordinates of the poses to be controlled and the often application-independent interference contours can be achieved. In this context, "provided" should also be understood to mean "designed" and "equipped".

Wenn die Steuereinheit derart programmiert ist, dass sie die Landkarte zum Generieren des Bewegungspfads in wenigstens zwei Bereiche mit unterschiedlicher Detailgenauigkeit aufteilt, kann eine zum Generieren des Bewegungspfads aufzuwendende Rechenzeit deutlich reduziert werden, da auf überflüssige Detailtreue in Bereichen, die weitläufig frei von Störkonturen sind, verzichtet werden kann. In solchen Bereichen kann die Steuereinheit den Bewegungspfad aus langen Segmenten zusammensetzen, während in kritischen Bereichen mit stark strukturierten Störkonturen ein kleinschrittiger Bewegungsablauf generiert werden kann. Das Generieren des Bewegungspfads kann weiter beschleunigt werden, wenn die Bewegung vorzugsweise durch solche Bereiche geführt wird, die hinsichtlich der Detailgenauigkeit unkritisch sind und nur in Fällen, in denen es unvermeidbar oder in einem Gesamtzusammenhang vorteilhaft ist, die Bewegung in Bereiche geführt wird, in denen zur Kollisionsvermeidung eine hohe Detailgenauigkeit notwendig ist.If the control unit is programmed in such a way that it divides the map into at least two areas with different levels of detail in order to generate the movement path, then a computing time to generate the movement path can be significantly reduced, since superfluous detail in areas which are largely free from interference contours can be waived. In such areas, the control unit can assemble the motion path from long segments, while in critical areas with highly structured interference contours, a small-step motion sequence can be generated. The generation of the movement path can be further accelerated if the movement is preferably guided through those areas which are not critical with regard to the precision of detail and only in cases in which it is unavoidable or advantageous in an overall context, the movement is guided into areas in which For collision avoidance a high degree of detail is necessary.

Ist die Steuereinheit derart programmiert, dass sie die Landkarte zum Generieren des Bewegungspfads in mehrere Unterkarten mit vorgegebenen Pfad-Teilen aufteilt, kann das Generieren des Pfads weiter beschleunigt werden, da zum Durchqueren der den Unterkarten entsprechenden Bereiche des Bewegungsraums des Roboters auf die vorgegebenen Pfad-Teile zurückgegriffen werden kann. Die vorgegebenen Pfad-Teile verbinden vorzugsweise Randpunkte der Unterkarten geradlinig miteinander.If the control unit is programmed in such a way that it divides the map into several sub-maps with predetermined path parts in order to generate the movement path, the generation of the path can be further accelerated since the areas of the movement space of the robot corresponding to the sub-maps are traversed to the prescribed paths. Parts can be used. The predetermined path parts preferably connect edge points of the sub-maps in a straight line with each other.

Ein Transformationsvorgang von einem raumbezogenen Koordinatensystem auf ein achsbezogenes Koordinatensystem kann auf den Initialisierungsprozess der Steuereinheit vorverlegt werden, wenn die Speichereinheit zum Speichern der Landkarte in dem achsbezogenen Koordinatensystem vorgesehen ist. Beim Generieren des Bewegungspfads ist dann eine Koordinatentransformation nicht mehr notwendig.A transformation process from a space-based coordinate system to an axis-related coordinate system may be advanced to the initialization process of the control unit when the memory unit is provided for storing the map in the axis-related coordinate system. When generating the motion path then a coordinate transformation is no longer necessary.

Eine Referenzfahrt des Roboters kann verkürzt werden bzw. ganz entfallen, wenn der Roboter wenigstens einen Absolutwert-Geber zum erfassen eines Absolutwerts von wenigstens einer Koordinate einer aktuellen Pose umfasst. Besonders vorteilhaft sind Ausgestaltungen der Erfindung, in denen alle Achsen des Roboters bzw. eines Greifarms des Roboters mit Absolutwert-Gebern ausgestattet sind.A reference travel of the robot can be shortened or eliminated altogether if the robot comprises at least one absolute value encoder for detecting an absolute value of at least one coordinate of a current pose. Particularly advantageous embodiments of the invention, in which all the axes of the robot or a gripper arm of the robot are equipped with absolute encoders.

Die Steuereinheit kann die Störkontur selbsttätig erkennen, wenn der Roboter wenigstens einen Sensor zum Erkennen der Störkontur umfasst. In einer besonders flexiblen Ausgestaltung der Erfindung ist der Sensor Teil einer Kamera, insbesondere einer CCD-Kamera, die Bilder von einer Umgebung des Roboters erfasst. Durch einschlägige Bildverarbeitungsprogramme kann die Steuereinheit aus den von der Kamera erfassten Bildern die Störkontur ermitteln und in die Landkarte eintragen.The control unit can automatically detect the interference contour if the robot comprises at least one sensor for detecting the interference contour. In a particularly flexible embodiment of the invention, the sensor is part of a camera, in particular a CCD camera, which captures images of an environment of the robot. By means of relevant image processing programs, the control unit can determine the interference contour from the images captured by the camera and enter it in the map.

Eine externe Eingabe der Landkarte kann vermieden werden, die Steuereinheit dazu vorgesehen ist, die Landkarte abhängig von einer vorgegebenen Störkontur zu generieren. Eine Vorgabe der Störkontur ist dabei besonders komfortabel und ohne aufwändige Umrechnungsvorgänge in einem World-Koordinatensystem des Roboters möglich.An external input of the map can be avoided, the control unit is provided to generate the map depending on a predetermined interference contour. A specification of the interference contour is particularly comfortable and without complicated conversion operations in a world coordinate system of the robot possible.

Die zum Generieren der Landkarte aufzuwendende Rechenzeit kann reduziert werden, wenn die Steuereinheit dazu vorgesehen ist, zum Generieren der Landkarte ein auf höchstens 20 Parameter beschränktes Modell für eine Außenkontur eines Greifarms zu nutzen. Wegen der durch die modellhafte Näherung gewonnenen Rechenzeitvorteile kann auf einen schnellen Prozessor und großen Arbeitsspeicher verzichtet werden, wodurch sich letztlich auch Kostenvorteile für die Herstellung des Roboters ergeben.The computation time required to generate the map can be reduced if the control unit is intended to use a model for an outer contour of a gripper arm limited to a maximum of 20 parameters for generating the map. Because of the model time approximation gained computational advantages can be dispensed with a fast processor and large memory, which ultimately also result in cost advantages for the production of the robot.

Eine besonders schnelle und einfache Bestimmung der Störkontur kann erreicht werden, wenn das Modell die Außenkontur des Greifarms durch wenigstens ein Polygon darstellt.A particularly fast and simple determination of the interference contour can be achieved if the model represents the outer contour of the gripping arm by at least one polygon.

Alternativ oder ergänzend dazu kann das Modell die Außenkontur des Greifarms durch wenigstens einen Kreis darstellen. Auch Kombinationen von Kreisen und Polygonen oder anderen einfachen geometrischen Formen sind denkbar. Das Modell muss im Allgemeinen nicht die volle dreidimensionale Außenkontur des Greifarms darstellen, sondern kann auf eine Projektion von der Dimension der Landkarte beschränkt werden.Alternatively or additionally, the model may represent the outer contour of the gripper arm by at least one circle. Also combinations of circles and polygons or other simple geometric shapes are conceivable. The model generally does not have to represent the full three-dimensional outer contour of the gripper arm, but can be limited to a projection on the dimension of the map.

Eine hinreichend präzise Modellierung eines Greifarms des Roboters kann mit geringem Aufwand dadurch erreicht werden, dass jeder unabhängige Armteil des Greifarms durch eine einzige elementare geometrische Form, beispielsweise durch ein Polygon, beschrieben wird.A sufficiently precise modeling of a gripper arm of the robot can be achieved with little effort that each independent arm of the gripper arm is described by a single elementary geometric shape, for example by a polygon.

Ferner betrifft die Erfindung ein Verfahren zum Steuern einer Bewegung eines Roboters, insbesondere eines Roboters der oben beschriebenen Art.Furthermore, the invention relates to a method for controlling a movement of a robot, in particular a robot of the type described above.

Es wird vorgeschlagen, dass beim Generieren des Bewegungspfads eine Landkarte genutzt wird, in der zumindest eine Störkontur verzeichnet ist. Eine Kollision mit durch die Störkontur dargestellten Gegenständen oder Hindernissen in einer Reichweite des Roboters kann dadurch vermieden werden.It is proposed that when generating the movement path a map is used in which at least one interference contour is recorded. A collision with objects or obstacles represented by the interference contour in a range of the robot can be avoided.

Weitere Merkmale der Erfindung und deren Vorteile ergeben sich aus der folgenden Figurenbeschreibung. Die Figuren zeigen Ausführungsbeispiele der Erfindung. Die Figuren, die Beschreibung und die Ansprüche enthalten zahlreiche Merkmale in Kombination, die der Fachmann auch einzeln betrachten und zu sinnvollen weiteren Kombinationen zusammenfassen wird.Further features of the invention and its advantages will become apparent from the following description. The figures show embodiments of the invention. The figures, the description and the claims contain numerous features in combination which the skilled person will also consider individually and summarize to meaningful further combinations.

Dabei zeigen:Showing:

1 einen Roboter mit einem Greifarm in einer Draufsicht mit einem schematisch dargestellten ersten Modell aus zwei Linien für eine Außenkontur des Greifarms; 1 a robot with a gripper arm in a plan view with a schematically illustrated first model of two lines for an outer contour of the gripping arm;

2 den Roboter mit dem Greifarm aus 1 mit einem schematisch dargestellten zweiten Modell aus Kreisen für eine Außenkontur des Greifarms; 2 the robot with the gripper arm out 1 with a schematically illustrated second model of circles for an outer contour of the gripping arm;

3 den Roboter mit dem Greifarm aus den 1 und 2 mit einem schematisch dargestellten dritten Modell aus zwei Rechtecken für eine Außenkontur des Greifarms; 3 the robot with the gripper arm out of the 1 and 2 with a schematically illustrated third model of two rectangles for an outer contour of the gripping arm;

4 den Roboter mit dem Greifarm aus den 13 mit einem schematisch dargestellten weiteren Modell aus zwei Polygonen für eine Außenkontur des Greifarms 4 the robot with the gripper arm out of the 1 - 3 with a schematically illustrated further model of two polygons for an outer contour of the gripping arm

5 einen Arbeitsraum des Roboters aus den 14 mit Gegenständen, die eine Störkontur erzeugen, in einer Draufsicht in Welt-Koordinaten; 5 a working space of the robot from the 1 - 4 with objects that generate an interference contour, in a plan view in world coordinates;

6 eine Landkarte mit den Störkonturen der Anordnung der Gegenstände aus 5 gemäß dem ersten Modell für die Außenkontur des Greifarms; 6 a map with the Störkonturen the arrangement of the objects 5 according to the first model for the outer contour of the gripping arm;

7 eine Landkarte mit Störkonturen gemäß dem dritten Modell für die Außenkontur des Greifarms; 7 a map with Störkonturen according to the third model for the outer contour of the gripper arm;

8 eine schematische Darstellung zum manuellen Generieren eines Bewegungspfads in einer Landkarte mit Störkonturen; 8th a schematic representation of the manual generation of a motion path in a map with Störkonturen;

9 eine schematische Darstellung zum autonomen Generieren eines Bewegungspfads in einer Landkarte mit Störkonturen; eine schematische Darstellung zum autonomen Generieren eines Bewegungspfads in einer Landkarte mit Störkonturen nach einem alternativen Algorithmus; 9 a schematic representation of the autonomous generation of a motion path in a map with Störkonturen; a schematic representation of the autonomous generation of a motion path in a map with Störkonturen according to an alternative algorithm;

10 eine schematische Darstellung zum autonomen Generieren eines Bewegungspfads in einer Landkarte mit Störkonturen nach einem weiteren alternativen Algorithmus, der die Landkarte in Bereiche mit unterschiedlicher Detailgenauigkeit aufteilt; 10 a schematic representation of the autonomous generation of a movement path in a map with Störkonturen for another alternative algorithm that divides the map into areas with different levels of detail;

11 eine erste Unterkarte der Landkarte aus 11; 11 a first sub-map of the map 11 ;

12 eine zweite Unterkarte der Landkarte aus 11; 12 a second sub-map of the map 11 ;

13 eine dritte Unterkarte der Landkarte aus 11 13 a third sub-map of the map 11

14 eine vierte Unterkarte der Landkarte aus 11; und 14 a fourth sub-map of the map 11 ; and

15 eine schematische Darstellung zum autonomen Generieren eines Bewegungspfads in einer Landkarte mit Störkonturen nach einem weiteren alternativen Algorithmus, der die Landkarte in rechteckige Unterkarten aufteilt. 15 a schematic representation of the autonomous generation of a movement path in a map with Störkonturen for another alternative algorithm that divides the map into rectangular sub-maps.

1 zeigt einen Roboter, und zwar lediglich beispielhaft einen als SCARA-Roboter ausgebildeten Industrieroboter, mit wenigstens zwei Bewegungsfreiheitsgraden mit den rotatorischen Koordinaten α1, α2 und einer hier nur schematisch dargestellten Steuereinheit 12 zum Steuern einer Bewegung zwischen einer Anfangspose 14 und einer Endpose 16 (7). 1 shows a robot, by way of example only, an industrial robot designed as a SCARA robot, with at least two Freedom of movement with the rotational coordinates α 1 , α 2 and a control unit shown here only schematically 12 for controlling a movement between an initial pose 14 and an end pose 16 ( 7 ).

Der Roboter umfasst einen schwenkbaren Greifarm 10, der um eine erste, vertikal verlaufende rotatorische Achse A1 schwenkbar ist. Der Greifarm 10 ist auf einem Sockel 22 montiert und besteht aus zwei durch ein Gelenk 24 verbundenen Armteilen 60, 62. Die Armteile 60, 62 sind durch das Gelenk 24 um eine parallel zu der ersten rotatorischen Achse A1 verlaufende zweite rotatorische Achse A2 schwenkbar. Weitere Achsen des Roboters sind hier nicht explizit dargestellt.The robot includes a swiveling gripping arm 10 which is pivotable about a first, vertically extending rotary axis A1. The gripper arm 10 is on a pedestal 22 mounted and consists of two by a joint 24 connected arm parts 60 . 62 , The arm parts 60 . 62 are through the joint 24 about a parallel to the first rotary axis A1 extending second rotary axis A2 pivotally. Other axes of the robot are not explicitly shown here.

Der Greifarm 10 des Roboters umfasst zwei hier nur schematisch dargestellte Absolutwert-Geber 26, 28 zum Erfassen eines Absolutwerts der rotatorischen Koordinaten α1, α2 einer aktuellen Pose. Die Erfindung wäre jedoch prinzipiell auch dann anwendbar, wenn der Greifarm 10 lediglich Inkrementgeber zum Erfassen von Veränderungen der Werte der rotatorischen Koordinaten α1, α2 hätte. Es wäre dann eine Referenzfahrt zu Referenzmarken mit bekannter Position im Raum notwendig.The gripper arm 10 of the robot comprises two absolute value encoders shown here only schematically 26 . 28 for detecting an absolute value of the rotational coordinates α 1 , α 2 of a current pose. However, the invention would in principle also be applicable if the gripping arm 10 only incremental for detecting changes in the values of the rotational coordinates α 1 , α 2 would have. It would then be a reference to reference marks with a known position in space necessary.

Im Bereich des Greifarms 10 sind störende Gegenstände 64, und zwar im vorliegenden Beispiel Stangen, angeordnet (5). Die vertikale Ausdehnung wird als unendlich betrachtet. Eine dritte und eine vierte Achse des Roboters und ein am Tool-Center-Point (TCP) befestigter Pfeil werden in der hier beschriebenen Näherung nicht betrachtet. Die Verallgemeinerung der erfindungsgemäßen Lösung auf die Betrachtung von mehr als zwei Achsen A1, A2 ist für den Fachmann aber nahe liegend und offensichtlich.In the area of the gripper arm 10 are disturbing objects 64 , in the present example bars, arranged ( 5 ). The vertical extent is considered infinite. A third and a fourth axis of the robot and an arrow attached to the Tool Center Point (TCP) are not considered in the approximation described here. However, the generalization of the solution according to the invention to the consideration of more than two axes A1, A2 is obvious and obvious to the person skilled in the art.

Die Steuereinheit 12 umfasst eine Speichereinheit 30 zum Speichern einer Landkarte 32, in der zumindest eine Störkontur 34 verzeichnet werden kann. Die Speichereinheit 30 ist zum Speichern der Landkarte 32 in einem achsbezogenen Koordinatensystem vorgesehen. Die Steuereinheit 12 muss dazu die Konturen der Gegenstände 64 derart in das achsbezogene Koordinatensystem eintragen, dass eine Kollisionsgefahr zwischen dem Greifarm 10 und einem der Gegenstände 64 aus der Landkarte 32 ablesbar ist. Ein Speicherplatz ist für eine binäre 360×360-Matrix reserviert, die die Landkarte 32 bildet. Hat ein Eintrag den Wert Null, so liegt der durch den entsprechenden Eintrag repräsentierte Punkt außerhalb der Störkontur 34, anderenfalls liegt der Punkt innerhalb der Störkontur 34 und ist daher für den Greifarm 10 ohne Kollision mit einem Gegenstand 64 nicht erreichbar. Die Genauigkeit der Karte, bestimmt durch die Schrittweite der Karte, entspricht der Genauigkeit der Posen-Bestimmung des Roboters bzw. vice versa. Die Steuereinheit 12 misst den Wert der Koordinaten α1, α2 bzw. Winkel und liest den der Pose durch die ganzzahligen Indizes der Matrix zugeordneten Wert aus der Speichereinheit 12 aus. Die Matrix bildet daher eine diskrete, zweidimensionale Landkarte 32, die jeder Pose bzw. jedem Wertepaar der Koordinaten α1, α2 ein Indexpaar und dadurch einen Wert zuordnet.The control unit 12 includes a storage unit 30 to save a map 32 , in which at least one interference contour 34 can be recorded. The storage unit 30 is to save the map 32 provided in an axis-related coordinate system. The control unit 12 must have the contours of the objects 64 enter into the axis-related coordinate system such that there is a risk of collision between the gripper arm 10 and one of the objects 64 from the map 32 is readable. A storage space is reserved for a binary 360 × 360 matrix that represents the map 32 forms. If an entry has the value zero, the point represented by the corresponding entry is outside the interference contour 34 otherwise the point lies within the interference contour 34 and is therefore for the gripper arm 10 without colliding with an object 64 not available. The accuracy of the map, determined by the step size of the map, corresponds to the accuracy of the pose determination of the robot or vice versa. The control unit 12 measures the value of the coordinates α 1 , α 2 or angle and reads the value associated with the pose by the integer indices of the matrix from the memory unit 12 out. The matrix therefore forms a discrete, two-dimensional map 32 which assigns each pair or each pair of values to the coordinates α 1 , α 2 an index pair and thereby a value.

Es wären weitere Ausgestaltungen der Erfindung denkbar, bei denen die Landkarte mehr-, insbesondere dreidimensional ist, der Wertebereich der Landkarte 32 mehr als zwei Elemente hat und/oder in denen der einer Pose zugeordnete Wert beispielsweise eine Kenngröße für eine Entfernung zur nächsten Störkontur 34 ist. Ferner ist es natürlich denkbar, die Schrittweite der Diskretisierung der Landkarte 32 kleiner oder größer als 1° zu wählen.Other embodiments of the invention would be conceivable in which the map is multi-dimensional, in particular three-dimensional, the value range of the map 32 has more than two elements and / or in which the value associated with a pose, for example, a characteristic for a distance to the next interference contour 34 is. Furthermore, it is of course conceivable, the step size of the discretization of the map 32 less than or greater than 1 °.

Die 116 zeigen mehrere alternative Ausgestaltungen der Erfindung. Funktionsgleiche Merkmale sind mit gleichen Bezugszeichen versehen. Die Beschreibung geht jeweils insbesondere auf Unterschiede zu den zuvor beschriebenen Ausführungsbeispielen ein, während im Hinblick auf gleich bleibende Merkmale auf die Beschreibung zu den zuvor beschriebenen Ausführungsbeispielen verwiesen wird.The 1 - 16 show several alternative embodiments of the invention. Functionally identical features are provided with the same reference numerals. In each case, the description deals in particular with differences from the exemplary embodiments described above, while reference is made to the description of the previously described exemplary embodiments with regard to features which remain the same.

2 zeigt einen Roboter in einer alternativen Ausgestaltung der Erfindung, in der der Greifarm 10 hier nur skizzenhaft dargestellte Sensoren 4646''' zum Erkennen einer Störkontur 34 umfasst. Die Sensoren 4646''' sind als induktive Näherungssensoren ausgebildet. 2 shows a robot in an alternative embodiment of the invention, in which the gripping arm 10 here only sketchy illustrated sensors 46 - 46 ''' for detecting a disturbing contour 34 includes. The sensors 46 - 46 ''' are designed as inductive proximity sensors.

In einem Initialisierungsvorgang nutzt die Steuereinheit 12 zum Generieren der Landkarte 32 ein auf wenige Parameter beschränktes Modell für eine Außenkontur 58 eines Greifarms 10. Es sind verschiedene Modelle denkbar, die in den 14 schematisch dargestellt sind und im Folgenden erläutert werden.In an initialization process, the control unit uses 12 to generate the map 32 a limited to a few parameters model for an outer contour 58 a gripper arm 10 , There are several models conceivable in the 1 - 4 are shown schematically and explained below.

In einer realistischen Implementierung des Modells, die hier nicht explizit dargestellt ist, nähert das Steuerprogramm die Außenkontur 58 bzw. das Volumen des Greifarms 10 durch Massepunkte bzw. Voxel oder Finite Elemente. Wegen der notwendigen hohen Zahl von Massepunkten ist der Rechenaufwand zur Erstellung der Landkarte 32 sehr hoch und erfordert zudem eine ähnlich aufwändige Modellierung der Gegenstände 64 im Bereich des Greifarms 10. Daher werden im Folgenden Modelle beschrieben, die einen im Vergleich zur Modellierung durch Massepunkte verringerten Rechenaufwand erfordern.In a realistic implementation of the model, which is not explicitly shown here, the control program approximates the outer contour 58 or the volume of the gripper arm 10 by mass points or voxels or finite elements. Because of the necessary high number of mass points, the computational effort to create the map 32 very high and also requires a similarly elaborate modeling of the objects 64 in the area of the gripper arm 10 , Therefore, models that require less computation compared to mass point modeling are described below.

In einer ersten Implementierung eines Steuerprogramms stellt das Modell die Außenkontur 58 des Greifarms 10 durch zwei Linien 48, 50 dar, die jeweils einen Armteil 60, 62 des Greifarms 10 abbilden. Die Koordinaten der Endpunkte der Linien 48, 50 können bei Kenntnis der Längen der Linien 48, 50 und der rotatorischen Koordinaten α1, α2 trigonometrisch berechnet werden. Da eine Breite des Greifarms 10 bzw. der Armteile 60, 62 in dem Modell nicht berücksichtigt ist, müssen zur sicheren Vermeidung von Kollisionen Sicherheitszonen zwischen den Linien 48, 50 und den durch Randkonturen beschriebenen Gegenständen 64 berücksichtigt werden, die wenigstens so groß sind wie der maximale Abstand der Außenkontur 58 von den Linien 48, 50.In a first implementation of a control program, the model represents the outer contour 58 of the gripper arm 10 through two lines 48 . 50 that is one arm each 60 . 62 of the gripper arm 10 depict. The coordinates of the endpoints of the lines 48 . 50 can with knowledge of the lengths of the lines 48 . 50 and the rotational coordinates α 1 , α 2 are calculated trigonometrically. Because a width of the gripper arm 10 or the arm parts 60 . 62 In the model is not considered, to avoid collisions safely zones between the lines 48 . 50 and the objects described by edge contours 64 be taken into account, which are at least as large as the maximum distance of the outer contour 58 from the lines 48 . 50 ,

Eine aus der Störkontur-Konstellation gemäß 5 resultierende Landkarte 32 gemäß der ersten Implementierung ist in 6 dargestellt. Die in 5 links vom Roboter angeordneten Gegenstände 64 erzeugen eine gemeinsame Zusammenhangskomponente der Störkontur 34. Der zentral vor dem Roboter angeordnete Gegenstand blockiert einen Winkelbereich bezüglich der ersten rotatorischen Koordinate α1. Links und rechts aus diesem Winkelbereich heraus ragende Ausbuchtungen sind dadurch bedingt, dass ein hinteres Ende des vorderen Armteils 62 des Greifarms 10 gegen den Gegenstand stößt. Ein rechts vom Roboter radial weiter entfernt angeordneter Gegenstand erzeugt eine dritte, inselartige Zusammenhangskomponente der Störkontur 34.One from the Störkontur constellation according to 5 resulting map 32 according to the first implementation is in 6 shown. In the 5 Objects arranged to the left of the robot 64 generate a common connected component of the interference contour 34 , The object arranged centrally in front of the robot blocks an angular range with respect to the first rotational coordinate α 1 . On the left and right out of this angular range protruding bulges are due to the fact that a rear end of the front arm 62 of the gripper arm 10 hits the object. An object arranged radially further to the right of the robot generates a third, island-like connected component of the interference contour 34 ,

In einer zweiten Implementierung eines Steuerprogramms stellt das Modell bzw. die Steuereinheit 12 die Außenkontur 58 des Greifarms 10 durch sieben verschieden große Kreise 56 dar (2). Die Flächen der Kreise 56 überdecken die Außenkontur 58 vollständig. Die Koordinaten der Mittelpunkte der Kreise 56 liegen auf den Linien 48, 50 (1) und werden bei Kenntnis der Längen der Linien 48, 50 und der rotatorischen Koordinaten α1, α2 trigonometrisch berechnet. Die Konturen der Gegenstände 64 werden in gleicher Weise durch Kreise überdeckt. Zum Berechnen der Landkarte 32 überprüft die Steuereinheit 12 zu jedem Wertepaar der Koordinaten α1, α2, ob einer der den Greifarm 10 überdeckenden Kreise 56 einen der die Gegenstände 64 überdeckenden Kreise schneidet. Ist dies der Fall, so trägt die Steuereinheit 12 einen Punkt der Störkontur 34 in die Landkarte 32 ein.In a second implementation of a control program, the model or control unit provides 12 the outer contour 58 of the gripper arm 10 through seven different circles 56 dar ( 2 ). The surfaces of the circles 56 cover the outer contour 58 Completely. The coordinates of the centers of the circles 56 lie on the lines 48 . 50 ( 1 ) and become aware of the lengths of the lines 48 . 50 and the rotational coordinates α 1 , α 2 calculated trigonometrically. The contours of the objects 64 are covered in the same way by circles. To calculate the map 32 checks the control unit 12 to each value pair of coordinates α 1 , α 2 , whether one of the gripper arm 10 covering circles 56 one of the objects 64 overlapping circles intersects. If this is the case, then the control unit carries 12 a point of the interference contour 34 in the map 32 one.

In einer dritten Implementierung eines Steuerprogramms stellt das Modell bzw. die Steuereinheit 12 die Außenkontur 58 des Greifarms 10 durch zwei Polygone 52, 54 dar (3), und zwar durch Rechtecke, die jeweils einen der Armteile 60, 62 überdecken und den entsprechenden Armteil 60, 62 repräsentieren. Die 16 Randlinien der beiden Polygone 52, 54 werden zum Generieren der Landkarte 32 ebenso wie die Randlinien der Gegenstände 64 im Bereich des Greifarms 10 von der Steuereinheit 12 durch Geraden dargestellt und durch die beiden Koordinaten α1, α2 und durch zwei Längen und zwei Breiten parametrisiert. Zwei weitere Parameter beschreiben die Lage der Achsen A1, A2 innerhalb der Polygone 52, 54. Insgesamt ergeben sich demnach weniger als 20 Parameter des Modells. Zum Generieren der Landkarte 32 überprüft die Steuereinheit 12 zu jedem Wertepaar der Koordinaten α1, α2, ob und in welchem Punkt eine der Randlinien der Polygone 52, 54 eine der Randlinien der Gegenstände 64 schneidet. Liegt der Schnittpunkt jeweils zwischen den Endpunkten der Randlinien, so trägt die Steuereinheit 12 an der entsprechenden Pose einen Punkt der Störkontur 34 in die Landkarte 32 ein.In a third implementation of a control program, the model or control unit provides 12 the outer contour 58 of the gripper arm 10 through two polygons 52 . 54 dar ( 3 ), by rectangles, each one of the arm parts 60 . 62 cover and the corresponding arm part 60 . 62 represent. The 16 margins of the two polygons 52 . 54 are used to generate the map 32 as well as the marginal lines of the objects 64 in the area of the gripper arm 10 from the control unit 12 represented by straight lines and parameterized by the two coordinates α 1 , α 2 and by two lengths and two widths. Two further parameters describe the position of the axes A1, A2 within the polygons 52 . 54 , Overall, this results in less than 20 parameters of the model. To generate the map 32 checks the control unit 12 for each pair of values of the coordinates α 1 , α 2 , if and at which point one of the boundary lines of the polygons 52 . 54 one of the marginal lines of the objects 64 cuts. If the point of intersection lies between the end points of the boundary lines, then the control unit carries 12 at the corresponding pose a point of the interference contour 34 in the map 32 one.

7 zeigt eine gemäß der dritten Implementierung gewonnene Landkarte 32 mit einer Störkontur 34. Inselartige, freie Einschlüsse in der Störkontur 34 resultieren daraus, dass die Polygone 52, 54 im mathematischen Modell einen Gegenstand 64 umschließen, so dass keine der Randlinien der Polygone 52, 54 eine der Randlinien des Gegenstands 64 schneidet. Die entsprechenden Posen sind in der Realität für den Greifarm 10 nicht zugänglich. 7 shows a map obtained according to the third implementation 32 with a disturbing contour 34 , Island-like, free inclusions in the Störkontur 34 result from the fact that the polygons 52 . 54 an object in the mathematical model 64 enclose so that none of the margins of the polygons 52 . 54 one of the marginal lines of the object 64 cuts. The corresponding poses are in reality for the gripper arm 10 inaccessible.

In einer vierten Implementierung eines Steuerprogramms stellt das Modell die Außenkontur 58 des Greifarms 10 durch zwei Polygone 52', 54' dar (4), und zwar durch ein Rechteck 52' und durch ein unregelmäßiges Sechseck 54', das einem konischen Verlauf des vorderen Armteils 62 Rechnung trägt. Die Polygone 52', 54' werden analog zu dem zuvor beschriebenen Ausführungsbeispiel durch ihre Randlinien beschrieben, und die Landkarte 32 wird durch die Überprüfung der Schnittpunkte der Geraden in der oben beschriebenen Weise generiert.In a fourth implementation of a control program, the model represents the outer contour 58 of the gripper arm 10 through two polygons 52 ' . 54 ' dar ( 4 ), by a rectangle 52 ' and by an irregular hexagon 54 ' which has a conical shape of the front arm part 62 Takes into account. The polygons 52 ' . 54 ' are described analogous to the embodiment described above by their marginal lines, and the map 32 is generated by checking the intersections of the straight lines in the manner described above.

In alternativen Ausgestaltungen der Erfindung können die Außenkontur 58 des Greifarms 10 und die Konturen der Gegenstände 64 durch weitere geometrische Formen, beispielsweise Dreiecke, andere Polygone, Ellipsen oder durch Kombinationen aus solchen elementaren Figuren modelliert werden. Ein höherer Detaillierungsgrad des Modells kann insbesondere für die vorderen Bereiche des Greifarms 10 in der Nähe des Tool-Center-Points lohnenswert sein.In alternative embodiments of the invention, the outer contour 58 of the gripper arm 10 and the contours of the objects 64 be modeled by other geometric shapes, such as triangles, other polygons, ellipses or combinations of such elemental figures. A higher degree of detail of the model can be found in particular for the front regions of the gripper arm 10 be worthwhile near the Tool Center Points.

Die Steuereinheit 12 ist durch eine implementierte Steuerungssoftware dazu ausgelegt, im Betrieb selbsttätig einen Bewegungspfad 36 (7) zwischen der Anfangspose 14 und der Endpose 16 in Abhängigkeit von der Landkarte 32 zu generieren.The control unit 12 is designed by an implemented control software to operate automatically a motion path 36 ( 7 ) between the initial pose 14 and the final pose 16 depending on the map 32 to generate.

Die Steuereinheit 12 nutzt dabei die Landkarte 32 bzw. die in der Landkarte 32 verzeichnete Störkontur 34 und generiert den Bewegungspfad 36 abhängig von der vorgegebenen Störkontur 34 bzw. von den Gegenständen 64, deren Koordinaten entweder manuell eingegeben oder durch den Roboter selbsttätig über die Sensoren 4646''' (2) erfasst sein können.The control unit 12 uses the map 32 or in the map 32 recorded interference contour 34 and generates the motion path 36 depending on the given interference contour 34 or of the objects 64 whose coordinates are entered either manually or by the robot automatically via the sensors 46 - 46 ''' ( 2 ) can be detected.

8 zeigt einen manuell in Abhängigkeit von der Landkarte 32 generierten Pfad. Ausgehend von einer Anfangspose 14 legt ein Programmierer Überschleifpunkte 66, 66' derart in die freien Bereiche außerhalb der Störkontur 34, dass die Verbindungsgeraden zwischen den Überschleifpunkten 66, 66' bzw. zwischen der Anfangspose 14 und dem ersten Überschleifpunkt 66 oder dem letzten Überschleifpunkt und der Endpose 16 vollständig außerhalb der Störkontur 34 liegt. 8th shows one manually depending on the map 32 generated path. Starting from an initial pose 14 puts a programmer rounding points 66 . 66 ' such in the free areas outside the interference contour 34 in that the connecting line between the blending points 66 . 66 ' or between the initial pose 14 and the first blending point 66 or the last rounding point and the final pose 16 completely outside the interference contour 34 lies.

9 zeigt einen autonom von der Steuereinheit 12 generierten Bewegungspfad 36, der durch einen Algorithmus mit der Maßgabe maximaler Sicherheit erzeugt ist. Der Algorithmus basiert darauf, dass sich der erste Armteil 60 durch Schwenken um die Achse A1 in Schritten, die der Schrittweite der Landkarte 32 entsprechen, in Richtung der Endpose 16 bewegt. Die rotatorische Koordinate α2 des zweiten Armteils 62 wird in jedem Schritt derart eingestellt, dass der größtmögliche Abstand zu allen Störkonturen 34 eingehalten wird. Das Verfahren prüft dazu die möglichen Werte der Koordinate α2 bei vorgegebener Koordinate α1 in einem zusammenhängenden Bereich, ermittelt den Mittelwert der kollisionsfreien Posen in diesem Bereich, erhöht den Wert der Koordinate α1 um 1 und generiert den Bewegungspfad 36 durch das Setzen von Überschleifpunkten 66. Für den Fall, dass der Mittelwert der kollisionsfreien Posen zu stark von der Koordinate α2 des letzten Überschleifpunkts 66 abweicht, werden die Fluktuationen auf einen Maximalwert begrenzt oder es wird ein anderes, dem Fachmann als sinnvoll erscheinendes, intelligentes Glättungsverfahren verwendet. 9 shows one autonomously from the control unit 12 generated motion path 36 which is generated by a maximum certainty algorithm. The algorithm is based on that the first arm part 60 by panning the axis A1 in steps, the increment of the map 32 correspond, in the direction of the final pose 16 emotional. The rotational coordinate α 2 of the second arm part 62 is set in each step such that the greatest possible distance to all interference contours 34 is complied with. For this, the method checks the possible values of the coordinate α 2 for a given coordinate α 1 in a contiguous area, determines the mean value of the collision-free poses in this area, increases the value of the coordinate α 1 by 1 and generates the movement path 36 by setting blending points 66 , In the event that the mean of the collision-free poses is too strong from the coordinate α 2 of the last blending point 66 deviates, the fluctuations are limited to a maximum value or it is another, the expert appears to be useful, intelligent smoothing method used.

Wenn der Wert der Koordinate α1 dem entsprechenden Wert der Zielpose 16 entspricht, wird versucht, die Achse A2 in Position zu bringen.If the value of the coordinate α 1 corresponds to the corresponding value of the target pose 16 an attempt is made to bring axis A2 into position.

10 zeigt einen autonom von der Steuereinheit 12 generierten Bewegungspfad 36, der durch einen alternativen Algorithmus nach der Maßgabe minimaler Strecke erzeugt ist. Dabei wird der Wert der Koordinate α1 ausgehend von der Anfangspose 14 oder von einem Überschleifpunkt 66 zunächst so weit wie möglich in Richtung der Zielpose 16 verschoben. Wenn eine kollisionsverursachende Pose angetroffen wird, setzt die Steuereinheit 12 einen Überschleifpunkt 66 an der letzten kollisionsfreien Pose mit dem Wert X der Koordinate α1. Anschließend wird der Wert der Koordinate α2 ausgehend von dem Überschleifpunkt 66 so weit verschoben, bis die Pose mit dem Wert X + 1 bzw. X – 1 der Koordinate α1 keine Kollision verursacht. Die Steuereinheit 12 setzt einen Überschleifpunkt 66' an die derart gefundene Pose, von der aus der Wert X der Koordinate α1 weiter in Richtung des entsprechenden Werts der Zielpose 16 verschoben werden kann. Die oben beschriebenen Schritte werden wiederholt, bis die Achse A1 in Position ist. Anschließend wird versucht, die Achse A2 in Position zu bringen. Im günstigsten Fall muss kein einziger Überschleifpunkt generiert werden. 10 shows one autonomously from the control unit 12 generated motion path 36 which is generated by an alternative algorithm according to the minimum distance requirement. In this case, the value of the coordinate α 1, starting from the initial pose 14 or from a sanding point 66 first as far as possible in the direction of the target pose 16 postponed. If a collision-causing pose is encountered, the control unit continues 12 a sanding point 66 on the last collision-free pose with the value X of the coordinate α 1 . Subsequently, the value of the coordinate α 2 is obtained from the blending point 66 until the pose with the value X + 1 or X - 1 of the coordinate α 1 causes no collision. The control unit 12 sets a rounding point 66 ' to the pose thus found, from which the value X of the coordinate α 1 moves further in the direction of the corresponding value of the target pose 16 can be moved. The steps described above are repeated until the axis A1 is in position. An attempt is then made to bring axis A2 into position. In the best case, no single rounding point has to be generated.

Die beiden zuletzt beschriebenen Methoden der Pfad-Generierung können durch eine simultane Pfad-Generierung beschleunigt werden, die gleichzeitig von der Anfangspose 14 und von der Zielpose 16 startet. Diese Erweiterung ist insbesondere dann notwendig, wenn sich die Zielpose 16 in der Nähe einer Störkontur 34 befindet.The two methods of path generation described last can be accelerated by a simultaneous path generation, simultaneously from the initial pose 14 and of the target pose 16 starts. This extension is especially necessary when the target pose 16 near a disturbing contour 34 located.

11 zeigt in einer schematisierten Weise eine alternative Ausgestaltung der Steuerungssoftware, die zwischen einem kritischen Bereich 38 der Landkarte 32 und einem unkritischen Bereich 40 der Landkarte 32 unterscheidet. Hierbei ist die Steuereinheit 12 derart programmiert, dass sie die Landkarte 32 zum Generieren des Bewegungspfads 36 in zwei Bereiche 38, 40 mit unterschiedlicher Detailgenauigkeit aufteilt. Ein erster, kritischer Bereich 38 weist eine hohe Flächendichte der Randlinien der Störkontur 34 auf, während ein zweiter Bereich 40 frei von Störkonturen 34 ist. 11 Fig. 12 shows, in a schematized manner, an alternative embodiment of the control software operating between a critical area 38 the map 32 and a non-critical area 40 the map 32 different. Here is the control unit 12 programmed so that they have the map 32 to generate the motion path 36 in two areas 38 . 40 with different levels of detail. A first, critical area 38 has a high surface density of the edge lines of the interference contour 34 on while a second area 40 free from interfering contours 34 is.

Die Steuereinheit 12 teilt die Landkarte 32 zum Generieren des Bewegungspfads 36 in mehrere Unterkarten 4242''' mit vorgegebenen Pfad-Teilen 44 auf. Die Unterkarten 4242''' sind jeweils rechteckig und ihre Größe hängt von dem Bereich 38, 40 ab, in dem sie angeordnet sind. Zur Illustration des Verfahrens sind vier der Unterkarten 4242''' mit römischen Ziffern XII–XV markiert und in den 1215 detailliert dargestellt.The control unit 12 share the map 32 to generate the motion path 36 in several sub-maps 42 - 42 ''' with given path parts 44 on. The sub-cards 42 - 42 ''' are each rectangular and their size depends on the area 38 . 40 in which they are arranged. To illustrate the process are four of the sub-maps 42 - 42 ''' marked with Roman numerals XII-XV and in the 12 - 15 shown in detail.

12 zeigt eine erste Unterkarte 42 der Landkarte 32, die frei von Störkonturen 34 ist. Die Pfad-Teile 44 verbinden jeweils die Eckpunkte der Unterkarte 42 entlang eines Rands der Unterkarte 42 miteinander. 12 shows a first sub-map 42 the map 32 , free from interfering contours 34 is. The path parts 44 each connect the vertices of the sub-map 42 along an edge of the sub-map 42 together.

Eine in 13 dargestellte Unterkarte 42' zeigt eine an einem linken Rand in die Unterkarte 42' hinein ragende Störkontur 34. Die Start- und Zielpunkte der vorgegebenen Pfad-Teile 44 liegen außerhalb der Störkontur 34 auf einem unregelmäßigen Viereck auf dem Rand der Unterkarte 42'.An in 13 illustrated sub-map 42 ' shows one at a left edge in the sub-map 42 ' protruding interference contour 34 , The start and end points of the given path parts 44 lie outside the interference contour 34 on an irregular square on the edge of the sub-map 42 ' ,

Eine weitere, in 14 dargestellte Unterkarte 42'' zeigt einen Abschnitt der Störkontur 34, welche die Unterkarte 42'' durch einen vertikalen, für den Greifarm 10 nicht zugänglichen Streifen in zwei Teile aufteilt. Eine erste Gruppe von Start- und Zielpunkten ist auf einem unregelmäßigen Viereck am Rand des ersten Teils der Unterkarte 42'' angeordnet und eine zweite Gruppe von Start- und Zielpunkten ist auf einem Dreieck am Rand des zweiten Teils
der Unterkarte 42'' angeordnet. Es ergeben sich sieben Teil-Pfade 44, die Start- und Zielpunkte jeweils innerhalb einer Gruppe entlang des Rands des Vierecks bzw. des Dreiecks miteinander verbinden.
Another, in 14 illustrated sub-map 42 '' shows a section of the interference contour 34 which the sub-map 42 '' through a vertical, for the gripper arm 10 not accessible strip divides into two parts. A first group of start and finish points is on an irregular square at the edge of the first part of the sub-map 42 '' arranged and a second group of start and end points is on a triangle at the edge of the second part
the sub-map 42 '' arranged. There are seven sub-paths 44 , the start and end points in each case within a group along the edge of the quadrilateral or the triangle interconnect.

Eine in 15 dargestellte Unterkarte 42''' wird an zwei Stellen von einer Störkontur 34 geprägt, und zwar von einem ersten, an einer linken oberen Ecke in die Unterkarte 42''' hinein ragenden Teil der Störkontur 34 und einen zweiten, als Spitze in die Unterkarte 42''' hinein ragenden Teil der Störkontur 34. Insgesamt sieben Start- und Zielpunkte sind durch Teil-Pfade 44 paarweise miteinander verbunden.An in 15 illustrated sub-map 42 ''' becomes in two places of a disturbing contour 34 marked, from a first, at a top left corner in the sub-map 42 ''' protruding part of the interference contour 34 and a second, as a tip in the sub-map 42 ''' protruding part of the interference contour 34 , A total of seven start and finish points are by sub-paths 44 paired together.

In 16 zeigt eine alternative Möglichkeit zur Pfadgenerierung aus einer Landkarte 32, in der zwischen kritischen und unkritischen Bereichen unterschieden wird. Die Steuereinheit 12 unterteilt die Landkarte 32 in Rechtecke mit unterschiedlichen Größen. Die Rechtecke sind jeweils frei von der Störkontur 34. In 16 sind sechs solcher Rechtecke mit römischen Ziffern I–VI bezeichnet. Die Aufteilung der Landkarte 32 in die Rechtecke erfolgt durch aus der Bildverarbeitung bekannte Such-Einlegeverfahren.In 16 shows an alternative way of path generation from a map 32 , which distinguishes between critical and uncritical areas. The control unit 12 divides the map 32 in rectangles of different sizes. The rectangles are each free of the interference contour 34 , In 16 Six such rectangles are labeled with Roman numerals I-VI. The division of the map 32 in the rectangles is done by known from image processing search-insertion process.

Zum Erzeugen des Bewegungspfads 36 nutzt die Steuereinheit 12 folgende Verhaltensregeln:
Innerhalb eines Rechtecks kann eine direkte Point-to-Point(PTP)-Bewegung erfolgen. Wenn beispielsweise eine Pose im Rechteck I erreicht wird und sich die Endpose 16 ebenfalls im Rechteck I befindet, kann sich der Greifarm 10 ohne weitere Überschleifpunkte zu der Endpose 16 bewegen.

  • Zwei benachbarte Rechtecke mit einer gemeinsamen Seite können hinsichtlich der vorhergehenden Verhaltensregel immer als ein Rechteck betrachtet werden. Wenn beispielsweise eine Pose im Rechteck II erreicht wird und sich die Endpose 16 im Rechteck V befindet, kann sich der Greifarm 10 ohne weitere Überschleifpunkte in die Endpose 16 bewegen.
To create the motion path 36 uses the control unit 12 the following rules of conduct:
Within a rectangle, a direct point-to-point (PTP) movement can occur. For example, if a pose in rectangle I is reached and the final pose 16 Also located in rectangle I, the gripper arm can 10 without further sanding points to the final pose 16 move.
  • Two adjacent rectangles with a common page can always be considered as a rectangle with respect to the previous behavior rule. For example, if a pose in rectangle II is reached and the final pose 16 Located in the rectangle V, the gripper arm can 10 without further sanding points in the final pose 16 move.

Befindet sich keine Störkontur 32 im Arbeitsraum, kann ein einziges Rechteck gebildet werden.If there is no interference contour 32 in the working space, a single rectangle can be formed.

Durch die Aufteilung der Landkarte 32 in Unterkarten 42–42''' bzw. durch die Einteilung in kritische und unkritische Bereiche 38, 40 kann der Landkarte 32 eine zur Pfadgenerierung erforderliche Information besonders schnell entnommen werden.By dividing the map 32 in sub-cards 4 2 42 ''' or by the division into critical and uncritical areas 38 . 40 can the map 32 a required for path generation information is taken very quickly.

In einer alternativen Ausgestaltung der Erfindung wird der Roboter nicht von einer integrierten Steuereinheit 12 gesteuert, sondern von einer externen, als universell programmierbarer Computer ausgebildeten Recheneinheit. Die Recheneinheit nutzt Verfahren zum Steuern einer Bewegung des Roboters zwischen einer Anfangspose 14 und einer Endpose 16 in wenigstens zwei Bewegungsfreiheitsgraden α1, α2, wobei ein Bewegungspfad 36 zwischen der Anfangspose 14 und der Endpose 16 von der Recheneinheit generiert wird.In an alternative embodiment of the invention, the robot does not come from an integrated control unit 12 but controlled by an external, designed as a universally programmable computer arithmetic unit. The arithmetic unit uses methods of controlling movement of the robot between an initial pose 14 and an end pose 16 in at least two degrees of freedom of movement α 1 , α 2 , wherein a movement path 36 between the initial pose 14 and the final pose 16 is generated by the arithmetic unit.

Beim Generieren des Bewegungspfads 36 nutzt die Recheneinheit in der oben beschriebenen Weise eine Landkarte 32, in der zumindest eine Störkontur 34 verzeichnet ist.When generating the motion path 36 the arithmetic unit uses a map in the manner described above 32 , in which at least one interference contour 34 is recorded.

BezugszeichenlisteLIST OF REFERENCE NUMBERS

1010
Greifarmclaw arm
1212
Steuereinheitcontrol unit
1414
AnfangsposeAnfangspose
1616
Endposeend pose
2222
Sockelbase
2424
Gelenkjoint
2626
Absolutwert-GeberAbsolute encoder
2828
Absolutwert-GeberAbsolute encoder
3030
Speichereinheitstorage unit
3232
Landkartemap
3434
Störkonturinterference contour
3636
Bewegungspfadmotion path
3838
BereichArea
4040
BereichArea
4242
Unterkarteunder map
4444
Pfad-TeilPath part
4646
Sensorsensor
4848
Linieline
5050
Linieline
5252
Polygonpolygon
5454
Polygonpolygon
5656
Kreiscircle
5858
Außenkonturouter contour
6060
Armteilarm
6262
Armteilarm
6464
Gegenstandobject
6666
ÜberschleifpunktAbout grinding point
a1a1
Koordinatecoordinate
a2a2
Koordinatecoordinate
A1A1
Achseaxis
A2A2
Achseaxis
XX
Wertvalue

Claims (19)

Roboter, insbesondere Industrie- oder Gelenkroboter, mit wenigstens zwei Bewegungsfreiheitsgraden (a1, a2) und einer Steuereinheit (12) zum Steuern einer Bewegung eines Greifarms des Roboters zwischen einer Anfangsposition (14) und einer Endpose (16), wobei die Steuereinheit (12) eine Speichereinheit (30) zum Speichern einer Landkarte (32) umfasst, in der zumindest eine Störkontur (34) verzeichenbar ist, dadurch gekennzeichnet, dass die Steuereinheit (12) dazu vorgesehen ist, einen Bewegungspfad (36) des Greifarms zwischen der Anfangspose (14) und der Endpose (16) selbsttägig in Abhängigkeit von der Landkarte (32) und in Schritten, die der Schrittweite der Landkarte (32) entsprechen, zu generieren und dass die Steuereinheit (12) derart programmiert ist, dass sie die Landkarte (32) zum Generieren des Bewegungspfades (36) in wenigstens zwei Bereiche (38, 40) mit unterschiedlicher Detailgenauigkeit aufteilt, sie den Bewegungspfad in einem ersten Bereich (40) aus ersten Segmenten und in einem zweiten Bereich (38) aus zweiten Segmenten generiert, wobei der erste Bereich (40) weniger Störkonturen aufweist als der zweite Bereich (38), und wobei die ersten Segmente im ersten Bereich (40) länger sind als die zweiten Segmente im zweiten Bereich (38).Robot, in particular industrial or articulated robot, having at least two degrees of freedom of movement (a1, a2) and a control unit ( 12 ) for controlling a movement of a gripper arm of the robot between an initial position ( 14 ) and an end pose ( 16 ), the control unit ( 12 ) a storage unit ( 30 ) to save a map ( 32 ), in which at least one interference contour ( 34 ), characterized in that the control unit ( 12 ) is intended to provide a motion path ( 36 ) of the gripper arm between the initial pose ( 14 ) and the final pose ( 16 ) every day depending on the map ( 32 ) and in steps corresponding to the increment of the map ( 32 ) and that the control unit ( 12 ) is programmed in such a way that the map ( 32 ) for generating the movement path ( 36 ) into at least two areas ( 38 . 40 ) with different Detail accuracy divides them the motion path in a first area ( 40 ) from first segments and in a second region ( 38 ) generated from second segments, the first region ( 40 ) has less interference contours than the second region ( 38 ), and wherein the first segments in the first area ( 40 ) are longer than the second segments in the second area ( 38 ). Roboter nach Anspruch 1, dadurch gekennzeichnet, dass die Dimension der Landkarte (32) gleich oder kleiner ist als die Zahl der Bewegungsfreiheitsgrade des Roboters.Robot according to claim 1, characterized in that the dimension of the map ( 32 ) is equal to or less than the number of degrees of freedom of movement of the robot. Roboter nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Steuereinheit (12) dazu vorgesehen ist, die Landkarte (32) in einem Initialisierungsprozess des Roboters zu generieren, so dass dadurch die beim Ermitteln eines Bewegungspfades aufzuwendende Rechenzeit gering gehalten ist.Robot according to one of the preceding claims, characterized in that the control unit ( 12 ) is provided for the map ( 32 ) in an initialization process of the robot to generate, so that thereby expended in determining a motion path computing time is kept low. Roboter nach einem der vorigen Ansprüche, dadurch gekennzeichnet, dass die Steuereinheit (12) dazu vorgesehen ist, die Landkarte (32) zum Generieren des Bewegungspfades (36) in wenigstens einen ersten Teilbereich, der frei von Störkonturen ist, und in wenigstens einen zweiten Teilbereich mit wenigstens einer Störkontur aufzuteilen, und dass die Schrittweite in dem wenigstens einen ersten Teilbereich größer ist als die Schrittweite in dem wenigstens einen zweiten Teilbereich.Robot according to one of the preceding claims, characterized in that the control unit ( 12 ) is provided for the map ( 32 ) for generating the movement path ( 36 ) in at least a first portion which is free of interference contours, and divide into at least a second portion having at least one interference contour, and that the step size in the at least one first portion is greater than the step size in the at least one second portion. Roboter nach Anspruch 4, dadurch gekennzeichnet, dass die Steuereinheit (12) dazu vorgesehen ist, den Bewegungspfad (36) in dem wenigstens einen ersten Teilbereich aus langen Segmenten zusammenzusetzen und in dem wenigstens einen zweiten Teilbereich einen kleinschrittigen Bewegungsablauf zu generieren.Robot according to claim 4, characterized in that the control unit ( 12 ) is provided, the movement path ( 36 ) in the at least one first portion of long segments and to generate in the at least one second portion of a small-step motion sequence. Roboter nach Anspruch 5, dadurch gekennzeichnet, dass die Steuereinheit (12) dazu vorgesehen ist, den Bewegungspfad so zu generieren, dass er vorzugsweise durch erste Teilbereiche geführt ist.Robot according to claim 5, characterized in that the control unit ( 12 ) is provided to generate the movement path such that it is preferably guided through first partial areas. Roboter nach einem der vorigen Ansprüche, dadurch gekennzeichnet, dass die Steuereinheit (12) dazu vorgesehen ist, zum Generieren der Landkarte (32) und zur Bestimmung des Abstandes des Greifarms (10) von einer Störkontur (34) ein Modell für eine Außenkontur (58) eines Greifarmes (10) zu nutzen.Robot according to one of the preceding claims, characterized in that the control unit ( 12 ) is intended to generate the map ( 32 ) and for determining the distance of the gripper arm ( 10 ) of a disturbing contour ( 34 ) a model for an outer contour ( 58 ) of a gripping arm ( 10 ) to use. Roboter nach Anspruch 7, dadurch gekennzeichnet, dass das Modell auf höchstens 20 Parameter beschränkt ist.Robot according to claim 7, characterized in that the model is limited to a maximum of 20 parameters. Roboter nach Anspruch 8, dadurch gekennzeichnet, dass das Modell die Außenkontur (58) jedes unabhängigen Armteils des Greifarmes (10) durch wenigstens ein Polygon (52, 54) darstellt.Robot according to claim 8, characterized in that the model is the outer contour ( 58 ) of each independent arm part of the gripper arm ( 10 ) by at least one polygon ( 52 . 54 ). Roboter nach einem der Ansprüche 8 oder 9, dadurch gekennzeichnet, dass das Modell die Außenkontur (58) des Greifarmes (10) durch wenigstens einen Kreis (56) darstellt.Robot according to one of claims 8 or 9, characterized in that the model of the outer contour ( 58 ) of the gripper arm ( 10 ) by at least one circle ( 56 ). Roboter nach einem der vorigen Ansprüche, dadurch gekennzeichnet, dass die Steuereinheit (12) derart programmiert ist, dass sie die Landkarte (32) zum Generieren des Bewegungspfades (36) in mehrere Unterkarten (42) mit vorgegebenen Pfad-Teilen (44) aufteilt.Robot according to one of the preceding claims, characterized in that the control unit ( 12 ) is programmed in such a way that the map ( 32 ) for generating the movement path ( 36 ) into several sub-cards ( 42 ) with predetermined path parts ( 44 ). Roboter nach Anspruch 11, dadurch gekennzeichnet, dass die Pfad-Teile (44) Randpunkte der Unterkanten (42) geradlinig miteinander verbinden.Robot according to claim 11, characterized in that the path parts ( 44 ) Edge points of the lower edges ( 42 ) connect in a straight line. Roboter nach einem der vorigen Ansprüche, dadurch gekennzeichnet, dass die Speichereinheit (30) zum Speichern der Landkarte (32) in einem achsbezogenen Koordinatensystem vorgesehen ist.Robot according to one of the preceding claims, characterized in that the memory unit ( 30 ) to save the map ( 32 ) is provided in an axis-related coordinate system. Roboter nach einem der vorigen Ansprüche, gekennzeichnet durch wenigstens einen Absolutwertgeber (26, 28) zum Erfassen eines Absolutwertes von wenigstens einer Koordinate (a1, a2) einer aktuellen Pose.Robot according to one of the preceding claims, characterized by at least one absolute value encoder ( 26 . 28 ) for detecting an absolute value of at least one coordinate (a1, a2) of a current pose. Roboter nach einem der vorigen Ansprüche, gekennzeichnet durch wenigstens einen Sensor (4646''') zum Erkennen einer Störkontur (34).Robot according to one of the preceding claims, characterized by at least one sensor ( 46 - 46 ''' ) for detecting a disturbing contour ( 34 ). Roboter nach einem der vorangehenden Ansprüche, dadurch gekennzeichnet, dass die Steuereinheit derart ausgebildet ist, dass nach jedem Schritt den nächsten Schritt so einzustellen, dass der größstmögliche Abstand des Greifarms zu allen Störkonturen eingehalten wird.Robot according to one of the preceding claims, characterized in that the control unit is designed such that after each step to adjust the next step so that the largest possible distance of the gripping arm is adhered to all Störkonturen. Roboter nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Steuereinheit (12) dazu vorgesehen ist, die Landkarte (32) abhängig von einer vorgegebenen Störkontur (34) zu generieren.Robot according to one of the preceding claims, characterized in that the control unit ( 12 ) is provided for the map ( 32 ) depending on a given interference contour ( 34 ) to generate. Verfahren zum Steuern einer Bewegung eines Roboters, insbesondere eines Roboters nach einem der vorigen Ansprüche, zwischen einer Anfangspose (14) und einer Endpose (16) in wenigstens zwei Bewegungsfreiheitsgraden (a1, a2), wobei ein Bewegungspfad (36) zwischen der Anfangspose (14) und der Endpose (16) generiert wird, und wobei beim Generieren des Bewegungspfads (36) eine Landkarte (32) genutzt wird, in der zumindest eine Störkontur (34) verzeichnet ist, dadurch gekennzeichnet, dass der Bewegungspfad (36) des Greifarms zwischen der Anfangspose (14) und der Endpose (16) selbsttätig in Abhängigkeit von der Landkarte (32) und in Schritten, die der Schrittweite der Landkarte (32) entsprechen, generiert wird und dass die Landkarte (32) zum Generieren des Bewegungspfades (36) in wenigstens zwei Bereiche (38, 40) mit unterschiedlicher Detailgenauigkeit aufgeteilt ist, der Bewegungspfad in einem ersten Bereich (40) aus ersten Segmenten und in einem zweiten Bereich (38) aus zweiten Segmenten generiert wird, wobei der erste Bereich (40) weniger Störkonturen aufweist als der zweite Bereich (38), und wobei die ersten Segmente im ersten Bereich (40) länger sind als die zweiten Segmente im zweiten Bereich (38).Method for controlling a movement of a robot, in particular a robot according to one of the preceding claims, between an initial pose ( 14 ) and an end pose ( 16 ) in at least two degrees of freedom of movement (a1, a2), wherein a movement path ( 36 ) between the initial pose ( 14 ) and the final pose ( 16 ) and when generating the motion path ( 36 ) a map ( 32 ) is used, in the at least one interference contour ( 34 ), characterized in that the movement path ( 36 ) of the gripper arm between the initial pose ( 14 ) and the final pose ( 16 ) automatically depending on the map ( 32 ) and in steps, the increment of the map ( 32 ), and that the map ( 32 ) for generating the movement path ( 36 ) into at least two areas ( 38 . 40 ) is divided with different degree of detail, the movement path in a first area ( 40 ) from first segments and in a second region ( 38 ) is generated from second segments, the first area ( 40 ) has less interference contours than the second region ( 38 ), and wherein the first segments in the first area ( 40 ) are longer than the second segments in the second area ( 38 ). Verfahren nach Anspruch 18, dadurch gekennzeichnet, dass nach jedem Schritt der nächste Schritt so eingestellt wird, dass der größtmögliche Abstand des Greifarms zu allen Störkonturen (34) eingehalten wird.A method according to claim 18, characterized in that after each step, the next step is set so that the maximum distance of the gripper arm to all interference contours ( 34 ) is complied with.
DE102006007623.0A 2006-02-18 2006-02-18 Robot with a control unit for controlling a movement between an initial pose and an end pose Active DE102006007623B4 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
DE102006007623.0A DE102006007623B4 (en) 2006-02-18 2006-02-18 Robot with a control unit for controlling a movement between an initial pose and an end pose
PCT/EP2007/001310 WO2007093413A1 (en) 2006-02-18 2007-02-15 Robot with a control unit for controlling a movement between an initial pose and a final pose

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
DE102006007623.0A DE102006007623B4 (en) 2006-02-18 2006-02-18 Robot with a control unit for controlling a movement between an initial pose and an end pose

Publications (2)

Publication Number Publication Date
DE102006007623A1 DE102006007623A1 (en) 2007-08-30
DE102006007623B4 true DE102006007623B4 (en) 2015-06-25

Family

ID=38042995

Family Applications (1)

Application Number Title Priority Date Filing Date
DE102006007623.0A Active DE102006007623B4 (en) 2006-02-18 2006-02-18 Robot with a control unit for controlling a movement between an initial pose and an end pose

Country Status (2)

Country Link
DE (1) DE102006007623B4 (en)
WO (1) WO2007093413A1 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021165912A1 (en) 2020-02-20 2021-08-26 G.D Societa' Per Azioni A procedure for the selective management of the alarms of an automatic machine for manufacturing or packing consumer articles
US11855557B2 (en) 2018-11-26 2023-12-26 Beckhoff Automation Gmbh Device and method for preventing a collision when driving at least two movers on a drive surface

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102007059480B4 (en) 2007-12-11 2018-07-05 Kuka Roboter Gmbh Method and device for pose monitoring of a manipulator
DE102007060653A1 (en) * 2007-12-15 2009-06-18 Abb Ag Position determination of an object
DE102008013400B4 (en) * 2008-03-06 2016-03-10 Voith Engineering Services Gmbh Method for determining locking areas of at least one first object movable in space
DE102008015779A1 (en) 2008-03-26 2009-10-01 Fpt Systems Gmbh Driverless transport system for transporting, picking up and dropping loads
DE102008057142B4 (en) * 2008-04-29 2016-01-28 Siemens Aktiengesellschaft Method for computer-aided motion planning of a robot
DE102010027572A1 (en) 2010-07-19 2012-04-19 Kuka Roboter Gmbh manipulator control
US20170028556A1 (en) * 2015-07-28 2017-02-02 Harris Corporation Path-optimized manipulator reversing controller
EP3287243A1 (en) 2016-08-24 2018-02-28 Siemens Aktiengesellschaft Method for collision detection and autonomous system
DE102016120763B4 (en) 2016-10-31 2019-03-14 Pilz Gmbh & Co. Kg Method for collision-free motion planning
IT201800004698A1 (en) 2018-04-19 2019-10-19 Procedure for restoring the functional state of an automatic machine for the production of items for the tobacco industry
DE102019105817A1 (en) * 2019-03-07 2020-09-10 Liebherr-Mischtechnik Gmbh Articulated arm control of a concrete pump

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0179252A2 (en) * 1984-09-14 1986-04-30 Siemens Aktiengesellschaft Method and apparatus for protecting people in the operating range of a movable part of a traversing or swiveling machine, particularly of an industrial robot
EP0439655A1 (en) * 1990-01-31 1991-08-07 Siemens Aktiengesellschaft Robot control method for collision avoidance between a task-oriented programmed robot and objects, both having different degrees of mobility
EP0543236A2 (en) * 1991-11-08 1993-05-26 Fujitsu Limited Automatic manipulator-head trajectory producing system
US5347459A (en) * 1993-03-17 1994-09-13 National Research Council Of Canada Real time collision detection
DE19810341A1 (en) * 1998-03-10 1999-09-16 Deutsch Zentr Luft & Raumfahrt Method of automatic collision prevention for manipulator in working area bounded by obstructions
US6604005B1 (en) * 1987-11-20 2003-08-05 Koninklijke Philips Electronics N.V. Method and apparatus for path planning
DE102004019888A1 (en) * 2003-04-23 2004-11-25 Toyota Jidosha K.K., Toyota Robot control method in which movement of robot within production hall is contained by definition of virtual safety limit which is used in conjunction with predicted positions of robot arm
DE10324517A1 (en) * 2003-05-28 2004-12-16 Daimlerchrysler Ag Robot and teaching method therefor, for controlling the area in which the robot operates, is based on definition of permitted and forbidden movement areas in a computer model defining the robot's range of movement

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6535794B1 (en) * 1993-02-23 2003-03-18 Faro Technologoies Inc. Method of generating an error map for calibration of a robot or multi-axis machining center
US7170252B2 (en) * 2003-07-23 2007-01-30 Renesas Technology Corporation Location aware automata

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0179252A2 (en) * 1984-09-14 1986-04-30 Siemens Aktiengesellschaft Method and apparatus for protecting people in the operating range of a movable part of a traversing or swiveling machine, particularly of an industrial robot
US6604005B1 (en) * 1987-11-20 2003-08-05 Koninklijke Philips Electronics N.V. Method and apparatus for path planning
EP0439655A1 (en) * 1990-01-31 1991-08-07 Siemens Aktiengesellschaft Robot control method for collision avoidance between a task-oriented programmed robot and objects, both having different degrees of mobility
EP0543236A2 (en) * 1991-11-08 1993-05-26 Fujitsu Limited Automatic manipulator-head trajectory producing system
US5347459A (en) * 1993-03-17 1994-09-13 National Research Council Of Canada Real time collision detection
DE19810341A1 (en) * 1998-03-10 1999-09-16 Deutsch Zentr Luft & Raumfahrt Method of automatic collision prevention for manipulator in working area bounded by obstructions
DE102004019888A1 (en) * 2003-04-23 2004-11-25 Toyota Jidosha K.K., Toyota Robot control method in which movement of robot within production hall is contained by definition of virtual safety limit which is used in conjunction with predicted positions of robot arm
DE10324517A1 (en) * 2003-05-28 2004-12-16 Daimlerchrysler Ag Robot and teaching method therefor, for controlling the area in which the robot operates, is based on definition of permitted and forbidden movement areas in a computer model defining the robot's range of movement

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11855557B2 (en) 2018-11-26 2023-12-26 Beckhoff Automation Gmbh Device and method for preventing a collision when driving at least two movers on a drive surface
WO2021165912A1 (en) 2020-02-20 2021-08-26 G.D Societa' Per Azioni A procedure for the selective management of the alarms of an automatic machine for manufacturing or packing consumer articles

Also Published As

Publication number Publication date
DE102006007623A1 (en) 2007-08-30
WO2007093413A1 (en) 2007-08-23

Similar Documents

Publication Publication Date Title
DE102006007623B4 (en) Robot with a control unit for controlling a movement between an initial pose and an end pose
DE102012007254B4 (en) A method and apparatus for predicting a disability between a target part of a robot and a peripheral object
DE102015001527B4 (en) Robot system using visual feedback
DE102018116053B4 (en) Robot system and robot learning method
DE102004019888B4 (en) Method and device for limiting the movement of a robot, and a robot provided with the device
DE102015107436B4 (en) Trainable path control
DE102011108282B4 (en) Numerical control for a multi-axis machine for machining a tilted working plane
DE102019118637B4 (en) AUTOMATIC PATH GENERATION DEVICE
DE102017127950B4 (en) ROBOT CONTROL, WHICH AUTOMATICALLY DEFINES A STROKE ZONE FOR A ROBOT
DE102013008755B4 (en) Offline programming system
DE102017001131C5 (en) Method and system for operating a robot
EP3324362B1 (en) Method and device for commissioning a multi-axis system
DE102017222057A1 (en) robot system
DE102013106076A1 (en) Toolpath display unit for displaying the tool vector of a machine tool
DE102018117829A1 (en) Control unit for articulated robots
WO2018010842A1 (en) Redundancy resolution for a redundant manipulator
DE102015104582A1 (en) Method for calibrating a robot at a work area and system for carrying out the method
DE10393527T5 (en) Systems and methods for displaying complex n-curves for direct control of tool motion
EP3225366B1 (en) Monitoring of the position of a kinematic
DE102018004673A1 (en) Robot system displaying a speed
DE102012022190B4 (en) Inverse kinematics
DE112019007889T5 (en) MACHINING PROGRAM CONVERSION DEVICE, NUMERICAL CONTROL DEVICE AND MACHINING PROGRAM CONVERSION METHOD
DE102017116788B4 (en) Robot control device and method of controlling the same
EP3542233A1 (en) Measuring a movement axis of a robot
EP0449039B1 (en) Method for the controlling of positioning systems

Legal Events

Date Code Title Description
OP8 Request for examination as to paragraph 44 patent law
8127 New person/name/address of the applicant

Owner name: KUKA LABORATORIES GMBH, 86165 AUGSBURG, DE

R081 Change of applicant/patentee

Owner name: KUKA LABORATORIES GMBH, DE

Free format text: FORMER OWNER: KUKA ROBOTER GMBH, 86165 AUGSBURG, DE

Effective date: 20110412

Owner name: KUKA ROBOTER GMBH, DE

Free format text: FORMER OWNER: KUKA ROBOTER GMBH, 86165 AUGSBURG, DE

Effective date: 20110412

R016 Response to examination communication
R018 Grant decision by examination section/examining division
R081 Change of applicant/patentee

Owner name: KUKA ROBOTER GMBH, DE

Free format text: FORMER OWNER: KUKA LABORATORIES GMBH, 86165 AUGSBURG, DE

R082 Change of representative

Representative=s name: WALLINGER RICKER SCHLOTTER TOSTMANN PATENT- UN, DE

R020 Patent grant now final
R081 Change of applicant/patentee

Owner name: KUKA DEUTSCHLAND GMBH, DE

Free format text: FORMER OWNER: KUKA ROBOTER GMBH, 86165 AUGSBURG, DE

R082 Change of representative

Representative=s name: WALLINGER RICKER SCHLOTTER TOSTMANN PATENT- UN, DE