DE19642016C1 - Method for mechanically moving an object on a level to a target position - Google Patents
Method for mechanically moving an object on a level to a target positionInfo
- Publication number
- DE19642016C1 DE19642016C1 DE19642016A DE19642016A DE19642016C1 DE 19642016 C1 DE19642016 C1 DE 19642016C1 DE 19642016 A DE19642016 A DE 19642016A DE 19642016 A DE19642016 A DE 19642016A DE 19642016 C1 DE19642016 C1 DE 19642016C1
- Authority
- DE
- Germany
- Prior art keywords
- rotation
- force
- determined
- angle
- point
- 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.)
- Expired - Fee Related
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/162—Mobile manipulator, movable base with manipulator arm mounted on it
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Description
Die Erfindung bezieht sich auf ein Verfahren zum Verschieben von Gegenständen auf einer Ebene durch einen Manipulator in eine genau definierte Lage.The invention relates to a method for moving of objects on one level through a manipulator in a precisely defined location.
Häufig müssen in Fertigungsbereichen Halbzeugbehälter oder Werkstücke genau positioniert werden. Autonome mobile Sys teme, welche Tätigkeiten verrichten, müssen beispielsweise Hindernisse auf ihrem Weg erkennen und eventuell mit Hilfe eines Manipulators beiseite schieben. Bisherige Arbeiten zum Verschieben von Gegenständen auf Ebenen beschränken sich zum einen auf Gegenstände mit bekannter Form [5, 7, 1, 3, 4]. In die sen Arbeiten wird das Schieben mit einem sensorlosen Balken bzw. Schild durchgeführt und es gelingt dabei einen Gegen stand in einer Ebene in Position und Ausrichtung exakt zu po sitionieren. Die Form des Gegenstandes muß jedoch bekannt sein und ist auf konvexe Polynome beschränkt. Das Verschieben kann ebenfalls mit Hilfe von zweifingrigen Greifern als Schieber durchgeführt werden [2]. In [6] wird mit Hilfe eines drehbar gelagerten Balkens als Schieber, wobei dieser im Dreh gelenk einen Winkelsensor aufweist, unter variabler Kraftrich tung ein Gegenstand verschoben. Damit ist es möglich, die Ori entierung des geschobenen Gegenstandes zu messen. Eine andere Lösung [8] benutzt zum Verschieben eines Gegenstandes eine runde Spitze, und die Lage des verschobenen Gegenstandes wird mit Hilfe eines Bildverarbeitungssystems und einer Kamera er faßt. Mit diesen Verfahren kann jedoch keine exakte Positio nierung eines Gegenstandes mit vorab unbekannter Form in sei ne Ziellage durchgeführt werden, denn seine Orientierung im Ziel bleibt dabei unberücksichtigt. Weitere Arbeiten zu die sem Thema sind nicht bekannt.Often, semi-finished containers or Workpieces are positioned exactly. Autonomous mobile sys For example, tasks that have to be performed Recognize obstacles on their way and possibly with help of a manipulator aside. Previous work on Moving objects on levels is limited to one on objects of known shape [5, 7, 1, 3, 4]. In the Pushing works with a sensorless bar or shield carried out and a counter is successful stood exactly on the same level in position and orientation sition. However, the shape of the item must be known and is limited to convex polynomials. The move can also be used with the help of two-finger grippers Sliders are carried out [2]. In [6] with the help of a rotatably mounted bar as a slide, this in rotation joint has an angle sensor, under variable force an object moved. This makes it possible for the Ori measurement of the pushed object. Another Solution [8] uses one to move an object round tip, and the location of the object being moved with the help of an image processing system and a camera sums up. However, an exact position cannot be obtained with these methods nation of an object with a previously unknown form in ne destination location, because its orientation in The goal is disregarded. Further work on the this topic is not known.
Die der Erfindung zugrundeliegende Aufgabe besteht darin, ein Verfahren zum Verschieben eines Gegenstandes auf einer Ebene anzugeben, mit dem die exakte Positionierung eines Gegenstan des von unbekannter Form in eine Ziellage durchgeführt wer den kann.The object underlying the invention is a Method for moving an object on a level specify with which the exact positioning of an object who carried out of unknown form to a target location that can.
Diese Aufgabe wird gemäß den Merkmalen des Patentanspruches 1 gelöst.This object is achieved according to the features of patent claim 1 solved.
Weiterbildungen der Erfindung ergeben sich aus den abhängigen Ansprüchen.Further developments of the invention result from the dependent Claims.
Ein besonderer Vorteil des erfindungsgemäßen Verfahrens be steht darin, daß es unter Zuhilfenahme sehr einfacher Mittel und unter Voraussetzung einer bekannten Zielposition mit ei ner Verschiebekraft unter variablem Kraftangriffswinkel in einem speziell definierten Kraftangriffspunkt eine exakte Po sitionierung des zu verschiebenden Gegenstandes durchführt.A particular advantage of the method according to the invention is that it is using very simple means and assuming a known target position with egg ner displacement force under variable force application angle in an exact butt at a specially defined force application point sitioning of the object to be moved.
Vorteilhaft kann die Lage und Ausrichtung des Gegenstandes nach dem erfindungsgemäßen Verfahren mittels eines optischen Sensors und einem Bildverarbeitungssystem durchgeführt wer den.The position and orientation of the object can be advantageous according to the inventive method by means of an optical Sensors and an image processing system who performed the.
Vorteilhaft kann die Lage und Ausrichtung des Gegenstandes nach dem erfindungsgemäßen Verfahren mit einem mechanischen Sensor wie beispielsweise einem Winkelgeber oder druckemp findlichen Sensoren an einer Meßspitze durchgeführt werden.The position and orientation of the object can be advantageous according to the inventive method with a mechanical Sensor such as an angle encoder or pressure sensitive sensors can be carried out on a measuring tip.
Besonders vorteilhaft wird erfindungsgemäß die Lage des Kraftangriffspunktes für die Verschiebekraft nach einer Heu ristik ermittelt, weil diese ohne großen Aufwand durch probe weises Hin- und Herschieben des Gegenstandes exakt den neu tralen Kraftangriffspunkt für ein gerades Verschieben des Ge genstandes herausfindet. Vorteilhaft werden dabei insbeson dere unterschiedliche Bodenbeläge, sowie damit verbundene un terschiedliche Reibungskoeffizienten bzw. Haftbedingungen des Gegenstandes an seiner Unterseite berücksichtigt.According to the invention, the position of the Force application point for the displacement force after a hay Statistics determined because this can be easily done by trial and error wise pushing the object back and forth exactly the new central force application point for a straight shift of the Ge finds out the object. Be particularly advantageous different floor coverings, as well as related un Different friction coefficients or conditions of detention Considered object at its bottom.
Besonders vorteilhaft werden zur Bestimmung der Lage des Kraftangriffspunktes für die Verschiebekraft die angegebenen Gleichungen benutzt, da damit eine sehr genaue Schätzung der Position des Kraftangriffspunktes an einer zielabgewandten Seite des Gegenstandes durchgeführt werden kann.Be particularly advantageous for determining the position of the Force application point for the displacement force the specified Used equations because it gives a very accurate estimate of the Position of the force application point on a target away Side of the item can be done.
Vorteilhaft wird der Winkel, unter welchem die Verschiebekraft im Kraftangriffspunkt angreift, nach der erfindungsgemäßen Formel bestimmt, da damit eine exakte Positionierung und eine möglichst schnelle Verschiebung des Gegenstandes erreicht wird.The angle at which the displacement force is advantageous attacks in the force application point, according to the invention Formula determined, because with it an exact positioning and a Movement of the object achieved as quickly as possible becomes.
Im folgenden wird ein Ausführungsbeispiel der Erfindung anhand von Figuren weiter erläutert.An exemplary embodiment of the invention is described below further explained by figures.
Fig. 1 gibt ein Beispiel zur Ermittlung des Kraftangriffs punktes nach dem erfindungsgemäßen Verfahren an. Fig. 1 gives an example for determining the force application point according to the inventive method.
Fig. 2 zeigt ein Beispiel zur Verschiebung eines Gegenstan des nach dem erfindungsgemäßen Verfahren. Fig. 2 shows an example of moving an object of the method according to the invention.
In Fig. 1 ist ein Beispiel zur Ermittlung eines Kraftan griffspunktes für das Angreifen der Verschiebekraft an einem zu verschiebenden Gegenstand angegeben. Nach dem erfindungs gemäßen Verfahren soll dabei insbesondere erreicht werden, daß eine Kraft, welche in diesem Punkt an dem Gegenstand an greift und senkrecht zur Oberfläche des Gegenstandes wirkt, den Gegenstand exakt in Richtung des Kraftvektors bewegt. In Fig. 1 sind dabei von links nach rechts drei Phasen des Ver fahrens dargestellt. Der zu verschiebende Gegenstand O befin det sich beispielsweise zu Beginn in einer Startlage ST. Aus dieser Startlage wird er beispielsweise mit Hilfe eines Mani pulators M, welcher eine Kraft F in einem ersten Kontaktpunkt EK ausübt, verschoben und dabei um einen Winkel δ verdreht, wobei der erste Kontaktpunkt EK eine Strecke S zurücklegt, welche gemessen wird. Beim Verschieben des Gegenstandes O kann beispielsweise eine Geschwindigkeitsregelung für den Ma nipulator eingesetzt werden, wobei die aufzubringende Kraft beispielsweise durch einen Kraftmeßsensor SEN, welcher bei spielsweise Kräfte richtungsabhängig detektieren kann, gemessen wird. Es ist dabei festzustellen, daß sich der Gegenstand O in eine erste Drehrichtung ED verdreht hat, wodurch der Win kel δ relativ zur Ausgangslage entstanden ist.In Fig. 1 an example for determining a Kraftan handle point for attacking the displacement force on an object to be moved is given. According to the method according to the Invention, it should in particular be achieved that a force which acts on the object at this point and acts perpendicular to the surface of the object moves the object exactly in the direction of the force vector. In Fig. 1, three phases of the process are shown from left to right. The object to be moved O is, for example, at the beginning in a starting position ST. From this starting position, it is displaced, for example with the aid of a manipulator M, which exerts a force F in a first contact point EK, and is thereby rotated by an angle δ, the first contact point EK covering a distance S which is measured. When moving the object O, for example, a speed control can be used for the manipulator, the force to be applied being measured, for example, by a force measuring sensor SEN, which for example can detect forces in a direction-dependent manner. It should be noted that the object O has rotated in a first direction of rotation ED, as a result of which the angle δ has arisen relative to the starting position.
Bei der Durchführung dieses heuristischen Verfahrens zur Bestimmung des Kraftangriffspunktes ist insbesondere zu beachten, daß der Manipulator in einem Kraftangriffspunkt angreifen sollte, welcher sich auf einer zielabgewandten Seite des Gegenstandes O befindet. Beispielsweise besitzt die Manipulatorsteuerung Kenntnisse von der Umgebung des Gegenstandes und kann anhand der Zielkoordinaten und der Erfassung der Geometrie des Ob jektes einen geeigneten ersten Kraftangriffspunkt EK bestim men. Die Lage des Gegenstandes kann dabei sowohl mit Hilfe optischer als auch mit Hilfe mechanischer Mittel festgestellt werden. Insbesondere können dabei Bildverarbeitungsmethoden oder mechanische Sensoren, wie beispielsweise Winkelmeßsenso ren oder kraftrichtungsabhängige Sensoren verwendet werden.When performing this heuristic determination process of the force application point, it should be noted in particular that the manipulator should attack in a force application point, which is on a side of the object facing away from the target O is located. For example, the manipulator control Knowledge of the environment of the object and can be based on the target coordinates and the acquisition of the geometry of the ob jektes a suitable first force application point EK men. The location of the object can be done both with the help optically as well as with the help of mechanical means will. In particular, image processing methods can be used or mechanical sensors, such as angle measuring sensors Ren or sensors dependent on the direction of force can be used.
Gemäß der Heuristik zur Ermittlung eines geeigneten neutralen Kraftangriffspunktes auf der Seite FL des Gegenstandes O wird nun in der mittleren Darstellung von Fig. 1 versucht, diesen Punkt einzugrenzen, indem der Manipulator M in Richtung des Pfeiles 50 verschoben wird. Dabei ist insbesondere zu beach ten, daß die Verschiebung des Manipulators entlang der Seite FL in Drehrichtung ED erfolgen sollte. Hierdurch wird gewähr leistet, daß er sich zumindest dem neutralen Kraftangriffs punkt für die Verschiebekraft annähert. In der Mitte von Fig. 1 ist der Gegenstand O in einer Zwischenlage ZW dargestellt. In der rechten Teildarstellung von Fig. 1 hat der Manipula tor M seine Endposition eingenommen und befindet sich nun in einem zweiten Kontaktpunkt ZK.According to the heuristic for determining a suitable neutral force application point on the side FL of the object O, an attempt is now made in the middle representation of FIG. 1 to narrow this point by moving the manipulator M in the direction of the arrow 50 . It should be noted in particular that the manipulator should be moved along the side FL in the direction of rotation ED. This ensures that he approaches at least the neutral force point for the displacement force. In the middle of FIG. 1, the object O is shown in an intermediate layer ZW. In the right part of FIG. 1, the manipulator M has reached its end position and is now in a second contact point ZK.
In diesem zweiten Kontaktpunkt
ZK wird beispielsweise die Kraft F für eine Verschiebung in
einem exakt definierten Zeitintervall aufgebracht. Bevorzugt
sollte dieses Zeitintervall genau so lange dauern wie das
Zeitintervall, welches in der Ausgangsphase im Kontaktpunkt
EK zur Verschiebung des Gegenstandes aufgewandt wurde. Wie
erkannt werden kann, wird der Gegenstand O aus der Zwischen
lage ZW in eine zweite Drehrichtung ZD verdreht, wodurch ein
Verdrehungswinkel γ entsteht. Nach dem Verfahren zur Ermitt
lung eines geeigneten Kraftangriffspunktes, nämlich eines neutralen
Kraftangriffspunktes, ist nun bekannt, da zwei verschiedene
Drehrichtungen ED und ZD unter Einwirkung der Kraft auftra
ten, daß sich zwischen dem Kontaktpunkt EK und dem Kontakt
punkt ZK der neutrale Kraftangriffspunkt befinden muß. Dieser
neutrale Kraftangriffspunkt soll nach dem erfindungsgemäßen
Verfahren derjenige Punkt sein, an welchem der Manipulator
unter variablen Kraftangriffswinkeln den Gegenstand ins Ziel
verschiebt. Aus den bekannten Daten, welche bei den beiden
Verschiebungen erfaßt wurden, d. h. im Fall des Kontaktpunk
tes EK der Winkel δ und die Strecke S und im Fall des Kon
taktpunktes ZK der Winkel γ und die entsprechende Verschie
bungsstrecke, welche hier als T dargestellt ist, kann dann
ein Verhältnis gebildet werden, aus welchem der zwischen dem
ersten und dem zweiten Kontaktpunkt befindliche neutrale Kon
taktpunkt bestimmt werden kann. Beispielsweise werden - bei
kleinen Winkeln - hierzu Radien gebildet, wozu die Strecke S
durch den Winkel δ gemäß Gleichung 2 dividiert wird:
In this second contact point ZK, for example, the force F is applied for a displacement in a precisely defined time interval. This time interval should preferably last exactly as long as the time interval which was used in the initial phase at the contact point EK to move the object. As can be seen, the object O is rotated from the intermediate position ZW in a second direction of rotation ZD, whereby a twist angle γ arises. After the procedure for determining a suitable force application point, namely a neutral force application point, it is now known that two different directions of rotation ED and ZD under the action of the force occur that the neutral force application point must be between the contact point EK and the contact point ZK. According to the method according to the invention, this neutral force application point should be the point at which the manipulator moves the object to the target under variable force application angles. From the known data, which were recorded during the two displacements, ie in the case of the contact point EK the angle δ and the distance S and in the case of the contact point ZK the angle γ and the corresponding displacement distance, which is shown here as T, a ratio can then be formed from which the neutral contact point located between the first and the second contact point can be determined. For example, at small angles, radii are formed for this purpose, for which purpose the distance S is divided by the angle δ according to equation 2:
Dasselbe Verhältnis kann für den zweiten Kontaktpunkt mit dem
Winkel γ und der Strecke T gebildet werden. Aus diesen beiden
Verhältnissen und aus der Strecke DIST, welche sich zwischen
dem ersten und dem zweiten Kontaktpunkt befindet, läßt sich
gemäß Gleichung 3 die Lage des neutralen Kraftangriffspunktes
n bestimmen:
The same relationship can be formed for the second contact point with the angle γ and the distance T. The position of the neutral force application point n can be determined from these two relationships and from the distance DIST, which is located between the first and the second contact point:
Hierin bezeichnen a und b die Koordinaten des ersten und zweiten Kontaktpunktes. In diesem Punkt läßt sich nach dem erfindungsgemäßen Verfahren eine Kraft aufbringen, mit wel cher der Gegenstand verschoben und genau positioniert werden kann.Here, a and b denote the coordinates of the first and second contact point. At this point, the The method according to the invention apply a force with which cher the object to be moved and positioned exactly can.
Fig. 2 veranschaulicht die Verschiebung eines Gegenstandes O
in eine Zielposition ZP und in eine Zielorientierung LO. Zur Ver
schiebung des Gegenstandes soll beispielsweise eine Kraft F
aufgebracht werden. Diese Kraft wird bevorzugt in einem Kon
taktpunkt KP aufgebracht, der sich dadurch auszeichnet, daß
er bei senkrechtem Einwirken der Kraft F auf die Seite KU des
Gegenstandes O eine Verschiebung in Richtung des Kraftvektors
bewirkt. Das bedeutet, daß sich der Gegenstand bewegt ohne sich
dabei zu verdrehen wenn in diesem Punkt KP eine Kraft senkrecht
zur Seite KU angreift. Gemäß der Erfindung ist nun ein
Winkel β zu bestimmen, um den der Gegenstand O
verdreht werden muß, damit er eine Zielorientierung LO ein
nehmen kann. Hierzu wird beispielsweise die Gerade ZG durch
den Zielpunkt ZP in Richtung der Zielorientierung LO als Ver
längerungsgerade dargestellt. Beispielsweise soll durch das
erfindungsgemäße Verfahren, wie hier in Fig. 2 dargestellt,
der Kontaktpunkt KP später im Zielpunkt ZP zu liegen kommen.
Weiterhin soll sich die lange Seite LA des Gegenstandes O
parallel zur Zielgerade ZG befinden. Bevorzugt wird hier ge
mäß der Erfindung noch der Abstand d des Kontaktpunktes KP
zur Zielgeraden ZG bestimmt. Der Winkel, unter welchem die
Kraft F dann im Kraftangriffspunkt KP angreifen soll, ergibt
sich nach dem erfindungsgemäßen Bewegungsgesetz nach Glei
chung 1:
Fig. 2 illustrates the displacement of an object O to a target position ZP, and in a target orientation LO. For example, a force F should be applied to shift the object. This force is preferably applied in a contact point KP, which is characterized in that it causes a displacement in the direction of the force vector when the force F acts vertically on the side KU of the object O. This means that the object moves without twisting when a force acts perpendicular to the side KU at this point KP. According to the invention, an angle β is now to be determined by which the object O must be rotated so that it can take a target orientation LO. For this purpose, the straight line ZG through the target point ZP in the direction of the target orientation LO is represented as an extension line. For example, the method according to the invention, as shown here in FIG. 2, is intended to make the contact point KP later in the target point ZP. Furthermore, the long side LA of the object O should be parallel to the home straight ZG. The distance d of the contact point KP to the home straight ZG is preferably determined here according to the invention. The angle at which the force F should then act in the force application point KP results from the law of motion according to equation 1:
α = Kββ + Kdd (1)
α = K β β + K d d (1)
mit:
αKraftangriffswinkel, begrenzt auf den Reibungs
konus zwischen Manipulator und Oberfläche des
Gegenstandes
β Verdrehwinkel; |β| < π/2
d Abstand des Kraftangriffspunktes KP zur Zielgeraden
ZG
Kd, Kβ Regelparameter.With:
α Force angle of attack, limited to the friction cone between the manipulator and the surface of the object
β twist angle; | β | <π / 2
d Distance of the force application point KP to the home straight ZG
K d , K β control parameters.
Für Kβ wird bevorzugt 5 und für Kd bevorzugt 10 gewählt. Wei terhin sollte dabei beachtet werden, daß |β| nicht größer als π/2 sein darf. Es ist ebenfalls zu beachten, daß die Ver schiebung des Gegenstandes O im Kraftangriffspunkt KP sowohl mit einem Einpunktkontakt als auch mit einem Zweipunktkon takt durchgeführt werden kann. Insbesondere hängt dies von der Beschaffenheit bzw. der Form der Seite KU ab. Bei einem Einpunktkontakt sollte jedoch beachtet werden, daß sich der Winkel α innerhalb des Reibungskonus zwischen der Manipulatorspitze und der Oberfläche befinden muß, da der Manipulator sonst von der Oberfläche abrutschen würde. Wei terhin ist zu beachten, daß wegen dieser Bedingung der Gegen stand nicht innerhalb einer beliebig kleinen Entfernung von dem Zielpunkt ZP unter der Zielorientierung LO positioniert werden kann. Der Mindestabstand, der erforderlich ist, hängt dabei von der Entfernung d, dem Winkel β und dem Drehverhalten des Gegenstandes O ab. Um das Schiebever halten des Gegenstandes O herauszufinden und damit den neu tralen Kontaktpunkt KP zu ermitteln, kann es fallweise auch sinnvoll sein, eine Verschiebung des Gegenstandes um eine kon stante Strecke S oder T, wie beispielsweise um 10 cm, vorzu nehmen und den dabei auftretenden Verdrehungswinkel δ bzw. γ zu messen. Durch eine geeignete Kraftregelung kann dabei bei spielsweise sichergestellt sein, daß die Kraft F während der Verdrehung immer senkrecht zur Oberfläche des Gegenstandes O einwirkt. Bei der Verschiebung des Manipulators zum zweiten Kontaktpunkt ZK wird beispielsweise ein Oberflächenkontur-Ver folgungsverfahren eingesetzt, welches aus dem Stand der Technik bereits bekannt ist. Hierbei wird vorzugsweise auf die Oberfläche eine konstante Kraft ausgeübt, welche nicht dazu führt, daß sich der Gegenstand verschiebt, sondern ledig lich in Verbindung mit dem Kraftsensor eine Art Tastsinn für den Manipulator gewährleistet, damit dieser sich entlang der Oberfläche bewegen kann. Falls von homogenen Reibungsbedin gungen zwischen der Bodenfläche und der Kontaktfläche des Ge genstandes O mit dem Boden ausgegangen werden kann, so kann es auch fallweise sinnvoll sein-den Kraftangriffspunkt KP des Kraftvektors mit Hilfe von optischen Bildanalysemethoden zu bestimmen. Dies setzt allerdings voraus, daß der Gegenstand eine homogene Dicke aufweist, so daß zur Findung von Schwere linien mit Hilfe der Zerlegung seiner Oberfläche in gleiche Flächenteile ein geeigneter Kraftangriffspunkt gefunden wer den kann. Kann ein dreidimensionales Modell des Gegenstandes erstellt werden, z. B. mit mehreren Kameras und strukturiertem Licht, so genügt die Voraussetzung der Homogenität des Gegen standes zur Berechnung eines geeigneten Kraftangriffspunktes. 5 is preferably chosen for K β and 10 is preferably chosen for K d . Furthermore, it should be noted that | β | must not be greater than π / 2. It should also be noted that the displacement of the object O in the force application point KP can be carried out with both a single-point contact and a two-point contact. In particular, this depends on the nature or shape of the KU page. In the case of a single-point contact, however, it should be noted that the angle α must be within the friction cone between the manipulator tip and the surface, since the manipulator would otherwise slide off the surface. Wei terhin is to be noted that because of this condition, the subject could not be positioned within an arbitrarily small distance from the target point ZP under the target orientation LO. The minimum distance required depends on the distance d, the angle β and the rotational behavior of the object O. In order to find out the pushing behavior of the object O and thus to determine the neutral contact point KP, it may also make sense in some cases to shift the object by a constant distance S or T, such as by 10 cm, and the one that occurs Angle of rotation δ or γ to measure. A suitable force control can ensure, for example, that the force F always acts perpendicular to the surface of the object O during the rotation. When moving the manipulator to the second contact point ZK, for example, a surface contour tracking method is used, which is already known from the prior art. Here, a constant force is preferably exerted on the surface, which does not result in the object moving, but only in conjunction with the force sensor ensures a kind of sense of touch for the manipulator so that it can move along the surface. If homogeneous conditions of friction between the floor surface and the contact surface of the object O with the floor can be assumed, it may also be useful in some cases to determine the force application point KP of the force vector with the aid of optical image analysis methods. However, this presupposes that the object has a homogeneous thickness, so that a suitable force application point can be found to find lines of gravity with the help of the decomposition of its surface into equal parts of the area. Can a three-dimensional model of the object be created, e.g. B. with several cameras and structured light, the requirement of homogeneity of the object is sufficient to calculate a suitable force application point.
[1] Srinivas Akella and Matthew T. Mason: Posing polygonal
objects in the plane by pushing. In: Proceedings of the 1992
IEEE International Conference on Robotics and Automation, S.
2255-2262, Nice, France, May 1992
[2] Zdravko Balorda and Tadej Bajd: Reducing positioning un
certainty of objects by robot pushing. In: IEEE Transactions on
Robotics and Automation, Vol. 10 No. 4: S. 535-541, August 1994
[3] Kevin M. Lynch: The mechanics of fine manipulation by
pushing. In: Proceedings of the 1992 IEEE International Confe
rence on Robotics and Automation, S. 2269-2276, Nice,
France, May 1992
[4] Kevin M. Lynch and Matthew T. Mason: Controllability of
pushing. In: Proceedings of the IEEE International Conference
on Robotics and Automation, Volume 1, S. 112-119, Nagoya,
Aichi, Japan, May 1995
[5] Matthew T. Mason: Mechanics and planning of manipulator
pushing operations. In: The International Journal of Robotics Re
serch, Vol. 5, No. 3, S. 53-71, Fall 1986
[6] K. Okawa, J. and Taguchi and K. Yokoyama: Control of mo
bile robots for the push-a-box Operation. In: Proceedings of
the IECON'93, Volume 3, S. 1472-1477, Maui, USA, No. 1993
[7] Michael A. Peshkin and Arthur C. Sanderson: Planning ro
botic manipulation strategies for sliding objects. In:Procee
dings of the 1987 IDEE International Conference on Robotics
and Automation, S. 696-701, Raleigh, NC, USA, 31 March-3
April 1987
[8] Marcos Salganicoff, Giorgio Metta, Andrea Oddera, and
Guilio Sandini: A Vision-Based Learning Method for Pushing
Manipulation. In: AAAI, Fall Symposium on Machine Learning in
Computer Vision, Raleigh, NC, October 22-24, 1993.[1] Srinivas Akella and Matthew T. Mason: Posing polygonal objects in the plane by pushing. In: Proceedings of the 1992 IEEE International Conference on Robotics and Automation, pp. 2255-2262, Nice, France, May 1992
[2] Zdravko Balorda and Tadej Bajd: Reducing positioning and certainty of objects by robot pushing. In: IEEE Transactions on Robotics and Automation, Vol. 10 No. 4: pp. 535-541, August 1994
[3] Kevin M. Lynch: The mechanics of fine manipulation by pushing. In: Proceedings of the 1992 IEEE International Conference on Robotics and Automation, pp. 2269-2276, Nice, France, May 1992
[4] Kevin M. Lynch and Matthew T. Mason: Controllability of pushing. In: Proceedings of the IEEE International Conference on Robotics and Automation, Volume 1, pp. 112-119, Nagoya, Aichi, Japan, May 1995
[5] Matthew T. Mason: Mechanics and planning of manipulator pushing operations. In: The International Journal of Robotics Re serch, Vol. 5, No. 3, pp. 53-71, Fall 1986
[6] K. Okawa, J. and Taguchi and K. Yokoyama: Control of mo bile robots for the push-a-box operation. In: Proceedings of the IECON'93, Volume 3, pp. 1472-1477, Maui, USA, No. 1993
[7] Michael A. Peshkin and Arthur C. Sanderson: Planning ro botic manipulation strategies for sliding objects. In: Procee dings of the 1987 IDEE International Conference on Robotics and Automation, pp. 696-701, Raleigh, NC, USA, March 31-April 3, 1987
[8] Marcos Salganicoff, Giorgio Metta, Andrea Oddera, and Guilio Sandini: A Vision-Based Learning Method for Pushing Manipulation. In: AAAI, Fall Symposium on Machine Learning in Computer Vision, Raleigh, NC, October 22-24, 1993.
Claims (7)
- a) bei dem der Drehwinkel (β) zwischen der Ausgangsdrehorien tierung und Zieldrehorientierung (LO) des Gegenstandes (O) als Verdrehung ermittelt wird,
- b) bei dem mindestens die Wegstrecke (d) zwischen Ausgangs lage und Ziellage (LO, ZP) des Gegenstandes (O) als Ver schiebung ermittelt wird,
- c) bei dem auf einer zielabgewandten Seite des Gegenstandes (O) ein Kraftangriffspunkt (KP) derart ermittelt wird, daß ein Verschieben des Gegenstandes unter Krafteinwirkung (F) senkrecht zu seiner Oberfläche (KU) in diesem Kraftan griffspunkt den Gegenstand (O) in Kraftrichtung rotations frei bewegt,
- d) und bei dem der Gegenstand unter Krafteinwirkung (KP) im Kraftangriffspunkt (KP) mit variablem Kraftangriffswinkel (α) unter Überwachung seiner Lage und Drehorientierung mindestens um die Verdrehung (β) verdreht und um die Ver schiebung (d) verschoben wird.
- a) at which the angle of rotation (β) between the starting rotation orientation and the target rotation orientation (LO) of the object (O) is determined as twisting,
- b) in which at least the distance (d) between the starting position and the target position (LO, ZP) of the object (O) is determined as a displacement,
- c) in which on a side of the object (O) facing away from a force application point (KP) is determined in such a way that moving the object under the action of force (F) perpendicular to its surface (KU) at this point of force engagement the object (O) in the direction of force rotated freely,
- d) and in which the object under the action of force (KP) in the force application point (KP) with variable force application angle (α) while monitoring its position and rotational orientation is rotated at least by the rotation (β) and shifted by the displacement (d).
- a) daß mittels eines Manipulators (M) an einer beliebigen er sten Stelle (EK) auf der zielabgewandten Seite eine erste Ver schiebung vorgenommen wird, wobei ein erster Verdrehwinkel (δ), eine erste Verdrehrichtung (ED) und eine erste Ver schiebestrecke (S) bestimmt wird,
- b) daß mittels des Manipulators (M) an einer zweiten Stelle (ZK) auf der zielabgewandten Seite eine zweite Verschiebung vorge nommen wird, wobei ein zweiter Verdrehwinkel (γ), eine zweite Verdrehrichtung (ZD) und eine zweite Verschiebe strecke (T) bestimmt wird, wobei die zweite Stelle so aus gewählt wird, daß sie sich näher an einem gedachten Dreh punkt der Verdrehung von a) befindet,
- c) bei dem, falls sich die Drehrichtung in b) gegenüber a) um kehrt, die Strecke zwischen der ersten Stelle und der zwei ten Stelle (DIST) im Verhältnis der jeweiligen Verschiebe strecken (S, T) und Winkel (δ, γ) zueinander aufgeteilt wird, woraus sich der Kraftangriffspunkt (KP) ergibt und, falls sich die Drehrichtung in b) gegenüber a) nicht umkehrt, b) solange erneut mit einer weiteren zweiten Stelle durchge führt wird, bis dieses Kriterium erfüllt wird.
- a) that a first shift is carried out by means of a manipulator (M) at any point he most (EK) on the side facing away from the target, a first angle of rotation (δ), a first direction of rotation (ED) and a first displacement distance (S ) is determined
- b) that by means of the manipulator (M) at a second point (ZK) on the side facing away from the target, a second displacement is made, a second angle of rotation (γ), a second direction of rotation (ZD) and a second displacement distance (T) being determined is, the second position is selected from that it is closer to an imaginary pivot point of the rotation of a),
- c) in which, if the direction of rotation in b) reverses relative to a), stretch the distance between the first position and the second position (DIST) in the ratio of the respective displacements (S, T) and angle (δ, γ) is divided to one another, from which the force application point (KP) results and, if the direction of rotation in b) does not reverse compared to a), b) is carried out again with a further second position until this criterion is met.
mit:
bestimmt wird. 6. The method according to claim 4 or 5, wherein the position of the first position and the coordinates of the second position are the coordinates, the first and second Ver rotation angle δ and γ and the first and second displacement distance S and T and the position of the force application point n to:
With:
is determined.
α = Kββ + Kdd (1)
mit:
α Kraftangriffswinkel begrenzt auf den Reibungs konus zwischen Manipulator und Oberfläche des Gegenstandes
β Verdrehwinkel; |β| < π/2
d Abstand des Kraftangriffspunktes zur Zielgeraden ZG
Kd, Kβ Regelparameter.7. The method according to any one of claims 4 to 6, wherein a displacement distance (d) of the force application point (KP) is determined as the distance between the straight line (ZG) running in the target orientation and the displacement is carried out according to the following motion law:
α = K β β + K d d (1)
With:
α force angle limited to the friction cone between the manipulator and the surface of the object
β twist angle; | β | <π / 2
d Distance of the force application point to the home straight ZG
K d , K β control parameters.
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE19642016A DE19642016C1 (en) | 1996-10-11 | 1996-10-11 | Method for mechanically moving an object on a level to a target position |
DE59701106T DE59701106D1 (en) | 1996-10-11 | 1997-09-24 | Method for mechanically moving an object on a level to a target position |
EP97116649A EP0835727B1 (en) | 1996-10-11 | 1997-09-24 | Process of mechanically moving an object on a surface to a destination position |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE19642016A DE19642016C1 (en) | 1996-10-11 | 1996-10-11 | Method for mechanically moving an object on a level to a target position |
Publications (1)
Publication Number | Publication Date |
---|---|
DE19642016C1 true DE19642016C1 (en) | 1998-05-28 |
Family
ID=7808505
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE19642016A Expired - Fee Related DE19642016C1 (en) | 1996-10-11 | 1996-10-11 | Method for mechanically moving an object on a level to a target position |
DE59701106T Expired - Fee Related DE59701106D1 (en) | 1996-10-11 | 1997-09-24 | Method for mechanically moving an object on a level to a target position |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE59701106T Expired - Fee Related DE59701106D1 (en) | 1996-10-11 | 1997-09-24 | Method for mechanically moving an object on a level to a target position |
Country Status (2)
Country | Link |
---|---|
EP (1) | EP0835727B1 (en) |
DE (2) | DE19642016C1 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114951003B (en) * | 2022-05-06 | 2023-12-26 | 苏州嘉诺智能制造有限公司 | Sorting method and device based on distance detection |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE2656433B2 (en) * | 1976-12-14 | 1979-09-06 | Fraunhofer-Gesellschaft Zur Foerderung Der Angewandten Forschung E.V., 8000 Muenchen | Process for regulating the movement variables, e.g. the rotational and translational movements, of a manipulator or industrial handling device |
DE3836003A1 (en) * | 1988-10-21 | 1990-04-26 | Wolfgang Prof Dr Ing Ziegler | Method and device for carrying out a force-controlled movement |
-
1996
- 1996-10-11 DE DE19642016A patent/DE19642016C1/en not_active Expired - Fee Related
-
1997
- 1997-09-24 DE DE59701106T patent/DE59701106D1/en not_active Expired - Fee Related
- 1997-09-24 EP EP97116649A patent/EP0835727B1/en not_active Expired - Lifetime
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE2656433B2 (en) * | 1976-12-14 | 1979-09-06 | Fraunhofer-Gesellschaft Zur Foerderung Der Angewandten Forschung E.V., 8000 Muenchen | Process for regulating the movement variables, e.g. the rotational and translational movements, of a manipulator or industrial handling device |
DE3836003A1 (en) * | 1988-10-21 | 1990-04-26 | Wolfgang Prof Dr Ing Ziegler | Method and device for carrying out a force-controlled movement |
Non-Patent Citations (5)
Title |
---|
AKELLA, Srinivas und MASON, Matthew T.: Posing polygonal objects in the plane by pushing. In: Proceedings of the 1992 IEEE International Confe- rence on Robotics and Automation, Nice, Frank- reich, Mai 1992, S. 2255-2262 * |
BALORDA, Zdravko, BAJD, Tadej: Reducing Positioning Uncertainty of Objects by Robot Pushing. In: IEEE trans. robotics autom., Vol. 10, No. 4, 1994, S. 535-541 * |
CLASSE, Detlef: Selektive Kraft- und Positions- regelung bei sensorgestützter Roboterprogrammie- rung. In: Automatisierungstechnik, Vol. 39, 1991, S. 92-97 * |
LYNCH, Kevin M.: The mechanics of fine manipula- tion by pushing. In: Proceedings of the 1992 IEEE International Conference on Robotics and Automa- tion, Nice, Frankreich, Mai 1992, S. 2269-2276 * |
MASON, Matthew T.: Mechanics and planning of mani-pulator pushing operations. In: The International Journal of Robotics Research, Vol. 5, No. 3, 1986, * |
Also Published As
Publication number | Publication date |
---|---|
DE59701106D1 (en) | 2000-03-16 |
EP0835727B1 (en) | 2000-02-09 |
EP0835727A1 (en) | 1998-04-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE102015208584B4 (en) | Gripping device and gripping method | |
DE102011011681B4 (en) | Robot with a learning control function | |
DE69331787T2 (en) | Robotic movement of an object over a workpiece surface | |
DE102018116053A1 (en) | Robot system and robot learning method | |
DE19930087C5 (en) | Method and device for controlling the advance position of a manipulator of a handling device | |
DE102015105687B4 (en) | robot | |
DE102018000467A1 (en) | Robot system comprising a force-controlled pusher | |
DE102018112403B4 (en) | ROBOTIC SYSTEM DISPLAYING INFORMATION FOR ASSISTING AN ROBOT | |
DE68922684T2 (en) | Profile control system for a given curved surface. | |
EP1722935A1 (en) | Method for calibration of a working point for tools on industrial robots | |
EP1604789A2 (en) | Method and device for improving the positioning accuracy of a manipulator | |
DE202008014481U1 (en) | Portable robotic control device for controlling a movement of a robot | |
WO1996003259A1 (en) | Self-contained mobile unit with space-saving manipulator and appropriate control process | |
EP2008778B1 (en) | Method and device for programming an industrial robot | |
DE102018114445B4 (en) | Apparatus and method for estimating a position of the center of gravity of a robot | |
DE102018133349A1 (en) | Method and device for moment estimation | |
DE102007037078B4 (en) | Method for complying with working space limits of a robot's work equipment | |
DE102018200864B3 (en) | Method and system for controlling a robot | |
WO2021186068A1 (en) | Determination of safety zones around an automatically operating machine | |
DE102017108492B4 (en) | A control device of a robot that displays an operating program in which the state of an additional axis is included | |
DE69118793T2 (en) | Path interpolation method for robots | |
DE102017005194B3 (en) | Controlling a robot assembly | |
DE102022130652A1 (en) | TRAINING A ROBOT BY DEMONSTRATING USING VISUALSERVOING | |
DE102007047190A1 (en) | Dust removal process and appropriate dedusting facility | |
DE102012022190B4 (en) | Inverse kinematics |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
8100 | Publication of the examined application without publication of unexamined application | ||
D1 | Grant (no unexamined application published) patent law 81 | ||
8364 | No opposition during term of opposition | ||
8339 | Ceased/non-payment of the annual fee |