sandy/ivybridge: Native raminit.

Based on damo22's work and my X230 tracing.

Works for my X230 in a variety of RAM configs.

Also-By: Damien Zammit <damien@zamaudio.com>
Change-Id: I1aa024c55a8416fc53b25e7123037df0e55a2769
Signed-off-by: Vladimir Serbinenko <phcoder@gmail.com>
Signed-off-by: Damien Zammit <damien@zamaudio.com>
Reviewed-on: http://review.coreboot.org/5786
Tested-by: build bot (Jenkins)
Reviewed-by: Edward O'Callaghan <eocallaghan@alterapraxis.com>
diff --git a/src/southbridge/intel/bd82x6x/Makefile.inc b/src/southbridge/intel/bd82x6x/Makefile.inc
index 64038e5..fa21277 100644
--- a/src/southbridge/intel/bd82x6x/Makefile.inc
+++ b/src/southbridge/intel/bd82x6x/Makefile.inc
@@ -45,10 +45,14 @@
 ramstage-$(CONFIG_HAVE_SMI_HANDLER) += smi.c
 smm-$(CONFIG_HAVE_SMI_HANDLER) += smihandler.c me.c me_8.x.c finalize.c pch.c
 
-romstage-y += early_usb.c early_smbus.c early_me.c me_status.c gpio.c
+romstage-y += early_usb.c early_smbus.c me_status.c gpio.c
 romstage-y += reset.c
 romstage-y += early_spi.c early_pch.c
 
+romstage-$(CONFIG_NORTHBRIDGE_INTEL_IVYBRIDGE) += early_me.c
+romstage-$(CONFIG_NORTHBRIDGE_INTEL_SANDYBRIDGE) += early_me.c
+romstage-$(CONFIG_NORTHBRIDGE_INTEL_IVYBRIDGE_NATIVE) += early_thermal.c early_pch_native.c early_me_native.c
+
 ifeq ($(CONFIG_BUILD_WITH_FAKE_IFD),y)
 IFD_BIN_PATH := $(objgenerated)/ifdfake.bin
 IFD_SECTIONS := $(addprefix -b ,$(CONFIG_IFD_BIOS_SECTION:"%"=%)) \
diff --git a/src/southbridge/intel/bd82x6x/early_me_native.c b/src/southbridge/intel/bd82x6x/early_me_native.c
new file mode 100644
index 0000000..ab54ffd
--- /dev/null
+++ b/src/southbridge/intel/bd82x6x/early_me_native.c
@@ -0,0 +1,272 @@
+/*
+ * This file is part of the coreboot project.
+ *
+ * Copyright (C) 2011 The Chromium OS Authors. All rights reserved.
+ *
+ * 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/hlt.h>
+#include <arch/io.h>
+#include <console/console.h>
+#include <delay.h>
+#include <device/pci_ids.h>
+#include <string.h>
+#include "me.h"
+#include "pch.h"
+
+static const char *me_ack_values[] = {
+	[ME_HFS_ACK_NO_DID]	= "No DID Ack received",
+	[ME_HFS_ACK_RESET]	= "Non-power cycle reset",
+	[ME_HFS_ACK_PWR_CYCLE]	= "Power cycle reset",
+	[ME_HFS_ACK_S3]		= "Go to S3",
+	[ME_HFS_ACK_S4]		= "Go to S4",
+	[ME_HFS_ACK_S5]		= "Go to S5",
+	[ME_HFS_ACK_GBL_RESET]	= "Global Reset",
+	[ME_HFS_ACK_CONTINUE]	= "Continue to boot"
+};
+
+static inline void pci_read_dword_ptr(void *ptr, int offset)
+{
+	u32 dword = pci_read_config32(PCH_ME_DEV, offset);
+	memcpy(ptr, &dword, sizeof(dword));
+}
+
+static inline void pci_write_dword_ptr(void *ptr, int offset)
+{
+	u32 dword = 0;
+	memcpy(&dword, ptr, sizeof(dword));
+	pci_write_config32(PCH_ME_DEV, offset, dword);
+}
+
+void intel_early_me_status(void)
+{
+	struct me_hfs hfs;
+	struct me_gmes gmes;
+
+	pci_read_dword_ptr(&hfs, PCI_ME_HFS);
+	pci_read_dword_ptr(&gmes, PCI_ME_GMES);
+
+	intel_me_status(&hfs, &gmes);
+}
+
+int intel_early_me_init(void)
+{
+	int count;
+	struct me_uma uma;
+	struct me_hfs hfs;
+
+	printk(BIOS_INFO, "Intel ME early init\n");
+
+	/* Wait for ME UMA SIZE VALID bit to be set */
+	for (count = ME_RETRY; count > 0; --count) {
+		pci_read_dword_ptr(&uma, PCI_ME_UMA);
+		if (uma.valid)
+			break;
+		udelay(ME_DELAY);
+	}
+	if (!count) {
+		printk(BIOS_ERR, "ERROR: ME is not ready!\n");
+		return -1;
+	}
+
+	/* Check for valid firmware */
+	pci_read_dword_ptr(&hfs, PCI_ME_HFS);
+	if (hfs.fpt_bad) {
+		printk(BIOS_WARNING, "WARNING: ME has bad firmware\n");
+		return -1;
+	}
+
+	printk(BIOS_INFO, "Intel ME firmware is ready\n");
+	return 0;
+}
+
+int intel_early_me_uma_size(void)
+{
+	struct me_uma uma;
+
+	pci_read_dword_ptr(&uma, PCI_ME_UMA);
+	if (uma.valid) {
+		printk(BIOS_DEBUG, "ME: Requested %uMB UMA\n", uma.size);
+		return uma.size;
+	}
+
+	printk(BIOS_DEBUG, "ME: Invalid UMA size\n");
+	return 0;
+}
+
+static inline void set_global_reset(int enable)
+{
+	u32 etr3 = pci_read_config32(PCH_LPC_DEV, ETR3);
+
+	/* Clear CF9 Without Resume Well Reset Enable */
+	etr3 &= ~ETR3_CWORWRE;
+
+	/* CF9GR indicates a Global Reset */
+	if (enable)
+		etr3 |= ETR3_CF9GR;
+	else
+		etr3 &= ~ETR3_CF9GR;
+
+	pci_write_config32(PCH_LPC_DEV, ETR3, etr3);
+}
+
+int intel_early_me_init_done(u8 status)
+{
+	u8 reset, errorcode, opmode;
+	u16 reg16;
+	u32 mebase_l, mebase_h;
+	u32 millisec;
+	u32 hfs, me_fws2;
+	struct me_did did = {
+		.init_done = ME_INIT_DONE,
+		.status = status
+	};
+	u32 meDID;
+
+	hfs = (pci_read_config32(PCI_DEV(0, 0x16, 0), PCI_ME_HFS) & 0xff000) >> 12;
+	      
+	opmode = (hfs & 0xf0) >> 4;
+	errorcode = hfs & 0xf;
+
+	if (opmode != ME_HFS_MODE_NORMAL) {
+		printk(BIOS_NOTICE, "ME: Wrong mode : %d\n", opmode);
+		//return 0;
+	}
+	if (errorcode) {
+		printk(BIOS_NOTICE, "ME: HFS error : %d\n", errorcode);
+		//return 0;
+	}
+
+	me_fws2 = pci_read_config32(PCI_DEV(0, 0x16, 0), 0x48);
+	printk(BIOS_NOTICE, "ME: FWS2: 0x%x\n", me_fws2);
+	printk(BIOS_NOTICE, "ME:  Bist in progress: 0x%x\n", me_fws2 & 0x1);
+	printk(BIOS_NOTICE, "ME:  ICC Status      : 0x%x\n", (me_fws2 & 0x6) >> 1);
+	printk(BIOS_NOTICE, "ME:  Invoke MEBx     : 0x%x\n", (me_fws2 & 0x8) >> 3);
+	printk(BIOS_NOTICE, "ME:  CPU replaced    : 0x%x\n", (me_fws2 & 0x10) >> 4);
+	printk(BIOS_NOTICE, "ME:  MBP ready       : 0x%x\n", (me_fws2 & 0x20) >> 5);
+	printk(BIOS_NOTICE, "ME:  MFS failure     : 0x%x\n", (me_fws2 & 0x40) >> 6);
+	printk(BIOS_NOTICE, "ME:  Warm reset req  : 0x%x\n", (me_fws2 & 0x80) >> 7);
+	printk(BIOS_NOTICE, "ME:  CPU repl valid  : 0x%x\n", (me_fws2 & 0x100) >> 8);
+	printk(BIOS_NOTICE, "ME:  (Reserved)      : 0x%x\n", (me_fws2 & 0x600) >> 9);
+	printk(BIOS_NOTICE, "ME:  FW update req   : 0x%x\n", (me_fws2 & 0x800) >> 11);
+	printk(BIOS_NOTICE, "ME:  (Reserved)      : 0x%x\n", (me_fws2 & 0xf000) >> 12);
+	printk(BIOS_NOTICE, "ME:  Current state   : 0x%x\n", (me_fws2 & 0xff0000) >> 16);
+	printk(BIOS_NOTICE, "ME:  Current PM event: 0x%x\n", (me_fws2 & 0xf000000) >> 24);
+	printk(BIOS_NOTICE, "ME:  Progress code   : 0x%x\n", (me_fws2 & 0xf0000000) >> 28);
+	
+	// Poll cpu replaced for 50ms
+	millisec = 0;
+	while ((((me_fws2 & 0x100) >> 8) == 0) && millisec < 50) {
+		udelay(1000);
+		me_fws2 = pci_read_config32(PCI_DEV(0, 0x16, 0), 0x48);
+		millisec++;
+	}
+	if (millisec >= 50 || ((me_fws2 & 0x100) >> 8) == 0x0) {
+		printk(BIOS_NOTICE, "Waited long enough, or CPU was not replaced, continue...\n");
+	} else if ((me_fws2 & 0x100) == 0x100) {
+		if ((me_fws2 & 0x80) == 0x80) {		
+			printk(BIOS_NOTICE, "CPU was replaced & warm reset required...\n");
+			reg16 = pcie_read_config16(PCI_DEV(0, 31, 0), 0xa2) & ~0x80;
+			pcie_write_config16(PCI_DEV(0, 31, 0), 0xa2, reg16);
+			set_global_reset(0);
+			outb(0x6, 0xcf9);
+			hlt();
+		}
+
+		if (((me_fws2 & 0x10) == 0x10) && (me_fws2 & 0x80) == 0x00) {
+			printk(BIOS_NOTICE, "Full training required\n");
+		}
+	}
+
+	printk(BIOS_NOTICE, "PASSED! Tell ME that DRAM is ready\n");
+
+	/* MEBASE from MESEG_BASE[35:20] */
+	mebase_l = pci_read_config32(PCI_CPU_DEVICE, PCI_CPU_MEBASE_L);
+	mebase_h = pci_read_config32(PCI_CPU_DEVICE, PCI_CPU_MEBASE_H) & 0xf;
+	did.uma_base = (mebase_l >> 20) | (mebase_h << 12);
+
+	meDID = did.uma_base | (1 << 28);// | (1 << 23);
+	pci_write_config32(PCI_DEV(0, 0x16, 0), PCI_ME_H_GS, meDID);
+
+	udelay(1100);
+
+	/* Must wait for ME acknowledgement */
+	millisec = 0;
+	hfs = (pci_read_config32(PCI_DEV(0, 0x16, 0), PCI_ME_HFS) & 0xfe000000) >> 24;
+	while ((((hfs & 0xf0) >> 4) != ME_HFS_BIOS_DRAM_ACK) && (millisec < 5000)) {
+		udelay(1000);
+		hfs = (pci_read_config32(PCI_DEV(0, 0x16, 0), PCI_ME_HFS) & 0xfe000000) >> 24;
+		millisec++;
+	}
+
+	me_fws2 = pci_read_config32(PCI_DEV(0, 0x16, 0), 0x48);
+	printk(BIOS_NOTICE, "ME: FWS2: 0x%x\n", me_fws2);
+	printk(BIOS_NOTICE, "ME:  Bist in progress: 0x%x\n", me_fws2 & 0x1);
+	printk(BIOS_NOTICE, "ME:  ICC Status      : 0x%x\n", (me_fws2 & 0x6) >> 1);
+	printk(BIOS_NOTICE, "ME:  Invoke MEBx     : 0x%x\n", (me_fws2 & 0x8) >> 3);
+	printk(BIOS_NOTICE, "ME:  CPU replaced    : 0x%x\n", (me_fws2 & 0x10) >> 4);
+	printk(BIOS_NOTICE, "ME:  MBP ready       : 0x%x\n", (me_fws2 & 0x20) >> 5);
+	printk(BIOS_NOTICE, "ME:  MFS failure     : 0x%x\n", (me_fws2 & 0x40) >> 6);
+	printk(BIOS_NOTICE, "ME:  Warm reset req  : 0x%x\n", (me_fws2 & 0x80) >> 7);
+	printk(BIOS_NOTICE, "ME:  CPU repl valid  : 0x%x\n", (me_fws2 & 0x100) >> 8);
+	printk(BIOS_NOTICE, "ME:  (Reserved)      : 0x%x\n", (me_fws2 & 0x600) >> 9);
+	printk(BIOS_NOTICE, "ME:  FW update req   : 0x%x\n", (me_fws2 & 0x800) >> 11);
+	printk(BIOS_NOTICE, "ME:  (Reserved)      : 0x%x\n", (me_fws2 & 0xf000) >> 12);
+	printk(BIOS_NOTICE, "ME:  Current state   : 0x%x\n", (me_fws2 & 0xff0000) >> 16);
+	printk(BIOS_NOTICE, "ME:  Current PM event: 0x%x\n", (me_fws2 & 0xf000000) >> 24);
+	printk(BIOS_NOTICE, "ME:  Progress code   : 0x%x\n", (me_fws2 & 0xf0000000) >> 28);
+
+	
+	/* Return the requested BIOS action */
+	printk(BIOS_NOTICE, "ME: Requested BIOS Action: %s\n",
+		me_ack_values[(hfs & 0xe) >> 1]);
+
+	reset = inb(0xcf9);
+	reset &= 0xf1;
+	switch ((hfs & 0xe) >> 1) {
+	case ME_HFS_ACK_NO_DID:
+	case ME_HFS_ACK_CONTINUE:
+		/* Continue to boot */
+		return 0;
+	case ME_HFS_ACK_RESET:
+		/* Non-power cycle reset */
+		set_global_reset(0);
+		reset |= 0x06;
+		break;
+	case ME_HFS_ACK_PWR_CYCLE:
+		/* Power cycle reset */
+		set_global_reset(0);
+		reset |= 0x0e;
+		break;
+	case ME_HFS_ACK_GBL_RESET:
+		/* Global reset */
+		set_global_reset(1);
+		reset |= 0x0e;
+		break;
+	case ME_HFS_ACK_S3:
+	case ME_HFS_ACK_S4:
+	case ME_HFS_ACK_S5:
+		break;
+	}
+
+	/* Perform the requested reset */
+	if (reset) {
+		outb(reset, 0xcf9);
+		hlt();
+	}
+	return -1;
+}
diff --git a/src/southbridge/intel/bd82x6x/early_pch_native.c b/src/southbridge/intel/bd82x6x/early_pch_native.c
new file mode 100644
index 0000000..5cd6315
--- /dev/null
+++ b/src/southbridge/intel/bd82x6x/early_pch_native.c
@@ -0,0 +1,375 @@
+/*
+ * This file is part of the coreboot project.
+ *
+ * Copyright (C) 2014 Vladimir Serbinenko <phcoder@gmail.com>
+ *
+ * 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 <console/console.h>
+#include <string.h>
+#include <arch/hlt.h>
+#include <arch/io.h>
+#include <cbmem.h>
+#include <arch/cbfs.h>
+#include <cbfs.h>
+#include <ip_checksum.h>
+#include <pc80/mc146818rtc.h>
+#include <device/pci_def.h>
+#include <delay.h>
+
+#include "pch.h"
+/* For DMI bar.  */
+#include "northbridge/intel/sandybridge/sandybridge.h"
+
+#define SOUTHBRIDGE PCI_DEV(0, 0x1f, 0)
+
+static void
+wait_2338 (void)
+{
+	while (read8 (DEFAULT_RCBA | 0x2338) & 1);
+}
+
+static u32
+read_2338 (u32 edx)
+{
+	u32 ret;
+
+	write32 (DEFAULT_RCBA | 0x2330, edx);
+	write16 (DEFAULT_RCBA | 0x2338, (read16 (DEFAULT_RCBA | 0x2338)
+					 & 0x1ff) | 0x600);
+	wait_2338 ();
+	ret = read32 (DEFAULT_RCBA | 0x2334);
+	wait_2338 ();
+	read8 (DEFAULT_RCBA | 0x2338);
+	return ret;
+}
+
+static void
+write_2338 (u32 edx, u32 val)
+{
+	read_2338 (edx);
+	write16 (DEFAULT_RCBA | 0x2338, (read16 (DEFAULT_RCBA | 0x2338)
+					 & 0x1ff) | 0x600);
+	wait_2338 ();
+
+	write32 (DEFAULT_RCBA | 0x2334, val);
+	wait_2338 ();
+	write16 (DEFAULT_RCBA | 0x2338,
+		 (read16 (DEFAULT_RCBA | 0x2338) & 0x1ff) | 0x600);
+	read8 (DEFAULT_RCBA | 0x2338);
+}
+
+
+static void
+init_dmi (void)
+{
+	int i;
+
+	write32 (DEFAULT_DMIBAR | 0x0914,
+		 read32 (DEFAULT_DMIBAR | 0x0914) | 0x80000000);
+	write32 (DEFAULT_DMIBAR | 0x0934,
+		 read32 (DEFAULT_DMIBAR | 0x0934) | 0x80000000);
+	for (i = 0; i < 4; i++)
+	{
+		write32 (DEFAULT_DMIBAR | 0x0a00 | (i << 4),
+			 read32 (DEFAULT_DMIBAR | 0x0a00 | (i << 4)) & 0xf3ffffff);
+		write32 (DEFAULT_DMIBAR | 0x0a04 | (i << 4),
+			 read32 (DEFAULT_DMIBAR | 0x0a04 | (i << 4)) | 0x800);
+	}
+	write32 (DEFAULT_DMIBAR | 0x0c30, (read32 (DEFAULT_DMIBAR | 0x0c30)
+					   & 0xfffffff) | 0x40000000);
+	for (i = 0; i < 2; i++)
+	{
+		write32 (DEFAULT_DMIBAR | 0x0904 | (i << 5),
+			 read32 (DEFAULT_DMIBAR | 0x0904 | (i << 5)) & 0xfe3fffff);
+		write32 (DEFAULT_DMIBAR | 0x090c | (i << 5),
+			 read32 (DEFAULT_DMIBAR | 0x090c | (i << 5)) & 0xfff1ffff);
+	}
+	write32 (DEFAULT_DMIBAR | 0x090c,
+		 read32 (DEFAULT_DMIBAR | 0x090c) & 0xfe1fffff);
+	write32 (DEFAULT_DMIBAR | 0x092c,
+		 read32 (DEFAULT_DMIBAR | 0x092c) & 0xfe1fffff);
+	read32 (DEFAULT_DMIBAR | 0x0904);	// !!! = 0x7a1842ec
+	write32 (DEFAULT_DMIBAR | 0x0904, 0x7a1842ec);
+	read32 (DEFAULT_DMIBAR | 0x090c);	// !!! = 0x00000208
+	write32 (DEFAULT_DMIBAR | 0x090c, 0x00000128);
+	read32 (DEFAULT_DMIBAR | 0x0924);	// !!! = 0x7a1842ec
+	write32 (DEFAULT_DMIBAR | 0x0924, 0x7a1842ec);
+	read32 (DEFAULT_DMIBAR | 0x092c);	// !!! = 0x00000208
+	write32 (DEFAULT_DMIBAR | 0x092c, 0x00000128);
+	read32 (DEFAULT_DMIBAR | 0x0700);	// !!! = 0x46139008
+	write32 (DEFAULT_DMIBAR | 0x0700, 0x46139008);
+	read32 (DEFAULT_DMIBAR | 0x0720);	// !!! = 0x46139008
+	write32 (DEFAULT_DMIBAR | 0x0720, 0x46139008);
+	read32 (DEFAULT_DMIBAR | 0x0c04);	// !!! = 0x2e680008
+	write32 (DEFAULT_DMIBAR | 0x0c04, 0x2e680008);
+	read32 (DEFAULT_DMIBAR | 0x0904);	// !!! = 0x7a1842ec
+	write32 (DEFAULT_DMIBAR | 0x0904, 0x3a1842ec);
+	read32 (DEFAULT_DMIBAR | 0x0924);	// !!! = 0x7a1842ec
+	write32 (DEFAULT_DMIBAR | 0x0924, 0x3a1842ec);
+	read32 (DEFAULT_DMIBAR | 0x0910);	// !!! = 0x00006300
+	write32 (DEFAULT_DMIBAR | 0x0910, 0x00004300);
+	read32 (DEFAULT_DMIBAR | 0x0930);	// !!! = 0x00006300
+	write32 (DEFAULT_DMIBAR | 0x0930, 0x00004300);
+	read32 (DEFAULT_DMIBAR | 0x0a00);	// !!! = 0x03042010
+	write32 (DEFAULT_DMIBAR | 0x0a00, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0a10);	// !!! = 0x03042010
+	write32 (DEFAULT_DMIBAR | 0x0a10, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0a20);	// !!! = 0x03042010
+	write32 (DEFAULT_DMIBAR | 0x0a20, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0a30);	// !!! = 0x03042010
+	write32 (DEFAULT_DMIBAR | 0x0a30, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0c00);	// !!! = 0x29700c08
+	write32 (DEFAULT_DMIBAR | 0x0c00, 0x29700c08);
+	read32 (DEFAULT_DMIBAR | 0x0a04);	// !!! = 0x0c0708f0
+	write32 (DEFAULT_DMIBAR | 0x0a04, 0x0c0718f0);
+	read32 (DEFAULT_DMIBAR | 0x0a14);	// !!! = 0x0c0708f0
+	write32 (DEFAULT_DMIBAR | 0x0a14, 0x0c0718f0);
+	read32 (DEFAULT_DMIBAR | 0x0a24);	// !!! = 0x0c0708f0
+	write32 (DEFAULT_DMIBAR | 0x0a24, 0x0c0718f0);
+	read32 (DEFAULT_DMIBAR | 0x0a34);	// !!! = 0x0c0708f0
+	write32 (DEFAULT_DMIBAR | 0x0a34, 0x0c0718f0);
+	read32 (DEFAULT_DMIBAR | 0x0900);	// !!! = 0x50000000
+	write32 (DEFAULT_DMIBAR | 0x0900, 0x50000000);
+	read32 (DEFAULT_DMIBAR | 0x0920);	// !!! = 0x50000000
+	write32 (DEFAULT_DMIBAR | 0x0920, 0x50000000);
+	read32 (DEFAULT_DMIBAR | 0x0908);	// !!! = 0x51ffffff
+	write32 (DEFAULT_DMIBAR | 0x0908, 0x51ffffff);
+	read32 (DEFAULT_DMIBAR | 0x0928);	// !!! = 0x51ffffff
+	write32 (DEFAULT_DMIBAR | 0x0928, 0x51ffffff);
+	read32 (DEFAULT_DMIBAR | 0x0a00);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a00, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0a10);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a10, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0a20);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a20, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0a30);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a30, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0700);	// !!! = 0x46139008
+	write32 (DEFAULT_DMIBAR | 0x0700, 0x46139008);
+	read32 (DEFAULT_DMIBAR | 0x0720);	// !!! = 0x46139008
+	write32 (DEFAULT_DMIBAR | 0x0720, 0x46139008);
+	read32 (DEFAULT_DMIBAR | 0x0904);	// !!! = 0x3a1842ec
+	write32 (DEFAULT_DMIBAR | 0x0904, 0x3a1846ec);
+	read32 (DEFAULT_DMIBAR | 0x0924);	// !!! = 0x3a1842ec
+	write32 (DEFAULT_DMIBAR | 0x0924, 0x3a1846ec);
+	read32 (DEFAULT_DMIBAR | 0x0a00);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a00, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0a10);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a10, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0a20);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a20, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0a30);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a30, 0x03042018);
+	read32 (DEFAULT_DMIBAR | 0x0908);	// !!! = 0x51ffffff
+	write32 (DEFAULT_DMIBAR | 0x0908, 0x51ffffff);
+	read32 (DEFAULT_DMIBAR | 0x0928);	// !!! = 0x51ffffff
+	write32 (DEFAULT_DMIBAR | 0x0928, 0x51ffffff);
+	read32 (DEFAULT_DMIBAR | 0x0c00);	// !!! = 0x29700c08
+	write32 (DEFAULT_DMIBAR | 0x0c00, 0x29700c08);
+	read32 (DEFAULT_DMIBAR | 0x0c0c);	// !!! = 0x16063400
+	write32 (DEFAULT_DMIBAR | 0x0c0c, 0x00063400);
+	read32 (DEFAULT_DMIBAR | 0x0700);	// !!! = 0x46139008
+	write32 (DEFAULT_DMIBAR | 0x0700, 0x46339008);
+	read32 (DEFAULT_DMIBAR | 0x0720);	// !!! = 0x46139008
+	write32 (DEFAULT_DMIBAR | 0x0720, 0x46339008);
+	read32 (DEFAULT_DMIBAR | 0x0700);	// !!! = 0x46339008
+	write32 (DEFAULT_DMIBAR | 0x0700, 0x45339008);
+	read32 (DEFAULT_DMIBAR | 0x0720);	// !!! = 0x46339008
+	write32 (DEFAULT_DMIBAR | 0x0720, 0x45339008);
+	read32 (DEFAULT_DMIBAR | 0x0700);	// !!! = 0x45339008
+	write32 (DEFAULT_DMIBAR | 0x0700, 0x453b9008);
+	read32 (DEFAULT_DMIBAR | 0x0720);	// !!! = 0x45339008
+	write32 (DEFAULT_DMIBAR | 0x0720, 0x453b9008);
+	read32 (DEFAULT_DMIBAR | 0x0700);	// !!! = 0x453b9008
+	write32 (DEFAULT_DMIBAR | 0x0700, 0x45bb9008);
+	read32 (DEFAULT_DMIBAR | 0x0720);	// !!! = 0x453b9008
+	write32 (DEFAULT_DMIBAR | 0x0720, 0x45bb9008);
+	read32 (DEFAULT_DMIBAR | 0x0700);	// !!! = 0x45bb9008
+	write32 (DEFAULT_DMIBAR | 0x0700, 0x45fb9008);
+	read32 (DEFAULT_DMIBAR | 0x0720);	// !!! = 0x45bb9008
+	write32 (DEFAULT_DMIBAR | 0x0720, 0x45fb9008);
+	read32 (DEFAULT_DMIBAR | 0x0914);	// !!! = 0x9021a080
+	write32 (DEFAULT_DMIBAR | 0x0914, 0x9021a280);
+	read32 (DEFAULT_DMIBAR | 0x0934);	// !!! = 0x9021a080
+	write32 (DEFAULT_DMIBAR | 0x0934, 0x9021a280);
+	read32 (DEFAULT_DMIBAR | 0x0914);	// !!! = 0x9021a280
+	write32 (DEFAULT_DMIBAR | 0x0914, 0x9821a280);
+	read32 (DEFAULT_DMIBAR | 0x0934);	// !!! = 0x9021a280
+	write32 (DEFAULT_DMIBAR | 0x0934, 0x9821a280);
+	read32 (DEFAULT_DMIBAR | 0x0a00);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a00, 0x03242018);
+	read32 (DEFAULT_DMIBAR | 0x0a10);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a10, 0x03242018);
+	read32 (DEFAULT_DMIBAR | 0x0a20);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a20, 0x03242018);
+	read32 (DEFAULT_DMIBAR | 0x0a30);	// !!! = 0x03042018
+	write32 (DEFAULT_DMIBAR | 0x0a30, 0x03242018);
+	read32 (DEFAULT_DMIBAR | 0x0258);	// !!! = 0x40000600
+	write32 (DEFAULT_DMIBAR | 0x0258, 0x60000600);
+	read32 (DEFAULT_DMIBAR | 0x0904);	// !!! = 0x3a1846ec
+	write32 (DEFAULT_DMIBAR | 0x0904, 0x2a1846ec);
+	read32 (DEFAULT_DMIBAR | 0x0914);	// !!! = 0x9821a280
+	write32 (DEFAULT_DMIBAR | 0x0914, 0x98200280);
+	read32 (DEFAULT_DMIBAR | 0x0924);	// !!! = 0x3a1846ec
+	write32 (DEFAULT_DMIBAR | 0x0924, 0x2a1846ec);
+	read32 (DEFAULT_DMIBAR | 0x0934);	// !!! = 0x9821a280
+	write32 (DEFAULT_DMIBAR | 0x0934, 0x98200280);
+	read32 (DEFAULT_DMIBAR | 0x022c);	// !!! = 0x00c26460
+	write32 (DEFAULT_DMIBAR | 0x022c, 0x00c2403c);
+	read8 (DEFAULT_RCBA | 0x21a4);	// !!! = 0x42
+
+	read32 (DEFAULT_RCBA | 0x21a4);	// !!! = 0x00012c42
+	read32 (DEFAULT_RCBA | 0x2340);	// !!! = 0x0013001b
+	write32 (DEFAULT_RCBA | 0x2340, 0x003a001b);
+	read8 (DEFAULT_RCBA | 0x21b0);	// !!! = 0x01
+	write8 (DEFAULT_RCBA | 0x21b0, 0x02);
+	read32 (DEFAULT_DMIBAR | 0x0084);	// !!! = 0x0041ac41
+	write32 (DEFAULT_DMIBAR | 0x0084, 0x0041ac42);
+	read8 (DEFAULT_DMIBAR | 0x0088);	// !!! = 0x00
+	write8 (DEFAULT_DMIBAR | 0x0088, 0x20);
+	read16 (DEFAULT_DMIBAR | 0x008a);	// !!! = 0x0041
+	read8 (DEFAULT_DMIBAR | 0x0088);	// !!! = 0x00
+	write8 (DEFAULT_DMIBAR | 0x0088, 0x20);
+	read16 (DEFAULT_DMIBAR | 0x008a);	// !!! = 0x0042
+	read16 (DEFAULT_DMIBAR | 0x008a);	// !!! = 0x0042
+
+	read32 (DEFAULT_DMIBAR | 0x0014);	// !!! = 0x8000007f
+	write32 (DEFAULT_DMIBAR | 0x0014, 0x80000019);
+	read32 (DEFAULT_DMIBAR | 0x0020);	// !!! = 0x01000000
+	write32 (DEFAULT_DMIBAR | 0x0020, 0x81000022);
+	read32 (DEFAULT_DMIBAR | 0x002c);	// !!! = 0x02000000
+	write32 (DEFAULT_DMIBAR | 0x002c, 0x82000044);
+	read32 (DEFAULT_DMIBAR | 0x0038);	// !!! = 0x07000080
+	write32 (DEFAULT_DMIBAR | 0x0038, 0x87000080);
+	read8 (DEFAULT_DMIBAR | 0x0004);	// !!! = 0x00
+	write8 (DEFAULT_DMIBAR | 0x0004, 0x01);
+
+	read32 (DEFAULT_RCBA | 0x0050);	// !!! = 0x01200654
+	write32 (DEFAULT_RCBA | 0x0050, 0x01200654);
+	read32 (DEFAULT_RCBA | 0x0050);	// !!! = 0x01200654
+	write32 (DEFAULT_RCBA | 0x0050, 0x012a0654);
+	read32 (DEFAULT_RCBA | 0x0050);	// !!! = 0x012a0654
+	read8 (DEFAULT_RCBA | 0x1114);	// !!! = 0x00
+	write8 (DEFAULT_RCBA | 0x1114, 0x05);
+	read32 (DEFAULT_RCBA | 0x2014);	// !!! = 0x80000011
+	write32 (DEFAULT_RCBA | 0x2014, 0x80000019);
+	read32 (DEFAULT_RCBA | 0x2020);	// !!! = 0x00000000
+	write32 (DEFAULT_RCBA | 0x2020, 0x81000022);
+	read32 (DEFAULT_RCBA | 0x2020);	// !!! = 0x81000022
+	read32 (DEFAULT_RCBA | 0x2030);	// !!! = 0x00000000
+	write32 (DEFAULT_RCBA | 0x2030, 0x82000044);
+	read32 (DEFAULT_RCBA | 0x2030);	// !!! = 0x82000044
+	read32 (DEFAULT_RCBA | 0x2040);	// !!! = 0x00000000
+	write32 (DEFAULT_RCBA | 0x2040, 0x87000080);
+	read32 (DEFAULT_RCBA | 0x0050);	// !!! = 0x012a0654
+	write32 (DEFAULT_RCBA | 0x0050, 0x812a0654);
+	read32 (DEFAULT_RCBA | 0x0050);	// !!! = 0x812a0654
+	read16 (DEFAULT_RCBA | 0x201a);	// !!! = 0x0000
+	read16 (DEFAULT_RCBA | 0x2026);	// !!! = 0x0000
+	read16 (DEFAULT_RCBA | 0x2036);	// !!! = 0x0000
+	read16 (DEFAULT_RCBA | 0x2046);	// !!! = 0x0000
+	read16 (DEFAULT_DMIBAR | 0x001a);	// !!! = 0x0000
+	read16 (DEFAULT_DMIBAR | 0x0026);	// !!! = 0x0000
+	read16 (DEFAULT_DMIBAR | 0x0032);	// !!! = 0x0000
+	read16 (DEFAULT_DMIBAR | 0x003e);	// !!! = 0x0000
+}
+
+void
+early_pch_init_native (void)
+{
+	pcie_write_config8 (SOUTHBRIDGE, 0xa6,
+			    pcie_read_config8 (SOUTHBRIDGE, 0xa6) | 2);
+
+	write32 (DEFAULT_RCBA | 0x2088, 0x00109000);
+	read32 (DEFAULT_RCBA | 0x20ac);	// !!! = 0x00000000
+	write32 (DEFAULT_RCBA | 0x20ac, 0x40000000);
+	write32 (DEFAULT_RCBA | 0x100c, 0x01110000);
+	write8 (DEFAULT_RCBA | 0x2340, 0x1b);
+	read32 (DEFAULT_RCBA | 0x2314);	// !!! = 0x0a080000
+	write32 (DEFAULT_RCBA | 0x2314, 0x0a280000);
+	read32 (DEFAULT_RCBA | 0x2310);	// !!! = 0xc809605b
+	write32 (DEFAULT_RCBA | 0x2310, 0xa809605b);
+	write32 (DEFAULT_RCBA | 0x2324, 0x00854c74);
+	read8 (DEFAULT_RCBA | 0x0400);	// !!! = 0x00
+	read32 (DEFAULT_RCBA | 0x2310);	// !!! = 0xa809605b
+	write32 (DEFAULT_RCBA | 0x2310, 0xa809605b);
+	read32 (DEFAULT_RCBA | 0x2310);	// !!! = 0xa809605b
+	write32 (DEFAULT_RCBA | 0x2310, 0xa809605b);
+
+	write_2338 (0xea007f62, 0x00590133);
+	write_2338 (0xec007f62, 0x00590133);
+	write_2338 (0xec007f64, 0x59555588);
+	write_2338 (0xea0040b9, 0x0001051c);
+	write_2338 (0xeb0040a1, 0x800084ff);
+	write_2338 (0xec0040a1, 0x800084ff);
+	write_2338 (0xea004001, 0x00008400);
+	write_2338 (0xeb004002, 0x40201758);
+	write_2338 (0xec004002, 0x40201758);
+	write_2338 (0xea004002, 0x00601758);
+	write_2338 (0xea0040a1, 0x810084ff);
+	write_2338 (0xeb0040b1, 0x0001c598);
+	write_2338 (0xec0040b1, 0x0001c598);
+	write_2338 (0xeb0040b6, 0x0001c598);
+	write_2338 (0xea0000a9, 0x80ff969f);
+	write_2338 (0xea0001a9, 0x80ff969f);
+	write_2338 (0xeb0040b2, 0x0001c396);
+	write_2338 (0xeb0040b3, 0x0001c396);
+	write_2338 (0xec0040b2, 0x0001c396);
+	write_2338 (0xea0001a9, 0x80ff94ff);
+	write_2338 (0xea000151, 0x0088037f);
+	write_2338 (0xea0000a9, 0x80ff94ff);
+	write_2338 (0xea000051, 0x0088037f);
+
+	write_2338 (0xea007f05, 0x00010642);
+	write_2338 (0xea0040b7, 0x0001c91c);
+	write_2338 (0xea0040b8, 0x0001c91c);
+	write_2338 (0xeb0040a1, 0x820084ff);
+	write_2338 (0xec0040a1, 0x820084ff);
+	write_2338 (0xea007f0a, 0xc2480000);
+
+	write_2338 (0xec00404d, 0x1ff177f);
+	write_2338 (0xec000084, 0x5a600000);
+	write_2338 (0xec000184, 0x5a600000);
+	write_2338 (0xec000284, 0x5a600000);
+	write_2338 (0xec000384, 0x5a600000);
+	write_2338 (0xec000094, 0x000f0501);
+	write_2338 (0xec000194, 0x000f0501);
+	write_2338 (0xec000294, 0x000f0501);
+	write_2338 (0xec000394, 0x000f0501);
+	write_2338 (0xec000096, 0x00000001);
+	write_2338 (0xec000196, 0x00000001);
+	write_2338 (0xec000296, 0x00000001);
+	write_2338 (0xec000396, 0x00000001);
+	write_2338 (0xec000001, 0x00008c08);
+	write_2338 (0xec000101, 0x00008c08);
+	write_2338 (0xec000201, 0x00008c08);
+	write_2338 (0xec000301, 0x00008c08);
+	write_2338 (0xec0040b5, 0x0001c518);
+	write_2338 (0xec000087, 0x06077597);
+	write_2338 (0xec000187, 0x06077597);
+	write_2338 (0xec000287, 0x06077597);
+	write_2338 (0xec000387, 0x06077597);
+	write_2338 (0xea000050, 0x00bb0157);
+	write_2338 (0xea000150, 0x00bb0157);
+	write_2338 (0xec007f60, 0x77777d77);
+	write_2338 (0xea00008d, 0x01320000);
+	write_2338 (0xea00018d, 0x01320000);
+	write_2338 (0xec0007b2, 0x04514b5e);
+	write_2338 (0xec00078c, 0x40000200);
+	write_2338 (0xec000780, 0x02000020);
+
+	init_dmi();
+}
diff --git a/src/southbridge/intel/bd82x6x/early_thermal.c b/src/southbridge/intel/bd82x6x/early_thermal.c
new file mode 100644
index 0000000..02ec9a7
--- /dev/null
+++ b/src/southbridge/intel/bd82x6x/early_thermal.c
@@ -0,0 +1,70 @@
+/*
+ * This file is part of the coreboot project.
+ *
+ * Copyright (C) 2014 Vladimir Serbinenko
+ *
+ * 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, or (at your option) any later version.
+ *
+ * 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 "pch.h"
+#include "cpu/intel/model_206ax/model_206ax.h"
+#include <cpu/x86/msr.h>
+
+/* Early thermal init, must be done prior to giving ME its memory
+   which is done at the end of raminit.  */
+void early_thermal_init(void)
+{
+	device_t dev;
+	msr_t msr;
+
+	dev = PCI_DEV(0x0, 0x1f, 0x6);
+
+	/* Program address for temporary BAR.  */
+	pci_write_config32(dev, 0x40, 0x40000000);
+	pci_write_config32(dev, 0x44, 0x0);
+
+	/* Activate temporary BAR.  */
+	pci_write_config32(dev, 0x40,
+			   pci_read_config32(dev, 0x40) | 5);
+
+
+	write16 (0x40000004, 0x3a2b);
+	write8 (0x4000000c, 0xff);
+	write8 (0x4000000d, 0x00);
+	write8 (0x4000000e, 0x40);
+	write8 (0x40000082, 0x00);
+	write8 (0x40000001, 0xba);
+
+	/* Perform init.  */
+	/* Configure TJmax.  */
+	msr = rdmsr(MSR_TEMPERATURE_TARGET);
+	write16(0x40000012, ((msr.lo >> 16) & 0xff) << 6);
+	/* Northbridge temperature slope and offset.  */
+	write16(0x40000016, 0x808c);
+
+	write16 (0x40000014, 0xde87);
+
+	/* Enable thermal data reporting, processor, PCH and northbridge.  */
+	write16(0x4000001a, (read16(0x4000001a) & ~0xf) | 0x10f0);
+
+	/* Disable temporary BAR.  */
+	pci_write_config32(dev, 0x40,
+			   pci_read_config32(dev, 0x40) & ~1);
+	pci_write_config32(dev, 0x40, 0);
+
+	write32 (DEFAULT_RCBA | 0x38b0,
+		 (read32 (DEFAULT_RCBA | 0x38b0) & 0xffff8003) | 0x403c);
+}
diff --git a/src/southbridge/intel/bd82x6x/pch.h b/src/southbridge/intel/bd82x6x/pch.h
index 90de855..83128e2 100644
--- a/src/southbridge/intel/bd82x6x/pch.h
+++ b/src/southbridge/intel/bd82x6x/pch.h
@@ -74,6 +74,8 @@
 void enable_usb_bar(void);
 int smbus_read_byte(unsigned device, unsigned address);
 int early_spi_read(u32 offset, u32 size, u8 *buffer);
+void early_thermal_init(void);
+void early_pch_init_native(void);
 #endif
 #endif
 
diff --git a/src/southbridge/intel/bd82x6x/smi.c b/src/southbridge/intel/bd82x6x/smi.c
index 0166edf..a20232e 100644
--- a/src/southbridge/intel/bd82x6x/smi.c
+++ b/src/southbridge/intel/bd82x6x/smi.c
@@ -29,10 +29,7 @@
 #include <cpu/x86/smm.h>
 #include <string.h>
 #include "pch.h"
-
-#if CONFIG_NORTHBRIDGE_INTEL_SANDYBRIDGE || CONFIG_NORTHBRIDGE_INTEL_IVYBRIDGE
 #include "northbridge/intel/sandybridge/sandybridge.h"
-#endif
 
 extern unsigned char _binary_smm_start;
 extern unsigned char _binary_smm_end;
diff --git a/src/southbridge/intel/bd82x6x/usb_ehci.c b/src/southbridge/intel/bd82x6x/usb_ehci.c
index 78f92d9..97f20bd 100644
--- a/src/southbridge/intel/bd82x6x/usb_ehci.c
+++ b/src/southbridge/intel/bd82x6x/usb_ehci.c
@@ -18,6 +18,7 @@
  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
  */
 
+#include <kconfig.h>
 #include <console/console.h>
 #include <device/device.h>
 #include <device/pci.h>
@@ -36,11 +37,43 @@
 	RCBA32(0x35b0) = reg32;
 
 	printk(BIOS_DEBUG, "EHCI: Setting up controller.. ");
+
+	/* For others, done in MRC.  */
+#if IS_ENABLED(CONFIG_NORTHBRIDGE_INTEL_IVYBRIDGE_NATIVE)
+	pci_write_config32(dev, 0x84, 0x930c8811);
+	pci_write_config32(dev, 0x88, 0x24000d30);
+	pci_write_config32(dev, 0xf4, 0x80408588);
+	pci_write_config32(dev, 0xf4, 0x80808588);
+	pci_write_config32(dev, 0xf4, 0x00808588);
+	pci_write_config32(dev, 0xfc, 0x205b1708);
+#endif
+
 	reg32 = pci_read_config32(dev, PCI_COMMAND);
 	reg32 |= PCI_COMMAND_MASTER;
 	//reg32 |= PCI_COMMAND_SERR;
 	pci_write_config32(dev, PCI_COMMAND, reg32);
 
+	/* For others, done in MRC.  */
+#if IS_ENABLED(CONFIG_NORTHBRIDGE_INTEL_IVYBRIDGE_NATIVE)
+	struct resource *res;
+	u8 access_cntl;
+
+	access_cntl = pci_read_config8(dev, 0x80);
+
+	/* Enable writes to protected registers. */
+	pci_write_config8(dev, 0x80, access_cntl | 1);
+
+	res = find_resource(dev, PCI_BASE_ADDRESS_0);
+	if (res) {
+		/* Number of ports and companion controllers.  */
+		reg32 = read32(res->base + 4);
+		write32(res->base + 4, (reg32 & 0xfff00000) | 3);
+	}
+
+	/* Restore protection. */
+	pci_write_config8(dev, 0x80, access_cntl);
+#endif
+
 	printk(BIOS_DEBUG, "done.\n");
 }