grub-lakitu/grub-core/bus/cs5536.c - cos/cobble - Git at Google

 /*
  *  GRUB  --  GRand Unified Bootloader
  *  Copyright (C) 2010  Free Software Foundation, Inc.
  *
  *  GRUB 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, either version 3 of the License, or
  *  (at your option) any later version.
  *
  *  GRUB 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 GRUB.  If not, see <http://www.gnu.org/licenses/>.
  */

 #include <grub/types.h>
 #include <grub/cs5536.h>
 #include <grub/pci.h>
 #include <grub/time.h>
 #include <grub/ata.h>
 #ifdef GRUB_MACHINE_MIPS_LOONGSON
 #include <grub/machine/kernel.h>
 #endif

 #include <grub/dl.h>

 GRUB_MOD_LICENSE ("GPLv3+");

 /* Context for grub_cs5536_find.  */
 struct grub_cs5536_find_ctx
 {
   grub_pci_device_t *devp;
   int found;
 };

 /* Helper for grub_cs5536_find.  */
 static int
 grub_cs5536_find_iter (grub_pci_device_t dev, grub_pci_id_t pciid, void *data)
 {
   struct grub_cs5536_find_ctx *ctx = data;

   if (pciid == GRUB_CS5536_PCIID)
     {
       *ctx->devp = dev;
       ctx->found = 1;
       return 1;
     }
   return 0;
 }

 int
 grub_cs5536_find (grub_pci_device_t *devp)
 {
   struct grub_cs5536_find_ctx ctx = {
     .devp = devp,
     .found = 0
   };

   grub_pci_iterate (grub_cs5536_find_iter, &ctx);

   return ctx.found;
 }

 grub_uint64_t
 grub_cs5536_read_msr (grub_pci_device_t dev, grub_uint32_t addr)
 {
   grub_uint64_t ret = 0;
   grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_ADDR),
 		  addr);
   ret = (grub_uint64_t)
     grub_pci_read (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_DATA0));
   ret |= (((grub_uint64_t)
 	  grub_pci_read (grub_pci_make_address (dev,
 						GRUB_CS5536_MSR_MAILBOX_DATA1)))
 	  << 32);
   return ret;
 }

 void
 grub_cs5536_write_msr (grub_pci_device_t dev, grub_uint32_t addr,
 		       grub_uint64_t val)
 {
   grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_ADDR),
 		  addr);
   grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_DATA0),
 		  val & 0xffffffff);
   grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_DATA1),
 		  val >> 32);
 }

 grub_err_t
 grub_cs5536_smbus_wait (grub_port_t smbbase)
 {
   grub_uint64_t start = grub_get_time_ms ();
   while (1)
     {
       grub_uint8_t status;
       status = grub_inb (smbbase + GRUB_CS5536_SMB_REG_STATUS);
       if (status & GRUB_CS5536_SMB_REG_STATUS_SDAST)
 	return GRUB_ERR_NONE;
       if (status & GRUB_CS5536_SMB_REG_STATUS_BER)
 	return grub_error (GRUB_ERR_IO, "SM bus error");
       if (status & GRUB_CS5536_SMB_REG_STATUS_NACK)
 	return grub_error (GRUB_ERR_IO, "NACK received");
       if (grub_get_time_ms () > start + 40)
 	return grub_error (GRUB_ERR_IO, "SM stalled");
     }
 }

 grub_err_t
 grub_cs5536_read_spd_byte (grub_port_t smbbase, grub_uint8_t dev,
 			   grub_uint8_t addr, grub_uint8_t *res)
 {
   grub_err_t err;

   /* Send START.  */
   grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
 	     | GRUB_CS5536_SMB_REG_CTRL1_START,
 	     smbbase + GRUB_CS5536_SMB_REG_CTRL1);

   /* Send device address.  */
   err = grub_cs5536_smbus_wait (smbbase);
   if (err)
     return err;
   grub_outb (dev << 1, smbbase + GRUB_CS5536_SMB_REG_DATA);

   /* Send ACK.  */
   err = grub_cs5536_smbus_wait (smbbase);
   if (err)
     return err;
   grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
 	     | GRUB_CS5536_SMB_REG_CTRL1_ACK,
 	     smbbase + GRUB_CS5536_SMB_REG_CTRL1);

   /* Send byte address.  */
   grub_outb (addr, smbbase + GRUB_CS5536_SMB_REG_DATA);

   /* Send START.  */
   err = grub_cs5536_smbus_wait (smbbase);
   if (err)
     return err;
   grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
 	     | GRUB_CS5536_SMB_REG_CTRL1_START,
 	     smbbase + GRUB_CS5536_SMB_REG_CTRL1);

   /* Send device address.  */
   err = grub_cs5536_smbus_wait (smbbase);
   if (err)
     return err;
   grub_outb ((dev << 1) | 1, smbbase + GRUB_CS5536_SMB_REG_DATA);

   /* Send STOP.  */
   err = grub_cs5536_smbus_wait (smbbase);
   if (err)
     return err;
   grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
 	     | GRUB_CS5536_SMB_REG_CTRL1_STOP,
 	     smbbase + GRUB_CS5536_SMB_REG_CTRL1);

   err = grub_cs5536_smbus_wait (smbbase);
   if (err)
     return err;
   *res = grub_inb (smbbase + GRUB_CS5536_SMB_REG_DATA);

   return GRUB_ERR_NONE;
 }

 grub_err_t
 grub_cs5536_init_smbus (grub_pci_device_t dev, grub_uint16_t divisor,
 			grub_port_t *smbbase)
 {
   grub_uint64_t smbbar;

   smbbar = grub_cs5536_read_msr (dev, GRUB_CS5536_MSR_SMB_BAR);

   /* FIXME  */
   if (!(smbbar & GRUB_CS5536_LBAR_ENABLE))
     return grub_error(GRUB_ERR_IO, "SMB controller not enabled\n");
   *smbbase = (smbbar & GRUB_CS5536_LBAR_ADDR_MASK) + GRUB_MACHINE_PCI_IO_BASE;

   if (divisor < 8)
     return grub_error (GRUB_ERR_BAD_ARGUMENT, "invalid divisor");

   /* Disable SMB.  */
   grub_outb (0, *smbbase + GRUB_CS5536_SMB_REG_CTRL2);

   /* Disable interrupts.  */
   grub_outb (0, *smbbase + GRUB_CS5536_SMB_REG_CTRL1);

   /* Set as master.  */
   grub_outb (GRUB_CS5536_SMB_REG_ADDR_MASTER,
   	     *smbbase + GRUB_CS5536_SMB_REG_ADDR);

   /* Launch.  */
   grub_outb (((divisor >> 7) & 0xff), *smbbase + GRUB_CS5536_SMB_REG_CTRL3);
   grub_outb (((divisor << 1) & 0xfe) | GRUB_CS5536_SMB_REG_CTRL2_ENABLE,
 	     *smbbase + GRUB_CS5536_SMB_REG_CTRL2);

   return GRUB_ERR_NONE;
 }

 grub_err_t
 grub_cs5536_read_spd (grub_port_t smbbase, grub_uint8_t dev,
 		      struct grub_smbus_spd *res)
 {
   grub_err_t err;
   grub_size_t size;
   grub_uint8_t b;
   grub_size_t ptr;

   err = grub_cs5536_read_spd_byte (smbbase, dev, 0, &b);
   if (err)
     return err;
   if (b == 0)
     return grub_error (GRUB_ERR_IO, "no SPD found");
   size = b;

   ((grub_uint8_t *) res)[0] = b;
   for (ptr = 1; ptr < size; ptr++)
     {
       err = grub_cs5536_read_spd_byte (smbbase, dev, ptr,
 				       &((grub_uint8_t *) res)[ptr]);
       if (err)
 	return err;
     }
   return GRUB_ERR_NONE;
 }

 static inline void
 set_io_space (grub_pci_device_t dev, int num, grub_uint16_t start,
 	      grub_uint16_t len)
 {
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_REGIONS_START + num,
 			 ((((grub_uint64_t) start + len - 4)
 			   << GRUB_CS5536_MSR_GL_REGION_IO_TOP_SHIFT)
 			  & GRUB_CS5536_MSR_GL_REGION_TOP_MASK)
 			 | (((grub_uint64_t) start
 			     << GRUB_CS5536_MSR_GL_REGION_IO_BASE_SHIFT)
 			  & GRUB_CS5536_MSR_GL_REGION_BASE_MASK)
 			 | GRUB_CS5536_MSR_GL_REGION_IO
 			 | GRUB_CS5536_MSR_GL_REGION_ENABLE);
 }

 static inline void
 set_iod (grub_pci_device_t dev, int num, int dest, int start, int mask)
 {
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_IOD_START + num,
 			 ((grub_uint64_t) dest << GRUB_CS5536_IOD_DEST_SHIFT)
 			 | (((grub_uint64_t) start & GRUB_CS5536_IOD_ADDR_MASK)
 			    << GRUB_CS5536_IOD_BASE_SHIFT)
 			 | ((mask & GRUB_CS5536_IOD_ADDR_MASK)
 			    << GRUB_CS5536_IOD_MASK_SHIFT));
 }

 static inline void
 set_p2d (grub_pci_device_t dev, int num, int dest, grub_uint32_t start)
 {
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_P2D_START + num,
 			 (((grub_uint64_t) dest) << GRUB_CS5536_P2D_DEST_SHIFT)
 			 | ((grub_uint64_t) (start >> GRUB_CS5536_P2D_LOG_ALIGN)
 			    << GRUB_CS5536_P2D_BASE_SHIFT)
 			 | (((1 << (32 - GRUB_CS5536_P2D_LOG_ALIGN)) - 1)
 			    << GRUB_CS5536_P2D_MASK_SHIFT));
 }

 void
 grub_cs5536_init_geode (grub_pci_device_t dev)
 {
   /* Enable more BARs.  */
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IRQ_MAP_BAR,
 			 GRUB_CS5536_LBAR_TURN_ON | GRUB_CS5536_LBAR_IRQ_MAP);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_MFGPT_BAR,
 			 GRUB_CS5536_LBAR_TURN_ON | GRUB_CS5536_LBAR_MFGPT);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_ACPI_BAR,
 			 GRUB_CS5536_LBAR_TURN_ON | GRUB_CS5536_LBAR_ACPI);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_PM_BAR,
 			 GRUB_CS5536_LBAR_TURN_ON | GRUB_CS5536_LBAR_PM);

   /* Setup DIVIL.  */
 #ifdef GRUB_MACHINE_MIPS_LOONGSON
   switch (grub_arch_machine)
     {
     case GRUB_ARCH_MACHINE_YEELOONG:
       grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_LEG_IO,
 			     GRUB_CS5536_MSR_DIVIL_LEG_IO_MODE_X86
 			     | GRUB_CS5536_MSR_DIVIL_LEG_IO_F_REMAP
 			     | GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE0
 			     | GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE1);
       break;
     case GRUB_ARCH_MACHINE_FULOONG2F:
       grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_LEG_IO,
 			     GRUB_CS5536_MSR_DIVIL_LEG_IO_UART2_COM3
 			     | GRUB_CS5536_MSR_DIVIL_LEG_IO_UART1_COM1
 			     | GRUB_CS5536_MSR_DIVIL_LEG_IO_MODE_X86
 			     | GRUB_CS5536_MSR_DIVIL_LEG_IO_F_REMAP
 			     | GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE0
 			     | GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE1);
       break;
     }
 #endif
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_IRQ_MAPPER_PRIMARY_MASK,
 			 (~GRUB_CS5536_DIVIL_LPC_INTERRUPTS) & 0xffff);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_IRQ_MAPPER_LPC_MASK,
 			 GRUB_CS5536_DIVIL_LPC_INTERRUPTS);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_LPC_SERIAL_IRQ_CONTROL,
 			 GRUB_CS5536_MSR_DIVIL_LPC_SERIAL_IRQ_CONTROL_ENABLE);

   /* Initialise USB controller.  */
   /* FIXME: assign adresses dynamically.  */
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_OHCI_BASE,
 			 GRUB_CS5536_MSR_USB_BASE_BUS_MASTER
 			 | GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE
 			 | 0x05024000);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_EHCI_BASE,
 			 GRUB_CS5536_MSR_USB_BASE_BUS_MASTER
 			 | GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE
 			 | (0x20ULL << GRUB_CS5536_MSR_USB_EHCI_BASE_FLDJ_SHIFT)
 			 | 0x05023000);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_CONTROLLER_BASE,
 			 GRUB_CS5536_MSR_USB_BASE_BUS_MASTER
 			 | GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE | 0x05020000);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_OPTION_CONTROLLER_BASE,
 			 GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE | 0x05022000);
   set_p2d (dev, 0, GRUB_CS5536_DESTINATION_USB, 0x05020000);
   set_p2d (dev, 1, GRUB_CS5536_DESTINATION_USB, 0x05022000);
   set_p2d (dev, 5, GRUB_CS5536_DESTINATION_USB, 0x05024000);
   set_p2d (dev, 6, GRUB_CS5536_DESTINATION_USB, 0x05023000);

   {
     volatile grub_uint32_t *oc;
     oc = grub_pci_device_map_range (dev, 0x05022000,
 				    GRUB_CS5536_USB_OPTION_REGS_SIZE);

     oc[GRUB_CS5536_USB_OPTION_REG_UOCMUX] =
       (oc[GRUB_CS5536_USB_OPTION_REG_UOCMUX]
        & ~GRUB_CS5536_USB_OPTION_REG_UOCMUX_PMUX_MASK)
       | GRUB_CS5536_USB_OPTION_REG_UOCMUX_PMUX_HC;
     grub_pci_device_unmap_range (dev, oc, GRUB_CS5536_USB_OPTION_REGS_SIZE);
   }

   /* Setup IDE controller.  */
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_IO_BAR,
 			 GRUB_CS5536_LBAR_IDE
 			 | GRUB_CS5536_MSR_IDE_IO_BAR_UNITS);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_CFG,
 			 GRUB_CS5536_MSR_IDE_CFG_CHANNEL_ENABLE);
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_TIMING,
 			 (GRUB_CS5536_MSR_IDE_TIMING_PIO0
 			  << GRUB_CS5536_MSR_IDE_TIMING_DRIVE0_SHIFT)
 			 | (GRUB_CS5536_MSR_IDE_TIMING_PIO0
 			    << GRUB_CS5536_MSR_IDE_TIMING_DRIVE1_SHIFT));
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_CAS_TIMING,
 			 (GRUB_CS5536_MSR_IDE_CAS_TIMING_CMD_PIO0
 			  << GRUB_CS5536_MSR_IDE_CAS_TIMING_CMD_SHIFT)
 			 | (GRUB_CS5536_MSR_IDE_CAS_TIMING_PIO0
 			    << GRUB_CS5536_MSR_IDE_CAS_TIMING_DRIVE0_SHIFT)
 			 | (GRUB_CS5536_MSR_IDE_CAS_TIMING_PIO0
 			    << GRUB_CS5536_MSR_IDE_CAS_TIMING_DRIVE1_SHIFT));

   /* Setup Geodelink PCI.  */
   grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_PCI_CTRL,
 			 (4ULL << GRUB_CS5536_MSR_GL_PCI_CTRL_OUT_THR_SHIFT)
 			 | (4ULL << GRUB_CS5536_MSR_GL_PCI_CTRL_IN_THR_SHIFT)
 			 | (8ULL << GRUB_CS5536_MSR_GL_PCI_CTRL_LATENCY_SHIFT)
 			 | GRUB_CS5536_MSR_GL_PCI_CTRL_IO_ENABLE
 			 | GRUB_CS5536_MSR_GL_PCI_CTRL_MEMORY_ENABLE);

   /* Setup windows.  */
   set_io_space (dev, 0, GRUB_CS5536_LBAR_SMBUS, GRUB_CS5536_SMBUS_REGS_SIZE);
   set_io_space (dev, 1, GRUB_CS5536_LBAR_GPIO, GRUB_CS5536_GPIO_REGS_SIZE);
   set_io_space (dev, 2, GRUB_CS5536_LBAR_MFGPT, GRUB_CS5536_MFGPT_REGS_SIZE);
   set_io_space (dev, 3, GRUB_CS5536_LBAR_IRQ_MAP, GRUB_CS5536_IRQ_MAP_REGS_SIZE);
   set_io_space (dev, 4, GRUB_CS5536_LBAR_PM, GRUB_CS5536_PM_REGS_SIZE);
   set_io_space (dev, 5, GRUB_CS5536_LBAR_ACPI, GRUB_CS5536_ACPI_REGS_SIZE);
   set_iod (dev, 0, GRUB_CS5536_DESTINATION_IDE, GRUB_ATA_CH0_PORT1, 0xffff8);
   set_iod (dev, 1, GRUB_CS5536_DESTINATION_ACC, GRUB_CS5536_LBAR_ACC, 0xfff80);
   set_iod (dev, 2, GRUB_CS5536_DESTINATION_IDE, GRUB_CS5536_LBAR_IDE, 0xffff0);
 }
	/*
	* GRUB -- GRand Unified Bootloader
	* Copyright (C) 2010 Free Software Foundation, Inc.
	*
	* GRUB 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, either version 3 of the License, or
	* (at your option) any later version.
	*
	* GRUB 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 GRUB. If not, see <http://www.gnu.org/licenses/>.
	*/

	#include <grub/types.h>
	#include <grub/cs5536.h>
	#include <grub/pci.h>
	#include <grub/time.h>
	#include <grub/ata.h>
	#ifdef GRUB_MACHINE_MIPS_LOONGSON
	#include <grub/machine/kernel.h>
	#endif

	#include <grub/dl.h>

	GRUB_MOD_LICENSE ("GPLv3+");

	/* Context for grub_cs5536_find. */
	struct grub_cs5536_find_ctx
	{
	grub_pci_device_t *devp;
	int found;
	};

	/* Helper for grub_cs5536_find. */
	static int
	grub_cs5536_find_iter (grub_pci_device_t dev, grub_pci_id_t pciid, void *data)
	{
	struct grub_cs5536_find_ctx *ctx = data;

	if (pciid == GRUB_CS5536_PCIID)
	{
	*ctx->devp = dev;
	ctx->found = 1;
	return 1;
	}
	return 0;
	}

	int
	grub_cs5536_find (grub_pci_device_t *devp)
	{
	struct grub_cs5536_find_ctx ctx = {
	.devp = devp,
	.found = 0
	};

	grub_pci_iterate (grub_cs5536_find_iter, &ctx);

	return ctx.found;
	}

	grub_uint64_t
	grub_cs5536_read_msr (grub_pci_device_t dev, grub_uint32_t addr)
	{
	grub_uint64_t ret = 0;
	grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_ADDR),
	addr);
	ret = (grub_uint64_t)
	grub_pci_read (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_DATA0));
	ret \|= (((grub_uint64_t)
	grub_pci_read (grub_pci_make_address (dev,
	GRUB_CS5536_MSR_MAILBOX_DATA1)))
	<< 32);
	return ret;
	}

	void
	grub_cs5536_write_msr (grub_pci_device_t dev, grub_uint32_t addr,
	grub_uint64_t val)
	{
	grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_ADDR),
	addr);
	grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_DATA0),
	val & 0xffffffff);
	grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_DATA1),
	val >> 32);
	}

	grub_err_t
	grub_cs5536_smbus_wait (grub_port_t smbbase)
	{
	grub_uint64_t start = grub_get_time_ms ();
	while (1)
	{
	grub_uint8_t status;
	status = grub_inb (smbbase + GRUB_CS5536_SMB_REG_STATUS);
	if (status & GRUB_CS5536_SMB_REG_STATUS_SDAST)
	return GRUB_ERR_NONE;
	if (status & GRUB_CS5536_SMB_REG_STATUS_BER)
	return grub_error (GRUB_ERR_IO, "SM bus error");
	if (status & GRUB_CS5536_SMB_REG_STATUS_NACK)
	return grub_error (GRUB_ERR_IO, "NACK received");
	if (grub_get_time_ms () > start + 40)
	return grub_error (GRUB_ERR_IO, "SM stalled");
	}
	}

	grub_err_t
	grub_cs5536_read_spd_byte (grub_port_t smbbase, grub_uint8_t dev,
	grub_uint8_t addr, grub_uint8_t *res)
	{
	grub_err_t err;

	/* Send START. */
	grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
	\| GRUB_CS5536_SMB_REG_CTRL1_START,
	smbbase + GRUB_CS5536_SMB_REG_CTRL1);

	/* Send device address. */
	err = grub_cs5536_smbus_wait (smbbase);
	if (err)
	return err;
	grub_outb (dev << 1, smbbase + GRUB_CS5536_SMB_REG_DATA);

	/* Send ACK. */
	err = grub_cs5536_smbus_wait (smbbase);
	if (err)
	return err;
	grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
	\| GRUB_CS5536_SMB_REG_CTRL1_ACK,
	smbbase + GRUB_CS5536_SMB_REG_CTRL1);

	/* Send byte address. */
	grub_outb (addr, smbbase + GRUB_CS5536_SMB_REG_DATA);

	/* Send START. */
	err = grub_cs5536_smbus_wait (smbbase);
	if (err)
	return err;
	grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
	\| GRUB_CS5536_SMB_REG_CTRL1_START,
	smbbase + GRUB_CS5536_SMB_REG_CTRL1);

	/* Send device address. */
	err = grub_cs5536_smbus_wait (smbbase);
	if (err)
	return err;
	grub_outb ((dev << 1) \| 1, smbbase + GRUB_CS5536_SMB_REG_DATA);

	/* Send STOP. */
	err = grub_cs5536_smbus_wait (smbbase);
	if (err)
	return err;
	grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
	\| GRUB_CS5536_SMB_REG_CTRL1_STOP,
	smbbase + GRUB_CS5536_SMB_REG_CTRL1);

	err = grub_cs5536_smbus_wait (smbbase);
	if (err)
	return err;
	*res = grub_inb (smbbase + GRUB_CS5536_SMB_REG_DATA);

	return GRUB_ERR_NONE;
	}

	grub_err_t
	grub_cs5536_init_smbus (grub_pci_device_t dev, grub_uint16_t divisor,
	grub_port_t *smbbase)
	{
	grub_uint64_t smbbar;

	smbbar = grub_cs5536_read_msr (dev, GRUB_CS5536_MSR_SMB_BAR);

	/* FIXME */
	if (!(smbbar & GRUB_CS5536_LBAR_ENABLE))
	return grub_error(GRUB_ERR_IO, "SMB controller not enabled\n");
	*smbbase = (smbbar & GRUB_CS5536_LBAR_ADDR_MASK) + GRUB_MACHINE_PCI_IO_BASE;

	if (divisor < 8)
	return grub_error (GRUB_ERR_BAD_ARGUMENT, "invalid divisor");

	/* Disable SMB. */
	grub_outb (0, *smbbase + GRUB_CS5536_SMB_REG_CTRL2);

	/* Disable interrupts. */
	grub_outb (0, *smbbase + GRUB_CS5536_SMB_REG_CTRL1);

	/* Set as master. */
	grub_outb (GRUB_CS5536_SMB_REG_ADDR_MASTER,
	*smbbase + GRUB_CS5536_SMB_REG_ADDR);

	/* Launch. */
	grub_outb (((divisor >> 7) & 0xff), *smbbase + GRUB_CS5536_SMB_REG_CTRL3);
	grub_outb (((divisor << 1) & 0xfe) \| GRUB_CS5536_SMB_REG_CTRL2_ENABLE,
	*smbbase + GRUB_CS5536_SMB_REG_CTRL2);

	return GRUB_ERR_NONE;
	}

	grub_err_t
	grub_cs5536_read_spd (grub_port_t smbbase, grub_uint8_t dev,
	struct grub_smbus_spd *res)
	{
	grub_err_t err;
	grub_size_t size;
	grub_uint8_t b;
	grub_size_t ptr;

	err = grub_cs5536_read_spd_byte (smbbase, dev, 0, &b);
	if (err)
	return err;
	if (b == 0)
	return grub_error (GRUB_ERR_IO, "no SPD found");
	size = b;

	((grub_uint8_t *) res)[0] = b;
	for (ptr = 1; ptr < size; ptr++)
	{
	err = grub_cs5536_read_spd_byte (smbbase, dev, ptr,
	&((grub_uint8_t *) res)[ptr]);
	if (err)
	return err;
	}
	return GRUB_ERR_NONE;
	}

	static inline void
	set_io_space (grub_pci_device_t dev, int num, grub_uint16_t start,
	grub_uint16_t len)
	{
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_REGIONS_START + num,
	((((grub_uint64_t) start + len - 4)
	<< GRUB_CS5536_MSR_GL_REGION_IO_TOP_SHIFT)
	& GRUB_CS5536_MSR_GL_REGION_TOP_MASK)
	\| (((grub_uint64_t) start
	<< GRUB_CS5536_MSR_GL_REGION_IO_BASE_SHIFT)
	& GRUB_CS5536_MSR_GL_REGION_BASE_MASK)
	\| GRUB_CS5536_MSR_GL_REGION_IO
	\| GRUB_CS5536_MSR_GL_REGION_ENABLE);
	}

	static inline void
	set_iod (grub_pci_device_t dev, int num, int dest, int start, int mask)
	{
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_IOD_START + num,
	((grub_uint64_t) dest << GRUB_CS5536_IOD_DEST_SHIFT)
	\| (((grub_uint64_t) start & GRUB_CS5536_IOD_ADDR_MASK)
	<< GRUB_CS5536_IOD_BASE_SHIFT)
	\| ((mask & GRUB_CS5536_IOD_ADDR_MASK)
	<< GRUB_CS5536_IOD_MASK_SHIFT));
	}

	static inline void
	set_p2d (grub_pci_device_t dev, int num, int dest, grub_uint32_t start)
	{
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_P2D_START + num,
	(((grub_uint64_t) dest) << GRUB_CS5536_P2D_DEST_SHIFT)
	\| ((grub_uint64_t) (start >> GRUB_CS5536_P2D_LOG_ALIGN)
	<< GRUB_CS5536_P2D_BASE_SHIFT)
	\| (((1 << (32 - GRUB_CS5536_P2D_LOG_ALIGN)) - 1)
	<< GRUB_CS5536_P2D_MASK_SHIFT));
	}

	void
	grub_cs5536_init_geode (grub_pci_device_t dev)
	{
	/* Enable more BARs. */
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IRQ_MAP_BAR,
	GRUB_CS5536_LBAR_TURN_ON \| GRUB_CS5536_LBAR_IRQ_MAP);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_MFGPT_BAR,
	GRUB_CS5536_LBAR_TURN_ON \| GRUB_CS5536_LBAR_MFGPT);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_ACPI_BAR,
	GRUB_CS5536_LBAR_TURN_ON \| GRUB_CS5536_LBAR_ACPI);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_PM_BAR,
	GRUB_CS5536_LBAR_TURN_ON \| GRUB_CS5536_LBAR_PM);

	/* Setup DIVIL. */
	#ifdef GRUB_MACHINE_MIPS_LOONGSON
	switch (grub_arch_machine)
	{
	case GRUB_ARCH_MACHINE_YEELOONG:
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_LEG_IO,
	GRUB_CS5536_MSR_DIVIL_LEG_IO_MODE_X86
	\| GRUB_CS5536_MSR_DIVIL_LEG_IO_F_REMAP
	\| GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE0
	\| GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE1);
	break;
	case GRUB_ARCH_MACHINE_FULOONG2F:
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_LEG_IO,
	GRUB_CS5536_MSR_DIVIL_LEG_IO_UART2_COM3
	\| GRUB_CS5536_MSR_DIVIL_LEG_IO_UART1_COM1
	\| GRUB_CS5536_MSR_DIVIL_LEG_IO_MODE_X86
	\| GRUB_CS5536_MSR_DIVIL_LEG_IO_F_REMAP
	\| GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE0
	\| GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE1);
	break;
	}
	#endif
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_IRQ_MAPPER_PRIMARY_MASK,
	(~GRUB_CS5536_DIVIL_LPC_INTERRUPTS) & 0xffff);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_IRQ_MAPPER_LPC_MASK,
	GRUB_CS5536_DIVIL_LPC_INTERRUPTS);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_LPC_SERIAL_IRQ_CONTROL,
	GRUB_CS5536_MSR_DIVIL_LPC_SERIAL_IRQ_CONTROL_ENABLE);

	/* Initialise USB controller. */
	/* FIXME: assign adresses dynamically. */
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_OHCI_BASE,
	GRUB_CS5536_MSR_USB_BASE_BUS_MASTER
	\| GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE
	\| 0x05024000);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_EHCI_BASE,
	GRUB_CS5536_MSR_USB_BASE_BUS_MASTER
	\| GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE
	\| (0x20ULL << GRUB_CS5536_MSR_USB_EHCI_BASE_FLDJ_SHIFT)
	\| 0x05023000);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_CONTROLLER_BASE,
	GRUB_CS5536_MSR_USB_BASE_BUS_MASTER
	\| GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE \| 0x05020000);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_OPTION_CONTROLLER_BASE,
	GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE \| 0x05022000);
	set_p2d (dev, 0, GRUB_CS5536_DESTINATION_USB, 0x05020000);
	set_p2d (dev, 1, GRUB_CS5536_DESTINATION_USB, 0x05022000);
	set_p2d (dev, 5, GRUB_CS5536_DESTINATION_USB, 0x05024000);
	set_p2d (dev, 6, GRUB_CS5536_DESTINATION_USB, 0x05023000);

	{
	volatile grub_uint32_t *oc;
	oc = grub_pci_device_map_range (dev, 0x05022000,
	GRUB_CS5536_USB_OPTION_REGS_SIZE);

	oc[GRUB_CS5536_USB_OPTION_REG_UOCMUX] =
	(oc[GRUB_CS5536_USB_OPTION_REG_UOCMUX]
	& ~GRUB_CS5536_USB_OPTION_REG_UOCMUX_PMUX_MASK)
	\| GRUB_CS5536_USB_OPTION_REG_UOCMUX_PMUX_HC;
	grub_pci_device_unmap_range (dev, oc, GRUB_CS5536_USB_OPTION_REGS_SIZE);
	}

	/* Setup IDE controller. */
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_IO_BAR,
	GRUB_CS5536_LBAR_IDE
	\| GRUB_CS5536_MSR_IDE_IO_BAR_UNITS);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_CFG,
	GRUB_CS5536_MSR_IDE_CFG_CHANNEL_ENABLE);
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_TIMING,
	(GRUB_CS5536_MSR_IDE_TIMING_PIO0
	<< GRUB_CS5536_MSR_IDE_TIMING_DRIVE0_SHIFT)
	\| (GRUB_CS5536_MSR_IDE_TIMING_PIO0
	<< GRUB_CS5536_MSR_IDE_TIMING_DRIVE1_SHIFT));
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_CAS_TIMING,
	(GRUB_CS5536_MSR_IDE_CAS_TIMING_CMD_PIO0
	<< GRUB_CS5536_MSR_IDE_CAS_TIMING_CMD_SHIFT)
	\| (GRUB_CS5536_MSR_IDE_CAS_TIMING_PIO0
	<< GRUB_CS5536_MSR_IDE_CAS_TIMING_DRIVE0_SHIFT)
	\| (GRUB_CS5536_MSR_IDE_CAS_TIMING_PIO0
	<< GRUB_CS5536_MSR_IDE_CAS_TIMING_DRIVE1_SHIFT));

	/* Setup Geodelink PCI. */
	grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_PCI_CTRL,
	(4ULL << GRUB_CS5536_MSR_GL_PCI_CTRL_OUT_THR_SHIFT)
	\| (4ULL << GRUB_CS5536_MSR_GL_PCI_CTRL_IN_THR_SHIFT)
	\| (8ULL << GRUB_CS5536_MSR_GL_PCI_CTRL_LATENCY_SHIFT)
	\| GRUB_CS5536_MSR_GL_PCI_CTRL_IO_ENABLE
	\| GRUB_CS5536_MSR_GL_PCI_CTRL_MEMORY_ENABLE);

	/* Setup windows. */
	set_io_space (dev, 0, GRUB_CS5536_LBAR_SMBUS, GRUB_CS5536_SMBUS_REGS_SIZE);
	set_io_space (dev, 1, GRUB_CS5536_LBAR_GPIO, GRUB_CS5536_GPIO_REGS_SIZE);
	set_io_space (dev, 2, GRUB_CS5536_LBAR_MFGPT, GRUB_CS5536_MFGPT_REGS_SIZE);
	set_io_space (dev, 3, GRUB_CS5536_LBAR_IRQ_MAP, GRUB_CS5536_IRQ_MAP_REGS_SIZE);
	set_io_space (dev, 4, GRUB_CS5536_LBAR_PM, GRUB_CS5536_PM_REGS_SIZE);
	set_io_space (dev, 5, GRUB_CS5536_LBAR_ACPI, GRUB_CS5536_ACPI_REGS_SIZE);
	set_iod (dev, 0, GRUB_CS5536_DESTINATION_IDE, GRUB_ATA_CH0_PORT1, 0xffff8);
	set_iod (dev, 1, GRUB_CS5536_DESTINATION_ACC, GRUB_CS5536_LBAR_ACC, 0xfff80);
	set_iod (dev, 2, GRUB_CS5536_DESTINATION_IDE, GRUB_CS5536_LBAR_IDE, 0xffff0);
	}