diff --git a/src/main/target/KISSFC/target.c b/src/main/target/KISSFC/target.c
index dc17d8729f..6382192388 100644
--- a/src/main/target/KISSFC/target.c
+++ b/src/main/target/KISSFC/target.c
@@ -32,6 +32,7 @@ const timerHardware_t timerHardware[USABLE_TIMER_CHANNEL_COUNT] = {
     DEF_TIM(TIM1, CH1, PA8,  TIM_USE_MOTOR,               TIMER_OUTPUT_ENABLED),
     DEF_TIM(TIM3, CH1, PA6,  TIM_USE_MOTOR,               TIMER_OUTPUT_ENABLED),
     DEF_TIM(TIM17,CH1, PA7,  TIM_USE_MOTOR,               TIMER_OUTPUT_ENABLED),
+    DEF_TIM(TIM16,CH1N,PA13, TIM_USE_PWM,                 TIMER_INPUT_ENABLED),
 #else
     DEF_TIM(TIM1, CH2N,PB14, TIM_USE_MOTOR,               TIMER_OUTPUT_ENABLED),
     DEF_TIM(TIM8, CH2N,PB0,  TIM_USE_MOTOR,               TIMER_OUTPUT_ENABLED),
@@ -39,10 +40,10 @@ const timerHardware_t timerHardware[USABLE_TIMER_CHANNEL_COUNT] = {
     DEF_TIM(TIM1, CH1, PA8,  TIM_USE_MOTOR,               TIMER_OUTPUT_ENABLED | TIMER_OUTPUT_INVERTED),
     DEF_TIM(TIM3, CH1, PA6,  TIM_USE_MOTOR | TIM_USE_LED, TIMER_OUTPUT_ENABLED | TIMER_OUTPUT_INVERTED),
     DEF_TIM(TIM17,CH1, PA7,  TIM_USE_MOTOR,               TIMER_OUTPUT_ENABLED | TIMER_OUTPUT_INVERTED),
+    DEF_TIM(TIM4, CH3, PA13, TIM_USE_PWM,                 TIMER_INPUT_ENABLED), // On KISSFC TIM16 did not work, using TIM4 works
 #endif
     DEF_TIM(TIM2, CH2, PB3,  TIM_USE_PWM | TIM_USE_PPM,   TIMER_INPUT_ENABLED),
     DEF_TIM(TIM2, CH1, PA15, TIM_USE_PWM,                 TIMER_INPUT_ENABLED),
     DEF_TIM(TIM2, CH3, PA2,  TIM_USE_PWM,                 TIMER_INPUT_ENABLED),
     DEF_TIM(TIM2, CH4, PB11, TIM_USE_PWM,                 TIMER_INPUT_ENABLED),
-    DEF_TIM(TIM16,CH1N,PA13, TIM_USE_PWM,                 TIMER_INPUT_ENABLED), 
 };
diff --git a/src/main/target/KISSFC/target.h b/src/main/target/KISSFC/target.h
index fe8fb50c60..81a5eade22 100644
--- a/src/main/target/KISSFC/target.h
+++ b/src/main/target/KISSFC/target.h
@@ -80,6 +80,9 @@
 
 #ifdef KISSCC
 #define SOFTSERIAL1_TX_PIN      PA13
+#else
+#define SOFTSERIAL1_TX_PIN      PA13 // AUX1
+#define SOFTSERIAL2_TX_PIN      PA15 // ROLL
 #endif
 
 #define USE_I2C