[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / firmware / pcdp.c

/*
 * 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!\n");
		return -ENODEV;
	}

	conswitchp = &vga_con;
	printk(KERN_INFO "PCDP: VGA console\n");
	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 = early_ioremap(efi.hcdp, 4096);
	printk(KERN_INFO "PCDP: v%d at 0x%lx\n", 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\n");
		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:
	early_iounmap(pcdp, 4096);
	return rc;
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Parse the EFI PCDP table to locate the console device.
	3	*
	4	* (c) Copyright 2002, 2003, 2004 Hewlett-Packard Development Company, L.P.
	5	* Khalid Aziz <khalid.aziz@hp.com>
	6	* Alex Williamson <alex.williamson@hp.com>
	7	* Bjorn Helgaas <bjorn.helgaas@hp.com>
	8	*
	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License version 2 as
	11	* published by the Free Software Foundation.
	12	*/
	13
	14	#include <linux/acpi.h>
	15	#include <linux/console.h>
	16	#include <linux/efi.h>
	17	#include <linux/serial.h>
18a8bd94	18	#include <linux/serial_8250.h>
66b7f8a3	19	#include <asm/vga.h>
1da177e4 LT	20	#include "pcdp.h"
	21
	22	static int __init
	23	setup_serial_console(struct pcdp_uart *uart)
	24	{
	25	#ifdef CONFIG_SERIAL_8250_CONSOLE
	26	int mmio;
280dedb8	27	static char options[64], *p = options;
11be00cb	28	char parity;
1da177e4	29
15a58ed1	30	mmio = (uart->addr.space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY);
e088a4ad	31	p += sprintf(p, "uart8250,%s,0x%llx",
280dedb8	32	mmio ? "mmio" : "io", uart->addr.address);
11be00cb	33	if (uart->baud) {
e088a4ad	34	p += sprintf(p, ",%llu", uart->baud);
11be00cb BH	35	if (uart->bits) {
	36	switch (uart->parity) {
	37	case 0x2: parity = 'e'; break;
	38	case 0x3: parity = 'o'; break;
	39	default: parity = 'n';
	40	}
	41	p += sprintf(p, "%c%d", parity, uart->bits);
	42	}
	43	}
1da177e4	44
18a8bd94 YL	45	add_preferred_console("uart", 8250, &options[9]);
18a8bd94 YL	46	return setup_early_serial8250_console(options);
1da177e4 LT	47	#else
	48	return -ENODEV;
	49	#endif
	50	}
	51
	52	static int __init
66b7f8a3	53	setup_vga_console(struct pcdp_device *dev)
1da177e4 LT	54	{
1da177e4 LT	55	#if defined(CONFIG_VT) && defined(CONFIG_VGA_CONSOLE)
66b7f8a3 MM	56	u8 *if_ptr;
	57
	58	if_ptr = ((u8 *)dev + sizeof(struct pcdp_device));
	59	if (if_ptr[0] == PCDP_IF_PCI) {
	60	struct pcdp_if_pci if_pci;
	61
	62	/* struct copy since ifptr might not be correctly aligned */
	63
	64	memcpy(&if_pci, if_ptr, sizeof(if_pci));
	65
	66	if (if_pci.trans & PCDP_PCI_TRANS_IOPORT)
	67	vga_console_iobase = if_pci.ioport_tra;
	68
	69	if (if_pci.trans & PCDP_PCI_TRANS_MMIO)
	70	vga_console_membase = if_pci.mmio_tra;
	71	}
	72
	73	if (efi_mem_type(vga_console_membase + 0xA0000) == EFI_CONVENTIONAL_MEMORY) {
1da177e4 LT	74	printk(KERN_ERR "PCDP: VGA selected, but frame buffer is not MMIO!\n");
	75	return -ENODEV;
	76	}
	77
	78	conswitchp = &vga_con;
	79	printk(KERN_INFO "PCDP: VGA console\n");
	80	return 0;
	81	#else
	82	return -ENODEV;
	83	#endif
	84	}
	85
	86	int __init
	87	efi_setup_pcdp_console(char *cmdline)
	88	{
	89	struct pcdp *pcdp;
	90	struct pcdp_uart *uart;
	91	struct pcdp_device dev, end;
	92	int i, serial = 0;
b2c99e3c	93	int rc = -ENODEV;
1da177e4	94
b2c99e3c	95	if (efi.hcdp == EFI_INVALID_TABLE_ADDR)
1da177e4 LT	96	return -ENODEV;
1da177e4 LT	97
6c4088ac	98	pcdp = early_ioremap(efi.hcdp, 4096);
b2c99e3c	99	printk(KERN_INFO "PCDP: v%d at 0x%lx\n", pcdp->rev, efi.hcdp);
1da177e4 LT	100
	101	if (strstr(cmdline, "console=hcdp")) {
	102	if (pcdp->rev < 3)
	103	serial = 1;
	104	} else if (strstr(cmdline, "console=")) {
	105	printk(KERN_INFO "Explicit \"console=\"; ignoring PCDP\n");
b2c99e3c	106	goto out;
1da177e4 LT	107	}
	108
	109	if (pcdp->rev < 3 && efi_uart_console_only())
	110	serial = 1;
	111
	112	for (i = 0, uart = pcdp->uart; i < pcdp->num_uarts; i++, uart++) {
	113	if (uart->flags & PCDP_UART_PRIMARY_CONSOLE \|\| serial) {
	114	if (uart->type == PCDP_CONSOLE_UART) {
b2c99e3c BH	115	rc = setup_serial_console(uart);
b2c99e3c BH	116	goto out;
1da177e4 LT	117	}
	118	}
	119	}
	120
	121	end = (struct pcdp_device ) ((u8 ) pcdp + pcdp->length);
	122	for (dev = (struct pcdp_device *) (pcdp->uart + pcdp->num_uarts);
	123	dev < end;
	124	dev = (struct pcdp_device ) ((u8 ) dev + dev->length)) {
	125	if (dev->flags & PCDP_PRIMARY_CONSOLE) {
	126	if (dev->type == PCDP_CONSOLE_VGA) {
b2c99e3c BH	127	rc = setup_vga_console(dev);
b2c99e3c BH	128	goto out;
1da177e4 LT	129	}
	130	}
	131	}
	132
b2c99e3c	133	out:
6c4088ac	134	early_iounmap(pcdp, 4096);
b2c99e3c	135	return rc;
1da177e4	136	}