Subversion Repositories FlightCtrl

Rev

Rev 182 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
161 salvo 1 
*********************************************************************
184 salvo 2 
GPS Implementierung von Peter Muehlenbrock ("Salvo") fürMikrokopter/FlightCrtl
3 
Stand 29.9.2007
161 salvo 4 
Verwendung der SW ohne Gewaehr. Siehe auch die Lizenzbedingungen in den Files gps.c, math.c
5 
*********************************************************************
6 
 
7 
Hardware-Voraussetzungen:
8 
Kalibrierter Kompass vom Typ CMPS03, waagrecht eingebaut
184 salvo 9 
GPS Modul vom Typ ublox, Die Meldungungen "NAV_STATUS", "NAV_POSUTM" und "NAV_VELED"
182 salvo 10 
mussen mit 4 HZ Updaterate aktiviert sein. Anschluss an RX Port der FlightCRtl.
161 salvo 11 
 
12 
Software-Voraussetzungen:
184 salvo 13 
in fc.h müsen die Neutralwerte ACC_X_NEUTRAL und ACC_Y_NEUTRAL
161 salvo 14 
eingetragen werden. Hierzu den Kopter waagrecht ausrichten (Wasserwaage) und mit dem Mikrokoptertool
15 
die Neutralwerte ermitteln.
16 
In timer0.h muess die Ausrichtung des Kompasses bezogen auf die Nordachse des Kopters
182 salvo 17 
eingetragen sein. KOMPASS_OFFSET legt diesen Wert fest.
161 salvo 18 
 
19 
Hexfiles:
20 
Ich habe bewußt keinen Hexfile generiert, da die Neutralwerte spezifisch je Kopter sind.
21 
Die SW muß also individuell compiliert werden und der Hexfile in die FlightCrtl eingebaut werden.
184 salvo 22 
Der Lohn für die Muehe ist eine sehr driftarme Fluglageregelung sowie eine von der Startausrichtung
23 
unabhängige waagrechte Lage in der Luft.
161 salvo 24 
Alle Einstellungen beziehen sich auf AVR Studio von Atmel und den WIN_AVR Compiler.
25 
 
26 
Parametrierung:
184 salvo 27 
Der GPS Hold Regler ist ein PID Regler, der ueber die UserParameter1(P), 2(I) und D(3) gesteuert wird.
28 
UserParameter1 beschreibt den P-Anteil, UserParameter2 den I-Anteil und UserParameter3 den D-Anteil.
29 
Hier kann und muss gespielt werden. Wenn alle 0 sind, ist der Regler deaktiviert.
30 
Standardwerte sind 8 für den P-Anteil, 1 für den I-Anteil und 18 für den D-Anteil.
161 salvo 31 
 
32 
Voraussetzungen für GPS_Hold:
184 salvo 33 
Neben den genannten HW und SW Voraussetzungen muß beim Kalibrieren das GPS MOdul bereits Positionsdaten liefern.
34 
Nur dann wird die Home Position abgespeichert und nur dann wird GPS_Hold aktiviert.
35 
Kenntlich gemacht wird dies durch einen etwas längeren Piepser nach dem Kalibrieren.
167 salvo 36 
Das GPS Aktiv Flag im Setting muss aktiviert sein. Eine Ausrichtung des Kopters nach Nord etc. ist nicht erforderlich.
161 salvo 37 
 
38 
Aktivierung GPS_Hold im Flug:
39 
Wenn alle genannten Voraussetzungen erfüllt sind, wird GPS Hold im Flug automatisch aktiviert, sobald der Nick und Roll Stick
184 salvo 40 
fürca. 500msec in Neutrallage sind. Weicht einer der Sticks davon ab (Parameter GPS_STICK_HOLDOFF) oder liefert das GPS Modul keine
182 salvo 41 
gueltigen Daten mehr wird GPS_Hold sofort deaktiviert.
161 salvo 42 
Damit kann jederzeit die manuelle Kontrolle wieder übernommen werden.
43 
 
44 
GPS_Hold regelt nur horizontale Abweichungen, keine Hoehe.
184 salvo 45 
Der Magnetkompass wird nur in waagrechter Lage dazu benutzt einen internen aus dem Giergyro ermittelten "Ersatz"kompasswert
46 
nach zu kalibrieren. Daher funktioniert die Bstimmung der Kopterausrichtung in jeder Lebenslage, sofern nur ab und zu
47 
der Magnetkompass in die waagrechte Lage kommt.
48 
Ein 3D Kompass ist damit überflüssig.
161 salvo 49 
 
50 
Bekannte Maengel:
184 salvo 51 
Leichte Schwingneigung, bei längerer Neigung weicht der Ersatzkompass ab.
52 
PID Regler muss noch besser parametriert werden.
161 salvo 53 
 
54 
 
55 
 
56 
 
57 
 
58 
 
59 
 
60 
 
61 
 
62 
 
63