|
@@ -43,95 +43,67 @@ void octeon_serial_out(struct uart_port *up, int offset, int value)
|
|
|
cvmx_write_csr((uint64_t)(up->membase + (offset << 3)), (u8)value);
|
|
|
}
|
|
|
|
|
|
-/*
|
|
|
- * Allocated in .bss, so it is all zeroed.
|
|
|
- */
|
|
|
-#define OCTEON_MAX_UARTS 3
|
|
|
-static struct plat_serial8250_port octeon_uart8250_data[OCTEON_MAX_UARTS + 1];
|
|
|
-static struct platform_device octeon_uart8250_device = {
|
|
|
- .name = "serial8250",
|
|
|
- .id = PLAT8250_DEV_PLATFORM,
|
|
|
- .dev = {
|
|
|
- .platform_data = octeon_uart8250_data,
|
|
|
- },
|
|
|
-};
|
|
|
-
|
|
|
-static void __init octeon_uart_set_common(struct plat_serial8250_port *p)
|
|
|
+static int __devinit octeon_serial_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
- p->flags = ASYNC_SKIP_TEST | UPF_SHARE_IRQ | UPF_FIXED_TYPE;
|
|
|
- p->type = PORT_OCTEON;
|
|
|
- p->iotype = UPIO_MEM;
|
|
|
- p->regshift = 3; /* I/O addresses are every 8 bytes */
|
|
|
+ int irq, res;
|
|
|
+ struct resource *res_mem;
|
|
|
+ struct uart_port port;
|
|
|
+
|
|
|
+ /* All adaptors have an irq. */
|
|
|
+ irq = platform_get_irq(pdev, 0);
|
|
|
+ if (irq < 0)
|
|
|
+ return irq;
|
|
|
+
|
|
|
+ memset(&port, 0, sizeof(port));
|
|
|
+
|
|
|
+ port.flags = ASYNC_SKIP_TEST | UPF_SHARE_IRQ | UPF_FIXED_TYPE;
|
|
|
+ port.type = PORT_OCTEON;
|
|
|
+ port.iotype = UPIO_MEM;
|
|
|
+ port.regshift = 3;
|
|
|
+ port.dev = &pdev->dev;
|
|
|
+
|
|
|
if (octeon_is_simulation())
|
|
|
/* Make simulator output fast*/
|
|
|
- p->uartclk = 115200 * 16;
|
|
|
+ port.uartclk = 115200 * 16;
|
|
|
else
|
|
|
- p->uartclk = octeon_get_io_clock_rate();
|
|
|
- p->serial_in = octeon_serial_in;
|
|
|
- p->serial_out = octeon_serial_out;
|
|
|
-}
|
|
|
+ port.uartclk = octeon_get_io_clock_rate();
|
|
|
|
|
|
-static int __init octeon_serial_init(void)
|
|
|
-{
|
|
|
- int enable_uart0;
|
|
|
- int enable_uart1;
|
|
|
- int enable_uart2;
|
|
|
- struct plat_serial8250_port *p;
|
|
|
-
|
|
|
-#ifdef CONFIG_CAVIUM_OCTEON_2ND_KERNEL
|
|
|
- /*
|
|
|
- * If we are configured to run as the second of two kernels,
|
|
|
- * disable uart0 and enable uart1. Uart0 is owned by the first
|
|
|
- * kernel
|
|
|
- */
|
|
|
- enable_uart0 = 0;
|
|
|
- enable_uart1 = 1;
|
|
|
-#else
|
|
|
- /*
|
|
|
- * We are configured for the first kernel. We'll enable uart0
|
|
|
- * if the bootloader told us to use 0, otherwise will enable
|
|
|
- * uart 1.
|
|
|
- */
|
|
|
- enable_uart0 = (octeon_get_boot_uart() == 0);
|
|
|
- enable_uart1 = (octeon_get_boot_uart() == 1);
|
|
|
-#ifdef CONFIG_KGDB
|
|
|
- enable_uart1 = 1;
|
|
|
-#endif
|
|
|
-#endif
|
|
|
-
|
|
|
- /* Right now CN52XX is the only chip with a third uart */
|
|
|
- enable_uart2 = OCTEON_IS_MODEL(OCTEON_CN52XX);
|
|
|
-
|
|
|
- p = octeon_uart8250_data;
|
|
|
- if (enable_uart0) {
|
|
|
- /* Add a ttyS device for hardware uart 0 */
|
|
|
- octeon_uart_set_common(p);
|
|
|
- p->membase = (void *) CVMX_MIO_UARTX_RBR(0);
|
|
|
- p->mapbase = CVMX_MIO_UARTX_RBR(0) & ((1ull << 49) - 1);
|
|
|
- p->irq = OCTEON_IRQ_UART0;
|
|
|
- p++;
|
|
|
- }
|
|
|
+ port.serial_in = octeon_serial_in;
|
|
|
+ port.serial_out = octeon_serial_out;
|
|
|
+ port.irq = irq;
|
|
|
|
|
|
- if (enable_uart1) {
|
|
|
- /* Add a ttyS device for hardware uart 1 */
|
|
|
- octeon_uart_set_common(p);
|
|
|
- p->membase = (void *) CVMX_MIO_UARTX_RBR(1);
|
|
|
- p->mapbase = CVMX_MIO_UARTX_RBR(1) & ((1ull << 49) - 1);
|
|
|
- p->irq = OCTEON_IRQ_UART1;
|
|
|
- p++;
|
|
|
- }
|
|
|
- if (enable_uart2) {
|
|
|
- /* Add a ttyS device for hardware uart 2 */
|
|
|
- octeon_uart_set_common(p);
|
|
|
- p->membase = (void *) CVMX_MIO_UART2_RBR;
|
|
|
- p->mapbase = CVMX_MIO_UART2_RBR & ((1ull << 49) - 1);
|
|
|
- p->irq = OCTEON_IRQ_UART2;
|
|
|
- p++;
|
|
|
+ res_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
+ if (res_mem == NULL) {
|
|
|
+ dev_err(&pdev->dev, "found no memory resource\n");
|
|
|
+ return -ENXIO;
|
|
|
}
|
|
|
+ port.mapbase = res_mem->start;
|
|
|
+ port.membase = ioremap(res_mem->start, resource_size(res_mem));
|
|
|
|
|
|
- BUG_ON(p > &octeon_uart8250_data[OCTEON_MAX_UARTS]);
|
|
|
+ res = serial8250_register_port(&port);
|
|
|
|
|
|
- return platform_device_register(&octeon_uart8250_device);
|
|
|
+ return res >= 0 ? 0 : res;
|
|
|
}
|
|
|
|
|
|
-device_initcall(octeon_serial_init);
|
|
|
+static struct of_device_id octeon_serial_match[] = {
|
|
|
+ {
|
|
|
+ .compatible = "cavium,octeon-3860-uart",
|
|
|
+ },
|
|
|
+ {},
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(of, octeon_serial_match);
|
|
|
+
|
|
|
+static struct platform_driver octeon_serial_driver = {
|
|
|
+ .probe = octeon_serial_probe,
|
|
|
+ .driver = {
|
|
|
+ .owner = THIS_MODULE,
|
|
|
+ .name = "octeon_serial",
|
|
|
+ .of_match_table = octeon_serial_match,
|
|
|
+ },
|
|
|
+};
|
|
|
+
|
|
|
+static int __init octeon_serial_init(void)
|
|
|
+{
|
|
|
+ return platform_driver_register(&octeon_serial_driver);
|
|
|
+}
|
|
|
+late_initcall(octeon_serial_init);
|