Subversion Repositories BL-Ctrl

Rev

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

Rev Author Line No. Line
1 ingob 1
/*############################################################################
2
 + Regler für Brushless-Motoren
3
 + ATMEGA8 mit 8MHz
4
 + (c) 01.2007 Holger Buss
5
 + Nur für den privaten Gebrauch
6
 + Keine Garantie auf Fehlerfreiheit
7
 + Kommerzielle Nutzung nur mit meiner Zustimmung
8
 + Der Code ist für die Hardware BL_Ctrl V1.0 entwickelt worden
9
 + www.mikrocontroller.com
10
############################################################################*/
11
#include "main.h"
12
volatile unsigned int PPM_Signal = 0;
13
volatile unsigned char Timer1Overflow = 0;
50 holgerb 14
volatile unsigned char PPM_Timeout = 0, anz_ppm_werte = 0;   // Ungültig, wenn Null
1 ingob 15
 
16
//############################################################################
17
//
18
void InitPPM(void)
19
//############################################################################
20
{
21
 TCCR1B |= (1<<ICES1)|(1<<ICNC1);
22
 ICP_POS_FLANKE;
23
 ICP_INT_ENABLE;
24
 TIMER1_INT_ENABLE;
25
}
26
 
27
//############################################################################
28
//
29
SIGNAL(SIG_OVERFLOW1)
30
//############################################################################
31
{
32
 Timer1Overflow++;
33
}
34
 
35
//############################################################################
36
//
37
SIGNAL(SIG_INPUT_CAPTURE1)
38
//############################################################################
39
{
40
 static unsigned int tim_alt;
41
 static unsigned int ppm;
42
 if(TCCR1B & (1<<ICES1))   // Positive Flanke
43
  {
44
   Timer1Overflow = 0;
45
   tim_alt = ICR1;
46
   ICP_NEG_FLANKE;
47
   PPM_Timeout = 100;
48
  }
49
 else                      // Negative Flanke
50
  {
51
    ICP_POS_FLANKE;
52
#ifdef  _32KHZ 
53
    ppm = (ICR1 - tim_alt + (int) Timer1Overflow * 256) / 32;
54
#endif 
55
#ifdef  _16KHZ 
56
    ppm = (ICR1 - tim_alt + (int) Timer1Overflow * 512) / 32;
57
#endif 
58
    if(ppm < 280) ppm = 280;
59
    ppm -= 280;
60
        if(PPM_Signal < ppm)  PPM_Signal++;
61
        else if(PPM_Signal > ppm)  PPM_Signal--;
62
    if(FILTER_PPM)      ppm     = (PPM_Signal * FILTER_PPM + ppm) / (FILTER_PPM + 1);  // Filtern
63
    PPM_Signal = ppm;
50 holgerb 64
    if(anz_ppm_werte < 255) anz_ppm_werte++;
1 ingob 65
    ZeitZumAdWandeln = 1;
66
  }
67
}
68
 
69
//############################################################################
70
//
71
SIGNAL(SIG_INTERRUPT0)
72
//############################################################################
73
{
74
 CLR_INT0_FLAG;      // IntFlag Loeschen 
75
}
76