diff --git a/source/Core/BSP/Magic/Setup.cpp b/source/Core/BSP/Magic/Setup.cpp
index 2a7bc875..0f14d5eb 100644
--- a/source/Core/BSP/Magic/Setup.cpp
+++ b/source/Core/BSP/Magic/Setup.cpp
@@ -58,7 +58,6 @@ void setup_pwm(void) {
 
   PWM_Channel_Init(&cfg);
   PWM_Channel_Disable(PWM_Channel);
-  gpio_set_mode(PWM_Out_Pin, GPIO21_FUN_PWM_CH1);
 }
 
 const ADC_Chan_Type adc_tip_pos_chans[]
diff --git a/source/Core/BSP/Magic/pinmux_config.h b/source/Core/BSP/Magic/pinmux_config.h
index 302d60bc..9fa10ec0 100644
--- a/source/Core/BSP/Magic/pinmux_config.h
+++ b/source/Core/BSP/Magic/pinmux_config.h
@@ -109,7 +109,7 @@
 
 // <q> GPIO21 <2> [GPIO_FUN_UNUSED//GPIO_FUN_I2S//GPIO_FUN_SPI//GPIO_FUN_I2C//GPIO_FUN_PWM//GPIO_FUN_CAM//GPIO_FUN_USB//GPIO_FUN_UART0_RTS//GPIO_FUN_UART1_RTS//GPIO_FUN_ETHER_MAC//GPIO_FUN_QDEC]
 // <i> config gpio21 function
-// #define CONFIG_GPIO21_FUNC GPIO21_FUN_PWM_CH1
+#define CONFIG_GPIO21_FUNC GPIO21_FUN_PWM_CH1
 
 // <q> GPIO22 <2> [GPIO_FUN_UNUSED//GPIO_FUN_I2S//GPIO_FUN_SPI//GPIO_FUN_I2C//GPIO_FUN_PWM//GPIO_FUN_CAM//GPIO_FUN_USB//GPIO_FUN_UART0_RTS//GPIO_FUN_UART1_RTS//GPIO_FUN_ETHER_MAC//GPIO_FUN_QDEC]
 // <i> config gpio22 function