X-Git-Url: https://www.fi.muni.cz/~kas/git//home/kas/public_html/git/?p=tinyboard.git;a=blobdiff_plain;f=projects%2Fstep-up%2Fpwm.c;fp=projects%2Fstep-up%2Fpwm.c;h=42ed777357eba68b6d8853e28c92891bd5298e06;hp=e3b477c26b34345e4316c5e846796fbd8f11b313;hb=522bd7b320a209dc11f0e50066fac6ec9978c25f;hpb=ab58f34d1b6778af9010d33ee1f5194d6861c4c2

diff --git a/projects/step-up/pwm.c b/projects/step-up/pwm.c
index e3b477c..42ed777 100644
--- a/projects/step-up/pwm.c
+++ b/projects/step-up/pwm.c
@@ -11,10 +11,12 @@
  * Counts from 0 to 0xFF, without OCR1C compare.
  */
 
+static unsigned char pwm_enabled;
+
 static void inline enable_pll()
 {
 	/* Async clock */
-	PLLCSR = _BV(PLLE);
+	PLLCSR = _BV(PLLE) | _BV(LSM);
 
 	/* Synchronize to the phase lock */
 	_delay_us(100);
@@ -25,17 +27,16 @@ static void inline enable_pll()
 
 void init_pwm()
 {
+	pwm_enabled = 0;
 	power_timer1_enable();
 
-	enable_pll();
-
-	TCCR1 = _BV(CTC1) | _BV(CS10);	// no clock prescaling
+	TCCR1 = _BV(CTC1) | _BV(CS11);	// pll_clk/2
 	GTCCR = _BV(COM1B1) | _BV(PWM1B);
 
 	OCR1C = PWM_MAX;
 	OCR1B = 0;		// initial stride is 0
 
-	DDRB  &= ~_BV(PB4); // tristate it
+	DDRB &= ~(_BV( PB4 ));
 	PORTB &= ~_BV(PB4); // set to zero
 }
 
@@ -54,10 +55,18 @@ void pwm_off()
 {
 	OCR1B = 0;
 	DDRB &= ~_BV(PB4);
+
+	PLLCSR &= ~(_BV(PLLE) | _BV(PCKE));
+	pwm_enabled = 0;
 }
 
 void pwm_set(uint8_t stride)
 {
 	OCR1B = stride;
-	DDRB |= _BV(PB4);
+
+	if (!pwm_enabled) {
+		enable_pll();
+		DDRB |= _BV(PB4);
+		pwm_enabled = 1;
+	}
 }