src/southbridge/amd/sb700/early_setup.c

   1 /*
   2  * This file is part of the coreboot project.
   3  *
   4  * Copyright (C) 2010 Advanced Micro Devices, Inc.
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; version 2 of the License.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  18  */
  19
  20 #ifndef _SB700_EARLY_SETUP_C_
  21 #define _SB700_EARLY_SETUP_C_
  22
  23 #include <reset.h>
  24 #include <arch/cpu.h>
  25 #include <cbmem.h>
  26 #include "sb700.h"
  27 #include "smbus.c"
  28
  29 #define SMBUS_IO_BASE 0x6000    /* Is it a temporary SMBus I/O base address? */
  30          /*SIZE 0x40 */
  31
  32 static void pmio_write(u8 reg, u8 value)
  33 {
  34         outb(reg, PM_INDEX);
  35         outb(value, PM_INDEX + 1);
  36 }
  37
  38 static u8 pmio_read(u8 reg)
  39 {
  40         outb(reg, PM_INDEX);
  41         return inb(PM_INDEX + 1);
  42 }
  43
  44 static void sb700_acpi_init(void)
  45 {
  46         pmio_write(0x20, ACPI_PM_EVT_BLK & 0xFF);
  47         pmio_write(0x21, ACPI_PM_EVT_BLK >> 8);
  48         pmio_write(0x22, ACPI_PM1_CNT_BLK & 0xFF);
  49         pmio_write(0x23, ACPI_PM1_CNT_BLK >> 8);
  50         pmio_write(0x24, ACPI_PM_TMR_BLK & 0xFF);
  51         pmio_write(0x25, ACPI_PM_TMR_BLK >> 8);
  52         pmio_write(0x28, ACPI_GPE0_BLK & 0xFF);
  53         pmio_write(0x29, ACPI_GPE0_BLK >> 8);
  54
  55         /* CpuControl is in \_PR.CPU0, 6 bytes */
  56         pmio_write(0x26, ACPI_CPU_CONTROL & 0xFF);
  57         pmio_write(0x27, ACPI_CPU_CONTROL >> 8);
  58
  59         pmio_write(0x2A, 0);    /* AcpiSmiCmdLo */
  60         pmio_write(0x2B, 0);    /* AcpiSmiCmdHi */
  61
  62         pmio_write(0x2C, ACPI_PMA_CNT_BLK & 0xFF);
  63         pmio_write(0x2D, ACPI_PMA_CNT_BLK >> 8);
  64
  65         pmio_write(0x0E, 1<<3 | 0<<2); /* AcpiDecodeEnable, When set, SB uses
  66                                         * the contents of the PM registers at
  67                                         * index 20-2B to decode ACPI I/O address.
  68                                         * AcpiSmiEn & SmiCmdEn*/
  69         pmio_write(0x10, 1<<1 | 1<<3| 1<<5); /* RTC_En_En, TMR_En_En, GBL_EN_EN */
  70 }
  71
  72 /* RPR 2.28: Get SB ASIC Revision. */
  73 static u8 set_sb700_revision(void)
  74 {
  75         device_t dev;
  76         u8 rev_id, enable_14Mhz, byte;
  77         u8 rev = 0;
  78
  79         /* if (rev != 0) return rev; */
  80
  81         dev = pci_locate_device(PCI_ID(0x1002, 0x4385), 0);
  82
  83         if (dev == PCI_DEV_INVALID) {
  84                 die("SMBUS controller not found\n");
  85                 /* NOT REACHED */
  86         }
  87         rev_id =  pci_read_config8(dev, 0x08);
  88
  89         if (rev_id == 0x39) {
  90                 enable_14Mhz = (pmio_read(0x53) >> 6) & 1;
  91                 if (enable_14Mhz == 0x0)
  92                         rev = 0x11;     /* A11 */
  93                 else if (enable_14Mhz == 0x1) {
  94                         /* This happens, if does, only once. So later if we need to get
  95                          * the revision ID, we don't have to make such a big function.
  96                          * We just get reg 0x8 in smbus dev. 0x39 is A11, 0x3A is A12. */
  97                         rev = 0x12;
  98                         byte = pci_read_config8(dev, 0x40);
  99                         byte |= 1 << 0;
 100                         pci_write_config8(dev, 0x40, byte);
 101
 102                         pci_write_config8(dev, 0x08, 0x3A); /* Change 0x39 to 0x3A. */
 103
 104                         byte &= ~(1 << 0);
 105                         pci_write_config8(dev, 0x40, byte);
 106                 }
 107         } else if (rev_id == 0x3A) { /* A12 will be 0x3A after BIOS is initialized */
 108                 rev = 0x12;
 109         } else if (rev_id == 0x3C) {
 110                 rev = 0x14;
 111         } else if (rev_id == 0x3D) {
 112                 rev = 0x15;
 113         } else
 114                 die("It is not SB700 or SB710\n");
 115
 116         return rev;
 117 }
 118
 119 /***************************************
 120 * Legacy devices are mapped to LPC space.
 121 *       Serial port 0
 122 *       KBC Port
 123 *       ACPI Micro-controller port
 124 *       This function does not change port 0x80 decoding.
 125 *       Console output through any port besides 0x3f8 is unsupported.
 126 *       If you use FWH ROMs, you have to setup IDSEL.
 127 ***************************************/
 128 static void sb700_lpc_init(void)
 129 {
 130         u8 reg8;
 131         u32 reg32;
 132         device_t dev;
 133
 134         dev = pci_locate_device(PCI_ID(0x1002, 0x4385), 0);     /* SMBUS controller */
 135         /* NOTE: Set BootTimerDisable, otherwise it would keep rebooting!!
 136          * This bit has no meaning if debug strap is not enabled. So if the
 137          * board keeps rebooting and the code fails to reach here, we could
 138          * disable the debug strap first. */
 139         reg32 = pci_read_config32(dev, 0x4C);
 140         reg32 |= 1 << 31;
 141         pci_write_config32(dev, 0x4C, reg32);
 142
 143         /* Enable lpc controller */
 144         reg32 = pci_read_config32(dev, 0x64);
 145         reg32 |= 1 << 20;
 146         pci_write_config32(dev, 0x64, reg32);
 147
 148         dev = pci_locate_device(PCI_ID(0x1002, 0x439d), 0);     /* LPC Controller */
 149         /* Decode port 0x3f8-0x3ff (Serial 0) */
 150         // XXX Serial port decode on LPC is hardcoded to 0x3f8
 151         reg8 = pci_read_config8(dev, 0x44);
 152         reg8 |= 1 << 6;
 153         pci_write_config8(dev, 0x44, reg8);
 154
 155         /* Decode port 0x60 & 0x64 (PS/2 keyboard) and port 0x62 & 0x66 (ACPI)*/
 156         reg8 = pci_read_config8(dev, 0x47);
 157         reg8 |= (1 << 5) | (1 << 6);
 158         pci_write_config8(dev, 0x47, reg8);
 159
 160         /* Enable PrefetchEnSPIFromHost to speed up SPI flash read (does not affect LPC) */
 161         reg8 = pci_read_config8(dev, 0xbb);
 162         reg8 |= 1 << 0;
 163         pci_write_config8(dev, 0xbb, reg8);
 164
 165         /* Super I/O, RTC */
 166         reg8 = pci_read_config8(dev, 0x48);
 167         /* Decode ports 0x2e-0x2f, 0x4e-0x4f (SuperI/O configuration) */
 168         reg8 |= (1 << 1) | (1 << 0);
 169         /* Decode port 0x70-0x73 (RTC) */
 170         reg8 |= (1 << 6);
 171         pci_write_config8(dev, 0x48, reg8);
 172 }
 173
 174 /* what is its usage? */
 175 static u32 get_sbdn(u32 bus)
 176 {
 177         device_t dev;
 178
 179         /* Find the device. */
 180         dev = pci_locate_device_on_bus(PCI_ID(0x1002, 0x4385), bus);
 181         return (dev >> 15) & 0x1f;
 182 }
 183
 184 static u8 dual_core(void)
 185 {
 186         return (pci_read_config32(PCI_DEV(0, 0x18, 3), 0xE8) & (0x3<<12)) != 0;
 187 }
 188
 189 /*
 190  * RPR 2.4 C-state and VID/FID change for the K8 platform.
 191  */
 192 static void enable_fid_change_on_sb(u32 sbbusn, u32 sbdn)
 193 {
 194         u8 byte;
 195         byte = pmio_read(0x9a);
 196         byte &= ~0x34;
 197         if (dual_core())
 198                 byte |= 0x34;
 199         else
 200                 byte |= 0x04;
 201         pmio_write(0x9a, byte);
 202
 203         byte = pmio_read(0x8f);
 204         byte &= ~0x30;
 205         byte |= 0x20;
 206         pmio_write(0x8f, byte);
 207
 208         pmio_write(0x8b, 0x01); /* TODO: if the HT Link is 200 MHz, it is 0x0A. It doesnt often happen. */
 209         pmio_write(0x8a, 0x90);
 210
 211         pmio_write(0x88, 0x10);
 212
 213         byte = pmio_read(0x7c);
 214         byte |= 0x03;
 215         pmio_write(0x7c, byte);
 216
 217         /* Must be 0 for K8 platform. */
 218         byte = pmio_read(0x68);
 219         byte &= ~0x01;
 220         pmio_write(0x68, byte);
 221         /* Must be 0 for K8 platform. */
 222         byte = pmio_read(0x8d);
 223         byte &= ~(1<<6);
 224         pmio_write(0x8d, byte);
 225
 226         byte = pmio_read(0x61);
 227         byte &= ~0x04;
 228         pmio_write(0x61, byte);
 229
 230         byte = pmio_read(0x42);
 231         byte &= ~0x04;
 232         pmio_write(0x42, byte);
 233
 234         pmio_write(0x89, 0x10);
 235 }
 236
 237 void hard_reset(void)
 238 {
 239         set_bios_reset();
 240
 241         /* full reset */
 242         outb(0x0a, 0x0cf9);
 243         outb(0x0e, 0x0cf9);
 244 }
 245
 246 void soft_reset(void)
 247 {
 248         set_bios_reset();
 249         /* link reset */
 250         outb(0x06, 0x0cf9);
 251 }
 252
 253 void sb700_pci_port80(void)
 254 {
 255         u8 byte;
 256         device_t dev;
 257
 258         /* P2P Bridge */
 259         dev = pci_locate_device(PCI_ID(0x1002, 0x4384), 0);
 260
 261         /* Chip Control: Enable subtractive decoding */
 262         byte = pci_read_config8(dev, 0x40);
 263         byte |= 1 << 5;
 264         pci_write_config8(dev, 0x40, byte);
 265
 266         /* Misc Control: Enable subtractive decoding if 0x40 bit 5 is set */
 267         byte = pci_read_config8(dev, 0x4B);
 268         byte |= 1 << 7;
 269         pci_write_config8(dev, 0x4B, byte);
 270
 271         /* The same IO Base and IO Limit here is meaningful because we set the
 272          * bridge to be subtractive. During early setup stage, we have to make
 273          * sure that data can go through port 0x80.
 274          */
 275         /* IO Base: 0xf000 */
 276         byte = pci_read_config8(dev, 0x1C);
 277         byte |= 0xF << 4;
 278         pci_write_config8(dev, 0x1C, byte);
 279
 280         /* IO Limit: 0xf000 */
 281         byte = pci_read_config8(dev, 0x1D);
 282         byte |= 0xF << 4;
 283         pci_write_config8(dev, 0x1D, byte);
 284
 285         /* PCI Command: Enable IO response */
 286         byte = pci_read_config8(dev, 0x04);
 287         byte |= 1 << 0;
 288         pci_write_config8(dev, 0x04, byte);
 289
 290         /* LPC controller */
 291         dev = pci_locate_device(PCI_ID(0x1002, 0x439D), 0);
 292
 293         byte = pci_read_config8(dev, 0x4A);
 294         byte &= ~(1 << 5);      /* disable lpc port 80 */
 295         pci_write_config8(dev, 0x4A, byte);
 296 }
 297
 298 void sb700_lpc_port80(void)
 299 {
 300         u8 byte;
 301         device_t dev;
 302         u32 reg32;
 303
 304         /* Enable LPC controller */
 305         dev = pci_locate_device(PCI_ID(0x1002, 0x4385), 0);
 306         reg32 = pci_read_config32(dev, 0x64);
 307         reg32 |= 0x00100000;    /* lpcEnable */
 308         pci_write_config32(dev, 0x64, reg32);
 309
 310         /* Enable port 80 LPC decode in pci function 3 configuration space. */
 311         dev = pci_locate_device(PCI_ID(0x1002, 0x439d), 0);
 312         byte = pci_read_config8(dev, 0x4a);
 313         byte |= 1 << 5;         /* enable port 80 */
 314         pci_write_config8(dev, 0x4a, byte);
 315 }
 316
 317 /* sbDevicesPorInitTable */
 318 static void sb700_devices_por_init(void)
 319 {
 320         device_t dev;
 321         u8 byte;
 322
 323         printk(BIOS_INFO, "sb700_devices_por_init()\n");
 324         /* SMBus Device, BDF:0-20-0 */
 325         printk(BIOS_INFO, "sb700_devices_por_init(): SMBus Device, BDF:0-20-0\n");
 326         dev = pci_locate_device(PCI_ID(0x1002, 0x4385), 0);
 327
 328         if (dev == PCI_DEV_INVALID) {
 329                 die("SMBUS controller not found\n");
 330                 /* NOT REACHED */
 331         }
 332         printk(BIOS_INFO, "SMBus controller enabled, sb revision is A%x\n",
 333                     set_sb700_revision());
 334
 335         /* sbPorAtStartOfTblCfg */
 336         /* Set A-Link bridge access address. This address is set at device 14h, function 0, register 0xf0.
 337          * This is an I/O address. The I/O address must be on 16-byte boundry.  */
 338         pci_write_config32(dev, 0xf0, AB_INDX);
 339
 340         /* To enable AB/BIF DMA access, a specific register inside the BIF register space needs to be configured first. */
 341         /* 4.3:Enables the SB700 to send transactions upstream over A-Link Express interface. */
 342         axcfg_reg(0x04, 1 << 2, 1 << 2);
 343         axindxc_reg(0x21, 0xff, 0);
 344
 345         /* 2.5:Enabling Non-Posted Memory Write for the K8 Platform */
 346         axindxc_reg(0x10, 1 << 9, 1 << 9);
 347         /* END of sbPorAtStartOfTblCfg */
 348
 349         /* sbDevicesPorInitTables */
 350         /* set smbus iobase */
 351         pci_write_config32(dev, 0x90, SMBUS_IO_BASE | 1);
 352
 353         /* enable smbus controller interface */
 354         byte = pci_read_config8(dev, 0xd2);
 355         byte |= (1 << 0);
 356         pci_write_config8(dev, 0xd2, byte);
 357
 358         /* KB2RstEnable */
 359         pci_write_config8(dev, 0x40, 0x44);
 360
 361         /* Enable ISA Address 0-960K decoding */
 362         pci_write_config8(dev, 0x48, 0x0f);
 363
 364         /* Enable ISA  Address 0xC0000-0xDFFFF decode */
 365         pci_write_config8(dev, 0x49, 0xff);
 366
 367         /* Enable decode cycles to IO C50, C51, C52 GPM controls. */
 368         byte = pci_read_config8(dev, 0x41);
 369         byte &= 0x80;
 370         byte |= 0x33;
 371         pci_write_config8(dev, 0x41, byte);
 372
 373         /* Legacy DMA Prefetch Enhancement, CIM masked it. */
 374         /* pci_write_config8(dev, 0x43, 0x1); */
 375
 376         /* Disabling Legacy USB Fast SMI# */
 377         byte = pci_read_config8(dev, 0x62);
 378         byte |= 0x24;
 379         pci_write_config8(dev, 0x62, byte);
 380
 381         /* Features Enable */
 382         pci_write_config32(dev, 0x64, 0x829E79BF); /* bit10: Enables the HPET interrupt. */
 383
 384         /* SerialIrq Control */
 385         pci_write_config8(dev, 0x69, 0x90);
 386
 387         /* Test Mode, PCIB_SReset_En Mask is set. */
 388         pci_write_config8(dev, 0x6c, 0x20);
 389
 390         /* IO Address Enable, CIM set 0x78 only and masked 0x79. */
 391         /*pci_write_config8(dev, 0x79, 0x4F); */
 392         pci_write_config8(dev, 0x78, 0xFF);
 393
 394         /* Set smbus iospace enable, I don't know why write 0x04 into reg5 that is reserved */
 395         pci_write_config16(dev, 0x4, 0x0407);
 396
 397         /* clear any lingering errors, so the transaction will run */
 398         outb(inb(SMBUS_IO_BASE + SMBHSTSTAT), SMBUS_IO_BASE + SMBHSTSTAT);
 399
 400         /* IDE Device, BDF:0-20-1 */
 401         printk(BIOS_INFO, "sb700_devices_por_init(): IDE Device, BDF:0-20-1\n");
 402         dev = pci_locate_device(PCI_ID(0x1002, 0x439C), 0);
 403         /* Disable prefetch */
 404         byte = pci_read_config8(dev, 0x63);
 405         byte |= 0x1;
 406         pci_write_config8(dev, 0x63, byte);
 407
 408         /* LPC Device, BDF:0-20-3 */
 409         printk(BIOS_INFO, "sb700_devices_por_init(): LPC Device, BDF:0-20-3\n");
 410         dev = pci_locate_device(PCI_ID(0x1002, 0x439D), 0);
 411         /* DMA enable */
 412         pci_write_config8(dev, 0x40, 0x04);
 413
 414         /* LPC Sync Timeout */
 415         pci_write_config8(dev, 0x49, 0xFF);
 416
 417         /* Enable Tpm12_en and Tpm_legacy. I don't know what is its usage and copied from CIM. */
 418         pci_write_config8(dev, 0x7C, 0x05);
 419
 420         /* P2P Bridge, BDF:0-20-4, the configuration of the registers in this dev are copied from CIM,
 421          */
 422         printk(BIOS_INFO, "sb700_devices_por_init(): P2P Bridge, BDF:0-20-4\n");
 423         dev = pci_locate_device(PCI_ID(0x1002, 0x4384), 0);
 424
 425         /* Arbiter enable. */
 426         pci_write_config8(dev, 0x43, 0xff);
 427
 428         /* Set PCDMA request into hight priority list. */
 429         /* pci_write_config8(dev, 0x49, 0x1) */ ;
 430
 431         pci_write_config8(dev, 0x40, 0x26);
 432
 433         pci_write_config8(dev, 0x0d, 0x40);
 434         pci_write_config8(dev, 0x1b, 0x40);
 435         /* Enable PCIB_DUAL_EN_UP will fix potential problem with PCI cards. */
 436         pci_write_config8(dev, 0x50, 0x01);
 437
 438         /* SATA Device, BDF:0-17-0, Non-Raid-5 SATA controller */
 439         printk(BIOS_INFO, "sb700_devices_por_init(): SATA Device, BDF:0-18-0\n");
 440         dev = pci_locate_device(PCI_ID(0x1002, 0x4390), 0);
 441
 442         /*PHY Global Control*/
 443         pci_write_config16(dev, 0x86, 0x2C00);
 444 }
 445
 446 /* sbPmioPorInitTable, Pre-initializing PMIO register space
 447 * The power management (PM) block is resident in the PCI/LPC/ISA bridge.
 448 * The PM regs are accessed via IO mapped regs 0xcd6 and 0xcd7.
 449 * The index address is first programmed into IO reg 0xcd6.
 450 * Read or write values are accessed through IO reg 0xcd7.
 451 */
 452 static void sb700_pmio_por_init(void)
 453 {
 454         u8 byte;
 455
 456         printk(BIOS_INFO, "sb700_pmio_por_init()\n");
 457         /* K8KbRstEn, KB_RST# control for K8 system. */
 458         byte = pmio_read(0x66);
 459         byte |= 0x20;
 460         pmio_write(0x66, byte);
 461
 462         /* RPR2.31 PM_TURN_OFF_MSG during ASF Shutdown. */
 463         if (get_sb700_revision(pci_locate_device(PCI_ID(0x1002, 0x4385), 0)) <= 0x12) {
 464                 byte = pmio_read(0x65);
 465                 byte &= ~(1 << 7);
 466                 pmio_write(0x65, byte);
 467
 468                 byte = pmio_read(0x75);
 469                 byte &= 0xc0;
 470                 byte |= 0x05;
 471                 pmio_write(0x75, byte);
 472
 473                 byte = pmio_read(0x52);
 474                 byte &= 0xc0;
 475                 byte |= 0x08;
 476                 pmio_write(0x52, byte);
 477         } else {
 478                 byte = pmio_read(0xD7);
 479                 byte |= 1 << 0;
 480                 pmio_write(0xD7, byte);
 481
 482                 byte = pmio_read(0x65);
 483                 byte |= 1 << 7;
 484                 pmio_write(0x65, byte);
 485
 486                 byte = pmio_read(0x75);
 487                 byte &= 0xc0;
 488                 byte |= 0x01;
 489                 pmio_write(0x75, byte);
 490
 491                 byte = pmio_read(0x52);
 492                 byte &= 0xc0;
 493                 byte |= 0x02;
 494                 pmio_write(0x52, byte);
 495
 496         }
 497
 498         /* Watch Dog Timer Control
 499          * Set watchdog time base to 0xfec000f0 to avoid SCSI card boot failure.
 500          * But I don't find WDT is enabled in SMBUS 0x41 bit3 in CIM.
 501          */
 502         pmio_write(0x6c, 0xf0);
 503         pmio_write(0x6d, 0x00);
 504         pmio_write(0x6e, 0xc0);
 505         pmio_write(0x6f, 0xfe);
 506
 507         /* rpr2.15: Enabling Spread Spectrum */
 508         byte = pmio_read(0x42);
 509         byte |= 1 << 7;
 510         pmio_write(0x42, byte);
 511         /* TODO: Check if it is necessary. IDE reset */
 512         byte = pmio_read(0xB2);
 513         byte |= 1 << 0;
 514         pmio_write(0xB2, byte);
 515 }
 516
 517 /*
 518 * Add any south bridge setting.
 519 */
 520 static void sb700_pci_cfg(void)
 521 {
 522         device_t dev;
 523         u8 byte;
 524
 525         /* SMBus Device, BDF:0-20-0 */
 526         dev = pci_locate_device(PCI_ID(0x1002, 0x4385), 0);
 527         /* Enable watchdog decode timer */
 528         byte = pci_read_config8(dev, 0x41);
 529         byte |= (1 << 3);
 530         pci_write_config8(dev, 0x41, byte);
 531
 532         /* Set to 1 to reset USB on the software (such as IO-64 or IO-CF9 cycles)
 533          * generated PCIRST#. */
 534         byte = pmio_read(0x65);
 535         byte |= (1 << 4);
 536         pmio_write(0x65, byte);
 537
 538         /* IDE Device, BDF:0-20-1 */
 539         dev = pci_locate_device(PCI_ID(0x1002, 0x439C), 0);
 540         /* Enable IDE Explicit prefetch, 0x63[0] clear */
 541         byte = pci_read_config8(dev, 0x63);
 542         byte &= 0xfe;
 543         pci_write_config8(dev, 0x63, byte);
 544
 545         /* LPC Device, BDF:0-20-3 */
 546         /* The code below is ported from old chipset. It is not
 547          * mentioned in RPR. But I keep them. The registers and the
 548          * comments are compatible. */
 549         dev = pci_locate_device(PCI_ID(0x1002, 0x439D), 0);
 550         /* Enabling LPC DMA function. */
 551         byte = pci_read_config8(dev, 0x40);
 552         byte |= (1 << 2);
 553         pci_write_config8(dev, 0x40, byte);
 554         /* Disabling LPC TimeOut. 0x48[7] clear. */
 555         byte = pci_read_config8(dev, 0x48);
 556         byte &= 0x7f;
 557         pci_write_config8(dev, 0x48, byte);
 558         /* Disabling LPC MSI Capability, 0x78[1] clear. */
 559         byte = pci_read_config8(dev, 0x78);
 560         byte &= 0xfd;
 561         pci_write_config8(dev, 0x78, byte);
 562
 563         /* SATA Device, BDF:0-17-0, Non-Raid-5 SATA controller */
 564         dev = pci_locate_device(PCI_ID(0x1002, 0x4390), 0);
 565         /* rpr7.12 SATA MSI and D3 Power State Capability. */
 566         byte = pci_read_config8(dev, 0x40);
 567         byte |= 1 << 0;
 568         pci_write_config8(dev, 0x40, byte);
 569         if (get_sb700_revision(pci_locate_device(PCI_ID(0x1002, 0x4385), 0)) <= 0x12)
 570                 pci_write_config8(dev, 0x34, 0x70); /* set 0x61 to 0x70 if S1 is not supported. */
 571         else
 572                 pci_write_config8(dev, 0x34, 0x50); /* set 0x61 to 0x50 if S1 is not supported. */
 573         byte &= ~(1 << 0);
 574         pci_write_config8(dev, 0x40, byte);
 575 }
 576
 577 /*
 578 */
 579 static void sb700_por_init(void)
 580 {
 581         /* sbDevicesPorInitTable + sbK8PorInitTable */
 582         sb700_devices_por_init();
 583
 584         /* sbPmioPorInitTable + sbK8PmioPorInitTable */
 585         sb700_pmio_por_init();
 586 }
 587
 588 /*
 589 * It should be called during early POST after memory detection and BIOS shadowing but before PCI bus enumeration.
 590 */
 591 static void sb700_before_pci_init(void)
 592 {
 593         sb700_pci_cfg();
 594 }
 595
 596 /*
 597 * This function should be called after enable_sb700_smbus().
 598 */
 599 static void sb700_early_setup(void)
 600 {
 601         printk(BIOS_INFO, "sb700_early_setup()\n");
 602         sb700_por_init();
 603         sb700_acpi_init();
 604 }
 605
 606 static int smbus_read_byte(u32 device, u32 address)
 607 {
 608         return do_smbus_read_byte(SMBUS_IO_BASE, device, address);
 609 }
 610
 611 int s3_save_nvram_early(u32 dword, int size, int  nvram_pos)
 612 {
 613         int i;
 614         printk(BIOS_DEBUG, "Writing %x of size %d to nvram pos: %d\n", dword, size, nvram_pos);
 615
 616         for (i = 0; i<size; i++) {
 617                 outb(nvram_pos, BIOSRAM_INDEX);
 618                 outb((dword >>(8 * i)) & 0xff , BIOSRAM_DATA);
 619                 nvram_pos++;
 620         }
 621
 622         return nvram_pos;
 623 }
 624
 625 int s3_load_nvram_early(int size, u32 *old_dword, int nvram_pos)
 626 {
 627         u32 data = *old_dword;
 628         int i;
 629         for (i = 0; i<size; i++) {
 630                 outb(nvram_pos, BIOSRAM_INDEX);
 631                 data &= ~(0xff << (i * 8));
 632                 data |= inb(BIOSRAM_DATA) << (i *8);
 633                 nvram_pos++;
 634         }
 635         *old_dword = data;
 636         printk(BIOS_DEBUG, "Loading %x of size %d to nvram pos:%d\n", *old_dword, size,
 637                 nvram_pos-size);
 638         return nvram_pos;
 639 }
 640
 641 #if CONFIG_HAVE_ACPI_RESUME == 1
 642 static int acpi_is_wakeup_early(void)
 643 {
 644         u16 tmp;
 645         tmp = inw(ACPI_PM1_CNT_BLK);
 646         printk(BIOS_DEBUG, "IN TEST WAKEUP %x\n", tmp);
 647         return (((tmp & (7 << 10)) >> 10) == 3);
 648 }
 649 #endif
 650
 651 struct cbmem_entry *get_cbmem_toc(void)
 652 {
 653         uint32_t xdata = 0;
 654         int xnvram_pos = 0xfc, xi;
 655         for (xi = 0; xi<4; xi++) {
 656                 outb(xnvram_pos, BIOSRAM_INDEX);
 657                 xdata &= ~(0xff << (xi * 8));
 658                 xdata |= inb(BIOSRAM_DATA) << (xi *8);
 659                 xnvram_pos++;
 660         }
 661         return (struct cbmem_entry *) xdata;
 662 }
 663
 664 #endif