grub/kern/mips/yeeloong/init.c

/*
 *  GRUB  --  GRand Unified Bootloader
 *  Copyright (C) 2009,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/kernel.h>
#include <grub/misc.h>
#include <grub/env.h>
#include <grub/time.h>
#include <grub/types.h>
#include <grub/misc.h>
#include <grub/mm.h>
#include <grub/time.h>
#include <grub/machine/kernel.h>
#include <grub/machine/memory.h>
#include <grub/mips/loongson.h>
#include <grub/cpu/kernel.h>
#include <grub/cs5536.h>
#include <grub/term.h>
#include <grub/machine/ec.h>
#include <grub/ata.h>

extern void grub_video_sm712_init (void);
extern void grub_video_init (void);
extern void grub_bitmap_init (void);
extern void grub_font_init (void);
extern void grub_gfxterm_init (void);
extern void grub_at_keyboard_init (void);

/* FIXME: use interrupt to count high.  */
grub_uint64_t
grub_get_rtc (void)
{
  static grub_uint32_t high = 0;
  static grub_uint32_t last = 0;
  grub_uint32_t low;

  asm volatile ("mfc0 %0, " GRUB_CPU_LOONGSON_COP0_TIMER_COUNT : "=r" (low));
  if (low < last)
    high++;
  last = low;

  return (((grub_uint64_t) high) << 32) | low;
}

grub_err_t
grub_machine_mmap_iterate (int NESTED_FUNC_ATTR (*hook) (grub_uint64_t,
							 grub_uint64_t,
							 grub_uint32_t))
{
  hook (GRUB_ARCH_LOWMEMPSTART, grub_arch_memsize << 20,
	GRUB_MACHINE_MEMORY_AVAILABLE);
  hook (GRUB_ARCH_HIGHMEMPSTART, grub_arch_highmemsize << 20,
	GRUB_MACHINE_MEMORY_AVAILABLE);
  return GRUB_ERR_NONE;
}

/* Dump of GPIO connections. FIXME: Remove useless and macroify.  */
static grub_uint32_t gpiodump[] = {
  0xffff0000, 0x2ffdd002, 0xffff0000, 0xffff0000,
  0x2fffd000, 0xffff0000, 0x1000efff, 0xefff1000,
  0x3ffbc004, 0xffff0000, 0xffff0000, 0xffff0000,
  0x3ffbc004, 0x3ffbc004, 0xffff0000, 0x00000000,
  0xffff0000, 0xffff0000, 0x3ffbc004, 0x3f9bc064,
  0x00000000, 0x00000000, 0x00000000, 0x00000000,
  0x00000000, 0x00000000, 0x00000000, 0x00000000,
  0x00000000, 0x00000000, 0x00000000, 0x00000000,
  0xffff0000, 0xffff0000, 0xffff0000, 0xffff0000,
  0xffff0000, 0xffff0000, 0x0000ffff, 0xffff0000,
  0xefff1000, 0xffff0000, 0xffff0000, 0xffff0000,
  0xefff1000, 0xefff1000, 0xffff0000, 0x00000000,
  0xffff0000, 0xffff0000, 0xefff1000, 0xffff0000,
  0x00000000, 0x00000000, 0x00000000, 0x00000000,
  0x00000000, 0x00000000, 0x00000000, 0x00000000,
  0x00000000, 0x50000000, 0x00000000, 0x00000000,
};

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_machine_init (void)
{
  grub_addr_t modend;

  /* FIXME: measure this.  */
  if (grub_arch_busclock == 0)
    {
      grub_arch_busclock = 66000000;
      grub_arch_cpuclock = 797000000;
    }

  grub_install_get_time_ms (grub_rtc_get_time_ms);

  if (grub_arch_memsize == 0)
    {
      grub_port_t smbbase;
      grub_err_t err;
      grub_pci_device_t dev;
      struct grub_smbus_spd spd;
      unsigned totalmem;
      int i;

      if (!grub_cs5536_find (&dev))
	grub_fatal ("No CS5536 found\n");

      err = grub_cs5536_init_smbus (dev, 0x7ff, &smbbase);
      if (err)
	grub_fatal ("Couldn't init SMBus: %s\n", grub_errmsg);

      /* Yeeloong has only one memory slot.  */
      err = grub_cs5536_read_spd (smbbase, GRUB_SMB_RAM_START_ADDR, &spd);
      if (err)
	grub_fatal ("Couldn't read SPD: %s\n", grub_errmsg);
      for (i = 5; i < 13; i++)
	if (spd.ddr2.rank_capacity & (1 << (i & 7)))
	  break;
      /* Something is wrong.  */
      if (i == 13)
	totalmem = 256;
      else
	totalmem = ((spd.ddr2.num_of_ranks
		     & GRUB_SMBUS_SPD_MEMORY_NUM_OF_RANKS_MASK) + 1) << (i + 2);
      
      if (totalmem >= 256)
	{
	  grub_arch_memsize = 256;
	  grub_arch_highmemsize = totalmem - 256;
	}
      else
	{
	  grub_arch_memsize = (totalmem >> 20);
	  grub_arch_highmemsize = 0;
	}

      /* Make sure GPIO is where we expect it to be.  */
      grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GPIO_BAR,
			     GRUB_CS5536_LBAR_TURN_ON 
			     | GRUB_CS5536_LBAR_GPIO);

      /* Setup GPIO.  */
      for (i = 0; i < (int) ARRAY_SIZE (gpiodump); i++)
	((volatile grub_uint32_t *) (GRUB_MACHINE_PCI_IO_BASE 
				     + GRUB_CS5536_LBAR_GPIO)) [i]
	  = gpiodump[i];

      /* 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.  */
      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);
      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);

      /* 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);

      /* Setup PCI controller.  */
      *((volatile grub_uint32_t *) (GRUB_MACHINE_PCI_CONTROLLER_HEADER
				    + GRUB_PCI_REG_COMMAND)) = 0x22b00046;
      *((volatile grub_uint32_t *) (GRUB_MACHINE_PCI_CONTROLLER_HEADER
				    + GRUB_PCI_REG_CACHELINE)) = 0xff;
      *((volatile grub_uint32_t *) (GRUB_MACHINE_PCI_CONTROLLER_HEADER 
				    + GRUB_PCI_REG_ADDRESS_REG0))
	= 0x80000000 | GRUB_PCI_ADDR_MEM_TYPE_64 | GRUB_PCI_ADDR_MEM_PREFETCH;
      *((volatile grub_uint32_t *) (GRUB_MACHINE_PCI_CONTROLLER_HEADER 
				    + GRUB_PCI_REG_ADDRESS_REG1)) = 0;
    }

  modend = grub_modules_get_end ();
  grub_mm_init_region ((void *) modend, (grub_arch_memsize << 20)
		       - (modend - GRUB_ARCH_LOWMEMVSTART));
  /* FIXME: use upper memory as well.  */

  /* Initialize output terminal (can't be done earlier, as gfxterm
     relies on a working heap.  */
  grub_video_init ();
  grub_video_sm712_init ();
  grub_bitmap_init ();
  grub_font_init ();
  grub_gfxterm_init ();

  grub_at_keyboard_init ();
}

void
grub_machine_fini (void)
{
}

void
grub_halt (void)
{
  grub_outb (grub_inb (GRUB_CPU_LOONGSON_GPIOCFG)
	     & ~GRUB_CPU_LOONGSON_SHUTDOWN_GPIO, GRUB_CPU_LOONGSON_GPIOCFG);

  grub_printf ("Shutdown failed\n");
  grub_refresh ();
  while (1);
}

void
grub_exit (void)
{
  grub_halt ();
}

void
grub_reboot (void)
{
  grub_write_ec (GRUB_MACHINE_EC_COMMAND_REBOOT);

  grub_printf ("Reboot failed\n");
  grub_refresh ();
  while (1);
}