/*
   * Parse the EFI PCDP table to locate the console device.
   *
   * (c) Copyright 2002, 2003, 2004 Hewlett-Packard Development Company, L.P.
   *	Khalid Aziz <khalid.aziz@hp.com>
   *	Alex Williamson <alex.williamson@hp.com>
   *	Bjorn Helgaas <bjorn.helgaas@hp.com>
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   */
  
  #include <linux/acpi.h>
  #include <linux/console.h>
  #include <linux/efi.h>
  #include <linux/serial.h>

  #include <linux/serial_8250.h>

  #include <asm/vga.h>

  #include "pcdp.h"
  
  static int __init
  setup_serial_console(struct pcdp_uart *uart)
  {
  #ifdef CONFIG_SERIAL_8250_CONSOLE
  	int mmio;

  	static char options[64], *p = options;

  	char parity;

  	mmio = (uart->addr.space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY);

  	p += sprintf(p, "uart8250,%s,0x%llx",

  		mmio ? "mmio" : "io", uart->addr.address);

  	if (uart->baud) {

  		p += sprintf(p, ",%llu", uart->baud);

  		if (uart->bits) {
  			switch (uart->parity) {
  			    case 0x2: parity = 'e'; break;
  			    case 0x3: parity = 'o'; break;
  			    default:  parity = 'n';
  			}
  			p += sprintf(p, "%c%d", parity, uart->bits);
  		}
  	}

  	add_preferred_console("uart", 8250, &options[9]);
  	return setup_early_serial8250_console(options);

  #else
  	return -ENODEV;
  #endif
  }
  
  static int __init

  setup_vga_console(struct pcdp_device *dev)

  {
  #if defined(CONFIG_VT) && defined(CONFIG_VGA_CONSOLE)

  	u8 *if_ptr;
  
  	if_ptr = ((u8 *)dev + sizeof(struct pcdp_device));
  	if (if_ptr[0] == PCDP_IF_PCI) {
  		struct pcdp_if_pci if_pci;
  
  		/* struct copy since ifptr might not be correctly aligned */
  
  		memcpy(&if_pci, if_ptr, sizeof(if_pci));
  
  		if (if_pci.trans & PCDP_PCI_TRANS_IOPORT)
  			vga_console_iobase = if_pci.ioport_tra;
  
  		if (if_pci.trans & PCDP_PCI_TRANS_MMIO)
  			vga_console_membase = if_pci.mmio_tra;
  	}
  
  	if (efi_mem_type(vga_console_membase + 0xA0000) == EFI_CONVENTIONAL_MEMORY) {

  		printk(KERN_ERR "PCDP: VGA selected, but frame buffer is not MMIO!
  ");
  		return -ENODEV;
  	}
  
  	conswitchp = &vga_con;
  	printk(KERN_INFO "PCDP: VGA console
  ");
  	return 0;
  #else
  	return -ENODEV;
  #endif
  }
  
  int __init
  efi_setup_pcdp_console(char *cmdline)
  {
  	struct pcdp *pcdp;
  	struct pcdp_uart *uart;
  	struct pcdp_device *dev, *end;
  	int i, serial = 0;

  	int rc = -ENODEV;

  	if (efi.hcdp == EFI_INVALID_TABLE_ADDR)

  		return -ENODEV;

  	pcdp = ioremap(efi.hcdp, 4096);
  	printk(KERN_INFO "PCDP: v%d at 0x%lx
  ", pcdp->rev, efi.hcdp);

  
  	if (strstr(cmdline, "console=hcdp")) {
  		if (pcdp->rev < 3)
  			serial = 1;
  	} else if (strstr(cmdline, "console=")) {
  		printk(KERN_INFO "Explicit \"console=\"; ignoring PCDP
  ");

  		goto out;

  	}
  
  	if (pcdp->rev < 3 && efi_uart_console_only())
  		serial = 1;
  
  	for (i = 0, uart = pcdp->uart; i < pcdp->num_uarts; i++, uart++) {
  		if (uart->flags & PCDP_UART_PRIMARY_CONSOLE || serial) {
  			if (uart->type == PCDP_CONSOLE_UART) {

  				rc = setup_serial_console(uart);
  				goto out;

  			}
  		}
  	}
  
  	end = (struct pcdp_device *) ((u8 *) pcdp + pcdp->length);
  	for (dev = (struct pcdp_device *) (pcdp->uart + pcdp->num_uarts);
  	     dev < end;
  	     dev = (struct pcdp_device *) ((u8 *) dev + dev->length)) {
  		if (dev->flags & PCDP_PRIMARY_CONSOLE) {
  			if (dev->type == PCDP_CONSOLE_VGA) {

  				rc = setup_vga_console(dev);
  				goto out;

  			}
  		}
  	}

  out:
  	iounmap(pcdp);
  	return rc;

  }