From 2c3fa4ad820c26b485da803a2de679744317ff90 Mon Sep 17 00:00:00 2001
From: Damien George <damien.p.george@gmail.com>
Date: Mon, 8 Apr 2019 14:28:45 +1000
Subject: [PATCH] stm32/i2cslave: Add support for H7 MCUs.

---
 ports/stm32/i2cslave.c |  2 +-
 ports/stm32/i2cslave.h | 10 ++++++++--
 2 files changed, 9 insertions(+), 3 deletions(-)

diff --git a/ports/stm32/i2cslave.c b/ports/stm32/i2cslave.c
index 473f0c8c5..da165294a 100644
--- a/ports/stm32/i2cslave.c
+++ b/ports/stm32/i2cslave.c
@@ -60,7 +60,7 @@ void i2c_slave_ev_irq_handler(i2c_slave_t *i2c) {
     }
 }
 
-#elif defined(STM32F7)
+#elif defined(STM32F7) || defined(STM32H7)
 
 void i2c_slave_init_helper(i2c_slave_t *i2c, int addr) {
     i2c->CR1 = I2C_CR1_STOPIE | I2C_CR1_ADDRIE | I2C_CR1_RXIE | I2C_CR1_TXIE;
diff --git a/ports/stm32/i2cslave.h b/ports/stm32/i2cslave.h
index ac35c0cc8..55882acd8 100644
--- a/ports/stm32/i2cslave.h
+++ b/ports/stm32/i2cslave.h
@@ -33,10 +33,16 @@ typedef I2C_TypeDef i2c_slave_t;
 void i2c_slave_init_helper(i2c_slave_t *i2c, int addr);
 
 static inline void i2c_slave_init(i2c_slave_t *i2c, int irqn, int irq_pri, int addr) {
-    int en_bit = RCC_APB1ENR_I2C1EN_Pos + ((uintptr_t)i2c - I2C1_BASE) / (I2C2_BASE - I2C1_BASE);
-    RCC->APB1ENR |= 1 << en_bit;
+    int i2c_idx = ((uintptr_t)i2c - I2C1_BASE) / (I2C2_BASE - I2C1_BASE);
+    #if defined(STM32F4) || defined(STM32F7)
+    RCC->APB1ENR |= 1 << (RCC_APB1ENR_I2C1EN_Pos + i2c_idx);
     volatile uint32_t tmp = RCC->APB1ENR; // Delay after enabling clock
     (void)tmp;
+    #elif defined(STM32H7)
+    RCC->APB1LENR |= 1 << (RCC_APB1LENR_I2C1EN_Pos + i2c_idx);
+    volatile uint32_t tmp = RCC->APB1LENR; // Delay after enabling clock
+    (void)tmp;
+    #endif
 
     i2c_slave_init_helper(i2c, addr);