From e16750ff0e435bc7a41954f27607c663f27857bc Mon Sep 17 00:00:00 2001
From: Patrick Delaunay <patrick.delaunay@st.com>
Date: Tue, 20 Mar 2018 11:45:14 +0100
Subject: [PATCH] stm32mp: add syscon for STGEN

Add STGEN as SYSCON device: allow access to device address
defined in device tree

Signed-off-by: Patrick Delaunay <patrick.delaunay@st.com>
---
 arch/arm/dts/stm32mp157-u-boot.dtsi        |  7 +++++++
 arch/arm/mach-stm32mp/Makefile             |  1 +
 arch/arm/mach-stm32mp/include/mach/stm32.h |  5 +++++
 arch/arm/mach-stm32mp/syscon.c             | 23 +++++++++++++++++++++++
 4 files changed, 36 insertions(+)
 create mode 100644 arch/arm/mach-stm32mp/syscon.c

diff --git a/arch/arm/dts/stm32mp157-u-boot.dtsi b/arch/arm/dts/stm32mp157-u-boot.dtsi
index d374b2b..7a9a4ce 100644
--- a/arch/arm/dts/stm32mp157-u-boot.dtsi
+++ b/arch/arm/dts/stm32mp157-u-boot.dtsi
@@ -31,6 +31,13 @@
 	soc {
 		u-boot,dm-pre-reloc;
 	};
+
+	stgen: stgen@5C008000 {
+		compatible = "st,stm32-stgen";
+		reg = <0x5C008000 0x1000>;
+		status = "okay";
+		u-boot,dm-pre-reloc;
+	};
 };
 
 &clk_hsi {
diff --git a/arch/arm/mach-stm32mp/Makefile b/arch/arm/mach-stm32mp/Makefile
index 4620869..a495c53 100644
--- a/arch/arm/mach-stm32mp/Makefile
+++ b/arch/arm/mach-stm32mp/Makefile
@@ -6,5 +6,6 @@
 
 obj-y += cpu.o
 obj-y += dram_init.o
+obj-y += syscon.o
 
 obj-$(CONFIG_SPL_BUILD) += spl.o
diff --git a/arch/arm/mach-stm32mp/include/mach/stm32.h b/arch/arm/mach-stm32mp/include/mach/stm32.h
index 40faeb0..c7a2789 100644
--- a/arch/arm/mach-stm32mp/include/mach/stm32.h
+++ b/arch/arm/mach-stm32mp/include/mach/stm32.h
@@ -25,6 +25,11 @@
 #define STM32_DDR_SIZE			SZ_1G
 
 #ifndef __ASSEMBLY__
+/* enumerated used to identify the SYSCON driver instance */
+enum {
+	STM32MP_SYSCON_UNKNOWN,
+	STM32MP_SYSCON_STGEN,
+};
 
 /*
  * enumerated for boot interface from Bootrom, used in TAMP_BOOT_CONTEXT
diff --git a/arch/arm/mach-stm32mp/syscon.c b/arch/arm/mach-stm32mp/syscon.c
new file mode 100644
index 0000000..5641745
--- /dev/null
+++ b/arch/arm/mach-stm32mp/syscon.c
@@ -0,0 +1,23 @@
+/*
+ * Copyright (C) 2018, STMicroelectronics - All Rights Reserved
+ *
+ * SPDX-License-Identifier:	GPL-2.0+	BSD-3-Clause
+ */
+
+#include <common.h>
+#include <dm.h>
+#include <syscon.h>
+#include <asm/arch/stm32.h>
+
+static const struct udevice_id stm32mp_syscon_ids[] = {
+	{ .compatible = "st,stm32-stgen",
+	  .data = STM32MP_SYSCON_STGEN },
+	{ }
+};
+
+U_BOOT_DRIVER(syscon_stm32mp) = {
+	.name = "stmp32mp_syscon",
+	.id = UCLASS_SYSCON,
+	.of_match = stm32mp_syscon_ids,
+	.bind = dm_scan_fdt_dev,
+};
-- 
2.7.4