drivers: flash: stm32g0: Implement set|get_rdp_level API

Allows to set readout protection bits for this series at runtime.

Signed-off-by: Martin Jäger <[email protected]>

Author: martinjaeger

drivers/flash/Kconfig.stm32

@@ -49,9 +49,12 @@ config FLASH_STM32_WRITE_PROTECT_DISABLE_PREVENTION
 
 config FLASH_STM32_READOUT_PROTECTION
 	bool "Extended operation for flash readout protection control"
-	depends on SOC_SERIES_STM32F4X || SOC_SERIES_STM32L4X || \
-			   SOC_SERIES_STM32G4X || SOC_SERIES_STM32F7X || \
-			   SOC_SERIES_STM32H7X
+	depends on SOC_SERIES_STM32F4X || \
+		   SOC_SERIES_STM32F7X || \
+		   SOC_SERIES_STM32G0X || \
+		   SOC_SERIES_STM32G4X || \
+		   SOC_SERIES_STM32H7X || \
+		   SOC_SERIES_STM32L4X
 	select FLASH_HAS_EX_OP
 	default n
 	help

drivers/flash/flash_stm32g0x.c

@@ -239,6 +239,21 @@ uint32_t flash_stm32_option_bytes_read(const struct device *dev)
 	return regs->OPTR;
 }
 
+#if defined(CONFIG_FLASH_STM32_READOUT_PROTECTION)
+uint8_t flash_stm32_get_rdp_level(const struct device *dev)
+{
+	FLASH_TypeDef *regs = FLASH_STM32_REGS(dev);
+
+	return (regs->OPTR & FLASH_OPTR_RDP_Msk) >> FLASH_OPTR_RDP_Pos;
+}
+
+void flash_stm32_set_rdp_level(const struct device *dev, uint8_t level)
+{
+	flash_stm32_option_bytes_write(dev, FLASH_OPTR_RDP_Msk,
+				       (uint32_t)level << FLASH_OPTR_RDP_Pos);
+}
+#endif /* CONFIG_FLASH_STM32_READOUT_PROTECTION */
+
 /*
  * The address space is always continuous, even though a subset of G0 SoCs has
  * two flash banks.