diff --git a/Multiprotocol/Multiprotocol.ino b/Multiprotocol/Multiprotocol.ino
index f3b17ad..47ee684 100644
--- a/Multiprotocol/Multiprotocol.ino
+++ b/Multiprotocol/Multiprotocol.ino
@@ -336,8 +336,7 @@ void loop()
 		#if defined STM32_board
 		if((TIMER2_BASE->SR & TIMER_SR_CC1IF)!=0){
 			cli();
-			OCR1A = TIMER2_BASE->CNT;
-			TIMER2_BASE->CCR1=OCR1A; 
+			OCR1A = TCNT1;
 			sei();
 		}
 		else