Subversion Repositories FlightCtrl

Rev

Rev 130 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 130 Rev 243
Line 9... Line 9...
9
#if defined (__AVR_ATmega644__)
9
#if defined (__AVR_ATmega644__)
10
#define SYSCLK  20000000L       //Quarz Frequenz in Hz
10
#define SYSCLK  20000000L       //Quarz Frequenz in Hz
11
//#define SYSCLK        16000000L       //Quarz Frequenz in Hz
11
//#define SYSCLK        16000000L       //Quarz Frequenz in Hz
12
#endif
12
#endif
Line 13... Line -...
13
 
-
 
14
 
13
 
15
// neue Hardware
14
// neue Hardware
16
#define ROT_OFF   PORTB &=~0x01 
15
#define ROT_OFF   {if(PlatinenVersion == 10) PORTB &=~0x01; else  PORTB |= 0x01;}
17
#define ROT_ON    PORTB |= 0x01 
16
#define ROT_ON    {if(PlatinenVersion == 10) PORTB |= 0x01; else  PORTB &=~0x01;}
18
#define ROT_FLASH PORTB ^= 0x01
17
#define ROT_FLASH PORTB ^= 0x01
19
#define GRN_OFF   PORTB &=~0x02 
18
#define GRN_OFF   PORTB &=~0x02 
20
#define GRN_ON    PORTB |= 0x02 
19
#define GRN_ON    PORTB |= 0x02 
Line 21... Line 20...
21
#define GRN_FLASH PORTD ^= 0x02
20
#define GRN_FLASH PORTB ^= 0x02
22
 
21
 
23
//#ifndef F_CPU
22
//#ifndef F_CPU
Line 28... Line 27...
28
 
27
 
Line 29... Line 28...
29
//#define ANZ_MITTELWERT   4
28
//#define ANZ_MITTELWERT   4
30
 
29
 
-
 
30
#define EEPROM_ADR_VALID            1
Line 31... Line 31...
31
#define EEPROM_ADR_VALID            1
31
#define EEPROM_ADR_ACTIVE_SET       2
Line 32... Line 32...
32
#define EEPROM_ADR_ACTIVE_SET       2
32
#define EEPROM_ADR_LAST_OFFSET      3
33
 
33
 
34
#define EEPROM_ADR_PARAM_BEGIN      100
34
#define EEPROM_ADR_PARAM_BEGIN      100
35
 
35
 
36
#define CFG_HOEHENREGELUNG  0x01
36
#define CFG_HOEHENREGELUNG  0x01
37
#define CFG_HOEHEN_SCHALTER 0x02
37
#define CFG_HOEHEN_SCHALTER 0x02
Line -... Line 38...
-
 
38
#define CFG_HEADING_HOLD    0x04
-
 
39
#define CFG_KOMPASS_AKTIV   0x08
-
 
40
#define CFG_KOMPASS_FIX     0x10
-
 
41
#define CFG_GPS_AKTIV       0x20
-
 
42
 
-
 
43
#define CFG_LOOP_OBEN       0x01
-
 
44
#define CFG_LOOP_UNTEN      0x02
-
 
45
#define CFG_LOOP_LINKS      0x04
-
 
46
#define CFG_LOOP_RECHTS     0x08
-
 
47
 
-
 
48
long durchschnitt_x;
-
 
49
long durchschnitt_y;
-
 
50
long durchschnitt_z;
-
 
51
 
-
 
52
int gps_h_d1;
-
 
53
int gps_h_d2;
-
 
54
 
-
 
55
long target_x, target_y, target_z;
-
 
56
 
-
 
57
volatile int  gps_error;
-
 
58
volatile int  gps_getpos;
-
 
59
 
-
 
60
volatile int gps_p;                     //P-Anteil
-
 
61
volatile int gps_d;                     //D-Anteil 
-
 
62
volatile int gps_acc;         //Acc-Anteil
-
 
63
 
-
 
64
int sticks_centered;
-
 
65
int stick_time;
-
 
66
 
-
 
67
long gps_home_x;
-
 
68
long gps_home_y;
-
 
69
long home_height;
-
 
70
 
-
 
71
int homing_state;
-
 
72
 
-
 
73
int way, way1, wayn, way2;
-
 
74
 
-
 
75
volatile int gpsmax;
Line 38... Line 76...
38
#define CFG_HEADING_HOLD    0x04
76
 
39
#define CFG_KOMPASS_AKTIV   0x08
77
volatile int komp_dreh;         // verdrehten Kompasseinbau kompensieren (+/-Grad)
40
#define CFG_KOMPASS_FIX     0x10
78
volatile int gps_new;
41
#define CFG_GPS_AKTIV       0x20
79
volatile int skal;                      //Skalierungsfaktor der Regelung (alter Wert: 10) (20)
42
 
80
volatile int  gps_gethome;
-
 
81
 
Line 43... Line 82...
43
 
82
//#define  SYSCLK  
44
//#define  SYSCLK  
83
//extern unsigned long SYSCLK;
45
//extern unsigned long SYSCLK;
84
extern volatile int i_Nick[20],i_Roll[20],DiffNick,DiffRoll;
46
extern volatile int i_Nick[20],i_Roll[20],DiffNick,DiffRoll;
85
extern volatile unsigned char SenderOkay;
Line 47... Line -...
47
extern volatile unsigned char SenderOkay;
-
 
48
extern unsigned char CosinusNickWinkel, CosinusRollWinkel;
-
 
49
 
-
 
50
extern void ReadParameterSet (unsigned char number, unsigned char *buffer, unsigned char length);
-
 
51
extern void WriteParameterSet(unsigned char number, unsigned char *buffer, unsigned char length);
-
 
52
extern unsigned char GetActiveParamSetNumber(void);
-
 
53
extern unsigned char EEPromArray[];
-
 
54
 
-
 
55
long durchschnitt_northing;
-
 
56
long durchschnitt_easting;
86
extern unsigned char CosinusNickWinkel, CosinusRollWinkel;
57
 
87
extern unsigned char PlatinenVersion;
58
volatile int gps_p;                     //P-Anteil (10)
88
 
59
volatile int gps_d;                     //D-Anteil (4)
89
extern void ReadParameterSet (unsigned char number, unsigned char *buffer, unsigned char length);
60
volatile int skal;                      //Skalierungsfaktor der Regelung (alter Wert: 10) (20)
90
extern void WriteParameterSet(unsigned char number, unsigned char *buffer, unsigned char length);
Line 70... Line 100...
70
#include <avr/boot.h>
100
#include <avr/boot.h>
71
#include <avr/wdt.h>
101
#include <avr/wdt.h>
Line 72... Line 102...
72
 
102
 
Line 73... Line 103...
73
#include "old_macros.h"
103
#include "old_macros.h"
74
 
104
 
75
#include "_Settings.h"
105
#include "_settings.h"
76
#include "printf_P.h"
106
#include "printf_P.h"
77
#include "timer0.h"
107
#include "timer0.h"
78
#include "uart.h"
108
#include "uart.h"