diff --git a/firmware/src/bsp/board.cpp b/firmware/src/bsp/board.cpp
index 83216bc..e93755d 100644
--- a/firmware/src/bsp/board.cpp
+++ b/firmware/src/bsp/board.cpp
@@ -11,10 +11,13 @@
 void board_init(void)
 {
 	// MCU setup
+	// ADC clock  must be 50kHz to 200kHz
+	// ADC clock = 8MHz/ADC_DIV
+	// PWM frequncy = 8MHz/(2*TOP*TIM_DIM)
 	mcu::startupCfg_t mcu_cfg;
-	mcu_cfg.adc_clk = mcu::ADC_DIV2;
-	mcu_cfg.pwm_clk = mcu::TIM_DIV1;
-	mcu_cfg.pwm_top = 200;
+	mcu_cfg.adc_clk = mcu::ADC_DIV64;  //125kHz /13.5 = 9259 samples/s
+	mcu_cfg.pwm_clk = mcu::TIM_DIV1;   // 8MHz
+	mcu_cfg.pwm_top = 1000;            // 4kHz
 	mcu_cfg.pwm_ch1_en = 1;
 	
 	mcu::startup(&mcu_cfg);
diff --git a/firmware/src/main.cpp b/firmware/src/main.cpp
index a29bbfe..96aa6c5 100644
--- a/firmware/src/main.cpp
+++ b/firmware/src/main.cpp
@@ -11,7 +11,7 @@
 /**** Private definitions ****/
 /**** Private constants ****/
 static const uint16_t dsp_lock_bmode = 1000;
-static const uint16_t dsp_lock_force = 50;
+static const uint16_t dsp_lock_force = 500;
 
 /**** Private variables ****/
 static logic::CfgMemory cfg_mem = logic::CfgMemory();