From e4d0f37b14e57a3fcf901ab708e865fba4172f42 Mon Sep 17 00:00:00 2001
From: bsongis <bsongis@8db61ce9-5e8f-94c8-fa6b-1d1c8bcca7d0>
Date: Sun, 22 Jan 2012 11:27:25 +0000
Subject: [PATCH] DSM2 on PPM output ported to V4 board Still remaining the
 TIFR lines to clear the interrupts

---
 src/pulses.cpp | 12 ++++++++++++
 1 file changed, 12 insertions(+)

diff --git a/src/pulses.cpp b/src/pulses.cpp
index b277e635f..1be617ed9 100644
--- a/src/pulses.cpp
+++ b/src/pulses.cpp
@@ -549,9 +549,15 @@ void setupPulses()
         OCR1B = 200; // 100 uS
         TCNT1 = 300; // Past the OCR1B value
         ICR1 = 44000; // Next frame starts in 22 mS
+#if defined(PCBV3)
+        TIMSK1 &= ~0x3C; // All interrupts off
+        // TODO !!!! TIFR = 0x3C; // Clear all pending interrupts
+        TIMSK1 |= 0x28; // Enable CAPT and COMPB
+#else
         TIMSK &= ~0x3C; // All interrupts off
         TIFR = 0x3C; // Clear all pending interrupts
         TIMSK |= 0x28; // Enable CAPT and COMPB
+#endif
         TCCR1A = (0 << WGM10);
         TCCR1B = (3 << WGM12) | (2 << CS10); // CTC ICR, 16MHz / 8
         break;
@@ -567,9 +573,15 @@ void setupPulses()
         TCCR1B = 0; // Stop counter
         OCR1A = 40000; // Next frame starts in 20 mS
         TCNT1 = 0;
+#if defined(PCBV3)
+        TIMSK1 &= ~0x3C; // All interrupts off
+        // TODO !!! TIFR = 0x3C; // Clear all pending interrupts
+        TIMSK1 |= 0x10; // Enable COMPA
+#else
         TIMSK &= ~0x3C; // All interrupts off
         TIFR = 0x3C; // Clear all pending interrupts
         TIMSK |= 0x10; // Enable COMPA
+#endif
         TCCR1A = (0 << WGM10);
         TCCR1B = (1 << WGM12) | (2 << CS10); // CTC OCRA, 16MHz / 8
         break;