128e3fb6cSRicardo Ribalda Delgado /* 228e3fb6cSRicardo Ribalda Delgado * Probe for F81216A LPC to 4 UART 328e3fb6cSRicardo Ribalda Delgado * 4fa01e2caSRicardo Ribalda Delgado * Copyright (C) 2014-2016 Ricardo Ribalda, Qtechnology A/S 528e3fb6cSRicardo Ribalda Delgado * 628e3fb6cSRicardo Ribalda Delgado * 728e3fb6cSRicardo Ribalda Delgado * This program is free software; you can redistribute it and/or modify 828e3fb6cSRicardo Ribalda Delgado * it under the terms of the GNU General Public License as published by 928e3fb6cSRicardo Ribalda Delgado * the Free Software Foundation; either version 2 of the License. 1028e3fb6cSRicardo Ribalda Delgado */ 1128e3fb6cSRicardo Ribalda Delgado #include <linux/module.h> 1228e3fb6cSRicardo Ribalda Delgado #include <linux/pci.h> 1328e3fb6cSRicardo Ribalda Delgado #include <linux/pnp.h> 1428e3fb6cSRicardo Ribalda Delgado #include <linux/kernel.h> 1528e3fb6cSRicardo Ribalda Delgado #include <linux/serial_core.h> 164da22f14SJi-Ze Hong (Peter Hong) #include <linux/irq.h> 1728e3fb6cSRicardo Ribalda Delgado #include "8250.h" 1828e3fb6cSRicardo Ribalda Delgado 19017bec38SRicardo Ribalda Delgado #define ADDR_PORT 0 20017bec38SRicardo Ribalda Delgado #define DATA_PORT 1 2128e3fb6cSRicardo Ribalda Delgado #define EXIT_KEY 0xAA 2228e3fb6cSRicardo Ribalda Delgado #define CHIP_ID1 0x20 2328e3fb6cSRicardo Ribalda Delgado #define CHIP_ID2 0x21 24*de48b099SJi-Ze Hong (Peter Hong) #define CHIP_ID_F81865 0x0407 25da60d6afSJi-Ze Hong (Peter Hong) #define CHIP_ID_F81866 0x1010 26c2236facSJi-Ze Hong (Peter Hong) #define CHIP_ID_F81216AD 0x1602 27c2236facSJi-Ze Hong (Peter Hong) #define CHIP_ID_F81216H 0x0501 281e26c472SJi-Ze Hong (Peter Hong) #define CHIP_ID_F81216 0x0802 2928e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID1 0x23 3028e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID1_VAL 0x19 3128e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID2 0x24 3228e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID2_VAL 0x34 3329d58642SRicardo Ribalda Delgado #define IO_ADDR1 0x61 3429d58642SRicardo Ribalda Delgado #define IO_ADDR2 0x60 3528e3fb6cSRicardo Ribalda Delgado #define LDN 0x7 3628e3fb6cSRicardo Ribalda Delgado 3787a713c8SArnd Bergmann #define FINTEK_IRQ_MODE 0x70 384da22f14SJi-Ze Hong (Peter Hong) #define IRQ_SHARE BIT(4) 394da22f14SJi-Ze Hong (Peter Hong) #define IRQ_MODE_MASK (BIT(6) | BIT(5)) 404da22f14SJi-Ze Hong (Peter Hong) #define IRQ_LEVEL_LOW 0 414da22f14SJi-Ze Hong (Peter Hong) #define IRQ_EDGE_HIGH BIT(5) 424da22f14SJi-Ze Hong (Peter Hong) 4328e3fb6cSRicardo Ribalda Delgado #define RS485 0xF0 4428e3fb6cSRicardo Ribalda Delgado #define RTS_INVERT BIT(5) 4528e3fb6cSRicardo Ribalda Delgado #define RS485_URA BIT(4) 4628e3fb6cSRicardo Ribalda Delgado #define RXW4C_IRA BIT(3) 4728e3fb6cSRicardo Ribalda Delgado #define TXW4C_IRA BIT(2) 4828e3fb6cSRicardo Ribalda Delgado 49c2236facSJi-Ze Hong (Peter Hong) #define FIFO_CTRL 0xF6 50c2236facSJi-Ze Hong (Peter Hong) #define FIFO_MODE_MASK (BIT(1) | BIT(0)) 51c2236facSJi-Ze Hong (Peter Hong) #define FIFO_MODE_128 (BIT(1) | BIT(0)) 52c2236facSJi-Ze Hong (Peter Hong) #define RXFTHR_MODE_MASK (BIT(5) | BIT(4)) 53c2236facSJi-Ze Hong (Peter Hong) #define RXFTHR_MODE_4X BIT(5) 54c2236facSJi-Ze Hong (Peter Hong) 55da60d6afSJi-Ze Hong (Peter Hong) #define F81216_LDN_LOW 0x0 56da60d6afSJi-Ze Hong (Peter Hong) #define F81216_LDN_HIGH 0x4 57da60d6afSJi-Ze Hong (Peter Hong) 58da60d6afSJi-Ze Hong (Peter Hong) /* 59da60d6afSJi-Ze Hong (Peter Hong) * F81866 registers 60da60d6afSJi-Ze Hong (Peter Hong) * 61da60d6afSJi-Ze Hong (Peter Hong) * The IRQ setting mode of F81866 is not the same with F81216 series. 62da60d6afSJi-Ze Hong (Peter Hong) * Level/Low: IRQ_MODE0:0, IRQ_MODE1:0 63da60d6afSJi-Ze Hong (Peter Hong) * Edge/High: IRQ_MODE0:1, IRQ_MODE1:0 64da60d6afSJi-Ze Hong (Peter Hong) */ 65da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_MODE 0xf0 66da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_SHARE BIT(0) 67da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_MODE0 BIT(1) 68da60d6afSJi-Ze Hong (Peter Hong) 69da60d6afSJi-Ze Hong (Peter Hong) #define F81866_FIFO_CTRL FIFO_CTRL 70da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_MODE1 BIT(3) 71da60d6afSJi-Ze Hong (Peter Hong) 72da60d6afSJi-Ze Hong (Peter Hong) #define F81866_LDN_LOW 0x10 73da60d6afSJi-Ze Hong (Peter Hong) #define F81866_LDN_HIGH 0x16 74da60d6afSJi-Ze Hong (Peter Hong) 7592a5f11aSRicardo Ribalda Delgado struct fintek_8250 { 76c2236facSJi-Ze Hong (Peter Hong) u16 pid; 77017bec38SRicardo Ribalda Delgado u16 base_port; 7892a5f11aSRicardo Ribalda Delgado u8 index; 79ce8c267eSRicardo Ribalda Delgado u8 key; 8092a5f11aSRicardo Ribalda Delgado }; 8192a5f11aSRicardo Ribalda Delgado 82f1232ac2SJi-Ze Hong (Peter Hong) static u8 sio_read_reg(struct fintek_8250 *pdata, u8 reg) 83f1232ac2SJi-Ze Hong (Peter Hong) { 84f1232ac2SJi-Ze Hong (Peter Hong) outb(reg, pdata->base_port + ADDR_PORT); 85f1232ac2SJi-Ze Hong (Peter Hong) return inb(pdata->base_port + DATA_PORT); 86f1232ac2SJi-Ze Hong (Peter Hong) } 87f1232ac2SJi-Ze Hong (Peter Hong) 88f1232ac2SJi-Ze Hong (Peter Hong) static void sio_write_reg(struct fintek_8250 *pdata, u8 reg, u8 data) 89f1232ac2SJi-Ze Hong (Peter Hong) { 90f1232ac2SJi-Ze Hong (Peter Hong) outb(reg, pdata->base_port + ADDR_PORT); 91f1232ac2SJi-Ze Hong (Peter Hong) outb(data, pdata->base_port + DATA_PORT); 92f1232ac2SJi-Ze Hong (Peter Hong) } 93f1232ac2SJi-Ze Hong (Peter Hong) 94f1232ac2SJi-Ze Hong (Peter Hong) static void sio_write_mask_reg(struct fintek_8250 *pdata, u8 reg, u8 mask, 95f1232ac2SJi-Ze Hong (Peter Hong) u8 data) 96f1232ac2SJi-Ze Hong (Peter Hong) { 97f1232ac2SJi-Ze Hong (Peter Hong) u8 tmp; 98f1232ac2SJi-Ze Hong (Peter Hong) 99f1232ac2SJi-Ze Hong (Peter Hong) tmp = (sio_read_reg(pdata, reg) & ~mask) | (mask & data); 100f1232ac2SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, reg, tmp); 101f1232ac2SJi-Ze Hong (Peter Hong) } 102f1232ac2SJi-Ze Hong (Peter Hong) 103ce8c267eSRicardo Ribalda Delgado static int fintek_8250_enter_key(u16 base_port, u8 key) 104017bec38SRicardo Ribalda Delgado { 105fa01e2caSRicardo Ribalda Delgado if (!request_muxed_region(base_port, 2, "8250_fintek")) 10628e3fb6cSRicardo Ribalda Delgado return -EBUSY; 10728e3fb6cSRicardo Ribalda Delgado 108ce8c267eSRicardo Ribalda Delgado outb(key, base_port + ADDR_PORT); 109ce8c267eSRicardo Ribalda Delgado outb(key, base_port + ADDR_PORT); 11028e3fb6cSRicardo Ribalda Delgado return 0; 11128e3fb6cSRicardo Ribalda Delgado } 11228e3fb6cSRicardo Ribalda Delgado 113017bec38SRicardo Ribalda Delgado static void fintek_8250_exit_key(u16 base_port) 114017bec38SRicardo Ribalda Delgado { 11528e3fb6cSRicardo Ribalda Delgado 116017bec38SRicardo Ribalda Delgado outb(EXIT_KEY, base_port + ADDR_PORT); 117017bec38SRicardo Ribalda Delgado release_region(base_port + ADDR_PORT, 2); 11828e3fb6cSRicardo Ribalda Delgado } 11928e3fb6cSRicardo Ribalda Delgado 120f1232ac2SJi-Ze Hong (Peter Hong) static int fintek_8250_check_id(struct fintek_8250 *pdata) 12128e3fb6cSRicardo Ribalda Delgado { 122dae77f75SRicardo Ribalda Delgado u16 chip; 12328e3fb6cSRicardo Ribalda Delgado 124f1232ac2SJi-Ze Hong (Peter Hong) if (sio_read_reg(pdata, VENDOR_ID1) != VENDOR_ID1_VAL) 12528e3fb6cSRicardo Ribalda Delgado return -ENODEV; 12628e3fb6cSRicardo Ribalda Delgado 127f1232ac2SJi-Ze Hong (Peter Hong) if (sio_read_reg(pdata, VENDOR_ID2) != VENDOR_ID2_VAL) 12828e3fb6cSRicardo Ribalda Delgado return -ENODEV; 12928e3fb6cSRicardo Ribalda Delgado 130f1232ac2SJi-Ze Hong (Peter Hong) chip = sio_read_reg(pdata, CHIP_ID1); 131f1232ac2SJi-Ze Hong (Peter Hong) chip |= sio_read_reg(pdata, CHIP_ID2) << 8; 132dae77f75SRicardo Ribalda Delgado 1331e26c472SJi-Ze Hong (Peter Hong) switch (chip) { 134*de48b099SJi-Ze Hong (Peter Hong) case CHIP_ID_F81865: 135da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 1361e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216AD: 1371e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: 1381e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216: 1391e26c472SJi-Ze Hong (Peter Hong) break; 1401e26c472SJi-Ze Hong (Peter Hong) default: 141dae77f75SRicardo Ribalda Delgado return -ENODEV; 1421e26c472SJi-Ze Hong (Peter Hong) } 143dae77f75SRicardo Ribalda Delgado 144c2236facSJi-Ze Hong (Peter Hong) pdata->pid = chip; 14528e3fb6cSRicardo Ribalda Delgado return 0; 14628e3fb6cSRicardo Ribalda Delgado } 14728e3fb6cSRicardo Ribalda Delgado 148da60d6afSJi-Ze Hong (Peter Hong) static int fintek_8250_get_ldn_range(struct fintek_8250 *pdata, int *min, 149da60d6afSJi-Ze Hong (Peter Hong) int *max) 150da60d6afSJi-Ze Hong (Peter Hong) { 151da60d6afSJi-Ze Hong (Peter Hong) switch (pdata->pid) { 152*de48b099SJi-Ze Hong (Peter Hong) case CHIP_ID_F81865: 153da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 154da60d6afSJi-Ze Hong (Peter Hong) *min = F81866_LDN_LOW; 155da60d6afSJi-Ze Hong (Peter Hong) *max = F81866_LDN_HIGH; 156da60d6afSJi-Ze Hong (Peter Hong) return 0; 157da60d6afSJi-Ze Hong (Peter Hong) 158da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216AD: 159da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: 160da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216: 161da60d6afSJi-Ze Hong (Peter Hong) *min = F81216_LDN_LOW; 162da60d6afSJi-Ze Hong (Peter Hong) *max = F81216_LDN_HIGH; 163da60d6afSJi-Ze Hong (Peter Hong) return 0; 164da60d6afSJi-Ze Hong (Peter Hong) } 165da60d6afSJi-Ze Hong (Peter Hong) 166da60d6afSJi-Ze Hong (Peter Hong) return -ENODEV; 167da60d6afSJi-Ze Hong (Peter Hong) } 168da60d6afSJi-Ze Hong (Peter Hong) 16941e69093SRicardo Ribalda Delgado static int fintek_8250_rs485_config(struct uart_port *port, 17028e3fb6cSRicardo Ribalda Delgado struct serial_rs485 *rs485) 17128e3fb6cSRicardo Ribalda Delgado { 17228e3fb6cSRicardo Ribalda Delgado uint8_t config = 0; 17392a5f11aSRicardo Ribalda Delgado struct fintek_8250 *pdata = port->private_data; 17428e3fb6cSRicardo Ribalda Delgado 17592a5f11aSRicardo Ribalda Delgado if (!pdata) 17628e3fb6cSRicardo Ribalda Delgado return -EINVAL; 17728e3fb6cSRicardo Ribalda Delgado 17828e3fb6cSRicardo Ribalda Delgado if (rs485->flags & SER_RS485_ENABLED) 17928e3fb6cSRicardo Ribalda Delgado memset(rs485->padding, 0, sizeof(rs485->padding)); 18028e3fb6cSRicardo Ribalda Delgado else 18128e3fb6cSRicardo Ribalda Delgado memset(rs485, 0, sizeof(*rs485)); 18228e3fb6cSRicardo Ribalda Delgado 18328e3fb6cSRicardo Ribalda Delgado rs485->flags &= SER_RS485_ENABLED | SER_RS485_RTS_ON_SEND | 18428e3fb6cSRicardo Ribalda Delgado SER_RS485_RTS_AFTER_SEND; 18528e3fb6cSRicardo Ribalda Delgado 18628e3fb6cSRicardo Ribalda Delgado if (rs485->delay_rts_before_send) { 18728e3fb6cSRicardo Ribalda Delgado rs485->delay_rts_before_send = 1; 18828e3fb6cSRicardo Ribalda Delgado config |= TXW4C_IRA; 18928e3fb6cSRicardo Ribalda Delgado } 19028e3fb6cSRicardo Ribalda Delgado 19128e3fb6cSRicardo Ribalda Delgado if (rs485->delay_rts_after_send) { 19228e3fb6cSRicardo Ribalda Delgado rs485->delay_rts_after_send = 1; 19328e3fb6cSRicardo Ribalda Delgado config |= RXW4C_IRA; 19428e3fb6cSRicardo Ribalda Delgado } 19528e3fb6cSRicardo Ribalda Delgado 19628e3fb6cSRicardo Ribalda Delgado if ((!!(rs485->flags & SER_RS485_RTS_ON_SEND)) == 19728e3fb6cSRicardo Ribalda Delgado (!!(rs485->flags & SER_RS485_RTS_AFTER_SEND))) 19828e3fb6cSRicardo Ribalda Delgado rs485->flags &= SER_RS485_ENABLED; 19928e3fb6cSRicardo Ribalda Delgado else 20028e3fb6cSRicardo Ribalda Delgado config |= RS485_URA; 20128e3fb6cSRicardo Ribalda Delgado 20228e3fb6cSRicardo Ribalda Delgado if (rs485->flags & SER_RS485_RTS_ON_SEND) 20328e3fb6cSRicardo Ribalda Delgado config |= RTS_INVERT; 20428e3fb6cSRicardo Ribalda Delgado 205ce8c267eSRicardo Ribalda Delgado if (fintek_8250_enter_key(pdata->base_port, pdata->key)) 20628e3fb6cSRicardo Ribalda Delgado return -EBUSY; 20728e3fb6cSRicardo Ribalda Delgado 208f1232ac2SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, LDN, pdata->index); 209f1232ac2SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, RS485, config); 210017bec38SRicardo Ribalda Delgado fintek_8250_exit_key(pdata->base_port); 21128e3fb6cSRicardo Ribalda Delgado 21241e69093SRicardo Ribalda Delgado port->rs485 = *rs485; 21341e69093SRicardo Ribalda Delgado 21428e3fb6cSRicardo Ribalda Delgado return 0; 21528e3fb6cSRicardo Ribalda Delgado } 21628e3fb6cSRicardo Ribalda Delgado 21706e39572SJi-Ze Hong (Peter Hong) static void fintek_8250_set_irq_mode(struct fintek_8250 *pdata, bool is_level) 21806e39572SJi-Ze Hong (Peter Hong) { 21906e39572SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, LDN, pdata->index); 220da60d6afSJi-Ze Hong (Peter Hong) 221da60d6afSJi-Ze Hong (Peter Hong) switch (pdata->pid) { 222da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 223da60d6afSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, F81866_FIFO_CTRL, F81866_IRQ_MODE1, 224da60d6afSJi-Ze Hong (Peter Hong) 0); 225*de48b099SJi-Ze Hong (Peter Hong) /* fall through */ 226*de48b099SJi-Ze Hong (Peter Hong) case CHIP_ID_F81865: 227da60d6afSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, F81866_IRQ_MODE, F81866_IRQ_SHARE, 228da60d6afSJi-Ze Hong (Peter Hong) F81866_IRQ_SHARE); 229da60d6afSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, F81866_IRQ_MODE, F81866_IRQ_MODE0, 230da60d6afSJi-Ze Hong (Peter Hong) is_level ? 0 : F81866_IRQ_MODE0); 231da60d6afSJi-Ze Hong (Peter Hong) break; 232da60d6afSJi-Ze Hong (Peter Hong) 233da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216AD: 234da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: 235da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216: 236da60d6afSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, FINTEK_IRQ_MODE, IRQ_SHARE, 237da60d6afSJi-Ze Hong (Peter Hong) IRQ_SHARE); 23806e39572SJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, FINTEK_IRQ_MODE, IRQ_MODE_MASK, 23906e39572SJi-Ze Hong (Peter Hong) is_level ? IRQ_LEVEL_LOW : IRQ_EDGE_HIGH); 240da60d6afSJi-Ze Hong (Peter Hong) break; 241da60d6afSJi-Ze Hong (Peter Hong) } 24206e39572SJi-Ze Hong (Peter Hong) } 24306e39572SJi-Ze Hong (Peter Hong) 244c2236facSJi-Ze Hong (Peter Hong) static void fintek_8250_set_max_fifo(struct fintek_8250 *pdata) 245c2236facSJi-Ze Hong (Peter Hong) { 246c2236facSJi-Ze Hong (Peter Hong) switch (pdata->pid) { 247c2236facSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: /* 128Bytes FIFO */ 248da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 249c2236facSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, FIFO_CTRL, 250c2236facSJi-Ze Hong (Peter Hong) FIFO_MODE_MASK | RXFTHR_MODE_MASK, 251c2236facSJi-Ze Hong (Peter Hong) FIFO_MODE_128 | RXFTHR_MODE_4X); 252c2236facSJi-Ze Hong (Peter Hong) break; 253c2236facSJi-Ze Hong (Peter Hong) 254c2236facSJi-Ze Hong (Peter Hong) default: /* Default 16Bytes FIFO */ 255c2236facSJi-Ze Hong (Peter Hong) break; 256c2236facSJi-Ze Hong (Peter Hong) } 257c2236facSJi-Ze Hong (Peter Hong) } 258c2236facSJi-Ze Hong (Peter Hong) 25906e39572SJi-Ze Hong (Peter Hong) static int probe_setup_port(struct fintek_8250 *pdata, u16 io_address, 26006e39572SJi-Ze Hong (Peter Hong) unsigned int irq) 261017bec38SRicardo Ribalda Delgado { 262017bec38SRicardo Ribalda Delgado static const u16 addr[] = {0x4e, 0x2e}; 263ce8c267eSRicardo Ribalda Delgado static const u8 keys[] = {0x77, 0xa0, 0x87, 0x67}; 26406e39572SJi-Ze Hong (Peter Hong) struct irq_data *irq_data; 26506e39572SJi-Ze Hong (Peter Hong) bool level_mode = false; 266da60d6afSJi-Ze Hong (Peter Hong) int i, j, k, min, max; 267017bec38SRicardo Ribalda Delgado 268017bec38SRicardo Ribalda Delgado for (i = 0; i < ARRAY_SIZE(addr); i++) { 269ce8c267eSRicardo Ribalda Delgado for (j = 0; j < ARRAY_SIZE(keys); j++) { 270f1232ac2SJi-Ze Hong (Peter Hong) pdata->base_port = addr[i]; 271f1232ac2SJi-Ze Hong (Peter Hong) pdata->key = keys[j]; 272017bec38SRicardo Ribalda Delgado 273ce8c267eSRicardo Ribalda Delgado if (fintek_8250_enter_key(addr[i], keys[j])) 274017bec38SRicardo Ribalda Delgado continue; 275da60d6afSJi-Ze Hong (Peter Hong) if (fintek_8250_check_id(pdata) || 276da60d6afSJi-Ze Hong (Peter Hong) fintek_8250_get_ldn_range(pdata, &min, &max)) { 277017bec38SRicardo Ribalda Delgado fintek_8250_exit_key(addr[i]); 27829d58642SRicardo Ribalda Delgado continue; 27929d58642SRicardo Ribalda Delgado } 28029d58642SRicardo Ribalda Delgado 281da60d6afSJi-Ze Hong (Peter Hong) for (k = min; k < max; k++) { 28229d58642SRicardo Ribalda Delgado u16 aux; 28329d58642SRicardo Ribalda Delgado 284f1232ac2SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, LDN, k); 285f1232ac2SJi-Ze Hong (Peter Hong) aux = sio_read_reg(pdata, IO_ADDR1); 286f1232ac2SJi-Ze Hong (Peter Hong) aux |= sio_read_reg(pdata, IO_ADDR2) << 8; 28729d58642SRicardo Ribalda Delgado if (aux != io_address) 28829d58642SRicardo Ribalda Delgado continue; 28929d58642SRicardo Ribalda Delgado 290fa01e2caSRicardo Ribalda Delgado pdata->index = k; 291fa01e2caSRicardo Ribalda Delgado 29206e39572SJi-Ze Hong (Peter Hong) irq_data = irq_get_irq_data(irq); 29306e39572SJi-Ze Hong (Peter Hong) if (irq_data) 29406e39572SJi-Ze Hong (Peter Hong) level_mode = 29506e39572SJi-Ze Hong (Peter Hong) irqd_is_level_type(irq_data); 29606e39572SJi-Ze Hong (Peter Hong) 29706e39572SJi-Ze Hong (Peter Hong) fintek_8250_set_irq_mode(pdata, level_mode); 298c2236facSJi-Ze Hong (Peter Hong) fintek_8250_set_max_fifo(pdata); 29906e39572SJi-Ze Hong (Peter Hong) fintek_8250_exit_key(addr[i]); 30006e39572SJi-Ze Hong (Peter Hong) 301fa01e2caSRicardo Ribalda Delgado return 0; 302017bec38SRicardo Ribalda Delgado } 303fa01e2caSRicardo Ribalda Delgado 30429d58642SRicardo Ribalda Delgado fintek_8250_exit_key(addr[i]); 305ce8c267eSRicardo Ribalda Delgado } 306ce8c267eSRicardo Ribalda Delgado } 307017bec38SRicardo Ribalda Delgado 308017bec38SRicardo Ribalda Delgado return -ENODEV; 309017bec38SRicardo Ribalda Delgado } 310017bec38SRicardo Ribalda Delgado 3111e26c472SJi-Ze Hong (Peter Hong) static void fintek_8250_set_rs485_handler(struct uart_8250_port *uart) 3121e26c472SJi-Ze Hong (Peter Hong) { 3131e26c472SJi-Ze Hong (Peter Hong) struct fintek_8250 *pdata = uart->port.private_data; 3141e26c472SJi-Ze Hong (Peter Hong) 3151e26c472SJi-Ze Hong (Peter Hong) switch (pdata->pid) { 3161e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216AD: 3171e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: 318da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 319*de48b099SJi-Ze Hong (Peter Hong) case CHIP_ID_F81865: 3201e26c472SJi-Ze Hong (Peter Hong) uart->port.rs485_config = fintek_8250_rs485_config; 3211e26c472SJi-Ze Hong (Peter Hong) break; 3221e26c472SJi-Ze Hong (Peter Hong) 3231e26c472SJi-Ze Hong (Peter Hong) default: /* No RS485 Auto direction functional */ 3241e26c472SJi-Ze Hong (Peter Hong) break; 3251e26c472SJi-Ze Hong (Peter Hong) } 3261e26c472SJi-Ze Hong (Peter Hong) } 3271e26c472SJi-Ze Hong (Peter Hong) 328fa01e2caSRicardo Ribalda Delgado int fintek_8250_probe(struct uart_8250_port *uart) 32928e3fb6cSRicardo Ribalda Delgado { 33092a5f11aSRicardo Ribalda Delgado struct fintek_8250 *pdata; 331fa01e2caSRicardo Ribalda Delgado struct fintek_8250 probe_data; 33228e3fb6cSRicardo Ribalda Delgado 33306e39572SJi-Ze Hong (Peter Hong) if (probe_setup_port(&probe_data, uart->port.iobase, uart->port.irq)) 33428e3fb6cSRicardo Ribalda Delgado return -ENODEV; 33528e3fb6cSRicardo Ribalda Delgado 336fa01e2caSRicardo Ribalda Delgado pdata = devm_kzalloc(uart->port.dev, sizeof(*pdata), GFP_KERNEL); 33792a5f11aSRicardo Ribalda Delgado if (!pdata) 33892a5f11aSRicardo Ribalda Delgado return -ENOMEM; 33992a5f11aSRicardo Ribalda Delgado 340fa01e2caSRicardo Ribalda Delgado memcpy(pdata, &probe_data, sizeof(probe_data)); 341fa01e2caSRicardo Ribalda Delgado uart->port.private_data = pdata; 3421e26c472SJi-Ze Hong (Peter Hong) fintek_8250_set_rs485_handler(uart); 34328e3fb6cSRicardo Ribalda Delgado 34406e39572SJi-Ze Hong (Peter Hong) return 0; 34528e3fb6cSRicardo Ribalda Delgado } 346