broadcom/cygnus: add specific controller initialization to coreboot

BUG=chrome-os-partner:37533,chrome-os-partner:35814
BRANCH=broadcom-firmware
TEST=bootblock initialize Cygnus HW successfully

Change-Id: I93b97d7b26f6bacd8fab3d6bc52ec52e92e91a43
Signed-off-by: Patrick Georgi <pgeorgi@chromium.org>
Original-Commit-Id: 8679570c6607ed6964f46df618fe8d0d22fcb2c0
Original-Reviewed-on: https://chrome-internal-review.googlesource.com/211695
Original-Tested-by: Corneliu Doban <cdoban@broadcom.com>
Original-Reviewed-by: Daisuke Nojiri <dnojiri@google.com>
Original-Reviewed-by: Scott Branden <sbranden@broadcom.com>
Original-Commit-Queue: Corneliu Doban <cdoban@broadcom.com>
Original-Signed-off-by: Corneliu Doban <cdoban@broadcom.com>
Original-Change-Id: I62d354bce71aba8d5074f5385616a1265bd604df
Original-Reviewed-on: https://chromium-review.googlesource.com/265861
Original-Reviewed-by: Daisuke Nojiri <dnojiri@chromium.org>
Original-Commit-Queue: Daisuke Nojiri <dnojiri@chromium.org>
Original-Trybot-Ready: Daisuke Nojiri <dnojiri@chromium.org>
Original-Tested-by: Daisuke Nojiri <dnojiri@chromium.org>
Reviewed-on: http://review.coreboot.org/9929
Tested-by: build bot (Jenkins)
Reviewed-by: Stefan Reinauer <stefan.reinauer@coreboot.org>

4 files changed, 760 insertions, 0 deletions

diff --git a/src/soc/broadcom/cygnus/Makefile.inc b/src/soc/broadcom/cygnus/Makefile.inc
index e22d38dc31..edeb687c48 100644
--- a/src/soc/broadcom/cygnus/Makefile.inc
+++ b/src/soc/broadcom/cygnus/Makefile.inc
@@ -21,6 +21,7 @@ bootblock-y += bootblock.c
 bootblock-y += cbmem.c
 bootblock-y += i2c.c
 bootblock-y += timer.c
+bootblock-y += hw_init.c
 bootblock-$(CONFIG_SPI_FLASH) += spi.c
 ifeq ($(CONFIG_BOOTBLOCK_CONSOLE),y)
 bootblock-$(CONFIG_DRIVERS_UART) += ns16550.c
diff --git a/src/soc/broadcom/cygnus/bootblock.c b/src/soc/broadcom/cygnus/bootblock.c
index 3c6d242d76..3c853923aa 100644
--- a/src/soc/broadcom/cygnus/bootblock.c
+++ b/src/soc/broadcom/cygnus/bootblock.c
@@ -21,6 +21,7 @@
 #include <bootblock_common.h>
 #include <stddef.h>
 #include <symbols.h>
+#include <soc/hw_init.h>
 
 void bootblock_soc_init(void)
 {
@@ -33,4 +34,6 @@ void bootblock_soc_init(void)
 	mmu_config_range_kb((uintptr_t)_sram/KiB, _sram_size/KiB,
 			    DCACHE_WRITETHROUGH);
 	dcache_mmu_enable();
+
+	hw_init();
 }
diff --git a/src/soc/broadcom/cygnus/hw_init.c b/src/soc/broadcom/cygnus/hw_init.c
new file mode 100644
index 0000000000..12adf66814
--- /dev/null
+++ b/src/soc/broadcom/cygnus/hw_init.c
@@ -0,0 +1,733 @@
+/*
+ * Copyright (C) 2015 Broadcom Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; version 2 of the License.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ */
+
+#include <arch/io.h>
+#include <delay.h>
+#include <console/console.h>
+#include <soc/hw_init.h>
+
+/*****************************************************************************
+ * TrustZone
+ *****************************************************************************/
+#define TZPC_TZPCDECPROT0SET			0x18034804
+#define TZPC_TZPCDECPROT0CLR			0x18034808
+#define TZPC_TZPCDECPROT1SET			0x18034810
+#define TZPC_TZPCDECPROT1CLR			0x18034814
+#define TZPC_TZPCDECPROT2SET			0x1803481c
+#define TZPC_TZPCDECPROT2CLR			0x18034820
+
+#define TZPCDECPROT0_MASK			0x000000FF
+#define TZPCDECPROT1_MASK			0x000000FF
+#define TZPCDECPROT2_MASK			0x000000FF
+
+#define TZ_STATE_SECURE				0
+#define TZ_STATE_NON_SECURE			1
+
+#define CYGNUS_M_PCIE0_M0			0x00000003
+#define CYGNUS_M_PCIE1_M0			0x0000000c
+#define CYGNUS_M_CMICD_M0			0x00000030
+#define CYGNUS_M_EXT_M0				0x000000c0
+
+#define CYGNUS_M_EXT_M1				(0x00000003 << 8)
+#define CYGNUS_M_SDIO_M0			(0x0000000c << 8)
+#define CYGNUS_M_SDIO_M1			(0x00000030 << 8)
+#define CYGNUS_M_AMAC_M0			(0x000000c0 << 8)
+
+#define CYGNUS_M_AMAC_M1			(0x00000003 << 16)
+#define CYGNUS_M_USB2H_M0			(0x0000000c << 16)
+#define CYGNUS_M_USB2D_M0			(0x00000030 << 16)
+#define CYGNUS_M_A9JTAG_M0			(0x000000c0 << 16)
+
+#define IPROC_M_PCIE	(CYGNUS_M_PCIE0_M0 | CYGNUS_M_PCIE1_M0)
+#define IPROC_M_EXT	(CYGNUS_M_EXT_M0 | CYGNUS_M_EXT_M1)
+#define IPROC_M_SDIO	(CYGNUS_M_SDIO_M0 | CYGNUS_M_SDIO_M1)
+#define IPROC_M_AMAC	(CYGNUS_M_AMAC_M0 | CYGNUS_M_AMAC_M1)
+#define IPROC_M_USB	(CYGNUS_M_USB2H_M0 | CYGNUS_M_USB2D_M0)
+#define IPROC_M_CMICD	(CYGNUS_M_CMICD_M0)
+
+static void tz_set_masters_security(uint32_t masters, uint32_t ns_bit)
+{
+	uint32_t val = 0;
+
+	/* Check any TZPCDECPROT0 is set and then write to TZPCDECPROT0 */
+	if (masters & TZPCDECPROT0_MASK) {
+		val = masters & TZPCDECPROT0_MASK;
+		if (ns_bit)
+			write32((void *)TZPC_TZPCDECPROT0SET, val);
+		else
+			write32((void *)TZPC_TZPCDECPROT0CLR, val);
+	}
+	/* Check any TZPCDECPROT1 is set and then write to TZPCDECPROT1 */
+	if ((masters >> 8) & TZPCDECPROT1_MASK) {
+		val = (masters >> 8) & TZPCDECPROT1_MASK;
+		if (ns_bit)
+			write32((void *)TZPC_TZPCDECPROT1SET, val);
+		else
+			write32((void *)TZPC_TZPCDECPROT1CLR, val);
+	}
+	/* Check any TZPCDECPROT2 is set and then write to TZPCDECPROT2 */
+	if ((masters >> 16) & TZPCDECPROT2_MASK) {
+		val = (masters >> 16) & TZPCDECPROT2_MASK;
+		if (ns_bit)
+			write32((void *)TZPC_TZPCDECPROT2SET, val);
+		else
+			write32((void *)TZPC_TZPCDECPROT2CLR, val);
+	}
+}
+
+/*****************************************************************************
+ * DMAC
+ *****************************************************************************/
+#define DMAC_M0_IDM_RESET_CONTROL	0x1810f800
+#define DMAC_RESET_MASK			0x00000001
+#define DMAC_RESET_TIMEOUT		1000
+
+static void dmac_init(void)
+{
+	unsigned int val, timeout;
+
+	/* bring the DMAC block out of reset */
+	val = read32((void *)DMAC_M0_IDM_RESET_CONTROL);
+	val |= DMAC_RESET_MASK;
+	write32((void *)DMAC_M0_IDM_RESET_CONTROL, val);
+	udelay(10);
+	val &= ~DMAC_RESET_MASK;
+	write32((void *)DMAC_M0_IDM_RESET_CONTROL, val);
+
+	timeout = 0;
+	while (read32((void *)DMAC_M0_IDM_RESET_CONTROL) & DMAC_RESET_MASK) {
+		udelay(1);
+		if (timeout++ > DMAC_RESET_TIMEOUT)
+			die("Failed to bring PL330 DMAC out of reset\n");
+	}
+}
+
+/*****************************************************************************
+ * Neon
+ *****************************************************************************/
+#define CRU_CONTROL				0x1800e000
+#define CRU_CONTROL_NEON_RESET_N		0x00000040
+
+#define CRU_IHOST_PWRDWN_EN			0x1800e004
+#define CRU_IHOST_PWRDWN_EN_CLAMPON_NEON	0x00100000
+#define CRU_IHOST_PWRDWN_EN_PWRON_NEON		0x00200000
+#define CRU_IHOST_PWRDWN_EN_PWROK_NEON		0x00400000
+
+#define CRU_IHOST_PWRDWN_STATUS			0x1800e008
+#define CRU_IHOST_PWRDWN_STATUS_PWRON_NEON	0x00200000
+#define CRU_IHOST_PWRDWN_STATUS_PWROK_NEON	0x00400000
+
+#define CRU_STATUS_DELAY_US			1
+#define CRU_MAX_RETRY_COUNT			10
+#define CRU_RETRY_INTVL_US			1
+
+static void neon_init(void)
+{
+	unsigned int i, val;
+
+	/* put Neon into reset */
+	val = read32((void *)CRU_CONTROL);
+	val &= ~CRU_CONTROL_NEON_RESET_N;
+	write32((void *)CRU_CONTROL, val);
+
+	/* assert the power on register bit */
+	val = read32((void *)CRU_IHOST_PWRDWN_EN);
+	val |= CRU_IHOST_PWRDWN_EN_PWRON_NEON;
+	write32((void *)CRU_IHOST_PWRDWN_EN, val);
+
+	/* wait for power on */
+	i = 0;
+	while (!(read32((void *)CRU_IHOST_PWRDWN_STATUS) &
+		 CRU_IHOST_PWRDWN_STATUS_PWRON_NEON)) {
+		udelay(CRU_RETRY_INTVL_US);
+		if (i++ >= CRU_MAX_RETRY_COUNT)
+			die("Failed to ack NEON power on\n");
+	}
+
+	udelay(CRU_STATUS_DELAY_US);
+
+	/* assert the power ok register bit */
+	val = read32((void *)CRU_IHOST_PWRDWN_EN);
+	val |= CRU_IHOST_PWRDWN_EN_PWROK_NEON;
+	write32((void *)CRU_IHOST_PWRDWN_EN, val);
+
+	/* wait for power ok */
+	i = 0;
+	while (!(read32((void *)CRU_IHOST_PWRDWN_STATUS) &
+		 CRU_IHOST_PWRDWN_STATUS_PWROK_NEON)) {
+		udelay(CRU_RETRY_INTVL_US);
+		if (i++ >= CRU_MAX_RETRY_COUNT)
+			die("Failed to ack NEON power ok\n");
+	}
+
+	udelay(CRU_STATUS_DELAY_US);
+
+	/* clamp off for the NEON block */
+	val = read32((void *)CRU_IHOST_PWRDWN_EN);
+	val &= ~CRU_IHOST_PWRDWN_EN_CLAMPON_NEON;
+	write32((void *)CRU_IHOST_PWRDWN_EN, val);
+
+	udelay(CRU_STATUS_DELAY_US);
+
+	/* bring NEON out of reset */
+	val = read32((void *)CRU_CONTROL);
+	val |= CRU_CONTROL_NEON_RESET_N;
+	write32((void *)CRU_CONTROL, val);
+}
+
+/*****************************************************************************
+ * PCIe
+ *****************************************************************************/
+#define CRMU_PCIE_CFG			0x0301d0a0
+#define PCIE0_LNK_PHY_IDDQ		0x00000004
+#define PCIE1_LNK_PHY_IDDQ		0x00000400
+
+static void pcie_init(void)
+{
+	unsigned int val;
+
+	/*
+	 * Force all AFEs of both PCIe0 and PCIe1 to be powered down, including
+	 * pad biasing
+	 *
+	 * This brings down the PCIe interfaces to the lowest possible power
+	 * mode
+	 */
+	val = read32((void *)CRMU_PCIE_CFG);
+	val |= PCIE1_LNK_PHY_IDDQ | PCIE0_LNK_PHY_IDDQ;
+	write32((void *)CRMU_PCIE_CFG, val);
+}
+
+/*****************************************************************************
+ * M0
+ *****************************************************************************/
+#define CRMU_MCU_ACCESS_CONTROL			0x03024c00
+#define CRMU_MCU_ACCESS_MODE_SECURE		0x2
+
+static void M0_init(void)
+{
+	/* Set M0 as a secure master */
+	write32((void *)CRMU_MCU_ACCESS_CONTROL, CRMU_MCU_ACCESS_MODE_SECURE);
+}
+
+/*****************************************************************************
+ * CCU
+ *****************************************************************************/
+#define IHOST_PROC_CLK_WR_ACCESS		0x19000000
+#define IHOST_PROC_CLK_POLICY_FREQ		0x19000008
+#define IHOST_PROC_CLK_POLICY_CTL		0x1900000c
+#define IHOST_PROC_CLK_POLICY0_MASK		0x19000010
+#define IHOST_PROC_CLK_POLICY1_MASK		0x19000014
+#define IHOST_PROC_CLK_POLICY2_MASK		0x19000018
+#define IHOST_PROC_CLK_POLICY3_MASK		0x1900001c
+#define IHOST_PROC_CLK_INTEN			0x19000020
+#define IHOST_PROC_CLK_INTSTAT			0x19000024
+#define IHOST_PROC_CLK_LVM_EN			0x19000034
+#define IHOST_PROC_CLK_LVM0_3			0x19000038
+#define IHOST_PROC_CLK_LVM4_7			0x1900003c
+#define IHOST_PROC_CLK_VLT0_3			0x19000040
+#define IHOST_PROC_CLK_VLT4_7			0x19000044
+#define IHOST_PROC_CLK_BUS_QUIESC		0x19000100
+#define IHOST_PROC_CLK_CORE0_CLKGATE		0x19000200
+#define IHOST_PROC_CLK_CORE1_CLKGATE		0x19000204
+#define IHOST_PROC_CLK_ARM_SWITCH_CLKGATE	0x19000210
+#define IHOST_PROC_CLK_ARM_PERIPH_CLKGATE	0x19000300
+#define IHOST_PROC_CLK_APB0_CLKGATE		0x19000400
+#define IHOST_PROC_CLK_PL310_DIV		0x19000a00
+#define IHOST_PROC_CLK_PL310_TRIGGER		0x19000a04
+#define IHOST_PROC_CLK_ARM_SWITCH_DIV		0x19000a08
+#define IHOST_PROC_CLK_ARM_SWITCH_TRIGGER	0x19000a0c
+#define IHOST_PROC_CLK_APB_DIV			0x19000a10
+#define IHOST_PROC_CLK_APB_DIV_TRIGGER		0x19000a14
+#define IHOST_PROC_CLK_PLLARMA			0x19000c00
+#define IHOST_PROC_CLK_PLLARMB			0x19000c04
+#define IHOST_PROC_CLK_PLLARMC			0x19000c08
+#define IHOST_PROC_CLK_PLLARMCTRL0		0x19000c0c
+#define IHOST_PROC_CLK_PLLARMCTRL1		0x19000c10
+#define IHOST_PROC_CLK_PLLARMCTRL2		0x19000c14
+#define IHOST_PROC_CLK_PLLARMCTRL3		0x19000c18
+#define IHOST_PROC_CLK_PLLARMCTRL4		0x19000c1c
+#define IHOST_PROC_CLK_PLLARMCTRL5		0x19000c20
+#define IHOST_PROC_CLK_PLLARM_OFFSET		0x19000c24
+#define IHOST_PROC_CLK_ARM_DIV			0x19000e00
+#define IHOST_PROC_CLK_ARM_SEG_TRG		0x19000e04
+#define IHOST_PROC_CLK_ARM_SEG_TRG_OVERRIDE	0x19000e08
+#define IHOST_PROC_CLK_PLL_DEBUG		0x19000e10
+#define IHOST_PROC_CLK_ACTIVITY_MON1		0x19000e20
+#define IHOST_PROC_CLK_ACTIVITY_MON2		0x19000e24
+#define IHOST_PROC_CLK_CLKGATE_DBG		0x19000e40
+#define IHOST_PROC_CLK_APB_CLKGATE_DBG1		0x19000e48
+#define IHOST_PROC_CLK_CLKMON			0x19000e64
+#define IHOST_PROC_CLK_POLICY_DBG		0x19000ec0
+#define IHOST_PROC_CLK_TGTMASK_DBG1		0x19000ec4
+#define IHOST_PROC_RST_WR_ACCESS		0x19000f00
+#define IHOST_PROC_RST_SOFT_RSTN		0x19000f04
+#define IHOST_PROC_RST_A9_CORE_SOFT_RSTN	0x19000f08
+
+#define WR_ACCESS_PRIVATE_ACCESS_MODE		0x80000000
+
+static uint32_t ccu_reg[] = {
+	IHOST_PROC_CLK_WR_ACCESS,
+	IHOST_PROC_CLK_POLICY_FREQ,
+	IHOST_PROC_CLK_POLICY_CTL,
+	IHOST_PROC_CLK_POLICY0_MASK,
+	IHOST_PROC_CLK_POLICY1_MASK,
+	IHOST_PROC_CLK_POLICY2_MASK,
+	IHOST_PROC_CLK_POLICY3_MASK,
+	IHOST_PROC_CLK_INTEN,
+	IHOST_PROC_CLK_INTSTAT,
+	IHOST_PROC_CLK_LVM_EN,
+	IHOST_PROC_CLK_LVM0_3,
+	IHOST_PROC_CLK_LVM4_7,
+	IHOST_PROC_CLK_VLT0_3,
+	IHOST_PROC_CLK_VLT4_7,
+	IHOST_PROC_CLK_BUS_QUIESC,
+	IHOST_PROC_CLK_CORE0_CLKGATE,
+	IHOST_PROC_CLK_CORE1_CLKGATE,
+	IHOST_PROC_CLK_ARM_SWITCH_CLKGATE,
+	IHOST_PROC_CLK_ARM_PERIPH_CLKGATE,
+	IHOST_PROC_CLK_APB0_CLKGATE,
+	IHOST_PROC_CLK_PL310_DIV,
+	IHOST_PROC_CLK_PL310_TRIGGER,
+	IHOST_PROC_CLK_ARM_SWITCH_DIV,
+	IHOST_PROC_CLK_ARM_SWITCH_TRIGGER,
+	IHOST_PROC_CLK_APB_DIV,
+	IHOST_PROC_CLK_APB_DIV_TRIGGER,
+	IHOST_PROC_CLK_PLLARMA,
+	IHOST_PROC_CLK_PLLARMB,
+	IHOST_PROC_CLK_PLLARMC,
+	IHOST_PROC_CLK_PLLARMCTRL0,
+	IHOST_PROC_CLK_PLLARMCTRL1,
+	IHOST_PROC_CLK_PLLARMCTRL2,
+	IHOST_PROC_CLK_PLLARMCTRL3,
+	IHOST_PROC_CLK_PLLARMCTRL4,
+	IHOST_PROC_CLK_PLLARMCTRL5,
+	IHOST_PROC_CLK_PLLARM_OFFSET,
+	IHOST_PROC_CLK_ARM_DIV,
+	IHOST_PROC_CLK_ARM_SEG_TRG,
+	IHOST_PROC_CLK_ARM_SEG_TRG_OVERRIDE,
+	IHOST_PROC_CLK_PLL_DEBUG,
+	IHOST_PROC_CLK_ACTIVITY_MON1,
+	IHOST_PROC_CLK_ACTIVITY_MON2,
+	IHOST_PROC_CLK_CLKGATE_DBG,
+	IHOST_PROC_CLK_APB_CLKGATE_DBG1,
+	IHOST_PROC_CLK_CLKMON,
+	IHOST_PROC_CLK_POLICY_DBG,
+	IHOST_PROC_CLK_TGTMASK_DBG1,
+	IHOST_PROC_RST_WR_ACCESS,
+	IHOST_PROC_RST_SOFT_RSTN,
+	IHOST_PROC_RST_A9_CORE_SOFT_RSTN
+};
+
+#define CCU_REG_TABLE_SIZE (sizeof(ccu_reg)/sizeof(ccu_reg[0]))
+
+/* Set priv_access_mode field to unrestricted (0) */
+static void ccu_init(void)
+{
+	uint32_t val;
+	uint32_t i;
+	for (i = 0; i < CCU_REG_TABLE_SIZE; i++) {
+		val = read32((void *)(ccu_reg[i]));
+		val &= ~WR_ACCESS_PRIVATE_ACCESS_MODE;
+		write32((void *)(ccu_reg[i]), val);
+	}
+}
+
+/*****************************************************************************
+ * LCD
+ *****************************************************************************/
+#define ASIU_TOP_LCD_AXI_SB_CTRL			0x180aa02c
+#define ASIU_TOP_LCD_AXI_SB_CTRL_LCD_ARPROT_MASK	0x03800000
+#define ASIU_TOP_LCD_AXI_SB_CTRL_LCD_HPROT_NON_SECURE	0x40000000
+
+#define ASIU_TOP_CLK_GATING_CTRL			0x180aa024
+#define ASIU_TOP_CLK_GATING_CTRL_LCD_CLK_GATE_EN	0x00000010
+#define ASIU_TOP_CLK_GATING_CTRL_MIPI_DSI_CLK_GATE_EN	0x00000008
+#define ASIU_TOP_CLK_GATING_CTRL_GFX_CLK_GATE_EN	0x00000001
+#define ASIU_TOP_CLK_GATING_CTRL_AUD_CLK_GATE_EN	0x00000002
+
+static void lcd_init(void)
+{
+	unsigned int val;
+
+	val = read32((void *)ASIU_TOP_LCD_AXI_SB_CTRL);
+	/* set LCD_ARPROT and LCD_HPROT_NON_SECURE to 0 */
+	val &= ~(ASIU_TOP_LCD_AXI_SB_CTRL_LCD_ARPROT_MASK |
+		 ASIU_TOP_LCD_AXI_SB_CTRL_LCD_HPROT_NON_SECURE);
+	write32((void *)ASIU_TOP_LCD_AXI_SB_CTRL, val);
+
+	/* make sure the LCD clock is ungated */
+	val = read32((void *)ASIU_TOP_CLK_GATING_CTRL);
+	val |= ASIU_TOP_CLK_GATING_CTRL_LCD_CLK_GATE_EN;
+	write32((void *)ASIU_TOP_CLK_GATING_CTRL, val);
+}
+
+/*******************************************************************
+ * Default priority settings in Cygnus
+ *
+ *   Master Name                Default Priority
+ *   ====================       =================
+ *   ihost_m0                   12
+ *   mhost0_m0                  12
+ *   mhost1_m0              `   12
+ *   pcie0_m0                   9
+ *   pcie0_m1                   9
+ *   cmicd_m0                   7
+ *   amac_m0                    7
+ *   amac_m1                    7
+ *   ext_m0 (LCD)               5
+ *   ext_m1 (V3D)               5
+ *   sdio_m0                    3
+ *   sdio_m1                    3
+ *   usb2h_m0                   3
+ *   usb2d_m0                   3
+ *   dmu_m0                     3
+ *   a9jtag_m0                  0
+ *
+ *****************************************************************************/
+
+#define AXIIC_EXT_M0_READ_QOS			0x1a057100
+#define AXIIC_EXT_M0_READ_MASK			0x0000000f
+#define AXIIC_EXT_M0_WRITE_QOS			0x1a057104
+#define AXIIC_EXT_M0_WRITE_MASK			0x0000000f
+
+static void lcd_qos_init(unsigned int qos)
+{
+	unsigned int val;
+
+	val = read32((void *)AXIIC_EXT_M0_READ_QOS);
+	val &= ~AXIIC_EXT_M0_READ_MASK;
+	val |= (qos & AXIIC_EXT_M0_READ_MASK);
+	write32((void *)AXIIC_EXT_M0_READ_QOS, val);
+
+	val = read32((void *)AXIIC_EXT_M0_WRITE_QOS);
+	val &= ~AXIIC_EXT_M0_WRITE_MASK;
+	val |= (qos & AXIIC_EXT_M0_WRITE_MASK);
+	write32((void *)AXIIC_EXT_M0_WRITE_QOS, val);
+}
+
+/*****************************************************************************
+ * V3D
+ *****************************************************************************/
+#define ASIU_TOP_GFX_AXI_SB_CTRL			0x180aa034
+#define ASIU_TOP_GFX_AXI_SB_CTRL_GFX_ARPROT_MASK	0x03800000
+#define ASIU_TOP_GFX_AXI_SB_CTRL_GFX_AWPROT_MASK	0x00700000
+
+static void v3d_init(void)
+{
+	unsigned int val;
+
+	val = read32((void *)ASIU_TOP_GFX_AXI_SB_CTRL);
+	/*
+	 * set both GFX_ARPROT and GFX_AWPROT to 0
+	 */
+	val &= ~(ASIU_TOP_GFX_AXI_SB_CTRL_GFX_ARPROT_MASK |
+		 ASIU_TOP_GFX_AXI_SB_CTRL_GFX_AWPROT_MASK);
+	write32((void *)ASIU_TOP_GFX_AXI_SB_CTRL, val);
+
+	/* make sure the V3D clock is ungated */
+	val = read32((void *)ASIU_TOP_CLK_GATING_CTRL);
+	val |= ASIU_TOP_CLK_GATING_CTRL_MIPI_DSI_CLK_GATE_EN |
+	       ASIU_TOP_CLK_GATING_CTRL_GFX_CLK_GATE_EN;
+	write32((void *)ASIU_TOP_CLK_GATING_CTRL, val);
+}
+
+/*****************************************************************************
+ * Audio
+ *****************************************************************************/
+#define CRMU_PLL_AON_CTRL				0x0301c020
+#define CRMU_PLL_AON_CTRL_ASIU_AUDIO_GENPLL_PWRON_PLL	0x00000800
+#define CRMU_PLL_AON_CTRL_ASIU_AUDIO_GENPLL_PWRON_BG	0x00000400
+#define CRMU_PLL_AON_CTRL_ASIU_AUDIO_GENPLL_PWRON_LDO	0x00000200
+#define CRMU_PLL_AON_CTRL_ASIU_AUDIO_GENPLL_ISO_IN	0x00000100
+
+#define ASIU_TOP_AUD_AXI_SB_CTRL			0x180aa028
+#define ASIU_TOP_AUD_AXI_SB_CTRL_AUD_ARPROT_MASK	0x03800000
+#define ASIU_TOP_AUD_AXI_SB_CTRL_AUD_AWPROT_MASK	0x00700000
+
+static void audio_init(void)
+{
+	unsigned int val;
+
+	/* Ungate (enable) audio clock. */
+	val = read32((void *)ASIU_TOP_CLK_GATING_CTRL);
+	val |= ASIU_TOP_CLK_GATING_CTRL_AUD_CLK_GATE_EN;
+	write32((void *)ASIU_TOP_CLK_GATING_CTRL, val);
+
+	/* Power on audio GEN PLL, LDO, and BG. Input isolation = normal. */
+	val = read32((void *)CRMU_PLL_AON_CTRL);
+	val |= CRMU_PLL_AON_CTRL_ASIU_AUDIO_GENPLL_PWRON_BG;
+	val |= CRMU_PLL_AON_CTRL_ASIU_AUDIO_GENPLL_PWRON_LDO;
+	val |= CRMU_PLL_AON_CTRL_ASIU_AUDIO_GENPLL_PWRON_PLL;
+	val &= ~CRMU_PLL_AON_CTRL_ASIU_AUDIO_GENPLL_ISO_IN;
+	write32((void *)CRMU_PLL_AON_CTRL, val);
+
+	/* Clear AWPROT and ARPROT signals to audio block. */
+	val = read32((void *)ASIU_TOP_AUD_AXI_SB_CTRL);
+	val &= ~(ASIU_TOP_AUD_AXI_SB_CTRL_AUD_AWPROT_MASK |
+		 ASIU_TOP_AUD_AXI_SB_CTRL_AUD_ARPROT_MASK);
+	write32((void *)ASIU_TOP_AUD_AXI_SB_CTRL, val);
+}
+
+/*****************************************************************************
+ * SDIO
+ *****************************************************************************/
+#define CRMU_SDIO_1P8_FAIL_CONTROL	0x0301c0a0
+#define UHS1_18V_VREG_FAIL		0x00000001
+
+#define SDIO_IDM0_IO_CONTROL_DIRECT	0x18116408
+#define SDIO_IDM1_IO_CONTROL_DIRECT	0x18117408
+#define SDIO_CMD_COMFLICT_DISABLE	0x00400000
+#define SDIO_FEEDBACK_CLK_EN		0x00200000
+#define SDIO_CLK_ENABLE			0x00000001
+
+#define CDRU_SDIO0_IO_CONTROL		0x0301d144
+#define CDRU_SDIO1_IO_CONTROL		0x0301d140
+#define INPUT_DISABLE			0x00000080
+#define SLEW_RATE_ENABLE		0x00000040
+#define PULL_UP_ENABLE			0x00000020
+#define PULL_DOWN_ENABLE		0x00000010
+#define HYSTERESIS_ENABLE		0x00000008
+#define SDIO_DEFAULT_DRIVE_STRENGTH	0x4		/* 8 mA */
+
+#define SDIO_IDM0_IDM_RESET_CONTROL	0x18116800
+#define SDIO_IDM1_IDM_RESET_CONTROL	0x18117800
+#define SDIO_RESET_MASK			0x00000001
+#define SDIO_RESET_TIMEOUT		1000
+
+#define CRMU_SDIO_CONTROL0		0x0301d088
+#define CRMU_SDIO_CONTROL1		0x0301d08c
+#define CRMU_SDIO_CONTROL2		0x0301d090
+#define CRMU_SDIO_CONTROL3		0x0301d094
+#define CRMU_SDIO_CONTROL4		0x0301d098
+#define CRMU_SDIO_CONTROL5		0x0301d09c
+
+/*
+ * SDIO_CAPS_L
+ *
+ * Field		Bit(s)
+ * ===========================
+ * DDR50		31
+ * SDR104		30
+ * SDR50		29
+ * SLOTTYPE		28:27
+ * ASYNCHIRQ		26
+ * SYSBUS64		25
+ * V18			24
+ * V3			23
+ * V33			22
+ * SUPRSM		21
+ * SDMA			20
+ * HSPEED		19
+ * ADMA2		18
+ * EXTBUSMED		17
+ * MAXBLK		16:15
+ * BCLK			14:7
+ * TOUT			6
+ * TOUTFREQ		5:0
+ */
+#define SDIO_CAPS_L			0xA17C0000
+
+/*
+ * SDIO_CAPS_H
+ *
+ * Field		Bit(s)
+ * ===========================
+ * reserved		31:20
+ * SPIBLOCKMODE		19
+ * SPIMODE_CAP		18
+ * CLOCKMULT		17:10
+ * RETUNE_MODE		9:8
+ * USETUNE_SDR50	7
+ * TMRCNT_RETUNE	6:3
+ * DRVR_TYPED		2
+ * DRVR_TYPEC		1
+ * DRVR_TYPEA		0
+ */
+#define SDIO_CAPS_H			0x000C0087
+
+/*
+ * Preset value
+ *
+ * Field		Bit(s)
+ * ===========================
+ * Driver Strength	12:11
+ * Clock Generator	10
+ * SDCLK Frequeency	9:0
+ */
+
+/*
+ * SDIO_PRESETVAL1
+ *
+ * Field		Bit(s)	Description
+ * ============================================================
+ * DDR50_PRESET		25:13	Preset Value for DDR50
+ * DEFAULT_PRESET	12:0	Preset Value for Default Speed
+ */
+#define SDIO_PRESETVAL1		0x01004004
+
+/*
+ * SDIO_PRESETVAL2
+ *
+ * Field		Bit(s)	Description
+ * ============================================================
+ * HIGH_SPEED_PRESET	25:13	Preset Value for High Speed
+ * INIT_PRESET		12:0	Preset Value for Initialization
+ */
+#define SDIO_PRESETVAL2		0x01004100
+
+/*
+ * SDIO_PRESETVAL3
+ *
+ * Field		Bit(s)	Description
+ * ============================================================
+ * SDR104_PRESET	25:13	Preset Value for SDR104
+ * SDR12_PRESET		12:0	Preset Value for SDR12
+ */
+#define SDIO_PRESETVAL3		0x00000004
+
+/*
+ * SDIO_PRESETVAL4
+ *
+ * Field		Bit(s)	Description
+ * ============================================================
+ * SDR25_PRESET		25:13	Preset Value for SDR25
+ * SDR50_PRESET		12:0	Preset Value for SDR50
+ */
+#define SDIO_PRESETVAL4		0x01005001
+
+static void sdio_ctrl_init(unsigned int idx)
+{
+	unsigned int sdio_idm_io_control_direct_reg;
+	unsigned int cdru_sdio_io_control_reg;
+	unsigned int sdio_idm_reset_control_reg;
+	unsigned int val, timeout;
+
+	switch (idx) {
+	case 0:
+		sdio_idm_io_control_direct_reg = SDIO_IDM0_IO_CONTROL_DIRECT;
+		cdru_sdio_io_control_reg = CDRU_SDIO0_IO_CONTROL;
+		sdio_idm_reset_control_reg = SDIO_IDM0_IDM_RESET_CONTROL;
+		break;
+	case 1:
+		sdio_idm_io_control_direct_reg = SDIO_IDM1_IO_CONTROL_DIRECT;
+		cdru_sdio_io_control_reg = CDRU_SDIO1_IO_CONTROL;
+		sdio_idm_reset_control_reg = SDIO_IDM1_IDM_RESET_CONTROL;
+		break;
+	default:
+		return;
+	}
+
+	/*
+	 * Disable the cmd conflict error interrupt and enable feedback clock
+	 */
+	val = read32((void *)sdio_idm_io_control_direct_reg);
+	val |= SDIO_CMD_COMFLICT_DISABLE | SDIO_FEEDBACK_CLK_EN |
+	       SDIO_CLK_ENABLE;
+	write32((void *)sdio_idm_io_control_direct_reg, val);
+
+	/*
+	 * Set drive strength, enable hysteresis and slew rate control
+	 */
+	val = SDIO_DEFAULT_DRIVE_STRENGTH |
+		HYSTERESIS_ENABLE | SLEW_RATE_ENABLE;
+	write32((void *)cdru_sdio_io_control_reg, val);
+
+	/* Reset SDIO controller */
+	val = read32((void *)sdio_idm_reset_control_reg);
+	val |= SDIO_RESET_MASK;
+	write32((void *)sdio_idm_reset_control_reg, SDIO_RESET_MASK);
+	udelay(10);
+	val &= ~SDIO_RESET_MASK;
+	write32((void *)sdio_idm_reset_control_reg, val);
+
+	timeout = 0;
+	while (read32((void *)sdio_idm_reset_control_reg) & SDIO_RESET_MASK) {
+		udelay(1);
+		if (timeout++ > SDIO_RESET_TIMEOUT)
+			die("Failed to bring SDIO out of reset\n");
+	}
+}
+
+static void sdio_init(void)
+{
+	unsigned int val;
+
+	/*
+	 * Configure SDIO host controller capabilities
+	 * (common setting for all SDIO controllers)
+	 */
+	write32((void *)CRMU_SDIO_CONTROL0, SDIO_CAPS_H);
+	write32((void *)CRMU_SDIO_CONTROL1, SDIO_CAPS_L);
+	/*
+	 * Configure SDIO host controller preset values
+	 * (common setting for all SDIO controllers)
+	 */
+	write32((void *)CRMU_SDIO_CONTROL2, SDIO_PRESETVAL1);
+	write32((void *)CRMU_SDIO_CONTROL3, SDIO_PRESETVAL2);
+	write32((void *)CRMU_SDIO_CONTROL4, SDIO_PRESETVAL3);
+	write32((void *)CRMU_SDIO_CONTROL5, SDIO_PRESETVAL4);
+
+	/*
+	 * The sdhci driver attempts to change the SDIO IO voltage for UHS-I
+	 * cards by setting the EN1P8V in control2 register then checks the
+	 * outcome by reading it back.
+	 * Cygnus does not have an internal regulator for the SDIO IO voltage
+	 * but can be configured to indicate success (leave EN1P8V set)
+	 * or failure (clear EN1P8V).
+	 *
+	 * Clear CRMU_SDIO_UHS1_18V_VREG_FAIL in CRMU_SDIO_1P8_FAIL_CONTROL
+	 * register to indicate success.
+	 * (common setting for all SDIO controllers)
+	 */
+	val = read32((void *)CRMU_SDIO_1P8_FAIL_CONTROL);
+	val &= ~UHS1_18V_VREG_FAIL;
+	write32((void *)CRMU_SDIO_1P8_FAIL_CONTROL, val);
+
+	/*
+	 * Initialize each SDIO controller
+	 */
+	sdio_ctrl_init(0);
+	sdio_ctrl_init(1);
+}
+
+void hw_init(void)
+{
+	tz_set_masters_security(IPROC_M_PCIE | IPROC_M_EXT | IPROC_M_SDIO |
+				IPROC_M_AMAC | IPROC_M_USB | IPROC_M_CMICD,
+				TZ_STATE_SECURE);
+	printk(BIOS_INFO, "trustzone initialized\n");
+	dmac_init();
+	printk(BIOS_INFO, "PL022 DMAC initialized\n");
+	lcd_init();
+	lcd_qos_init(15);
+	printk(BIOS_INFO, "LCD initialized\n");
+	v3d_init();
+	printk(BIOS_INFO, "V3D initialized\n");
+	audio_init();
+	printk(BIOS_INFO, "audio initialized\n");
+	neon_init();
+	printk(BIOS_INFO, "neon initialized\n");
+	pcie_init();
+	printk(BIOS_INFO, "PCIe initialized\n");
+	M0_init();
+	printk(BIOS_INFO, "M0 initialized\n");
+	ccu_init();
+	printk(BIOS_INFO, "CCU initialized\n");
+	sdio_init();
+	printk(BIOS_INFO, "SDIO initialized\n");
+}
diff --git a/src/soc/broadcom/cygnus/include/soc/hw_init.h b/src/soc/broadcom/cygnus/include/soc/hw_init.h
new file mode 100644
index 0000000000..a02daa0b00
--- /dev/null
+++ b/src/soc/broadcom/cygnus/include/soc/hw_init.h
@@ -0,0 +1,23 @@
+/*
+ * Copyright (C) 2015 Broadcom Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; version 2 of the License.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ */
+
+#ifndef __SOC_BROADCOM_CYGNUS_HW_INIT_H__
+#define __SOC_BROADCOM_CYGNUS_HW_INIT_H__
+
+void hw_init(void);
+
+#endif