Subversion Repositories FlightCtrl

Compare Revisions

Ignore whitespace Rev 370 → Rev 371

/branches/v0.60_MicroMag3_Nick666/trunc/compass.c
23,7 → 23,7
 
//############################################################################
// Initialisierung
void MM3_init(void)
void init_MM3(void)
//############################################################################
{
SPCR = (1<<SPIE)|(1<<SPE)|(1<<MSTR)|(1<<SPR1)|(1<<SPR0); //Interrupt an, Master, 156 kHz Oszillator
43,7 → 43,7
 
//############################################################################
// Wird in der SIGNAL (SIG_OVERFLOW0) aufgerufen
void MM3_timer0(void)
void timer0_MM3(void)
//############################################################################
{
switch (MM3.STATE)
193,7 → 193,7
 
//############################################################################
// Neigungskompensierung und Berechnung der Ausrichtung
signed int MM3_heading(void)
signed int heading_MM3(void)
//############################################################################
{
float sin_nick, cos_nick, sin_roll, cos_roll;
/branches/v0.60_MicroMag3_Nick666/trunc/compass.h
26,10 → 26,10
extern MM3_working_struct MM3;
extern MM3_calib_struct MM3_calib;
 
void MM3_init(void);
void MM3_timer0(void);
void init_MM3(void);
void timer0_MM3(void);
void calib_MM3(void);
signed int MM3_heading(void);
signed int heading_MM3(void);
 
#define Max_Axis_Value 500
 
/branches/v0.60_MicroMag3_Nick666/trunc/fc.c
687,8 → 687,7
DebugOut.Analog[6] = (Mess_Integral_Hoch / 512);
DebugOut.Analog[7] = GasMischanteil;
DebugOut.Analog[8] = KompassValue;
//DebugOut.Analog[8] = MM3_heading();
 
DebugOut.Analog[9] = MM3.x_axis;
DebugOut.Analog[10] = MM3.y_axis;
DebugOut.Analog[11] = MM3.z_axis;
/branches/v0.60_MicroMag3_Nick666/trunc/main.c
114,7 → 114,7
ADC_Init();
i2c_init();
MM3_init();
init_MM3();
sei();
 
/branches/v0.60_MicroMag3_Nick666/trunc/timer0.c
44,11 → 44,11
 
if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV)
{
MM3_timer0(); // Kompass auslesen
timer0_MM3(); // Kompass auslesen
 
if (!cntKompass--) // Aufruf mit 10 Hz
{
KompassValue = MM3_heading();
KompassValue = heading_MM3();
KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
cntKompass = 800;
}