Fischertechnik-Modell Roboter und Förderband

Transkript

1 Berner Fachhochschule Technik und Informatik Fachbereich Elektro- und Kommunikationstechnik Labor für Technische Informatik Fischertechnik-Modell Roboter und Förderband 2007, BFH-TI, WBR1 und SCE1 Dateiname: Fischertechnik_Foerderband.doc Erstellt am: 28. April 2005 Letzte Änderung: 2. November 2007 Autoren: Roger Weber, Erwin Stucki Version: 2.0

2 Inhaltsverzeichnis 1 EINFÜHRUNG EINSATZ DES MODELLS ZIEL DIESES DOKUMENTS AUFBAU DER BEARBEITUNGSSTRASSE ÜBERSICHT A-KNOTEN UND IHRE EIGENSCHAFTEN B-KNOTEN UND IHRE EIGENSCHAFTEN Förderband Zulieferstrasse (B1) Wendeeinheit 1 (B2) Fräseinheit (B3) (Milling) Bohreinheit (B4) Wendeeinheit 2 (B5) Finalstage B ANFAHRPOSITIONEN AUFBAU DES CAN-NETZES BESCHREIBUNG DES CAN-PROTOKOLLS ÜBERSICHT AUFGABEN DER EINZELNEN KNOTEN Knoten A1 A4 (3D-Roboter) Konten B1 (Zulieferstrasse) Knoten B2 (Wendeeinheit 1) Knoten B3 (Fräseinheit) Knoten B4 (Bohreinheit) Knoten B5 (Wendeeinheit 2) Knoten B6 (Finalstage)...12 Seite 2 von 12

3 1 Einführung 1.1 Einsatz des Modells Das Fischertechnik-Modell mit einem Roboter und einem Förderband wird im Fachbereich EKT in Burgdorf für verschiedene Projektarbeiten der Technischen Informatik eingesetzt. Zur Zeit sind dies folgende Unterrichtsmodule: Vertiefungsmodul Echtzeit Betriebssysteme Wahlmodul 8-Bit-Mikrokontroller Mit Hilfe des Modells sollen die Studierenden den Modulinhalt in praktischen Arbeiten umsetzen können. 1.2 Ziel dieses Dokuments In diesem Dokument wird der Aufbau des Modells und der einzelnen Knoten detailliert beschrieben. Weiter wird das Protokoll, über welches die einzelnen Knoten mit der Steuerung kommunizieren, definiert. Die Angaben in diesem Dokument dienen als Grundlage für die softwaremässige Implementation eines CAN-Knotens oder einer übergeordneten Steuerung. Seite 3 von 12

4 2 Aufbau der Bearbeitungsstrasse 2.1 Übersicht Ein 3-Achsen-Roboter beliefert eine Bearbeitungsstrasse mit Werkstücken. In der Bearbeitungsstrasse werden die Werkstücke gefräst und gebohrt. Nach der Bearbeitung der Werkstücke werden diese vom Roboter geholt und abgelegt. A3 A4 Der Roboter ist in 4 mechanische Einheiten aufgeteilt. - (A1) Greifer - (A2) Vertikalachse - (A3) Greifarm - (A4) Drehkranz Jede dieser Einheiten wird durch einen Mikrokontroller gesteuert. A2 A1 Abbildung 1: 3-Achsen-Roboter B1 B2 B3 Die Bearbeitungsstrasse ist in 6 mechanische Einheiten aufgeteilt. - (B1) Zulieferstrasse - (B2) Wendeeinheit 1 - (B3) Frässtrasse - (B4) Bohrstrasse - (B5) Wendeeinheit 2 - (B6) Endstrasse B4 Jede dieser Einheiten wird durch einen Mikrokontroller gesteuert. B6 B5 Abbildung 2: Bearbeitungsstrasse Seite 4 von 12

5 2.2 A-Knoten und ihre Eigenschaften Die A-Knoten sind in der Anzahl und Art ihrer Sensoren und Aktoren gleich. Jeder Knoten muss einen Motor Steuern und zwei Schalter überwachen. Dabei dient jeweils ein Schalter als Endschalter und einer zur Wegmessung Greifarm Motor Endschalter Vertikalachse Endschalter Schalter Wegmessung Schalter Wegmessung Motor Motor Endschalter Motor Endschalter Schalter Wegmessung Greifer Schalter Wegmessung Drehkranz Abbildung 3: 3D-Roboter Die folgende Tabelle zeigt die Beschaltung der CAN-A-Knoten auf den Mikrokontroller-Boards: Tabelle 1: A-Knoten CPU-Port Bezeichnung Knoten A1 A4 P1.1 PWM Motor A Antrieb P1.2 PWM Motor B - P3.2 Input Sensor 2 End Switch P3.3 Input Sensor 1 Positioning Switch P4.2 Enable Motor A Enable Antrieb P4.3 Enable Motor B - P4.4 Direction Motor A Direction Antrieb ( P4_5 = 0 // to zerro ) P4.5 Direction Motor B - Die Endschalter werden verwendet um die Achsen und den Greifer zu nullen. Ist ein Enschalter betätigt, so befindet sich eine Achse in der Nullposition respektive der Greifer ist offen. Für die Wegmessung wird jeweils ein weiterer Schalter verwendet. Durch das Zählen der Betätigungen kann die Position der Achsen oder des Greifers bestimmt werden. Die anzufahrenden Achspositionen sind in Abbildung 10 angegeben. Der Greifer ist geschlossen, wenn Position 18 erreicht ist. Seite 5 von 12

6 2.3 B-Knoten und ihre Eigenschaften Förderband Zulieferstrasse (B1) Die Zulieferstrasse verfügt über einen Motor () und zwei Lichtschranken und L2. L2 Abbildung 4: Zulieferstrasse B1 CPU-Port Bezeichnung Knoten B1 P1.1 PWM Motor A - P1.2 PWM Motor B Förderband P3.2 Input Sensor 2 Lichtschranke 2 (bei Wendestation) P3.3 Input Sensor 1 Lichtschranke 1 (Anfang Förderband) P4.2 Enable Motor A - P4.3 Enable Motor B Enable Förderband P4.4 Direction Motor A - P4.5 Direction Motor B Transportrichtung ( P4_5 = 0 // forward ) Wendeeinheit 1 (B2) Die Wendeeinheit verfügt über einen Motor () und zwei Endschalter S1 und S2. S1 S2 Abbildung 5: Wendeeinheit B2 CPU-Port Bezeichnung Knoten B2 P1.1 PWM Motor A - P1.2 PWM Motor B Motor P3.2 Input Sensor 2 Schalter S2 P3.3 Input Sensor 1 Schalter S1 P4.2 Enable Motor 1 - P4.3 Enable Motor 2 Enable Motor P4.4 Direction Motor A - P4.5 Direction Motor B Transportrichtung ( P4_5 = 0 // forward ) Fräseinheit (B3) (Milling) Die Fräseinheit verfügt über zwei Motoren ( und M2) und eine Lichtschranke. M2 Abbildung 6: Fräseinheit B3 CPU-Port Bezeichnung Knoten B3 P1.1 PWM Motor A Förderband (M2) P1.2 PWM Motor B Fräser () P3.2 Input Sensor 2 - P3.3 Input Sensor 1 Lichtschranke 1 P4.2 Enable Motor A Enable Förderband P4.3 Enable Motor B Enable Milling-Machine P4.4 Direction Motor A Transportrichtung ( P4_4 = 0 // forward ) P4.5 Direction Motor B Transportrichtung ( P4_5 = 0 // forward ) Seite 6 von 12

7 2.3.4 Bohreinheit (B4) Die Bohreinheit verfügt über zwei Motoren ( und M2) und eine Lichtschranke. M2 Abbildung 7: Bohreinheit B4 CPU-Port Bezeichnung Knoten B4 P1.1 PWM Motor A Förderband () P1.2 PWM Motor B Bohrer (M2) P3.2 Input Sensor 2 - P3.3 Input Sensor 1 Lichtschranke 1 P4.2 Enable Motor A Enable Förderband P4.3 Enable Motor B Enable Bohrer P4.4 Direction Motor A Transportrichtung ( P4_4 = 0 // forward ) P4.5 Direction Motor B Transportrichtung ( P4_5 = 0 // forward ) Wendeeinheit 2 (B5) Die Wendeeinheit verfügt über einen Motor () und zwei Endschalter S1 und S2. CPU-Port Bezeichnung Knoten B5 S2 S1 P1.1 PWM Motor A - P1.2 PWM Motor B Motor P3.2 Input Sensor 2 Schalter S2 P3.3 Input Sensor 1 Schalter S1 P4.2 Enable Motor 1 - P4.3 Enable Motor 2 Enable Motor P4.4 Direction Motor A - P4.5 Direction Motor B Transportrichtung ( P4_5 = 0 // forward ) Abbildung 8: Wendeeinheit B Finalstage B6 Die Finalstage verfügt über einen Motor () und eine Lichtschranke. CPU-Port Bezeichnung Knoten B6 P1.1 PWM Motor A - P1.2 PWM Motor B Förderband P3.2 Input Sensor 2 - P3.3 Input Sensor 1 Lichtschranke 1 P4.2 Enable Motor A - P4.3 Enable Motor B Enable Förderband P4.4 Direction Motor A - P4.5 Direction Motor B Transportrichtung ( P4_5 = 0 // forward ) Abbildung 9: Finalstage B6 Seite 7 von 12

8 2.4 Anfahrpositionen Die Anfahrpositionen sind absolut zum jeweiligen Nullpunkt des Aktors (Vertikal, Greifarm, Drehkranz) angegeben. Der Nullpunkt eines Aktors ist sein Endschalter. Vertikal: 0x19 Greifarm: 0x49 Drehkranz: 0x09 Vertikal: 0x42 Greifarm: 0x2A Drehkranz: 0x1E Vertikal: 0x6C Greifarm: 0x06 Drehkranz: 0x14 Vertikal: 0x4D Greifarm: 0x44 Drehkranz: 0x35 Vertikal: 0x42 Greifarm: 0x04 Drehkranz: 0x84 Vertikal: 0x4C Greifarm: 0x3E Drehkranz: 0x60 Vertikal: 0x1A Greifarm: 0x48 Drehkranz: 0x8D Vertikal: 0x69 Greifarm: 0x45 Drehkranz: 0x79 Abbildung 10: Anfahrpositionen Seite 8 von 12

9 3 Aufbau des CAN-Netzes Alle Knoten des Roboters, der Bearbeitungsstrasse sowie die Steuerung (CARME-Kit) sind über CAN miteinander vernetzt. Der Aufbau sieht schematisch wie folgt aus: Knoten A1 Knoten A4 Knoten B1 Knoten B6 CAN CAN CAN CAN CAN CAN Steuerung CARME + µc/os CAN-Monitor Abbildung 11: Aufbau des CAN-Netzes Mit Hilfe eines CAN-Monitors kann der Datenverkehr auf dem Bus überwacht werden. Dieser Monitor erlaubt es auch, Meldungen zu Testzwecken zu verschicken. 4 Beschreibung des CAN-Protokolls 4.1 Übersicht Die Steuerung kann durch senden von definierten Kommunikationsobjekten: die Zustände der Knoten abfragen die Knoten Aufträge ausführen lassen Um die Kommunikation möglichst einfach zu gestalten wird ein proprietäres Protokoll eingesetzt: Für jeden Knoten existieren folgende Kommunikationsobjekte: Command Wird ein Commandobjekt empfangen, so wird ein vom Knoten abhängiger Auftrag ausgeführt. Status Request Der Knoten schickt auf diesen Request ein Status Response. Status Response Die Status-Rückmeldung des Knotens. Sie hängt vom jeweiligen Knoten ab. Command Ack Die Bestätigung eines Command. Command Steuerung Command Ack Status Request Status Response Knoten A / B Abbildung 12: Kommunikationsobjekte Die ID der Kommunikationsobjekte können aus der folgenden Tabelle entnommen werden: Seite 9 von 12

10 Knoten Commandobjekt Status Request Status Response Command Ack ID DB0 DB1 ID DB0 DB1 ID DB0 DB1 ID DB0 DB1 A1 (Greifer) 0x100 Speed 0xAA : öffnen 0xCC : schliessen 0x101 0x102 dont_know = 0 opened = 1 closed = 2 opening = 3 closing = 4 0x103 no_err = 0 invalid_position = 2 A2 (Vetikalachse) 0x110 Speed 0x00 : back to zero 0x?? : go to pos. 0x111 0x112 dont_know = 0 moving_up = 1 moving_down = 2 not_moving = 3 position 0x113 no_err = 0 invalid_position = 2 A3 (Greifarm) 0x120 Speed 0x00 : back to zero 0x?? : go to pos. 0x121 0x122 dont_know = 0 moving_up = 1 moving_down = 2 not_moving = 3 position 0x123 no_err = 0 invalid_position = 2 A4 (Drehkranz) 0x130 Speed 0x00 : back to zero 0x?? : go to pos. 0x131 0x132 dont_know = 0 moving_up = 1 moving_down = 2 not_moving = 3 position 0x133 no_err = 0 invalid_position = 2 B1 (Conveyor) 0x200 Speed 0x201 0x202 not_moving = 0 moving = 1 L2 Value x203 no_err = 0 no_block = 2 B2 (Conveyor) 0x210 Speed 0x211 0x212 not_moving = 0 moving = 1 Schalter keiner = 0 vorne S1 = 1 hinten S2 = 2 0x213 no_err = 0 B3 (Conveyor) 0x220 Speed Aktion Ein Station vorwärts 1 Fräsen 2 Stop fräsen 3 0x221 0x222 Not_moving = 0 moving = 1 finished_milling = 2 milling = 3 no_part = 0 part = 1 0x223 no_err = 0 invalid_action = 2 B4 (Conveyor) 0x230 Speed Aktion Ein Station vorwäts 1 Bohren 2 Stop bohren 3 0x231 0x232 Not_moving = 0 moving = 1 finished_drilling = 2 drilling = 3 no_part = 0 part = 1 0x233 no_err = 0 invalid_ action = 2 B5 (Conveyor) 0x240 Speed 0x241 0x242 not_moving = 0 moving = 1 Schalter keiner = 0 vorne S1 = 1 hinten S2 = 2 0x243 no_err = 0 B6 (Conveyor) 0x250 Speed 0x201 0x252 not_moving = 0 moving = 1 no_part = 0 part = 1 0x253 no_err = 0 Tabelle 2: Übersicht CAN-Messages Seite 10 von 12

11 4.2 Aufgaben der einzelnen Knoten Die Aufgaben der Knoten sind unterschiedlich. Im Folgenden sind die Kommunikations-Objekte der einzelnen Knoten genauer beschrieben Knoten A1 A4 (3D-Roboter) Die Command- und Status Response-Objekte der 4 Roboter-Knoten sind im wesentlichen identisch. Im Databyte 0 des Commandobjektes ist die Geschwindigkeit in Prozent [%] abgelegt. Im Databyte 1 befindet sich die auszuführende Aktion. Bei Knoten A1 bedeutet 0xAA = öffnen und 0xCC = schließen. Bei den übrigen Knoten steht im Datenbyte 1 die anzufahrende Position. 0x00 bedeutet gehe zurück zum Nullpunkt. Die Command-Acknowledge-Objekte geben an, ob der Command ausgeführt werden kann, oder ob Fehler in den Übergabeparametern vorliegen. "Timeout" als Rückgabewert bedeutet, dass die Position nach einer definierten Zeit noch nicht erreicht wurde, beispielsweise weil ein Arm des Roboters blockiert wurde. In den Status Response Objekten wird der Zustand der Knoten übermittelt. Nach dem Einschalten ist der Zustand immer "don't know" Konten B1 (Zulieferstrasse) Command: Wird ein Commandobjekt empfangen, so wird ein Klotz um eine Stufe weitertransportiert. Pos.1 Pos.2 : Förderband läuft so lange, bis der Klotz bei Pos.2 angelangt ist. Pos.2 Pos.3 : Förderband läut so lange bis ein weiterer Klotz von Pos.1 auf Pos.2 transportiert oder bis ein Timeout erreicht wurde L2 300 Abbildung 13 Position 1 Abbildung 14 Position 2 Abbildung 15 Position 3 Status Request: Die Steuerung will Informationen über den Status des Knotens B1. Status Response: Es wird der Zustand des Bandes sowie der Zustand von und L2 übermittelt Command Ack: Bestätigung ob der Command ausgeführt werden kann: Entweder ok, ungültige Geschwindigkeit oder kein Klotz vor einer Lichtschranke Knoten B2 (Wendeeinheit 1) Command: Wird ein Commandobjekt empfangen, so wird ein Klotz von Pos.1 nach Pos.2 transportiert. Die Wendeeinheit geht danach selbstständig wieder in den Ausgangszustand zurück (Pos1.) Abbildung 16 Position 1 Abbildung 17 Position 2 Status Request: Die Steuerung will Informationen über den Status des Knotens B2. Status Response: Es wird der Zustand des Bandes sowie der Zustand der Schalter S1 und S2 übermittelt. Command Ack: Bestätigung ob der Command ausgeführt werden kann: Entweder ok oder ungültige Geschwindigkeit. Seite 11 von 12

12 4.2.4 Knoten B3 (Fräseinheit) Command: Wird ein Commandobjekt empfangen, so steht im Databyte 2 die auszuführende Aktion. Action 1 Eine Station vorwärts Action 2 Fräsen Action 3 Stop Fräsen Bei Action = 1: Pos.1 Pos.2 : Förderband läuft so lange, bis der Klotz bei Pos.2 angelangt ist. Pos.2 Pos.3 : Förderband läut so lange bis bis ein Klotz von Pos.1 auf Pos.2 transportiert oder bis ein Timeout erreicht wurde. M2 Abbildung 18 Position 1 Abbildung 19 Position 2 Abbildung 20 Position 3 Status Request: Die Steuerung will Informationen über den Status des Knotens B3. Status Response: Es wird der Zustand des Bandes, der Zustand der Fräseinheit sowie der Zustand von übermittelt Command Ack: Bestätigung ob der Command ausgeführt werden kann: Entweder ok, ungültige Geschwindigkeit, ungültige Aktion oder Timeout Knoten B4 (Bohreinheit) Die Bohreinheit ist analog zur Fräseinheit zu programmieren Knoten B5 (Wendeeinheit 2) Die Wendeeinheit 2 ist analog zur Wendeeinheit 1 zu programmieren Knoten B6 (Finalstage) Command: Wird ein Commandobjekt empfangen, so wird ein Klotz um eine Stufe weitertransportiert. Pos.1 Pos.2 : Förderband läuft so lange, bis der Klotz bei Pos.2 angelangt ist. Pos.2 Pos.3 : Förderband läut so lange bis ein weiterer Klotz von Pos.1 auf Pos.2 transportiert oder bis ein Timeout erreicht wurde. Abbildung 21 Position 1 Abbildung 22 Position 2 Abbildung 23 Position 3 Status Request: Die Steuerung will Informationen über den Status des Knotens B6. Status Response: Es wird der Zustand des Bandes sowie der Zustand von übermittelt Command Ack: Bestätigung ob der Command ausgeführt werden kann: Entweder ok, ungültige Geschwindigkeit, oder Timeout. Seite 12 von 12