#define STOP_TIMER1 ({TCCR1 = 0; TCNT1 = 1;})
-#define PWM_CYCLE 21
+#define PWM_CYCLE 14
static inline void setup_hw(void)
{
CLKPR = (1 << CLKPCE);
CLKPR = 0;
+ setpin(PIN_LED, 0);
+ setpin(PIN_TRIGGER, 0);
+ setpin(PIN_BTN, 1); /* Need pullup */
INPUT_PIN(PIN_SENSE);
INPUT_PIN(PIN_BTN);
OUTPUT_PIN(PIN_DRIVE);
OUTPUT_PIN(PIN_LED);
OUTPUT_PIN(PIN_TRIGGER);
- setpin(PIN_LED, 0);
- setpin(PIN_TRIGGER, 0);
-
- setpin(PIN_BTN, 1); /* Need pullup */
-
+
GIMSK |= _BV(PCIE); /* Enable pin change interrupt for sense port */
PCMSK |= _BV(PCINT4); /* PB4, Rail sense input */
/* Setup timer 0, used for mm_switch */
TCCR0A = 0; /* Normal mode */
TCCR0B = 2; /* Prescaler 8 */
- // TIMSK |= _BV(OCIE0A); /* Get a match interrupt */
+
TIMSK |= _BV(TOIE0);
- OCR0A = 100;
TCCR0B = 2;
-#ifdef WITH_PWM
+#ifdef WITH_PWM
/* Timer 1 as PWM */
OCR1C = PWM_CYCLE;
OCR1B = PWM_CYCLE;
setpin(PIN_TRIGGER, 0);
}
-
static inline void __attribute__((unused)) trigger_on(void)
{
setpin(PIN_TRIGGER, 1);
}
#define MM_RESETFLAG TIFR |= _BV(OVF0)
-
+//#define MM_USE_QUEUE
+#define MM_QUEUE_DEPTH 8
+#define MM_USE_CALLBACK
#ifdef USE_REGISTER_VARS
uint8_t register drive_on asm("r12");