128e3fb6cSRicardo Ribalda Delgado /* 228e3fb6cSRicardo Ribalda Delgado * Probe for F81216A LPC to 4 UART 328e3fb6cSRicardo Ribalda Delgado * 428e3fb6cSRicardo Ribalda Delgado * Based on drivers/tty/serial/8250_pnp.c, by Russell King, et al 528e3fb6cSRicardo Ribalda Delgado * 628e3fb6cSRicardo Ribalda Delgado * Copyright (C) 2014 Ricardo Ribalda, Qtechnology A/S 728e3fb6cSRicardo Ribalda Delgado * 828e3fb6cSRicardo Ribalda Delgado * 928e3fb6cSRicardo Ribalda Delgado * This program is free software; you can redistribute it and/or modify 1028e3fb6cSRicardo Ribalda Delgado * it under the terms of the GNU General Public License as published by 1128e3fb6cSRicardo Ribalda Delgado * the Free Software Foundation; either version 2 of the License. 1228e3fb6cSRicardo Ribalda Delgado */ 1328e3fb6cSRicardo Ribalda Delgado #include <linux/module.h> 1428e3fb6cSRicardo Ribalda Delgado #include <linux/pci.h> 1528e3fb6cSRicardo Ribalda Delgado #include <linux/pnp.h> 1628e3fb6cSRicardo Ribalda Delgado #include <linux/kernel.h> 1728e3fb6cSRicardo Ribalda Delgado #include <linux/serial_core.h> 1828e3fb6cSRicardo Ribalda Delgado #include "8250.h" 1928e3fb6cSRicardo Ribalda Delgado 2028e3fb6cSRicardo Ribalda Delgado #define ADDR_PORT 0x4E 2128e3fb6cSRicardo Ribalda Delgado #define DATA_PORT 0x4F 2228e3fb6cSRicardo Ribalda Delgado #define ENTRY_KEY 0x77 2328e3fb6cSRicardo Ribalda Delgado #define EXIT_KEY 0xAA 2428e3fb6cSRicardo Ribalda Delgado #define CHIP_ID1 0x20 2528e3fb6cSRicardo Ribalda Delgado #define CHIP_ID1_VAL 0x02 2628e3fb6cSRicardo Ribalda Delgado #define CHIP_ID2 0x21 2728e3fb6cSRicardo Ribalda Delgado #define CHIP_ID2_VAL 0x16 2828e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID1 0x23 2928e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID1_VAL 0x19 3028e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID2 0x24 3128e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID2_VAL 0x34 3228e3fb6cSRicardo Ribalda Delgado #define LDN 0x7 3328e3fb6cSRicardo Ribalda Delgado 3428e3fb6cSRicardo Ribalda Delgado #define RS485 0xF0 3528e3fb6cSRicardo Ribalda Delgado #define RTS_INVERT BIT(5) 3628e3fb6cSRicardo Ribalda Delgado #define RS485_URA BIT(4) 3728e3fb6cSRicardo Ribalda Delgado #define RXW4C_IRA BIT(3) 3828e3fb6cSRicardo Ribalda Delgado #define TXW4C_IRA BIT(2) 3928e3fb6cSRicardo Ribalda Delgado 4028e3fb6cSRicardo Ribalda Delgado #define DRIVER_NAME "8250_fintek" 4128e3fb6cSRicardo Ribalda Delgado 4228e3fb6cSRicardo Ribalda Delgado static int fintek_8250_enter_key(void){ 4328e3fb6cSRicardo Ribalda Delgado 4428e3fb6cSRicardo Ribalda Delgado if (!request_muxed_region(ADDR_PORT, 2, DRIVER_NAME)) 4528e3fb6cSRicardo Ribalda Delgado return -EBUSY; 4628e3fb6cSRicardo Ribalda Delgado 4728e3fb6cSRicardo Ribalda Delgado outb(ENTRY_KEY, ADDR_PORT); 4828e3fb6cSRicardo Ribalda Delgado outb(ENTRY_KEY, ADDR_PORT); 4928e3fb6cSRicardo Ribalda Delgado return 0; 5028e3fb6cSRicardo Ribalda Delgado } 5128e3fb6cSRicardo Ribalda Delgado 5228e3fb6cSRicardo Ribalda Delgado static void fintek_8250_exit_key(void){ 5328e3fb6cSRicardo Ribalda Delgado 5428e3fb6cSRicardo Ribalda Delgado outb(EXIT_KEY, ADDR_PORT); 5528e3fb6cSRicardo Ribalda Delgado release_region(ADDR_PORT, 2); 5628e3fb6cSRicardo Ribalda Delgado } 5728e3fb6cSRicardo Ribalda Delgado 5828e3fb6cSRicardo Ribalda Delgado static int fintek_8250_get_index(resource_size_t base_addr) 5928e3fb6cSRicardo Ribalda Delgado { 6028e3fb6cSRicardo Ribalda Delgado resource_size_t base[] = {0x3f8, 0x2f8, 0x3e8, 0x2e8}; 6128e3fb6cSRicardo Ribalda Delgado int i; 6228e3fb6cSRicardo Ribalda Delgado 6328e3fb6cSRicardo Ribalda Delgado for (i = 0; i < ARRAY_SIZE(base); i++) 6428e3fb6cSRicardo Ribalda Delgado if (base_addr == base[i]) 6528e3fb6cSRicardo Ribalda Delgado return i; 6628e3fb6cSRicardo Ribalda Delgado 6728e3fb6cSRicardo Ribalda Delgado return -ENODEV; 6828e3fb6cSRicardo Ribalda Delgado } 6928e3fb6cSRicardo Ribalda Delgado 7028e3fb6cSRicardo Ribalda Delgado static int fintek_8250_check_id(void) 7128e3fb6cSRicardo Ribalda Delgado { 7228e3fb6cSRicardo Ribalda Delgado 7328e3fb6cSRicardo Ribalda Delgado outb(CHIP_ID1, ADDR_PORT); 7428e3fb6cSRicardo Ribalda Delgado if (inb(DATA_PORT) != CHIP_ID1_VAL) 7528e3fb6cSRicardo Ribalda Delgado return -ENODEV; 7628e3fb6cSRicardo Ribalda Delgado 7728e3fb6cSRicardo Ribalda Delgado outb(CHIP_ID2, ADDR_PORT); 7828e3fb6cSRicardo Ribalda Delgado if (inb(DATA_PORT) != CHIP_ID2_VAL) 7928e3fb6cSRicardo Ribalda Delgado return -ENODEV; 8028e3fb6cSRicardo Ribalda Delgado 8128e3fb6cSRicardo Ribalda Delgado outb(VENDOR_ID1, ADDR_PORT); 8228e3fb6cSRicardo Ribalda Delgado if (inb(DATA_PORT) != VENDOR_ID1_VAL) 8328e3fb6cSRicardo Ribalda Delgado return -ENODEV; 8428e3fb6cSRicardo Ribalda Delgado 8528e3fb6cSRicardo Ribalda Delgado outb(VENDOR_ID2, ADDR_PORT); 8628e3fb6cSRicardo Ribalda Delgado if (inb(DATA_PORT) != VENDOR_ID2_VAL) 8728e3fb6cSRicardo Ribalda Delgado return -ENODEV; 8828e3fb6cSRicardo Ribalda Delgado 8928e3fb6cSRicardo Ribalda Delgado return 0; 9028e3fb6cSRicardo Ribalda Delgado } 9128e3fb6cSRicardo Ribalda Delgado 92*41e69093SRicardo Ribalda Delgado static int fintek_8250_rs485_config(struct uart_port *port, 9328e3fb6cSRicardo Ribalda Delgado struct serial_rs485 *rs485) 9428e3fb6cSRicardo Ribalda Delgado { 9528e3fb6cSRicardo Ribalda Delgado uint8_t config = 0; 96*41e69093SRicardo Ribalda Delgado int index = fintek_8250_get_index(port->iobase); 9728e3fb6cSRicardo Ribalda Delgado 9828e3fb6cSRicardo Ribalda Delgado if (index < 0) 9928e3fb6cSRicardo Ribalda Delgado return -EINVAL; 10028e3fb6cSRicardo Ribalda Delgado 10128e3fb6cSRicardo Ribalda Delgado if (rs485->flags & SER_RS485_ENABLED) 10228e3fb6cSRicardo Ribalda Delgado memset(rs485->padding, 0, sizeof(rs485->padding)); 10328e3fb6cSRicardo Ribalda Delgado else 10428e3fb6cSRicardo Ribalda Delgado memset(rs485, 0, sizeof(*rs485)); 10528e3fb6cSRicardo Ribalda Delgado 10628e3fb6cSRicardo Ribalda Delgado rs485->flags &= SER_RS485_ENABLED | SER_RS485_RTS_ON_SEND | 10728e3fb6cSRicardo Ribalda Delgado SER_RS485_RTS_AFTER_SEND; 10828e3fb6cSRicardo Ribalda Delgado 10928e3fb6cSRicardo Ribalda Delgado if (rs485->delay_rts_before_send) { 11028e3fb6cSRicardo Ribalda Delgado rs485->delay_rts_before_send = 1; 11128e3fb6cSRicardo Ribalda Delgado config |= TXW4C_IRA; 11228e3fb6cSRicardo Ribalda Delgado } 11328e3fb6cSRicardo Ribalda Delgado 11428e3fb6cSRicardo Ribalda Delgado if (rs485->delay_rts_after_send) { 11528e3fb6cSRicardo Ribalda Delgado rs485->delay_rts_after_send = 1; 11628e3fb6cSRicardo Ribalda Delgado config |= RXW4C_IRA; 11728e3fb6cSRicardo Ribalda Delgado } 11828e3fb6cSRicardo Ribalda Delgado 11928e3fb6cSRicardo Ribalda Delgado if ((!!(rs485->flags & SER_RS485_RTS_ON_SEND)) == 12028e3fb6cSRicardo Ribalda Delgado (!!(rs485->flags & SER_RS485_RTS_AFTER_SEND))) 12128e3fb6cSRicardo Ribalda Delgado rs485->flags &= SER_RS485_ENABLED; 12228e3fb6cSRicardo Ribalda Delgado else 12328e3fb6cSRicardo Ribalda Delgado config |= RS485_URA; 12428e3fb6cSRicardo Ribalda Delgado 12528e3fb6cSRicardo Ribalda Delgado if (rs485->flags & SER_RS485_RTS_ON_SEND) 12628e3fb6cSRicardo Ribalda Delgado config |= RTS_INVERT; 12728e3fb6cSRicardo Ribalda Delgado 12828e3fb6cSRicardo Ribalda Delgado if (fintek_8250_enter_key()) 12928e3fb6cSRicardo Ribalda Delgado return -EBUSY; 13028e3fb6cSRicardo Ribalda Delgado 13128e3fb6cSRicardo Ribalda Delgado outb(LDN, ADDR_PORT); 13228e3fb6cSRicardo Ribalda Delgado outb(index, DATA_PORT); 13328e3fb6cSRicardo Ribalda Delgado outb(RS485, ADDR_PORT); 13428e3fb6cSRicardo Ribalda Delgado outb(config, DATA_PORT); 13528e3fb6cSRicardo Ribalda Delgado fintek_8250_exit_key(); 13628e3fb6cSRicardo Ribalda Delgado 137*41e69093SRicardo Ribalda Delgado port->rs485 = *rs485; 138*41e69093SRicardo Ribalda Delgado 13928e3fb6cSRicardo Ribalda Delgado return 0; 14028e3fb6cSRicardo Ribalda Delgado } 14128e3fb6cSRicardo Ribalda Delgado 14228e3fb6cSRicardo Ribalda Delgado static int 14328e3fb6cSRicardo Ribalda Delgado fintek_8250_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id) 14428e3fb6cSRicardo Ribalda Delgado { 14528e3fb6cSRicardo Ribalda Delgado int line; 14628e3fb6cSRicardo Ribalda Delgado struct uart_8250_port uart; 14728e3fb6cSRicardo Ribalda Delgado int ret; 14828e3fb6cSRicardo Ribalda Delgado 14928e3fb6cSRicardo Ribalda Delgado if (!pnp_port_valid(dev, 0)) 15028e3fb6cSRicardo Ribalda Delgado return -ENODEV; 15128e3fb6cSRicardo Ribalda Delgado 15228e3fb6cSRicardo Ribalda Delgado if (fintek_8250_get_index(pnp_port_start(dev, 0)) < 0) 15328e3fb6cSRicardo Ribalda Delgado return -ENODEV; 15428e3fb6cSRicardo Ribalda Delgado 15528e3fb6cSRicardo Ribalda Delgado /* Enable configuration registers*/ 15628e3fb6cSRicardo Ribalda Delgado if (fintek_8250_enter_key()) 15728e3fb6cSRicardo Ribalda Delgado return -EBUSY; 15828e3fb6cSRicardo Ribalda Delgado 15928e3fb6cSRicardo Ribalda Delgado /*Check ID*/ 16028e3fb6cSRicardo Ribalda Delgado ret = fintek_8250_check_id(); 16128e3fb6cSRicardo Ribalda Delgado fintek_8250_exit_key(); 16228e3fb6cSRicardo Ribalda Delgado if (ret) 16328e3fb6cSRicardo Ribalda Delgado return ret; 16428e3fb6cSRicardo Ribalda Delgado 16528e3fb6cSRicardo Ribalda Delgado memset(&uart, 0, sizeof(uart)); 16628e3fb6cSRicardo Ribalda Delgado if (!pnp_irq_valid(dev, 0)) 16728e3fb6cSRicardo Ribalda Delgado return -ENODEV; 16828e3fb6cSRicardo Ribalda Delgado uart.port.irq = pnp_irq(dev, 0); 16928e3fb6cSRicardo Ribalda Delgado uart.port.iobase = pnp_port_start(dev, 0); 17028e3fb6cSRicardo Ribalda Delgado uart.port.iotype = UPIO_PORT; 171*41e69093SRicardo Ribalda Delgado uart.port.rs485_config = fintek_8250_rs485_config; 17228e3fb6cSRicardo Ribalda Delgado 17328e3fb6cSRicardo Ribalda Delgado uart.port.flags |= UPF_SKIP_TEST | UPF_BOOT_AUTOCONF; 17428e3fb6cSRicardo Ribalda Delgado if (pnp_irq_flags(dev, 0) & IORESOURCE_IRQ_SHAREABLE) 17528e3fb6cSRicardo Ribalda Delgado uart.port.flags |= UPF_SHARE_IRQ; 17628e3fb6cSRicardo Ribalda Delgado uart.port.uartclk = 1843200; 17728e3fb6cSRicardo Ribalda Delgado uart.port.dev = &dev->dev; 17828e3fb6cSRicardo Ribalda Delgado 17928e3fb6cSRicardo Ribalda Delgado line = serial8250_register_8250_port(&uart); 18028e3fb6cSRicardo Ribalda Delgado if (line < 0) 18128e3fb6cSRicardo Ribalda Delgado return -ENODEV; 18228e3fb6cSRicardo Ribalda Delgado 18328e3fb6cSRicardo Ribalda Delgado pnp_set_drvdata(dev, (void *)((long)line + 1)); 18428e3fb6cSRicardo Ribalda Delgado return 0; 18528e3fb6cSRicardo Ribalda Delgado } 18628e3fb6cSRicardo Ribalda Delgado 18728e3fb6cSRicardo Ribalda Delgado static void fintek_8250_remove(struct pnp_dev *dev) 18828e3fb6cSRicardo Ribalda Delgado { 18928e3fb6cSRicardo Ribalda Delgado long line = (long)pnp_get_drvdata(dev); 19028e3fb6cSRicardo Ribalda Delgado 19128e3fb6cSRicardo Ribalda Delgado if (line) 19228e3fb6cSRicardo Ribalda Delgado serial8250_unregister_port(line - 1); 19328e3fb6cSRicardo Ribalda Delgado } 19428e3fb6cSRicardo Ribalda Delgado 19528e3fb6cSRicardo Ribalda Delgado #ifdef CONFIG_PM 19628e3fb6cSRicardo Ribalda Delgado static int fintek_8250_suspend(struct pnp_dev *dev, pm_message_t state) 19728e3fb6cSRicardo Ribalda Delgado { 19828e3fb6cSRicardo Ribalda Delgado long line = (long)pnp_get_drvdata(dev); 19928e3fb6cSRicardo Ribalda Delgado 20028e3fb6cSRicardo Ribalda Delgado if (!line) 20128e3fb6cSRicardo Ribalda Delgado return -ENODEV; 20228e3fb6cSRicardo Ribalda Delgado serial8250_suspend_port(line - 1); 20328e3fb6cSRicardo Ribalda Delgado return 0; 20428e3fb6cSRicardo Ribalda Delgado } 20528e3fb6cSRicardo Ribalda Delgado 20628e3fb6cSRicardo Ribalda Delgado static int fintek_8250_resume(struct pnp_dev *dev) 20728e3fb6cSRicardo Ribalda Delgado { 20828e3fb6cSRicardo Ribalda Delgado long line = (long)pnp_get_drvdata(dev); 20928e3fb6cSRicardo Ribalda Delgado 21028e3fb6cSRicardo Ribalda Delgado if (!line) 21128e3fb6cSRicardo Ribalda Delgado return -ENODEV; 21228e3fb6cSRicardo Ribalda Delgado serial8250_resume_port(line - 1); 21328e3fb6cSRicardo Ribalda Delgado return 0; 21428e3fb6cSRicardo Ribalda Delgado } 21528e3fb6cSRicardo Ribalda Delgado #else 21628e3fb6cSRicardo Ribalda Delgado #define fintek_8250_suspend NULL 21728e3fb6cSRicardo Ribalda Delgado #define fintek_8250_resume NULL 21828e3fb6cSRicardo Ribalda Delgado #endif /* CONFIG_PM */ 21928e3fb6cSRicardo Ribalda Delgado 22028e3fb6cSRicardo Ribalda Delgado static const struct pnp_device_id fintek_dev_table[] = { 22128e3fb6cSRicardo Ribalda Delgado /* Qtechnology Panel PC / IO1000 */ 22228e3fb6cSRicardo Ribalda Delgado { "PNP0501"}, 22328e3fb6cSRicardo Ribalda Delgado {} 22428e3fb6cSRicardo Ribalda Delgado }; 22528e3fb6cSRicardo Ribalda Delgado 22628e3fb6cSRicardo Ribalda Delgado MODULE_DEVICE_TABLE(pnp, fintek_dev_table); 22728e3fb6cSRicardo Ribalda Delgado 22828e3fb6cSRicardo Ribalda Delgado static struct pnp_driver fintek_8250_driver = { 22928e3fb6cSRicardo Ribalda Delgado .name = DRIVER_NAME, 23028e3fb6cSRicardo Ribalda Delgado .probe = fintek_8250_probe, 23128e3fb6cSRicardo Ribalda Delgado .remove = fintek_8250_remove, 23228e3fb6cSRicardo Ribalda Delgado .suspend = fintek_8250_suspend, 23328e3fb6cSRicardo Ribalda Delgado .resume = fintek_8250_resume, 23428e3fb6cSRicardo Ribalda Delgado .id_table = fintek_dev_table, 23528e3fb6cSRicardo Ribalda Delgado }; 23628e3fb6cSRicardo Ribalda Delgado 23728e3fb6cSRicardo Ribalda Delgado static int fintek_8250_init(void) 23828e3fb6cSRicardo Ribalda Delgado { 23928e3fb6cSRicardo Ribalda Delgado return pnp_register_driver(&fintek_8250_driver); 24028e3fb6cSRicardo Ribalda Delgado } 24128e3fb6cSRicardo Ribalda Delgado module_init(fintek_8250_init); 24228e3fb6cSRicardo Ribalda Delgado 24328e3fb6cSRicardo Ribalda Delgado static void fintek_8250_exit(void) 24428e3fb6cSRicardo Ribalda Delgado { 24528e3fb6cSRicardo Ribalda Delgado pnp_unregister_driver(&fintek_8250_driver); 24628e3fb6cSRicardo Ribalda Delgado } 24728e3fb6cSRicardo Ribalda Delgado module_exit(fintek_8250_exit); 24828e3fb6cSRicardo Ribalda Delgado 24928e3fb6cSRicardo Ribalda Delgado MODULE_DESCRIPTION("Fintek F812164 module"); 25028e3fb6cSRicardo Ribalda Delgado MODULE_AUTHOR("Ricardo Ribalda <ricardo.ribalda@gmail.com>"); 25128e3fb6cSRicardo Ribalda Delgado MODULE_LICENSE("GPL"); 252