static uint16_t pwm[N_PWMLEDS];
static volatile unsigned char step;
-void init_pwm()
+static void enable_pll()
{
- int i;
-
- step = 0;
-
- for (i = 0; i < N_PWMLEDS; i++)
- pwm[n] = 0;
-
/* Async clock */
PLLCSR = _BV(PLLE);
/* Synchronize to the phase lock */
- _delay_ms(1);
+ _delay_us(100);
while ((PLLCSR & _BV(PLOCK)) == 0)
;
PLLCSR |= _BV(PCKE);
+}
+
+void init_pwm()
+{
+ int i;
+
+ step = 0;
+
+ for (i = 0; i < N_PWMLEDS; i++)
+ pwm[i] = 0;
+
+ enable_pll();
// PWM channel D is inverted, ...
TCCR1C = _BV(COM1D1) | _BV(COM1D0) | _BV(PWM1D);
TCCR1D = TCCR1C = TCCR1B = TCCR1A = 0;
TIMSK = 0;
TIFR = 0;
+
+ PLLCSR &= ~(_BV(PLLE) | _BV(PCKE));
}
void pwm_off(unsigned char n)
step = 0;
for (i = 0; i < N_PWMLEDS; i++)
- if (pwm[n])
- pwm_update_hw(n);
+ if (pwm[i])
+ pwm_update_hw(i);
}
#if 0