PowerPoint-µController

Werbung
Balance
Akt
Gruppe – Balance Akt
Methodisches Konstruieren – µ-Computer
Studentische Projektarbeit
2
Ziel dieser Projektarbeit ist die Lösung eines
mechatronischen Problems durch teamorientiertes
Christophe
Brenner
Sebastian
und ingenieurmäßiges
Vorgehen.
Michael
Brust
Jürgen
Luther
Marko
Feldić
Produkt
Ortlechner
Delphine
-Mengus
Präsentation
13.02.2004
Sascha
Meffert
Aufgabenstellung
Mit Hilfe eines mechatronischen Systems soll
eine Kugel auf einer ebenen Platte balanciert
werden. Anfangs ist die Platte geneigt und die
Position der Kugel auf der Platte beliebig. Die
Platte wird über Stellantriebe so geneigt, dass
die Kugel in einen fest definierten Endbereich
rollt und dort balanciert wird. Dieser Endbereich
kann vom Endbenutzer nicht variiert werden.
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Funktionsprinzip
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Teilaufgaben
Mechanik – Mechanischer Aufbau
Kamera- Sensorik & Datenverarbeitung
Regelung & Regelungselektronik
Motorenansteuerung & Leistungselektronik
Projekt – Dokumentation
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Kamera- Sensorik Übersicht
• FireWire – Kamera mit Software NEUROCHECK
•
µ - Controller
• ADDA - Wandlerkarte
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Blockschaltbild
80585-Karte
Port 0
Low-Byte-Adresse / Datum
AdressLatch
PC1
Low-Byte-Adresse
FireWire
Kabel
Eprom
ALE
80535
Port 2
J2
J3,8
High-Byte-Adresse
1394-Video
Kamera
Microcontroller
CE
OE
VAGND
VAREF
Port 1
AN
Port 6
PSEN
RAM
Port
5
Port
4
Port
3
J1
WR / P3.6
Serielle Schnittstelle
CS
OE
WE
A15
RD / P3.7
AdressLogik
J 4 ,5 ,6 ,7
RxD / P3.0
TxD / P3.1
Steckerleiste
P1.1
P1.2
P1.3
P3.2
P3.3
PC
V24T reiber
PC
P3.4
R2OUT / P1.4
T1 T2 T3 L1 L2 L3
T asten / Leuchten
Steckerleiste
Serielles Kabel
V24T reiber
T2IN / P4.7
Serielles Kabel
PC2
Serielle Schnittstelle
Istwert Lageregler (Spannungsbereich 0 – 2.55V)
Sollwert Winkelregler Y (Spannungsbereich 0 – 2.55V)
ADDA-Karte
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Struktogramm NEUROCHECK
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
NEUROCHECK
0
x
255
Systemprotokoll
Ergebnisausgabe
Prüfprogramm
Ergebnisausgabe
255
Kamerabild
Gruppe 2
y
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Datenpaket
• Beispiel:
STX
STX
Gruppe 2
+
+
2
5
3
1
1
.
.
5
1
6
2
7
3
8
4
ETX
Labor Mikrocontroller Projekt – Balance Akt
ETX
EOT
13.02.2004
Programmabläufe
•Serielle Schnittstelle auslesen
•Daten in internen Speicher schieben
•Auslesen des Speichers und Integer wandeln
•ascii2hex – Wandlung
•Einzelne Zehnerpotenzen zusammenfügen
•Im internen Speicher für die Regelung ablegen
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Haupt- Struktogramm
Assembleranweisungen
Programmbeschreibung
Initialisierung allg. Konstanten und Variablen
Initialisierung der Interuptvektoren
Initialisierung für On-Chip-Peripherie
Warteschleife, läuft bis Reset
Empfangsinterrupt ausgelöst?
Interrupt-Service-Routine INT2
Abfrage + Speicherung
Auslese
Regelung
DA- Wandlung
Programmende
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Regelung Übersicht
• PD-Regler
• Kaskadenregelung:
– Innerer Regelkreis: Winkelregelung der Platte
– Äußerer Regelkreis: Lageregelung der Kugel
• Ersetzen einer Reglerplatine :
Programmierung des Lagereglers in y- Richtung
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Blockschaltbild
u
LR‫٭‬
WR ‫٭‬
Istwert
DAWandler
Verstärker
Stell-
Strecke
x
glied
Poti
Kamera
system
Mikrocontroller
‫٭‬Lageregelung
‫٭‬Winkelregelung
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Reglerdimensionierung
Istwert
Ts
Sollwert
Ts
 RD C D
2
vorgeben
RI  0,1* RD
einstellen
Ziel:
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Regleralgorithmus
Reglerübertragungsfunktion:
GPD(s) = K*(1 + TV*s/(TF*s+1))
Diskretisierung:
uk= TF/(TF+TS)*uk-1 + K*(TS+TF+TV)/(TS+TF)*ek – K*(TF+TV)/(TF+TS)*ek-1
mit a1 = TF/(TF+TS), b0 = K*(TS+TF+TV) und b1 = K*(TF+TV)/(TF+TS)
 uk = a1*uk-1+ b0*ek- b1*ek-1
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Die Programmierung
• Programmiersprache: C oder Assembler ?
 Assembler, da Einbindung eines C-Programms
sehr kompliziert
• 8-Bit oder 16-Bit Werte ?
 16-Bit Werte, da große Werte auftauchen
können
 Programmierung entsprechender Arithmetik
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Struktogramm Regler
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Motorenansteuerung Übersicht
• Entwicklung und Umsetzung der D\A Wandlung
• Verstärkung der Steuersignale des Reglers
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Struktugramm DA Wandlung
A auf 0 setzen
Für welche Richtung muß der Sollwert des
Winkelreglers gewandelt werden?
X
X- Coor in A- speichern
Y
P4.0 selektieren (wandler DA.0)
Y- Coor in A speichern
A mit P5 wandeln
P4.1 selektieren
P4.0 setzen
A mit P5 wandeln
P4.1 setzen
RET
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Verstärker
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Platinenlayout
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Platine
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Produktpräsentation
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Dokumentation
• Projekt – Dokumentation vom Prinzip bis zur
Ausarbeitung nach VDI 2222.
• Recherchen zum Stand der Technik sowie zu
den Bauteilen
• WEB-Dokumentation für MikrocomputertechnikLabor:
• http://193.196.117.123/projekte/BalanceAkt
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
• Unser Dank gilt allen Professoren und
Mitarbeitern die uns bei dem Projekt unterstützt
haben
• Desweiteren danken wir der Firma ZF Sachs
AG und der Firma Weber- Feinmechanik
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Vielen Dank für Ihre
Aufmerksamkeit!
Gruppe 2
Labor Mikrocontroller Projekt – Balance Akt
13.02.2004
Herunterladen