From c1136bef10f43b2c69400af38c4404e2d20e9180 Mon Sep 17 00:00:00 2001
From: D4SK <konstantin.vogel@gmx.net>
Date: Sat, 5 Jun 2021 22:52:14 +0100
Subject: [PATCH] stm32: Add hardware pwm for stm32h7

Signed-off-by: Konstantin Vogel <konstantin.vogel@gmx.net>
Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
---
 src/stm32/Kconfig    |  1 +
 src/stm32/hard_pwm.c | 49 +++++++++++++++++++++++++++++++++++++++++++-
 2 files changed, 49 insertions(+), 1 deletion(-)

diff --git a/src/stm32/Kconfig b/src/stm32/Kconfig
index b500f06c..68adab7d 100644
--- a/src/stm32/Kconfig
+++ b/src/stm32/Kconfig
@@ -61,6 +61,7 @@ choice
     config MACH_STM32H750
         bool "STM32H750"
         select MACH_STM32H7
+        select HAVE_GPIO_HARD_PWM
 endchoice
 
 config MACH_STM32F0
diff --git a/src/stm32/hard_pwm.c b/src/stm32/hard_pwm.c
index 8367fb05..d61ba5ce 100644
--- a/src/stm32/hard_pwm.c
+++ b/src/stm32/hard_pwm.c
@@ -4,6 +4,7 @@
 //
 // This file may be distributed under the terms of the GNU GPLv3 license.
 
+#include "autoconf.h" // CONFIG_MACH_STM32H7
 #include "board/irq.h" // irq_save
 #include "command.h" // shutdown
 #include "gpio.h" // gpio_pwm_write
@@ -19,6 +20,49 @@ struct gpio_pwm_info {
 };
 
 static const struct gpio_pwm_info pwm_regs[] = {
+#if CONFIG_MACH_STM32H7
+    {TIM2, GPIO('A', 0),  1, GPIO_FUNCTION(1)},
+    {TIM2, GPIO('A', 5),  1, GPIO_FUNCTION(1)},
+    {TIM2, GPIO('A', 15), 1, GPIO_FUNCTION(1)},
+    {TIM2, GPIO('B', 3),  2, GPIO_FUNCTION(1)},
+    {TIM2, GPIO('A', 1),  2, GPIO_FUNCTION(1)},
+    {TIM2, GPIO('B', 10), 3, GPIO_FUNCTION(1)},
+    {TIM2, GPIO('A', 2),  3, GPIO_FUNCTION(1)},
+    {TIM3, GPIO('C', 6),  1, GPIO_FUNCTION(2)},
+    {TIM3, GPIO('B', 4),  1, GPIO_FUNCTION(2)},
+    {TIM3, GPIO('A', 6),  1, GPIO_FUNCTION(2)},
+    {TIM3, GPIO('C', 7),  2, GPIO_FUNCTION(2)},
+    {TIM3, GPIO('B', 5),  2, GPIO_FUNCTION(2)},
+    {TIM3, GPIO('A', 7),  2, GPIO_FUNCTION(2)},
+    {TIM3, GPIO('C', 8),  3, GPIO_FUNCTION(2)},
+    {TIM3, GPIO('B', 0),  3, GPIO_FUNCTION(2)},
+    {TIM4, GPIO('D', 12), 1, GPIO_FUNCTION(2)},
+    {TIM4, GPIO('B', 6),  1, GPIO_FUNCTION(2)},
+    {TIM4, GPIO('D', 13), 2, GPIO_FUNCTION(2)},
+    {TIM4, GPIO('B', 7),  2, GPIO_FUNCTION(2)},
+    {TIM4, GPIO('D', 14), 3, GPIO_FUNCTION(2)},
+    {TIM4, GPIO('B', 8),  3, GPIO_FUNCTION(2)},
+    {TIM5, GPIO('H', 10), 1, GPIO_FUNCTION(2)},
+    {TIM5, GPIO('A', 0),  1, GPIO_FUNCTION(2)},
+    {TIM5, GPIO('H', 11), 2, GPIO_FUNCTION(2)},
+    {TIM5, GPIO('A', 1),  2, GPIO_FUNCTION(2)},
+    {TIM5, GPIO('H', 12), 3, GPIO_FUNCTION(2)},
+    {TIM5, GPIO('A', 2),  3, GPIO_FUNCTION(2)},
+    {TIM12, GPIO('H', 6),  1, GPIO_FUNCTION(2)},
+    {TIM12, GPIO('B', 14), 1, GPIO_FUNCTION(2)},
+    {TIM12, GPIO('H', 9),  2, GPIO_FUNCTION(2)},
+    {TIM12, GPIO('B', 15), 2, GPIO_FUNCTION(2)},
+    {TIM13, GPIO('F', 8),  1, GPIO_FUNCTION(9)},
+    {TIM13, GPIO('A', 6),  1, GPIO_FUNCTION(9)},
+    {TIM14, GPIO('F', 9),  1, GPIO_FUNCTION(9)},
+    {TIM14, GPIO('A', 7),  1, GPIO_FUNCTION(9)},
+    {TIM15, GPIO('E', 5),  1, GPIO_FUNCTION(4)},
+    {TIM15, GPIO('A', 2),  1, GPIO_FUNCTION(4)},
+    {TIM16, GPIO('F', 6),  1, GPIO_FUNCTION(1)},
+    {TIM16, GPIO('B', 8),  1, GPIO_FUNCTION(1)},
+    {TIM17, GPIO('F', 7),  1, GPIO_FUNCTION(1)},
+    {TIM17, GPIO('B', 9),  1, GPIO_FUNCTION(1)}
+#else
     {TIM2, GPIO('A', 0),  1, GPIO_FUNCTION(2)},
     {TIM2, GPIO('A', 1),  2, GPIO_FUNCTION(2)},
     {TIM2, GPIO('A', 2),  3, GPIO_FUNCTION(2)},
@@ -43,6 +87,7 @@ static const struct gpio_pwm_info pwm_regs[] = {
     {TIM4, GPIO('B', 7),  2, GPIO_FUNCTION(2)},
     {TIM4, GPIO('B', 8),  3, GPIO_FUNCTION(2)},
     {TIM4, GPIO('B', 9),  4, GPIO_FUNCTION(2)}
+#endif
 };
 
 struct gpio_pwm
@@ -132,7 +177,9 @@ gpio_pwm_setup(uint8_t pin, uint32_t cycle_time, uint8_t val){
     }
     // Enable PWM output
     p->timer->CR1 |= TIM_CR1_CEN;
-
+#if CONFIG_MACH_STM32H7
+    p->timer->BDTR |= TIM_BDTR_MOE;
+#endif
     return channel;
 }