From dc3ac2b424dc2f915f825227ac941ab1b982ed21 Mon Sep 17 00:00:00 2001
From: Kevin O'Connor <kevin@koconnor.net>
Date: Sat, 18 Dec 2021 20:54:11 -0500
Subject: [PATCH] stm32: Enable optimized gpio_clock_enable() function on
 stm32h7

Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
---
 src/stm32/stm32h7.c | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/src/stm32/stm32h7.c b/src/stm32/stm32h7.c
index cd5ed0c6..4edab5f0 100644
--- a/src/stm32/stm32h7.c
+++ b/src/stm32/stm32h7.c
@@ -100,7 +100,9 @@ get_pclock_frequency(uint32_t periph_base)
 void
 gpio_clock_enable(GPIO_TypeDef *regs)
 {
-    enable_pclock((uint32_t)regs);
+    uint32_t pos = ((uint32_t)regs - D3_APB1PERIPH_BASE) / 0x400;
+    RCC->APB4ENR |= (1<<pos);
+    RCC->APB4ENR;
 }
 
 #if !CONFIG_STM32_CLOCK_REF_INTERNAL