blob: ff00f42a3093c69426b53fee073aae57652e180c (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
|
#include "ppmsum.h"
#include "rcc.h"
PPMSum* PPMSum::self = 0;
template<>
void interrupt<Interrupt::TIM1_UP>() {
PPMSum::self->irq();
}
template<>
void interrupt<Interrupt::TIM1_CC>() {
PPMSum::self->irq();
}
void PPMSum::irq() {
int16_t sr = TIM1.SR;
TIM1.SR = 0;
if(sr & 0x01) {
// Timeout.
synced = false;
} else if(sr & 0x02) {
// Period.
if(TIM1.CCR1 > 5000) {
synced = true;
index = 0;
} else {
index++;
index &= 0xf;
}
} else if(sr & 0x04) {
// Pulsewidth.
channels[index] = TIM1.CCR2;
}
}
void PPMSum::enable() {
RCC.enable(RCC.TIM1);
TIM1.PSC = 72;
TIM1.CCMR1 = 0x0201;
TIM1.SMCR = 0x54;
TIM1.CCER = 0x31;
TIM1.DIER = 0x07;
Interrupt::enable(Interrupt::TIM1_UP);
Interrupt::enable(Interrupt::TIM1_CC);
TIM1.CR1 = 0x05;
}
|
