[PATCH v2 7/9] serial: pl011: add acpi_match

From: Aleksey Makarov
Date: Fri Feb 12 2016 - 12:50:01 EST


Add an implementation of acpi_match() to the pl011 driver.
It allows console to check if it matches the console specified by
ACPI SPCR table.

Signed-off-by: Aleksey Makarov <aleksey.makarov@xxxxxxxxxx>
Tested-by: Christopher Covington <cov@xxxxxxxxxxxxxx>
---
drivers/tty/serial/amba-pl011.c | 22 ++++++++++++++++++++++
1 file changed, 22 insertions(+)

diff --git a/drivers/tty/serial/amba-pl011.c b/drivers/tty/serial/amba-pl011.c
index 500232a..f613bff 100644
--- a/drivers/tty/serial/amba-pl011.c
+++ b/drivers/tty/serial/amba-pl011.c
@@ -2285,12 +2285,34 @@ static int __init pl011_console_setup(struct console *co, char *options)
return uart_set_options(&uap->port, co, baud, parity, bits, flow);
}

+static int __init pl011_console_acpi_match(struct console *co,
+ struct acpi_table_spcr *spcr)
+{
+ struct uart_amba_port *uap = amba_ports[co->index < 0 ? 0 : co->index];
+
+ if (uap->vendor->access_32b) {
+ if (spcr->interface_type != ACPI_DBG2_ARM_SBSA_32BIT)
+ return -ENODEV;
+ } else {
+ if (spcr->interface_type != ACPI_DBG2_ARM_PL011 &&
+ spcr->interface_type != ACPI_DBG2_ARM_SBSA_GENERIC)
+ return -ENODEV;
+ }
+
+ if (spcr->serial_port.space_id != ACPI_ADR_SPACE_SYSTEM_MEMORY ||
+ spcr->serial_port.address != (u64)uap->port.mapbase)
+ return -ENODEV;
+
+ return 0;
+}
+
static struct uart_driver amba_reg;
static struct console amba_console = {
.name = "ttyAMA",
.write = pl011_console_write,
.device = uart_console_device,
.setup = pl011_console_setup,
+ .acpi_match = pl011_console_acpi_match,
.flags = CON_PRINTBUFFER,
.index = -1,
.data = &amba_reg,
--
2.7.0