2N/A/*
2N/A * GRUB -- GRand Unified Bootloader
2N/A * Copyright (C) 2010 Free Software Foundation, Inc.
2N/A *
2N/A * GRUB is free software: you can redistribute it and/or modify
2N/A * it under the terms of the GNU General Public License as published by
2N/A * the Free Software Foundation, either version 3 of the License, or
2N/A * (at your option) any later version.
2N/A *
2N/A * GRUB is distributed in the hope that it will be useful,
2N/A * but WITHOUT ANY WARRANTY; without even the implied warranty of
2N/A * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
2N/A * GNU General Public License for more details.
2N/A *
2N/A * You should have received a copy of the GNU General Public License
2N/A * along with GRUB. If not, see <http://www.gnu.org/licenses/>.
2N/A */
2N/A
2N/A#include <grub/types.h>
2N/A#include <grub/cs5536.h>
2N/A#include <grub/pci.h>
2N/A#include <grub/time.h>
2N/A#include <grub/ata.h>
2N/A#ifdef GRUB_MACHINE_MIPS_LOONGSON
2N/A#include <grub/machine/kernel.h>
2N/A#endif
2N/A
2N/A#include <grub/dl.h>
2N/A
2N/AGRUB_MOD_LICENSE ("GPLv3+");
2N/A
2N/Aint
2N/Agrub_cs5536_find (grub_pci_device_t *devp)
2N/A{
2N/A int found = 0;
2N/A auto int NESTED_FUNC_ATTR hook (grub_pci_device_t dev,
2N/A grub_pci_id_t pciid);
2N/A
2N/A int NESTED_FUNC_ATTR hook (grub_pci_device_t dev,
2N/A grub_pci_id_t pciid)
2N/A {
2N/A if (pciid == GRUB_CS5536_PCIID)
2N/A {
2N/A *devp = dev;
2N/A found = 1;
2N/A return 1;
2N/A }
2N/A return 0;
2N/A }
2N/A
2N/A grub_pci_iterate (hook);
2N/A
2N/A return found;
2N/A}
2N/A
2N/Agrub_uint64_t
2N/Agrub_cs5536_read_msr (grub_pci_device_t dev, grub_uint32_t addr)
2N/A{
2N/A grub_uint64_t ret = 0;
2N/A grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_ADDR),
2N/A addr);
2N/A ret = (grub_uint64_t)
2N/A grub_pci_read (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_DATA0));
2N/A ret |= (((grub_uint64_t)
2N/A grub_pci_read (grub_pci_make_address (dev,
2N/A GRUB_CS5536_MSR_MAILBOX_DATA1)))
2N/A << 32);
2N/A return ret;
2N/A}
2N/A
2N/Avoid
2N/Agrub_cs5536_write_msr (grub_pci_device_t dev, grub_uint32_t addr,
2N/A grub_uint64_t val)
2N/A{
2N/A grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_ADDR),
2N/A addr);
2N/A grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_DATA0),
2N/A val & 0xffffffff);
2N/A grub_pci_write (grub_pci_make_address (dev, GRUB_CS5536_MSR_MAILBOX_DATA1),
2N/A val >> 32);
2N/A}
2N/A
2N/Agrub_err_t
2N/Agrub_cs5536_smbus_wait (grub_port_t smbbase)
2N/A{
2N/A grub_uint64_t start = grub_get_time_ms ();
2N/A while (1)
2N/A {
2N/A grub_uint8_t status;
2N/A status = grub_inb (smbbase + GRUB_CS5536_SMB_REG_STATUS);
2N/A if (status & GRUB_CS5536_SMB_REG_STATUS_SDAST)
2N/A return GRUB_ERR_NONE;
2N/A if (status & GRUB_CS5536_SMB_REG_STATUS_BER)
2N/A return grub_error (GRUB_ERR_IO, "SM bus error");
2N/A if (status & GRUB_CS5536_SMB_REG_STATUS_NACK)
2N/A return grub_error (GRUB_ERR_IO, "NACK received");
2N/A if (grub_get_time_ms () > start + 40)
2N/A return grub_error (GRUB_ERR_IO, "SM stalled");
2N/A }
2N/A}
2N/A
2N/Agrub_err_t
2N/Agrub_cs5536_read_spd_byte (grub_port_t smbbase, grub_uint8_t dev,
2N/A grub_uint8_t addr, grub_uint8_t *res)
2N/A{
2N/A grub_err_t err;
2N/A
2N/A /* Send START. */
2N/A grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
2N/A | GRUB_CS5536_SMB_REG_CTRL1_START,
2N/A smbbase + GRUB_CS5536_SMB_REG_CTRL1);
2N/A
2N/A /* Send device address. */
2N/A err = grub_cs5536_smbus_wait (smbbase);
2N/A if (err)
2N/A return err;
2N/A grub_outb (dev << 1, smbbase + GRUB_CS5536_SMB_REG_DATA);
2N/A
2N/A /* Send ACK. */
2N/A err = grub_cs5536_smbus_wait (smbbase);
2N/A if (err)
2N/A return err;
2N/A grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
2N/A | GRUB_CS5536_SMB_REG_CTRL1_ACK,
2N/A smbbase + GRUB_CS5536_SMB_REG_CTRL1);
2N/A
2N/A /* Send byte address. */
2N/A grub_outb (addr, smbbase + GRUB_CS5536_SMB_REG_DATA);
2N/A
2N/A /* Send START. */
2N/A err = grub_cs5536_smbus_wait (smbbase);
2N/A if (err)
2N/A return err;
2N/A grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
2N/A | GRUB_CS5536_SMB_REG_CTRL1_START,
2N/A smbbase + GRUB_CS5536_SMB_REG_CTRL1);
2N/A
2N/A /* Send device address. */
2N/A err = grub_cs5536_smbus_wait (smbbase);
2N/A if (err)
2N/A return err;
2N/A grub_outb ((dev << 1) | 1, smbbase + GRUB_CS5536_SMB_REG_DATA);
2N/A
2N/A /* Send STOP. */
2N/A err = grub_cs5536_smbus_wait (smbbase);
2N/A if (err)
2N/A return err;
2N/A grub_outb (grub_inb (smbbase + GRUB_CS5536_SMB_REG_CTRL1)
2N/A | GRUB_CS5536_SMB_REG_CTRL1_STOP,
2N/A smbbase + GRUB_CS5536_SMB_REG_CTRL1);
2N/A
2N/A err = grub_cs5536_smbus_wait (smbbase);
2N/A if (err)
2N/A return err;
2N/A *res = grub_inb (smbbase + GRUB_CS5536_SMB_REG_DATA);
2N/A
2N/A return GRUB_ERR_NONE;
2N/A}
2N/A
2N/Agrub_err_t
2N/Agrub_cs5536_init_smbus (grub_pci_device_t dev, grub_uint16_t divisor,
2N/A grub_port_t *smbbase)
2N/A{
2N/A grub_uint64_t smbbar;
2N/A
2N/A smbbar = grub_cs5536_read_msr (dev, GRUB_CS5536_MSR_SMB_BAR);
2N/A
2N/A /* FIXME */
2N/A if (!(smbbar & GRUB_CS5536_LBAR_ENABLE))
2N/A return grub_error(GRUB_ERR_IO, "SMB controller not enabled\n");
2N/A *smbbase = (smbbar & GRUB_CS5536_LBAR_ADDR_MASK) + GRUB_MACHINE_PCI_IO_BASE;
2N/A
2N/A if (divisor < 8)
2N/A return grub_error (GRUB_ERR_BAD_ARGUMENT, "invalid divisor");
2N/A
2N/A /* Disable SMB. */
2N/A grub_outb (0, *smbbase + GRUB_CS5536_SMB_REG_CTRL2);
2N/A
2N/A /* Disable interrupts. */
2N/A grub_outb (0, *smbbase + GRUB_CS5536_SMB_REG_CTRL1);
2N/A
2N/A /* Set as master. */
2N/A grub_outb (GRUB_CS5536_SMB_REG_ADDR_MASTER,
2N/A *smbbase + GRUB_CS5536_SMB_REG_ADDR);
2N/A
2N/A /* Launch. */
2N/A grub_outb (((divisor >> 7) & 0xff), *smbbase + GRUB_CS5536_SMB_REG_CTRL3);
2N/A grub_outb (((divisor << 1) & 0xfe) | GRUB_CS5536_SMB_REG_CTRL2_ENABLE,
2N/A *smbbase + GRUB_CS5536_SMB_REG_CTRL2);
2N/A
2N/A return GRUB_ERR_NONE;
2N/A}
2N/A
2N/Agrub_err_t
2N/Agrub_cs5536_read_spd (grub_port_t smbbase, grub_uint8_t dev,
2N/A struct grub_smbus_spd *res)
2N/A{
2N/A grub_err_t err;
2N/A grub_size_t size;
2N/A grub_uint8_t b;
2N/A grub_size_t ptr;
2N/A
2N/A err = grub_cs5536_read_spd_byte (smbbase, dev, 0, &b);
2N/A if (err)
2N/A return err;
2N/A if (b == 0)
2N/A return grub_error (GRUB_ERR_IO, "no SPD found");
2N/A size = b;
2N/A
2N/A ((grub_uint8_t *) res)[0] = b;
2N/A for (ptr = 1; ptr < size; ptr++)
2N/A {
2N/A err = grub_cs5536_read_spd_byte (smbbase, dev, ptr,
2N/A &((grub_uint8_t *) res)[ptr]);
2N/A if (err)
2N/A return err;
2N/A }
2N/A return GRUB_ERR_NONE;
2N/A}
2N/A
2N/Astatic inline void
2N/Aset_io_space (grub_pci_device_t dev, int num, grub_uint16_t start,
2N/A grub_uint16_t len)
2N/A{
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_REGIONS_START + num,
2N/A ((((grub_uint64_t) start + len - 4)
2N/A << GRUB_CS5536_MSR_GL_REGION_IO_TOP_SHIFT)
2N/A & GRUB_CS5536_MSR_GL_REGION_TOP_MASK)
2N/A | (((grub_uint64_t) start
2N/A << GRUB_CS5536_MSR_GL_REGION_IO_BASE_SHIFT)
2N/A & GRUB_CS5536_MSR_GL_REGION_BASE_MASK)
2N/A | GRUB_CS5536_MSR_GL_REGION_IO
2N/A | GRUB_CS5536_MSR_GL_REGION_ENABLE);
2N/A}
2N/A
2N/Astatic inline void
2N/Aset_iod (grub_pci_device_t dev, int num, int dest, int start, int mask)
2N/A{
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_IOD_START + num,
2N/A ((grub_uint64_t) dest << GRUB_CS5536_IOD_DEST_SHIFT)
2N/A | (((grub_uint64_t) start & GRUB_CS5536_IOD_ADDR_MASK)
2N/A << GRUB_CS5536_IOD_BASE_SHIFT)
2N/A | ((mask & GRUB_CS5536_IOD_ADDR_MASK)
2N/A << GRUB_CS5536_IOD_MASK_SHIFT));
2N/A}
2N/A
2N/Astatic inline void
2N/Aset_p2d (grub_pci_device_t dev, int num, int dest, grub_uint32_t start)
2N/A{
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_P2D_START + num,
2N/A (((grub_uint64_t) dest) << GRUB_CS5536_P2D_DEST_SHIFT)
2N/A | ((grub_uint64_t) (start >> GRUB_CS5536_P2D_LOG_ALIGN)
2N/A << GRUB_CS5536_P2D_BASE_SHIFT)
2N/A | (((1 << (32 - GRUB_CS5536_P2D_LOG_ALIGN)) - 1)
2N/A << GRUB_CS5536_P2D_MASK_SHIFT));
2N/A}
2N/A
2N/Avoid
2N/Agrub_cs5536_init_geode (grub_pci_device_t dev)
2N/A{
2N/A /* Enable more BARs. */
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IRQ_MAP_BAR,
2N/A GRUB_CS5536_LBAR_TURN_ON | GRUB_CS5536_LBAR_IRQ_MAP);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_MFGPT_BAR,
2N/A GRUB_CS5536_LBAR_TURN_ON | GRUB_CS5536_LBAR_MFGPT);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_ACPI_BAR,
2N/A GRUB_CS5536_LBAR_TURN_ON | GRUB_CS5536_LBAR_ACPI);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_PM_BAR,
2N/A GRUB_CS5536_LBAR_TURN_ON | GRUB_CS5536_LBAR_PM);
2N/A
2N/A /* Setup DIVIL. */
2N/A#ifdef GRUB_MACHINE_MIPS_LOONGSON
2N/A switch (grub_arch_machine)
2N/A {
2N/A case GRUB_ARCH_MACHINE_YEELOONG:
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_LEG_IO,
2N/A GRUB_CS5536_MSR_DIVIL_LEG_IO_MODE_X86
2N/A | GRUB_CS5536_MSR_DIVIL_LEG_IO_F_REMAP
2N/A | GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE0
2N/A | GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE1);
2N/A break;
2N/A case GRUB_ARCH_MACHINE_FULOONG2F:
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_LEG_IO,
2N/A GRUB_CS5536_MSR_DIVIL_LEG_IO_UART2_COM3
2N/A | GRUB_CS5536_MSR_DIVIL_LEG_IO_UART1_COM1
2N/A | GRUB_CS5536_MSR_DIVIL_LEG_IO_MODE_X86
2N/A | GRUB_CS5536_MSR_DIVIL_LEG_IO_F_REMAP
2N/A | GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE0
2N/A | GRUB_CS5536_MSR_DIVIL_LEG_IO_RTC_ENABLE1);
2N/A break;
2N/A }
2N/A#endif
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_IRQ_MAPPER_PRIMARY_MASK,
2N/A (~GRUB_CS5536_DIVIL_LPC_INTERRUPTS) & 0xffff);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_IRQ_MAPPER_LPC_MASK,
2N/A GRUB_CS5536_DIVIL_LPC_INTERRUPTS);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_DIVIL_LPC_SERIAL_IRQ_CONTROL,
2N/A GRUB_CS5536_MSR_DIVIL_LPC_SERIAL_IRQ_CONTROL_ENABLE);
2N/A
2N/A /* Initialise USB controller. */
2N/A /* FIXME: assign adresses dynamically. */
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_OHCI_BASE,
2N/A GRUB_CS5536_MSR_USB_BASE_BUS_MASTER
2N/A | GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE
2N/A | 0x05024000);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_EHCI_BASE,
2N/A GRUB_CS5536_MSR_USB_BASE_BUS_MASTER
2N/A | GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE
2N/A | (0x20ULL << GRUB_CS5536_MSR_USB_EHCI_BASE_FLDJ_SHIFT)
2N/A | 0x05023000);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_CONTROLLER_BASE,
2N/A GRUB_CS5536_MSR_USB_BASE_BUS_MASTER
2N/A | GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE | 0x05020000);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_USB_OPTION_CONTROLLER_BASE,
2N/A GRUB_CS5536_MSR_USB_BASE_MEMORY_ENABLE | 0x05022000);
2N/A set_p2d (dev, 0, GRUB_CS5536_DESTINATION_USB, 0x05020000);
2N/A set_p2d (dev, 1, GRUB_CS5536_DESTINATION_USB, 0x05022000);
2N/A set_p2d (dev, 5, GRUB_CS5536_DESTINATION_USB, 0x05024000);
2N/A set_p2d (dev, 6, GRUB_CS5536_DESTINATION_USB, 0x05023000);
2N/A
2N/A {
2N/A volatile grub_uint32_t *oc;
2N/A oc = grub_pci_device_map_range (dev, 0x05022000,
2N/A GRUB_CS5536_USB_OPTION_REGS_SIZE);
2N/A
2N/A oc[GRUB_CS5536_USB_OPTION_REG_UOCMUX] =
2N/A (oc[GRUB_CS5536_USB_OPTION_REG_UOCMUX]
2N/A & ~GRUB_CS5536_USB_OPTION_REG_UOCMUX_PMUX_MASK)
2N/A | GRUB_CS5536_USB_OPTION_REG_UOCMUX_PMUX_HC;
2N/A grub_pci_device_unmap_range (dev, oc, GRUB_CS5536_USB_OPTION_REGS_SIZE);
2N/A }
2N/A
2N/A /* Setup IDE controller. */
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_IO_BAR,
2N/A GRUB_CS5536_LBAR_IDE
2N/A | GRUB_CS5536_MSR_IDE_IO_BAR_UNITS);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_CFG,
2N/A GRUB_CS5536_MSR_IDE_CFG_CHANNEL_ENABLE);
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_TIMING,
2N/A (GRUB_CS5536_MSR_IDE_TIMING_PIO0
2N/A << GRUB_CS5536_MSR_IDE_TIMING_DRIVE0_SHIFT)
2N/A | (GRUB_CS5536_MSR_IDE_TIMING_PIO0
2N/A << GRUB_CS5536_MSR_IDE_TIMING_DRIVE1_SHIFT));
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_IDE_CAS_TIMING,
2N/A (GRUB_CS5536_MSR_IDE_CAS_TIMING_CMD_PIO0
2N/A << GRUB_CS5536_MSR_IDE_CAS_TIMING_CMD_SHIFT)
2N/A | (GRUB_CS5536_MSR_IDE_CAS_TIMING_PIO0
2N/A << GRUB_CS5536_MSR_IDE_CAS_TIMING_DRIVE0_SHIFT)
2N/A | (GRUB_CS5536_MSR_IDE_CAS_TIMING_PIO0
2N/A << GRUB_CS5536_MSR_IDE_CAS_TIMING_DRIVE1_SHIFT));
2N/A
2N/A /* Setup Geodelink PCI. */
2N/A grub_cs5536_write_msr (dev, GRUB_CS5536_MSR_GL_PCI_CTRL,
2N/A (4ULL << GRUB_CS5536_MSR_GL_PCI_CTRL_OUT_THR_SHIFT)
2N/A | (4ULL << GRUB_CS5536_MSR_GL_PCI_CTRL_IN_THR_SHIFT)
2N/A | (8ULL << GRUB_CS5536_MSR_GL_PCI_CTRL_LATENCY_SHIFT)
2N/A | GRUB_CS5536_MSR_GL_PCI_CTRL_IO_ENABLE
2N/A | GRUB_CS5536_MSR_GL_PCI_CTRL_MEMORY_ENABLE);
2N/A
2N/A /* Setup windows. */
2N/A set_io_space (dev, 0, GRUB_CS5536_LBAR_SMBUS, GRUB_CS5536_SMBUS_REGS_SIZE);
2N/A set_io_space (dev, 1, GRUB_CS5536_LBAR_GPIO, GRUB_CS5536_GPIO_REGS_SIZE);
2N/A set_io_space (dev, 2, GRUB_CS5536_LBAR_MFGPT, GRUB_CS5536_MFGPT_REGS_SIZE);
2N/A set_io_space (dev, 3, GRUB_CS5536_LBAR_IRQ_MAP, GRUB_CS5536_IRQ_MAP_REGS_SIZE);
2N/A set_io_space (dev, 4, GRUB_CS5536_LBAR_PM, GRUB_CS5536_PM_REGS_SIZE);
2N/A set_io_space (dev, 5, GRUB_CS5536_LBAR_ACPI, GRUB_CS5536_ACPI_REGS_SIZE);
2N/A set_iod (dev, 0, GRUB_CS5536_DESTINATION_IDE, GRUB_ATA_CH0_PORT1, 0xffff8);
2N/A set_iod (dev, 1, GRUB_CS5536_DESTINATION_ACC, GRUB_CS5536_LBAR_ACC, 0xfff80);
2N/A set_iod (dev, 2, GRUB_CS5536_DESTINATION_IDE, GRUB_CS5536_LBAR_IDE, 0xffff0);
2N/A}