PageRenderTime 28ms CodeModel.GetById 23ms app.highlight 4ms RepoModel.GetById 0ms app.codeStats 0ms

/drivers/firmware/pcdp.c

https://bitbucket.org/ndreys/linux-sunxi
C | 136 lines | 103 code | 20 blank | 13 comment | 28 complexity | 268683f99ba88c552bf1bdc6762c23bd MD5 | raw file
Possible License(s): GPL-2.0, LGPL-2.0, AGPL-1.0
  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>
 18#include <linux/serial_8250.h>
 19#include <asm/vga.h>
 20#include "pcdp.h"
 21
 22static int __init
 23setup_serial_console(struct pcdp_uart *uart)
 24{
 25#ifdef CONFIG_SERIAL_8250_CONSOLE
 26	int mmio;
 27	static char options[64], *p = options;
 28	char parity;
 29
 30	mmio = (uart->addr.space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY);
 31	p += sprintf(p, "uart8250,%s,0x%llx",
 32		mmio ? "mmio" : "io", uart->addr.address);
 33	if (uart->baud) {
 34		p += sprintf(p, ",%llu", uart->baud);
 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	}
 44
 45	add_preferred_console("uart", 8250, &options[9]);
 46	return setup_early_serial8250_console(options);
 47#else
 48	return -ENODEV;
 49#endif
 50}
 51
 52static int __init
 53setup_vga_console(struct pcdp_device *dev)
 54{
 55#if defined(CONFIG_VT) && defined(CONFIG_VGA_CONSOLE)
 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) {
 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
 86int __init
 87efi_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;
 93	int rc = -ENODEV;
 94
 95	if (efi.hcdp == EFI_INVALID_TABLE_ADDR)
 96		return -ENODEV;
 97
 98	pcdp = early_ioremap(efi.hcdp, 4096);
 99	printk(KERN_INFO "PCDP: v%d at 0x%lx\n", pcdp->rev, efi.hcdp);
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");
106		goto out;
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) {
115				rc = setup_serial_console(uart);
116				goto out;
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) {
127				rc = setup_vga_console(dev);
128				goto out;
129			}
130		}
131	}
132
133out:
134	early_iounmap(pcdp, 4096);
135	return rc;
136}