TECHNISCHES GEBIET

[0001] Die vorliegende Erfindung betrifft ein eine kraftgeregelte Handhabungsvorrich tung {handling device) für die automatisierte, robotergestützte Oberflächenbearbeitung. Derartige Handhabungsvorrichtungen können insbesondere als Schnittstelle zwischen Ma nipulator (Roboter) und Werkzeugmaschine dienen.

HINTERGRUND

[0002] Bei der robotergestützten Oberflächenbearbeitung wird eine Werkzeugmaschine (z.B. eine Schleifmaschine, eine Bohrmaschine, eine Fräsmaschine, eine Poliermaschine und dgl.) von einem Manipulator, beispielsweise einem Industrieroboter, geführt. Dabei kann die Werkzeugmaschine auf unterschiedliche Weise mit dem sogenannten TCP ( Tool Center Point) des Manipulators gekoppelt sein; der Manipulator kann in der Regel Position und Orientierung des TCP praktisch beliebig einstellen, um eine Werkzeugmaschine auf einer Trajektorie z.B. parallel zu einer Oberfläche eines Werkstücks zu bewegen. Industrie roboter sind üblicherweise positionsgeregelt, was eine präzise Bewegung des TCP entlang der gewünschten Trajektorie ermöglicht.

[0003] Um beim robotergestützten Schleifen, Polieren oder bei anderen Oberflächenbear beitungsprozessen ein gutes Ergebnis zu erzielen, ist in vielen Anwendungen eine Rege lung der Prozesskraft (z.B. Schleifkraft) nötig, was mit herkömmlichen Industrierobotern oft nur schwer mit hinreichender Genauigkeit zu realisieren ist. Die großen und schweren Armsegmente eines Industrieroboters besitzen eine zu große Massenträgheit, als dass ein Regler (closed-loop Controller ) rasch genug auf Schwankungen der Prozesskraft reagieren könnte. Um dieses Problem zu lösen, kann zwischen dem TCP des Manipulators und der Werkzeugmaschine ein im Vergleich zum Industrieroboter kleine (und leichte) Handha bungsvorrichtung angeordnet sein, die den TCP des Manipulators mit der Werkzeugma schine koppelt. Die Handhabungsvorrichtung umfasst insbesondere einen Linearaktor und regelt während der Oberflächenbearbeitung lediglich die Prozesskraft (also die Anpress kraft zwischen Werkzeug und Werkstück), während der Manipulator die Werkzeugma schine samt Linearaktor positionsgeregelt entlang der gewünschten Trajektorie bewegt. Durch die Kraftregelung kann die Handhabungsvorrichtung mit Hilfe des Linearaktors Un genauigkeiten in der Lage und der Form des zu bearbeitenden Werkstücks sowie auch Un genauigkeiten der Trajektorie des Manipulators (innerhalb gewisser Grenzen) ausgl eichen.

[0004] Bei vielen Oberflächenbearbeitungsprozessen ist die Qualität des Prozessergeb nisses stark davon abhängig, ob die Prozesskraft während des Bearbeitungsprozesses auch innerhalb eine gewünschten, spezifizierten Bereichs bleibt. Beispielsweise kann bei einem Schleifprozess eine (auch nur kurzfristig) zu hohe Schleifkraft (Prozesskraft) das Werk stück stark beschädigen oder sogar zerstören und/oder hohe Reparaturkosten verursachen.

[0005] Der Erfinder hat sich die Aufgabe gestellt, eine verbesserte Handhabungsvorrich tung mit Kraftregelung zu entwickeln, die es ermöglicht, die Einhaltung der spezifizierten Prozesskraft weitgehend sicherzustellen.

ZUSAMMENFASSUNG

[0006] Die oben genannte Aufgabe wird durch die Vorrichtung gemäß Patentanspruch 1 und das Verfahren gemäß Anspruch 7 gelöst. Verschiedene Ausführungsformen und Wei terentwicklungen sind Gegenstand der abhängigen Patentansprüche. Ein Ausführungsbei spiel betrifft eine Handhabungsvorrichtung (handling apparatus) mit einem Linearaktor, der zwischen einem ersten Flansch, der mit einem Manipulator verbindbar ist, und einem zweiten Flansch, an dem ein Werkzeug oder eine Werkzeugmaschine mit einem Werkzeug montierbar ist, wirkt. Der Linearaktor übt nach Maßgabe einer Stellgröße eine Kraft auf den zweiten Flansch oder einen Endanschlag aus. Die Vorrichtung umfasst weiter einen Kraftsensor, der zwischen den zweiten Flansch und das Werk-zeug gekoppelt und dazu ausgebildet ist, bei Kontakt zwischen Werkzeug und einer Ober-fläche eine von der Hand habungsvorrichtung auf das Werkzeug ausgeübte Kraft zu messen. Eine Steuereinheit weist eine einem Zustandsbeobachter auf, der dazu ausgebildet ist, basierend auf der Stell größe einen Schätzwert für die von der Handhabungsvorrichtung auf das Werkzeug ausge übte Kraft zu ermitteln. Die Steuereinheit ist weiter dazu ausgebildet, einen Kontakt zwi schen dem Werkzeug und der Oberfläche zu detektieren, wobei die Stellgröße basierend auf dem Schätzwert und einem Sollwert eingestellt wird, solange kein Kontakt detektiert wird, wohingegen die Stellgröße basierend auf der gemessenen Kraft und dem Sollwert eingestellt wird, solange ein Kontakt detektiert wird. [0007] Ein weiteres Ausführungsbeispiel betrifft ein Verfahren zum Steuern einer Hand habungsvorrichtung. Diese umfasst einen Linearaktor, der zwischen einem mit einem Ma nipulator verbindbaren ersten Flansch und einem zweiten Flansch, an dem ein Werkzeug oder eine Werkzeugmaschine mit einem Werkzeug montierbar ist, wirkt. Gemäß einem Ausführungsbeispiel umfasst das Verfahren umfasst das Ansteuern des Linearaktors mit einer Stellgröße, sodass dieser nach Maßgabe der Stellgröße eine Kraft auf den zweiten Flansch oder einen Endanschlag ausübt. Das Verfahren umfasst weiter das Detektieren ei nes Kontakts zwischen dem Werkzeug und einer Oberfläche sowie das Messen - bei Kon takt zwischen Werkzeug und einer Oberfläche - einer von der Handhabungsvorrichtung auf das Werkzeug ausgeübten Kraft mit Hilfe eines Kraftsensors, der zwischen den zwei ten Flansch und das Werkzeug gekoppelt ist. Des Weiteren wird ein Schätzwert für die von der Handhabungsvorrichtung auf das Werkzeug ausgeübte Kraft basierend auf der Stell größe ermittelt. Solange kein Kontakt detektiert wird, wird die Stellgröße basierend auf dem Schätzwert und einem Sollwert eingestellt, und solange ein Kontakt detektiert wird, wird die Stellgröße basierend auf der gemessenen Kraft und dem Sollwert eingestellt.

KURZE BESCHREBIBUNG DER ZEICHNUNGEN

[0008] Verschiedene Implementierungen werden nachfolgend anhand von den in den Ab bildungen dargestellten Beispielen näher erläutert. Die Darstellungen sind nicht zwangs läufig maßstabsgetreu und die Erfindung beschränkt sich nicht nur auf die dargestellten Aspekte. Vielmehr wird Wert darauf gelegt, die den dargestellten Ausführungsbeispielen zugrunde liegenden Prinzipien darzustellen.

[0009] Figur 1 ist ein allgemeines Beispiel eines Systems zum robotergestützten Schlei fen mit einem Industrieroboter, einer Handhabungsvorrichtung mit Kraftregelung und einer Schleifmaschine.

[0010] Figur 2 illustriert eine exemplarische Implementierung der Handhabungsvorrich tung (ohne die dazugehörige Steuereinheit).

[0011] Figur 3 illustriert ein Beispiel einer Steuereinheit für die Handhabungsvorrich tung, in der die Kraftregelung implementiert ist. [0012] Figur 4 illustriert ein Beispiel eines Verfahrens zur Steuerung einer Handhabungs vorrichtung für die robotergestützte Oberflächenbearbeitung.

DETAILLIERTE BESCHREIBUNG

[0013] Bevor verschiedene Ausführungsbeispiele im Detail erläutert werden, wird zu nächst ein allgemeines Beispiel einer robotergestützten Schleifvorrichtung beschrieben. Es versteht sich, dass die hier beschriebenen Konzepte auch auf andere Arten von Oberflä chenbearbeitung (z.B. Polieren, Fräsen, Bohren, etc.) übertragbar und nicht auf Schleifen beschränkt sind.

[0014] Gemäß Fig. 1 umfasst eine robotergestützte Schleifvorrichtung einen Manipulator 80, beispielsweise einen Industrieroboter und eine Schleifmaschine 50 mit rotierendem Schleifwerkzeug 51. Die Schleifmaschine 50 ist mit dem sogenannten Tool-Center -Point (TCP) des Manipulators 1 über einen Linearaktor 100 gekoppelt, der allgemein als Hand habungsvorrichtung bezeichnet wird. Der TCP ist genau genommen kein Punkt, sondern ein Vektor und kann z.B. durch drei Raumkoordinaten (Position) und drei Winkel (Orien tierung) beschrieben werden. In der Robotik werden zur Beschreibung der Lage des TCPs manchmal auch generalisierte Koordinaten (meist sechs Gelenkwinkel des Roboters) im Konfigurationsraum verwendet. Position und Orientierung des TCPs werden manchmal auch als „Pose“ bezeichnet. Die Position (inkl. Orientierung) des TCP als Funktion der Zeit definiert die Bewegung des Schleifwerkzeugs, die als Trajektorie bezeichnet wird. Als TCP wird oft der Mittelpunkt des Endeffektorflansches des Roboters definiert, was aber nicht notwendigerweise der Fall sein muss. Der TCP kann ein beliebiger Punkt sein (und theoretisch auch außerhalb des Roboters liegen), dessen Position und Orientierung vom Roboter einstellbar ist. Der TCP kann auch den Ursprung des Werkzeugkoordinatensys tems definieren.

[0015] Im Falle eines Industrieroboters mit sechs Freiheitsgraden kann der Manipulator

80 aus vier Segmenten 82, 83, 84 und 85 aufgebaut sein, die jeweils über Gelenke Gn, G12 und G13 verbunden sind. Das erste Segment 82 ist dabei meist starr mit einem Fundament

81 verbunden (was jedoch nicht zwangsläufig der Fall sein muss). Das Gelenk G11 verbin det die Segmente 82 und 83. Das Gelenk G11 kann 2-achsig sein und eine Drehung des Segments 83 um eine horizontale Drehachse (Elevationswinkel) und eine vertikale Dreh achse (Azimutwinkel) ermöglichen. Das Gelenk G12 verbindet die Segmente 83 und 84 und ermöglicht eine Schwenkbewegung des Segments 84 relativ zur Lage des Segments 83. Das Gelenk G13 verbindet die Segmente 84 und 85. Das Gelenk G13 kann 2-achsig sein und daher (ähnlich wie das Gelenk Gn) eine Schwenkbewegung in zwei Richtungen er möglichen. Der TCP hat eine feste Relativposition zum Segment 85, wobei dieses übli cherweise noch ein Drehgelenk (nicht dargestellt) umfasst, welches eine Drehbewegung des am Segment 85 angeordneten Endeffektorflansches 86 um eine Längsachse A des Seg ments 85 ermöglicht (in Fig. 1 als strichpunktierte Line eingezeichnet, entspricht in dem dargestellten Beispiel auch der Drehachse des Schleifwerkzeugs). Jeder Achse eines Ge lenks ist ein Aktor (z.B. ein Elektromotor) zugeordnet, der eine Drehbewegung um die je weilige Gelenksachse bewirken kann. Die Aktoren in den Gelenken werden von einer Ro botersteuerung 70 gemäß einem Roboterprogramm angesteuert. Verschiedene Industriero boter/Manipulatoren und dazugehörige Steuerungen sind an sich bekannt und werden da her hier nicht weiter erläutert.

[0016] Der Manipulator 80 ist üblicherweise positionsgeregelt, d.h. die Robotersteuerung kann die Pose (Ort und Orientierung) des TCP festlegen und diesen entlang einer vordefi nierten Trajektorie bewegen. In Fig. 1 ist die Längsachse des Segments 85, auf der der TCP liegt, mit A bezeichnet. Wenn der Linearaktor der Handhabungsvorrichtung 100 an einem Endanschlag anliegt, ist mit der Pose des TCPs auch die Pose der Schleifmaschine 50 (und auch der Schleifscheibe 51) definiert. Wie eingangs bereits erwähnt, dient die Handhabungsvorrichtung 100 dazu, während des Schleifprozesses die Kontaktkraft (Pro zesskraft) zwischen Werkzeug (z.B. Schleifscheibe 51) und Werkstück 60 auf einen ge wünschten Wert einzustellen. Eine direkte Kraftregelung durch den Manipulator 80 ist für Schleifanwendungen in der Regel zu ungenau, da durch die hohe Massenträgheit der Seg mente 83 bis 85 des Manipulators 80 eine schnelle Kompensation von Kraftspitzen (z.B. beim Aufsetzen des Schleifwerkzeugs auf das Werkstück 60) mit herkömmlichen Manipu latoren praktisch nicht möglich ist. Aus diesem Grund ist die Robotersteuerung 70 dazu ausgebildet, die Pose (Position und Orientierung) des TCP des Manipulators 80 zu regeln, während die Kraftregelung ausschließlich mit Hilfe der Handhabungsvorrichtung 100 be werkstelligt wird.

[0017] Wie bereits erwähnt, kann während des Schleifprozesses die Kontaktkraft FK zwi schen Schleifwerkzeug (Schleifscheibe 51der Schleifmaschine 50) und Werkstück 60 mit Hilfe der Handhabungsvorrichtung 100 und einer Kraftregelung (die beispielsweise in der Steuerung 70 implementiert sein kann) so eingestellt werden, dass die Kontaktkraft FK (in Richtung der Längsachse A) zwischen Schleifscheibe 51 und Werkstück 60 einem vorgeb- baren Sollwert entspricht. Die Kontaktkraft FK ist dabei eine Reaktion auf die Aktorkraft FA, mit der die Handhabungsvorrichtung 100 auf die Werkstückoberfläche drückt. Bei feh lendem Kontakt zwischen Werkstück 60 und Werkzeug 51 fährt der in der Handhabungs vorrichtung 100 enthaltene Aktor (siehe auch Fig. 2) aufgrund der fehlenden Kontaktkraft am Werkstück 60 gegen einen Endanschlag (nicht dargestellt da im Aktor 2 integriert) und drückt mit einer definierten Kraft gegen diesen. Die Kraftregelung ist dabei durchgehend aktiv. In dieser Situation (kein Kontakt) ist die Aktorauslenkung daher maximal und die Handhabungsvorrichtung befindet sich in einer Endposition. Die definierte Kraft, mit der der (Linear-) Aktor (der in der Handhabungsvorrichtung 100 enthalten ist) gegen den End anschlag drückt, kann sehr klein sein oder (theoretisch) sogar auf null geregelt werden, um ein möglichst sanftes Kontaktieren der Werkstückoberfläche zu ermöglichen.

[0018] Die Positionsregelung des Manipulators 80 (die ebenfalls in der Steuerung 70 im plementiert sein kann) kann vollkommen unabhängig von der Kraftregelung der Handha bungsvorrichtung 100 arbeiten. Letztere ist nicht verantwortlich für die Positionierung der Schleifmaschine 50, sondern lediglich für das Einstellen und Aufrechterhalten der er wünschten Kontaktkraft FK während des Schleifprozesses und zur Erkennung von Kontakt zwischen Werkzeug 51 und Werkstück 60. Ein Kontakt kann z.B. in einfacher Weise dadurch erkannt werden, dass der in der Handhabungsvorrichtung enthaltene Linearaktor sich aus der Endposition herausbewegt hat (Aktorauslenkung a ist kleiner als die maximale Auslenkung aMA am Endanschlag).

[0019] In Fig. 2 ist ein Beispiel der Handhabungsvorrichtung 100 schematisch darge stellt. Teile, die einem Fachmann bekannt und für die folgende Diskussion nicht notwendig sind (wie z.B. Ventile, Linearführungen, etc.) wurden in Fig. 2 weggelassen, um die Dar stellung nicht zu verkomplizieren. Der in der Handhabungsvorrichtung 100 enthaltene Ak tor 153 kann ein pneumatischer Aktor sein, z.B. ein doppeltwirkender Pneumatikzylinder. Jedoch sind auch andere pneumatische Aktoren anwendbar wie z.B. Balgzylinder und Luftmuskel. Als Alternative kommen auch elektrische Direktantriebe (getriebelos) in Be tracht.

[0020] Es versteht sich, dass die Wirkrichtung des Aktors/der Handhabungsvorrichtung 100 und die Drehachse der Schleifmaschine 50 nicht notwendigerweise mit der Längs achse A des Segments 85 des Manipulators 80 zusammenfallen müssen. Im Falle eines pneumatischen Aktors kann die Kraftregelung in an sich bekannter Weise mit Hilfe eines Regelventils, eines Reglers (z.B. implementiert in der Steuerung 70) und eines Druckluft speichers oder Kompressors realisiert werden. Da für die Berücksichtigung der Schwer kraft (d.h. der Gewichtskraft der Schleifmaschine 50) die Neigung zur Lotrechten relevant ist, kann der Aktor 2 einen Neigungssensor (nicht dargestellt) enthalten oder diese Infor mation kann basierend auf den Gelenkwinkeln des Manipulators 80 ermittelt werden. Die ermittelte Neigung wird von dem Kraftregler berücksichtigt (siehe auch Erläuterungen zu Fig. 3). Die Handhabungsvorrichtung 100 ermöglicht nicht nur eine gewisse mechanische Entkopplung zwischen Manipulator 80 und Werkstück 60, sondern ist auch in der Lage, Ungenauigkeiten in der Positionierung des TCP auszugleichen.

[0021] Die Handhabungsvorrichtung umfasst neben dem Linearaktor 153 (Pneumatikzy linder) einen Abstandssensor ( _< displacement sensor ), der beispielsweise als induktiver Sen sor oder als Potentiomenter ausgebildet sein kann. Im Wesentlichen ist der Abstandssensor dazu ausgebildet, die Auslenkung (< displacement ) des Linearaktors 153 zu messen. Bei ei ner maximalen Auslenkung a=aMAx drückt der Linearaktor gegen einen Endanschlag. Der Linearaktor kann die beiden Flansche 101 und 102 koppeln. Die Veränderung des Ab stands zwischen den beiden Flanschen 101 und 102 entspricht der Veränderung der Aus lenkung des Linearaktors 153. Der (in Fig. 2) obere Flansch 102 kann (z.B. mittels Schrau ben) mit dem Endeffektorflansch eines Roboters verbunden sein (siehe Fig. 1, Endeffektor flansch 86). An dem unteren Flansch 101 kann (direkt oder indirekt) die Werkzeugma schine 50 montiert sein., wobei in dem dargestellten Beispiel zwischen der Handhabungs vorrichtung und der Werkzeugmaschine 50 ein Kraftsensor 150 angeordnet ist. Dieser Kraftsensor 150 kann z.B. als Kraftmessdose ( load cell) ausegebildet sein und ermöglicht die direkt Messung der Kraft, die zwischen der Handhabungsvorrichtung und der Werk zeugmaschine 50 wirkt.

[0022] Ein Faltenbalg 121 kann die Teile innerhalb der Handhabungsvorrichtung gegen Staub und dergleichen schützen, und gleichzeitig eine Bewegung in Wirkrichtung des Pneumatikzylinders 153 ermöglichen. Dabei wirkt der Faltenbalg 121 wie eine Feder, de ren Kennlinie bei der Kraftregelung berücksichtigt werden kann. Die von dem Faltenbalg 121 bewirkte (Feder-) Kraftkomponente kann beispielsweise basierend auf der vom Ab standssensor 151 gemessenen Auslenkung a ermittelt werden. Im einfachsten Fall ist die von dem Faltenbalg 121 bewirkte (Feder-) Kraftkomponente proportional zur Auslenkung (bei linearer Federcharakteristik). In manchen Ausführungsbeispielen wird die tatsächliche Federcharakteristik des Faltenbalgs 121 mittels Kalibrationsmessungen ermittelt.

[0023] Zusätzlich zu der direkten Kraftmessung durch die Kraftmessdose 150 erfolgt eine indirekte Kraftmessung durch Messung des Drucks p im Pneumatikzylinder 153 mit Hilfe eines Drucksensors 152, der pneumatisch mit einer Druckluftleitung des Pneumatikzylin ders 153 gekoppelt sein kann. Die Kraft erhält man dann durch Multiplikation des Drucks p mit der im Zylinder wirksamen Kolbenfläche A (FA=P A). Wird statt eines pneumati schen Aktors ein elektromechanischer Aktor eingesetzt, kann die Kraft auch aus der Stromaufnahme des elektromechanischen Aktors ermittelt werden. Statt einer Druckmes sung wird in diesem Fall eine Strommessung durchgeführt. Aus dem Strommesswert kann wiederum die Aktorkraft berechnet werden

[0024] Bei bekannten Systemen ist in der Regel keine redundante Kraftmessung durch einen direkten Kraftsensor wie eine Kraftmessdose vorgesehen, da bei geregelten pneuma tischen Systemen ohnehin der Zylinderdruck (oder bei elektromechanischen Aktoren der Strom) als Messwert vorliegt. In diesem Zusammenhang ist es wichtig zu erwähnen, dass bei dem hier beschriebenen Beispiel die direkte Kraftmessung (Kraft FM) durch den Krafts ensor 150 nicht einfach einen redundanten Messwert zu der indirekten Kraftmessung (Kraft r· A) liefert. Würde man die indirekte Kraftmessung (mittels Druck- oder Strommes sung) durch eine direkte Kraftmessung mittels Kraftmessdose ersetzen wollen, dann müsste der jeweilige Kraftsensor so angeordnet sein, dass der die vom Aktor (Pneuma tikzylinder) auf den Flansch 101 der Handhabungsvorrichtung 100 ausgeübte Aktorkraft misst. Bei einer Blockierung der Bewegung des Flanschs 101 (relativ zum Flansch 102) beispielsweise durch einen Endanschlag, würde in diesem Fall der Kraftsensor die gegen den Endanshclag wirkende Aktorkraft messen, auch wenn kein Kontakt mit dem Werk stück vorliegt. Dies ist aber bei dem Beispiel aus Fig. 2 nicht der Fall. Der Kraftsensor 150 ist nicht innerhalb der Handhabungsvorrichtung 100 (zwischen Pneumatikzylinder 153 und Flansch 101), sondern außen am Flansch 101, sodass der Kraftsensor nur die Kraft FM misst, die zwischen Werkzeugmaschine 50 und Handhabungsvorrichtung wirkt. Bei feh lendem Kontakt mit dem Werkstück würde in dem dargestellten Beispiel der Kraftsensor 150 nur die Gewichtskraft der Werkzeugmaschine 50 messen, unabhängig davon, ob und mit welcher Kraft FA der Pneumatikzylinder 153 gegen den Endanschlag drückt. Das heißt, in den hier beschriebenen Beispielen sind - bei fehlendem Kontakt - die direkte Kraftmessung (Kraft FM) und die indirekte Kraftmessung (Kraft r· A) nicht redundant, son dern es werden prinzipiell unterschiedliche Kräfte gemessen.

[0025] Ein Zusammenhang zwischen der durch die indirekte Kraftmessung ermittelte Aktorkraft FA (FA=P A im Falle eines Pnaumatikzylinders) und der direkt gemessenen Kraft FM kann nur bei vorhandenem Kontakt zwischen Werkstück und Werkzeugma schine formuliert werden. Nur in dieser Situation (Kontakt vorhanden) wirkt eine Kontakt kraft FK (Prozesskraft) auf die Handhabungsvorrichtung zurück und es gilt FK=FM+FG, wo bei FG die auf die Werkstückoberfläche wirkende Gewichtskraft der Werkzeugmaschine und FM die direkt gemessene Kraft, mit der die Handhabungsvorrichtung auf die Werk zeugmaschine drückt, bezeichnet. An dieser Stelle sei angemerkt, dass die Gewichtskraft FG auch negativ werden kann, wenn die Schleifmaschine kopfüber betrieben wird. Bei Kontakt gilt für die direkt gemessene Kraft weiter FM = FA + AF = r· A + AF, wobei der Offset AF sämtliche Störkräfte (z.B. Reibung, Hystereseeffekte, etc.) beinhaltet. Für die Kontaktkraft/Prozesskraft gilt bei Kontakt demnach FK=FA+FG + AF = FM + FG, wobei der vom Zustand der Handhabungsvorrichtung abhängige Offset AF im Betrieb ermittelt wer den kann (z.B. basierend auf mathematischen Modellen und/oder Kalibrationsmessungen).

[0026] Das Blockschaltbild aus Fig. 3 zeigt ein Beispiel eine Steuereinheit, die zum Be trieb de Handhabungsvorrichtung 100 verwendet werden kann. Die Steuereinheit aus Fig.

3 umfasst einen Zustandsbeobachter 160 {state observer ), auch Zustandsschätzer {state e- stimato ) genannt, dem die Soll- oder Ist- Stellgröße {controlled variable) zugeführt wird, welche im vorliegenden Beispiel den Sollwert oder den gemessenen Istwert des Zylinder drucks repräsentiert. Der Zustandsbeobachter 160 empfängt des Weiteren Sensordaten (z.B. die gemessene Auslenkung a der Handhabungsvorrichtung 100, die Beschleunigung der Handhabungsvorrichtung, die Neigung der Handhabungsvorrichtung zur Lotrechten, etc.) sowie Systemparameter (z.B. das Gewicht der an der Handhabungsvorrichtung mon tierten Werkzeugmaschine) und ist dazu ausgebildet, aus den zugeführten Informationen (Sensordaten und Stellgröße) einen Zustand der Handhabungsvorrichtung zu schätzen, ins besondere die effektiv vom Aktor (Pneumatikzylinder) bereitgestellte Kraft FA + AF (ge schätzte Ist-Prozesskraft) die entweder auf den Endanschlag (bei fehlendem Kontakt) oder auf das Werkstück (bei Kontakt) wirkt. Für die Zustandsschätzung kann der Zustandsbe obachter mathematische Modelle beinhalten, die das physikalische Verhalten der Handha bungsvorrichtung modellieren (z.B. Federkennlinie des Faltenbalgs, Reibung, etc.). [0027] Der Zustandsbeobachter 160 ist weiter dazu ausgebildet, einen Kontakt zwischen Werkzeugmaschine und Werkzeug zu detektieren und zu signalisieren. Da bei fehlendem Kontakt der Aktor (Pneumatikzylinder) gegen seinen Endanschlag drück, kann ein Kontakt z.B. allein dadurch detektiert werden, dass der Aktor sich vom Endanschlag weg bewegt (Auslenkung a kleiner als die Maximalauslenkung aMAx am Endanschlag).

[0028] Eine weitere Komponente der Steuereinheit aus Fig. 3 ist die Prozesssteuerung und -Überwachungseinheit 161 (process Controller and monitoring unit). Hier findet die Regelung ( regulation ) der Prozesskraft statt. Dazu empfängt die Prozesssteuerung und -Überwachungseinheit 161 die geschätzte Ist-Prozesskraft und Information bezüglich Kon takt vom Zustandsbeobachter 160 sowie Systemparameter (z.B. Gewicht der Werkzeugma schine 50), die Soll-Prozesskraft Fs und die vom Kraftsensor 150 direkt gemessene Ist-Pro- zesskraft FM, die wie oben besprochen jedoch nur bei vorhandenem Kontakt eine sinnvolle Messgröße dargestellt. Basierend auf Soll-Prozesskraft Fs und der direkt gemessenen und/oder geschätzten Ist-Kraft FM oder FA+AF und unter Berücksichtigung der Gewichts kraft FG wird mit Hilfe eines Regelalgorithmus die Stellgröße ( controlled variable ) berech net, mit der der Aktor angesteuert wird (bei einem Pneumatikaktor ist das wie erwähnt der Zylinderdruck p). Geeignete Regelalgorithmen sind an sich bekannt und werden daher hier nicht weiter diskutiert. Bei einem theoretischen Regelfehler ( control deviation ) von null wird die Stellgröße (z.B. ein Druck bei pneumatischen Aktoren, ein Aktorstrom bei elekt romechanischen Aktoren) so eingestellt, dass bei Kontakt für die Prozesskraft FK folgendes gilt: FK= FM + FG = Fs. Das heißt, die Prozesskraft (Kontaktkraft) entspricht der (ggf. vari ierenden) Soll-Kraft.

[0029] Die Prozesssteuerung und -Überwachungseinheit 161 ist weiter dazu ausgebildet die „Quelle“ für die Ist-Prozesskraft (Kraftsensor 150, Zustandsbeobachter 160) abhängig davon auszuwählen, ob ein Kontakt detektiert wurde oder nicht. Bei fehlendem Kontakt wird der Zustandsbeobachter 160 ausgewählt und bei detektiertem Kontakt der Kraftsensor 150. Idealerweise müssten beide Quellen - bei detektiertem Kontakt - denselben Kraftwert liefern, jedoch fließen in den geschätzten Wert FA+ AF durch Kalibration bestimmte Ein flussparameter ein, die sich mit der Zeit verändern können, wohingegen der direkt gemes sene Wert FM immer die tatsächliche Kraft misst (vorausgesetzt der Kraftsensor 150 funk tioniert ordnungsgemäß). [0030] Plausibilitätsprüfung. Die Prozesssteuerung und -Überwachungseinheit 161 kann weiter dazu ausgebildet sein, während eines Oberflächenbearbeitungsprozesses (d.h. bei Kontakt) basierend auf dem direkt gemessenen Kraftwert FM und dem vom Zustandsbe obachter gelieferten Kraftwert FA+AF eine Plausibilitätsprüfung durchzuführen. Dazu kann die Prozesssteuerung und -Überwachungseinheit 161 die beiden Werten FA+AF und FM ver gleichen, und bei Abweichungen z.B. einen Fehler melden. In manchen Situationen ist es sogar möglich basierend auf der Abweichung zwischen den beiden Werten FA+AF und FM und deren zeitlichen Verlauf, und ggf. unter Berücksichtigung anderer Messwerte wie z.B. die gemessene Auslenkung a eine (wahrscheinliche) Ursache für die Abweichung zu ermit teln. Wenn beispielsweise der direkt gemessene Kraftwert FM nicht mehr dem vom Zu standsbeobachter geschätzten Wert folgt, ist eine wahrscheinliche Ursache dafür, dass die Linearführung in der Handhabungsvorrichtung klemmt oder die Reibung stark erhöht ist. Folgt der direkt gemessene Wert FM dem geschätzten Wert FA+AF mit einer kleineren Ab weichung, kann das daraufhindeuten, dass die Reibung in dem Pneumatikzylinder (Aktor 153) oder der Linearführung (nicht dargestellt) leicht erhöht ist und eine Wartung durchge führt werden soll.

[0031] Im Folgenden werden einigen Aspekte und Merkmale der hier beschriebenen Ausführungsbeispiele zusammengefasst. Es versteht sich, dass das Folgende keine ab schließende Aufzählung, sondern lediglich eine exemplarische Zusammenfassung darstellt. Die Ausführungsbeispiele betreffen ein System und ein Verfahren zum Steuern einer Handhabungsvorrichtung mit einem ersten und einem zweiten Flansch und mit einem Li nearaktor, der zwischen dem ersten Flansch und dem zweiten Flansch wirkt. Der erste Flansch ist im Betrieb an einem Manipulator (z.B. an dessen Endeffektorflansch, vgl. Fig.

1) montiert, und an dem zweiten Flansch ist im Betrieb ein Werkzeug (oder eine Werk zeugmaschine mit einem Werkzeug) montiert. Der Linearaktor kann nach Maßgabe einer Stellgröße eine Kraft auf den zweiten Flansch ausüben, während er sich an dem ersten Flansch abstützt (vgl. Fig. 2, Flansche 101 und 102, Linearaktor 152). Im Falle eines pneu matischen Aktors (Pneumatikzylinder) ist die Stellgröße ein Luftdruck, im Falle eines elektromechanischen Aktors kann die Stellgröße der durch den Aktor fließende Strom sein.

[0032] In einem Ausführungsbeispiel ist ein Kraftsensor zwischen dem zweiten Flansch und dem Werkzeug angeordnet, sodass der Kraftsensor bei Kontakt zwischen Werkzeug und einer Oberfläche eine von der Handhabungsvorrichtung auf das Werkzeug ausgeübte Kraft FM misst. Die Kontaktkraft zwischen Werkzeug und Oberfläche entspricht einer Überlagerung der Kraft FM und der (von der Winkel Stellung abhängigen) Gewichtskraft FG, welche das Gewicht von Werkzeugmaschine und Werkzeug auf die Oberfläche ausübt.

[0033] Ohne Kontakt, hängt die Werkzeugmaschine an der Handhabungsvorrichtung und der Kraftsensor misst lediglich deren Gewichtskraft FG, während der Linearaktor (kraftge regelt) gegen einen Endanschlag drückt. In dieser Situation ist der erwähnte Kraftsensor nicht für die Kraftregelung verwendbar. Daher wird mit einem Zustandsbeobachter, der z.B. in einer Steuereinheit implementiert sein kann, basierend auf der Stellgröße (z.B. Soll druck oder Ist-Druck) ein Schätzwert für die von dem Linearaktor bereitgestellte Kraft FA+AF ermittelt. Die Steuereinheit kann auch dazu ausgebildet sein, einen Kontakt zwi schen Werkzeug und einer Oberfläche zu detektieren. Des Weiteren ist die die Steuerein heit dazu ausgebildet, die Stellgröße (z.B. Druck p) für den Linearaktor basierend auf dem Schätzwert FA+AF und einem Sollwert einzustellen, wenn kein Kontakt detektiert wird, und die Stellgröße basierend auf der gemessenen Kraft FM und dem Sollwert einzustellen, wenn (sobald uns solange) ein Kontakt detektiert wird. Das heißt, die für die Kraftregelung verwendete Kraftinformation hängt davon ab, ob ein Kontakt detektiert wird oder nicht.

[0034] Ein Beispiel des hier beschriebenen Konzepts wird im Folgenden anhand des Flussdiagrams aus Fig. 4 zusammengefasst. Fig. 4 betrifft ein Verfahren zum Steuern einer Handhabungsvorrichtung mit einem Linearaktor (siehe Fig. 2, Pneumatikzylinder 154), der zwischen einem mit einem Manipulator verbindbaren ersten Flansch (siehe Fig. 1, Flansch 102) und einem zweiten Flansch (siehe Fig. 1, Flansch 101) wirkt, an dem ein Werkzeug oder eine Werkzeugmaschine mit einem Werkzeug montierbar ist. Das Verfahren umfasst das Ansteuem des Linearaktors mit einer Stellgröße (z.B. einem Luftdruck p), sodass die ser (nach Maßgabe der Stellgröße) eine Kraft auf den zweiten Flansch (bei Kontakt zwi schen Werkzeug und Oberfläche) oder auf einen Endanschlag (bei fehlendem Kontakt) ausübt (siehe Fig. 4, Schritt Sl). Das Verfahren umfasst weiter der Detektieren eines Kon takts zwischen Werkzeug und Oberfläche (siehe Fig. 4, Schritt S2) sowie - bei Kontakt zwischen Werkzeug und Oberfläche - das Messen einer von der Handhabungsvorrichtung auf das Werkzeug ausgeübten Kraft FM mit Hilfe eines Kraftsensors, der mechanisch zwi schen dem zweiten Flansch und das Werkzeug gekoppelt ist (siehe Fig. 4, Schritt S3).

[0035] Das Verfahren umfasst weiter (mit oder ohne Kontakt zur Oberfläche) das Ermit teln eines Schätzwerts FA+AF für die von der Handhabungsvorrichtung auf das Werkzeug ausgeübte Kraft FM basierend auf der Stellgröße (siehe Fig. 4, Schritt S4). Die Stellgröße wird eingestellt basierend auf dem Schätzwert und einem Sollwert, wenn und solange kein Kontakt detektiert wird (siehe Fig. 4, Schritt S6), und basierend auf der gemessenen Kraft und dem Sollwert, wenn und solange ein Kontakt detektiert wird (siehe Fig. 4, Schritt S5). Es versteht sich, dass die in Fig. 4 gezeigten Verfahrensschritte teilweise parallel ablaufen. Die Pfeile in dem Flussdiagramm implizieren keine zwingende zeitliche Reihenfolge.

[0036] Insbesondere wird der Schritt S4 unabhängig davon ausgeführt, ob ein Kontakt detektiert wurde oder nicht. Bei fehlendem Kontakt wird der Schätzwert für die Kraft be nötigt, um die Kraft einstellen zu können, mit der der Linearaktor auf den Endanschlag drückt. Für einen sanften Kontakt sollte diese Kraft so klein wie möglich sein (idealerweise null oder einige wenige Newton). Wenn das Werkzeug die Oberfläche berührt, bewegt sich der der Aktor vom Endanschlag weg und die Kraftregelung kann dann basierend auf der direkt gemessenen Kraft FM erfolgen. Nichtsdestotrotz wird zur Validierung des Prozesses und zur Fehlererkennung auch während des Oberflächenbearbeitungsprozesses (bei Kon takt) der Schätzwert FA+AF ermittelt. Vor einem Kontakt drückt der Aktor mit einer mög lichst kleinen (Minimal-) Kraft auf den Endanschlag. Theoretisch kann diese Minimalkraft auf null Newton geregelt werden. In der Praxis werden Werte von unter 10 Newton oder sogar unter 1 Newton verwendet, um die Oberfläche sehr sanft kontaktieren zu können. Sobald ein Kontakt besteht, kann die Sollkraft mit einer definierten Rate erhöht werden, bis die gewünschte Prozesskraft (Schleifkraft) erreicht ist.

[0037] In die Ermittlung des Schätzwertes (vgl. Fig. 3, Zustandsbeobachter 160) können neben der Stellgröße (Druck im Falle eines pneumatischen Aktors) weitere Sensordaten betreffend den Zustand des Aktors und/oder der Handhabungsvorrichtung einfließen wie z.B. die Auslenkung des Aktors, welche z.B. mit einem Potentiometer oder einem indukti ven Wegsensor (displacement sensor ), der mit dem Aktor gekoppelt ist, gemessen werden kann. Die Gewichtskraft FG=m g cos(0) kann beispielsweise bei der Kraftregelung (siehe Fig. 3, Prozesssteuerung 161) berücksichtigt werden, indem beispielsweise die Gewichts kraft FG von der Sollkraft subtrahiert wird (m bezeichnet die Masse der Werkzeugmaschine samt Werkzeug, g die Erdbeschleunigung und #die Winkelabweichung von der Lotrechten (Kippwinkel, tilt)). Alternativ kann die Gewichtskraft auch bei der direkten und indirekten Kraftmessung berücksichtigt werden. Der Kippwinkel Q kann entweder gemessen werden oder aus den (verallgemeinerten) Koordinaten des TCP des Manipulators berechnet wer den. Die Robotersteuerung „kennt“ ja die Winkel Stellung des TCPs und damit auch die Winkel Stellung der Handhabungsvorrichtung und des Werkzeugs.

[0038] Gemäß einem Ausführungsbeispiel ist es auch möglich, automatisiert die Prozess validität eines Oberflächenbearbeitungsprozesses zu prüfen und am Ende des Prozesses zu bestätigen. Dazu kann beispielsweise während eines Oberflächenbearbeitungsprozesses die (mittels Kraftsensor direkt) gemessenen Kraft FM und den (vom Zustandsbeobachter ermit telten) Schätzwert FA+AF verglichen werden und eventuellen Abweichungen zwischen Messwert und Schätzwert für einen bestimmten Oberflächenbearbeitungsprozess protokol liert werden. Am Ende des Prozesses ober bereites während des Prozesses können die pro tokollierten Daten ausgewertet werden, um die die Validität des Prozesses zu überprüfen und/oder ggf. Fehler anzuzeigen. Dazu können beispielsweise basierend auf Abweichun gen zwischen direkt gemessener Kraft und Schätzwert (und ggf. weiteren Sensordaten wie z.B. die Aktorauslenkung) konkrete Fehler ermittelt werden. Wenn z.B. bei einer Erhöhung des Schätzwertes die gemessene Kraft nicht gleichermaßen ansteigt, während Kontakt mit der Oberfläche besteht, dann ist es sehr wahrscheinlich, dass eine (z.B. parallel zum Aktor angeordnete) Linearführung oder der Aktor selbst feststeckt oder zumindest die Reibung im Linearaktor oder in der Linearführung ungewöhnlich hoch ist. In diesem Fall kann beim nächsten Kontaktieren der Oberfläche ein sanfter kontakt nicht mehr garantiert werden. Zusätzlich oder alternativ können auch Abweichungen zwischen dem Kraftsollwert und der gemessenen Kraft ausgewertet werden.