diff --git a/radio/src/targets/stock/board_stock.cpp b/radio/src/targets/stock/board_stock.cpp
index 919b2858c..6ff848a10 100644
--- a/radio/src/targets/stock/board_stock.cpp
+++ b/radio/src/targets/stock/board_stock.cpp
@@ -131,15 +131,18 @@ inline void boardInit()
 #elif defined(PWM_BACKLIGHT)
   /** Smartieparts LED Backlight is connected to PORTB/pin7, which can be used as pwm output of timer2 **/
   #if defined(CPUM2561)
-    TCCR0A = (1<<WGM00)|(1<<COM0A0);
-    TCCR0B = (0b111<<CS00);
-    DDRB |= (1<<DDB7);
-  #elif defined(SP22)
-    TCCR2  = (0b011<<CS20)|(1<<WGM20)|(1<<COM21)|(1<<COM20); // inv. pwm mode, clk/64
+    #if defined(SP22)
+      TCCR0A = (1<<WGM00)|(1<<COM0A1)|(1<<COM0A0); // inv. pwm mode, clk/64
+    #else
+      TCCR0A = (1<<WGM00)|(1<<COM0A1); // pwm mode, clk/64
+    #endif
+    TCCR0B = (0b011<<CS00);
   #else
-    TCCR2  = (0b011<<CS20)|(1<<WGM20)|(1<<COM21); // pwm mode, clk/64
-  #endif
-  #if !defined(CPUM2561)
+    #if defined(SP22)
+      TCCR2  = (0b011<<CS20)|(1<<WGM20)|(1<<COM21)|(1<<COM20); // inv. pwm mode, clk/64
+    #else
+      TCCR2  = (0b011<<CS20)|(1<<WGM20)|(1<<COM21); // pwm mode, clk/64
+    #endif
     TIMSK |= (1<<OCIE0) | (1<<TOIE0); // Enable Output-Compare and Overflow interrrupts
   #endif
 #else