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*da60d6afSJi-Ze Hong (Peter Hong) #define CHIP_ID_F81866 0x1010 25c2236facSJi-Ze Hong (Peter Hong) #define CHIP_ID_F81216AD 0x1602 26c2236facSJi-Ze Hong (Peter Hong) #define CHIP_ID_F81216H 0x0501 271e26c472SJi-Ze Hong (Peter Hong) #define CHIP_ID_F81216 0x0802 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 3229d58642SRicardo Ribalda Delgado #define IO_ADDR1 0x61 3329d58642SRicardo Ribalda Delgado #define IO_ADDR2 0x60 3428e3fb6cSRicardo Ribalda Delgado #define LDN 0x7 3528e3fb6cSRicardo Ribalda Delgado 3687a713c8SArnd Bergmann #define FINTEK_IRQ_MODE 0x70 374da22f14SJi-Ze Hong (Peter Hong) #define IRQ_SHARE BIT(4) 384da22f14SJi-Ze Hong (Peter Hong) #define IRQ_MODE_MASK (BIT(6) | BIT(5)) 394da22f14SJi-Ze Hong (Peter Hong) #define IRQ_LEVEL_LOW 0 404da22f14SJi-Ze Hong (Peter Hong) #define IRQ_EDGE_HIGH BIT(5) 414da22f14SJi-Ze Hong (Peter Hong) 4228e3fb6cSRicardo Ribalda Delgado #define RS485 0xF0 4328e3fb6cSRicardo Ribalda Delgado #define RTS_INVERT BIT(5) 4428e3fb6cSRicardo Ribalda Delgado #define RS485_URA BIT(4) 4528e3fb6cSRicardo Ribalda Delgado #define RXW4C_IRA BIT(3) 4628e3fb6cSRicardo Ribalda Delgado #define TXW4C_IRA BIT(2) 4728e3fb6cSRicardo Ribalda Delgado 48c2236facSJi-Ze Hong (Peter Hong) #define FIFO_CTRL 0xF6 49c2236facSJi-Ze Hong (Peter Hong) #define FIFO_MODE_MASK (BIT(1) | BIT(0)) 50c2236facSJi-Ze Hong (Peter Hong) #define FIFO_MODE_128 (BIT(1) | BIT(0)) 51c2236facSJi-Ze Hong (Peter Hong) #define RXFTHR_MODE_MASK (BIT(5) | BIT(4)) 52c2236facSJi-Ze Hong (Peter Hong) #define RXFTHR_MODE_4X BIT(5) 53c2236facSJi-Ze Hong (Peter Hong) 54*da60d6afSJi-Ze Hong (Peter Hong) #define F81216_LDN_LOW 0x0 55*da60d6afSJi-Ze Hong (Peter Hong) #define F81216_LDN_HIGH 0x4 56*da60d6afSJi-Ze Hong (Peter Hong) 57*da60d6afSJi-Ze Hong (Peter Hong) /* 58*da60d6afSJi-Ze Hong (Peter Hong) * F81866 registers 59*da60d6afSJi-Ze Hong (Peter Hong) * 60*da60d6afSJi-Ze Hong (Peter Hong) * The IRQ setting mode of F81866 is not the same with F81216 series. 61*da60d6afSJi-Ze Hong (Peter Hong) * Level/Low: IRQ_MODE0:0, IRQ_MODE1:0 62*da60d6afSJi-Ze Hong (Peter Hong) * Edge/High: IRQ_MODE0:1, IRQ_MODE1:0 63*da60d6afSJi-Ze Hong (Peter Hong) */ 64*da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_MODE 0xf0 65*da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_SHARE BIT(0) 66*da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_MODE0 BIT(1) 67*da60d6afSJi-Ze Hong (Peter Hong) 68*da60d6afSJi-Ze Hong (Peter Hong) #define F81866_FIFO_CTRL FIFO_CTRL 69*da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_MODE1 BIT(3) 70*da60d6afSJi-Ze Hong (Peter Hong) 71*da60d6afSJi-Ze Hong (Peter Hong) #define F81866_LDN_LOW 0x10 72*da60d6afSJi-Ze Hong (Peter Hong) #define F81866_LDN_HIGH 0x16 73*da60d6afSJi-Ze Hong (Peter Hong) 7492a5f11aSRicardo Ribalda Delgado struct fintek_8250 { 75c2236facSJi-Ze Hong (Peter Hong) u16 pid; 76017bec38SRicardo Ribalda Delgado u16 base_port; 7792a5f11aSRicardo Ribalda Delgado u8 index; 78ce8c267eSRicardo Ribalda Delgado u8 key; 7992a5f11aSRicardo Ribalda Delgado }; 8092a5f11aSRicardo Ribalda Delgado 81f1232ac2SJi-Ze Hong (Peter Hong) static u8 sio_read_reg(struct fintek_8250 *pdata, u8 reg) 82f1232ac2SJi-Ze Hong (Peter Hong) { 83f1232ac2SJi-Ze Hong (Peter Hong) outb(reg, pdata->base_port + ADDR_PORT); 84f1232ac2SJi-Ze Hong (Peter Hong) return inb(pdata->base_port + DATA_PORT); 85f1232ac2SJi-Ze Hong (Peter Hong) } 86f1232ac2SJi-Ze Hong (Peter Hong) 87f1232ac2SJi-Ze Hong (Peter Hong) static void sio_write_reg(struct fintek_8250 *pdata, u8 reg, u8 data) 88f1232ac2SJi-Ze Hong (Peter Hong) { 89f1232ac2SJi-Ze Hong (Peter Hong) outb(reg, pdata->base_port + ADDR_PORT); 90f1232ac2SJi-Ze Hong (Peter Hong) outb(data, pdata->base_port + DATA_PORT); 91f1232ac2SJi-Ze Hong (Peter Hong) } 92f1232ac2SJi-Ze Hong (Peter Hong) 93f1232ac2SJi-Ze Hong (Peter Hong) static void sio_write_mask_reg(struct fintek_8250 *pdata, u8 reg, u8 mask, 94f1232ac2SJi-Ze Hong (Peter Hong) u8 data) 95f1232ac2SJi-Ze Hong (Peter Hong) { 96f1232ac2SJi-Ze Hong (Peter Hong) u8 tmp; 97f1232ac2SJi-Ze Hong (Peter Hong) 98f1232ac2SJi-Ze Hong (Peter Hong) tmp = (sio_read_reg(pdata, reg) & ~mask) | (mask & data); 99f1232ac2SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, reg, tmp); 100f1232ac2SJi-Ze Hong (Peter Hong) } 101f1232ac2SJi-Ze Hong (Peter Hong) 102ce8c267eSRicardo Ribalda Delgado static int fintek_8250_enter_key(u16 base_port, u8 key) 103017bec38SRicardo Ribalda Delgado { 104fa01e2caSRicardo Ribalda Delgado if (!request_muxed_region(base_port, 2, "8250_fintek")) 10528e3fb6cSRicardo Ribalda Delgado return -EBUSY; 10628e3fb6cSRicardo Ribalda Delgado 107ce8c267eSRicardo Ribalda Delgado outb(key, base_port + ADDR_PORT); 108ce8c267eSRicardo Ribalda Delgado outb(key, base_port + ADDR_PORT); 10928e3fb6cSRicardo Ribalda Delgado return 0; 11028e3fb6cSRicardo Ribalda Delgado } 11128e3fb6cSRicardo Ribalda Delgado 112017bec38SRicardo Ribalda Delgado static void fintek_8250_exit_key(u16 base_port) 113017bec38SRicardo Ribalda Delgado { 11428e3fb6cSRicardo Ribalda Delgado 115017bec38SRicardo Ribalda Delgado outb(EXIT_KEY, base_port + ADDR_PORT); 116017bec38SRicardo Ribalda Delgado release_region(base_port + ADDR_PORT, 2); 11728e3fb6cSRicardo Ribalda Delgado } 11828e3fb6cSRicardo Ribalda Delgado 119f1232ac2SJi-Ze Hong (Peter Hong) static int fintek_8250_check_id(struct fintek_8250 *pdata) 12028e3fb6cSRicardo Ribalda Delgado { 121dae77f75SRicardo Ribalda Delgado u16 chip; 12228e3fb6cSRicardo Ribalda Delgado 123f1232ac2SJi-Ze Hong (Peter Hong) if (sio_read_reg(pdata, VENDOR_ID1) != VENDOR_ID1_VAL) 12428e3fb6cSRicardo Ribalda Delgado return -ENODEV; 12528e3fb6cSRicardo Ribalda Delgado 126f1232ac2SJi-Ze Hong (Peter Hong) if (sio_read_reg(pdata, VENDOR_ID2) != VENDOR_ID2_VAL) 12728e3fb6cSRicardo Ribalda Delgado return -ENODEV; 12828e3fb6cSRicardo Ribalda Delgado 129f1232ac2SJi-Ze Hong (Peter Hong) chip = sio_read_reg(pdata, CHIP_ID1); 130f1232ac2SJi-Ze Hong (Peter Hong) chip |= sio_read_reg(pdata, CHIP_ID2) << 8; 131dae77f75SRicardo Ribalda Delgado 1321e26c472SJi-Ze Hong (Peter Hong) switch (chip) { 133*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 1341e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216AD: 1351e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: 1361e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216: 1371e26c472SJi-Ze Hong (Peter Hong) break; 1381e26c472SJi-Ze Hong (Peter Hong) default: 139dae77f75SRicardo Ribalda Delgado return -ENODEV; 1401e26c472SJi-Ze Hong (Peter Hong) } 141dae77f75SRicardo Ribalda Delgado 142c2236facSJi-Ze Hong (Peter Hong) pdata->pid = chip; 14328e3fb6cSRicardo Ribalda Delgado return 0; 14428e3fb6cSRicardo Ribalda Delgado } 14528e3fb6cSRicardo Ribalda Delgado 146*da60d6afSJi-Ze Hong (Peter Hong) static int fintek_8250_get_ldn_range(struct fintek_8250 *pdata, int *min, 147*da60d6afSJi-Ze Hong (Peter Hong) int *max) 148*da60d6afSJi-Ze Hong (Peter Hong) { 149*da60d6afSJi-Ze Hong (Peter Hong) switch (pdata->pid) { 150*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 151*da60d6afSJi-Ze Hong (Peter Hong) *min = F81866_LDN_LOW; 152*da60d6afSJi-Ze Hong (Peter Hong) *max = F81866_LDN_HIGH; 153*da60d6afSJi-Ze Hong (Peter Hong) return 0; 154*da60d6afSJi-Ze Hong (Peter Hong) 155*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216AD: 156*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: 157*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216: 158*da60d6afSJi-Ze Hong (Peter Hong) *min = F81216_LDN_LOW; 159*da60d6afSJi-Ze Hong (Peter Hong) *max = F81216_LDN_HIGH; 160*da60d6afSJi-Ze Hong (Peter Hong) return 0; 161*da60d6afSJi-Ze Hong (Peter Hong) } 162*da60d6afSJi-Ze Hong (Peter Hong) 163*da60d6afSJi-Ze Hong (Peter Hong) return -ENODEV; 164*da60d6afSJi-Ze Hong (Peter Hong) } 165*da60d6afSJi-Ze Hong (Peter Hong) 16641e69093SRicardo Ribalda Delgado static int fintek_8250_rs485_config(struct uart_port *port, 16728e3fb6cSRicardo Ribalda Delgado struct serial_rs485 *rs485) 16828e3fb6cSRicardo Ribalda Delgado { 16928e3fb6cSRicardo Ribalda Delgado uint8_t config = 0; 17092a5f11aSRicardo Ribalda Delgado struct fintek_8250 *pdata = port->private_data; 17128e3fb6cSRicardo Ribalda Delgado 17292a5f11aSRicardo Ribalda Delgado if (!pdata) 17328e3fb6cSRicardo Ribalda Delgado return -EINVAL; 17428e3fb6cSRicardo Ribalda Delgado 17528e3fb6cSRicardo Ribalda Delgado if (rs485->flags & SER_RS485_ENABLED) 17628e3fb6cSRicardo Ribalda Delgado memset(rs485->padding, 0, sizeof(rs485->padding)); 17728e3fb6cSRicardo Ribalda Delgado else 17828e3fb6cSRicardo Ribalda Delgado memset(rs485, 0, sizeof(*rs485)); 17928e3fb6cSRicardo Ribalda Delgado 18028e3fb6cSRicardo Ribalda Delgado rs485->flags &= SER_RS485_ENABLED | SER_RS485_RTS_ON_SEND | 18128e3fb6cSRicardo Ribalda Delgado SER_RS485_RTS_AFTER_SEND; 18228e3fb6cSRicardo Ribalda Delgado 18328e3fb6cSRicardo Ribalda Delgado if (rs485->delay_rts_before_send) { 18428e3fb6cSRicardo Ribalda Delgado rs485->delay_rts_before_send = 1; 18528e3fb6cSRicardo Ribalda Delgado config |= TXW4C_IRA; 18628e3fb6cSRicardo Ribalda Delgado } 18728e3fb6cSRicardo Ribalda Delgado 18828e3fb6cSRicardo Ribalda Delgado if (rs485->delay_rts_after_send) { 18928e3fb6cSRicardo Ribalda Delgado rs485->delay_rts_after_send = 1; 19028e3fb6cSRicardo Ribalda Delgado config |= RXW4C_IRA; 19128e3fb6cSRicardo Ribalda Delgado } 19228e3fb6cSRicardo Ribalda Delgado 19328e3fb6cSRicardo Ribalda Delgado if ((!!(rs485->flags & SER_RS485_RTS_ON_SEND)) == 19428e3fb6cSRicardo Ribalda Delgado (!!(rs485->flags & SER_RS485_RTS_AFTER_SEND))) 19528e3fb6cSRicardo Ribalda Delgado rs485->flags &= SER_RS485_ENABLED; 19628e3fb6cSRicardo Ribalda Delgado else 19728e3fb6cSRicardo Ribalda Delgado config |= RS485_URA; 19828e3fb6cSRicardo Ribalda Delgado 19928e3fb6cSRicardo Ribalda Delgado if (rs485->flags & SER_RS485_RTS_ON_SEND) 20028e3fb6cSRicardo Ribalda Delgado config |= RTS_INVERT; 20128e3fb6cSRicardo Ribalda Delgado 202ce8c267eSRicardo Ribalda Delgado if (fintek_8250_enter_key(pdata->base_port, pdata->key)) 20328e3fb6cSRicardo Ribalda Delgado return -EBUSY; 20428e3fb6cSRicardo Ribalda Delgado 205f1232ac2SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, LDN, pdata->index); 206f1232ac2SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, RS485, config); 207017bec38SRicardo Ribalda Delgado fintek_8250_exit_key(pdata->base_port); 20828e3fb6cSRicardo Ribalda Delgado 20941e69093SRicardo Ribalda Delgado port->rs485 = *rs485; 21041e69093SRicardo Ribalda Delgado 21128e3fb6cSRicardo Ribalda Delgado return 0; 21228e3fb6cSRicardo Ribalda Delgado } 21328e3fb6cSRicardo Ribalda Delgado 21406e39572SJi-Ze Hong (Peter Hong) static void fintek_8250_set_irq_mode(struct fintek_8250 *pdata, bool is_level) 21506e39572SJi-Ze Hong (Peter Hong) { 21606e39572SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, LDN, pdata->index); 217*da60d6afSJi-Ze Hong (Peter Hong) 218*da60d6afSJi-Ze Hong (Peter Hong) switch (pdata->pid) { 219*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 220*da60d6afSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, F81866_FIFO_CTRL, F81866_IRQ_MODE1, 221*da60d6afSJi-Ze Hong (Peter Hong) 0); 222*da60d6afSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, F81866_IRQ_MODE, F81866_IRQ_SHARE, 223*da60d6afSJi-Ze Hong (Peter Hong) F81866_IRQ_SHARE); 224*da60d6afSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, F81866_IRQ_MODE, F81866_IRQ_MODE0, 225*da60d6afSJi-Ze Hong (Peter Hong) is_level ? 0 : F81866_IRQ_MODE0); 226*da60d6afSJi-Ze Hong (Peter Hong) break; 227*da60d6afSJi-Ze Hong (Peter Hong) 228*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216AD: 229*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: 230*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216: 231*da60d6afSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, FINTEK_IRQ_MODE, IRQ_SHARE, 232*da60d6afSJi-Ze Hong (Peter Hong) IRQ_SHARE); 23306e39572SJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, FINTEK_IRQ_MODE, IRQ_MODE_MASK, 23406e39572SJi-Ze Hong (Peter Hong) is_level ? IRQ_LEVEL_LOW : IRQ_EDGE_HIGH); 235*da60d6afSJi-Ze Hong (Peter Hong) break; 236*da60d6afSJi-Ze Hong (Peter Hong) } 23706e39572SJi-Ze Hong (Peter Hong) } 23806e39572SJi-Ze Hong (Peter Hong) 239c2236facSJi-Ze Hong (Peter Hong) static void fintek_8250_set_max_fifo(struct fintek_8250 *pdata) 240c2236facSJi-Ze Hong (Peter Hong) { 241c2236facSJi-Ze Hong (Peter Hong) switch (pdata->pid) { 242c2236facSJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: /* 128Bytes FIFO */ 243*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 244c2236facSJi-Ze Hong (Peter Hong) sio_write_mask_reg(pdata, FIFO_CTRL, 245c2236facSJi-Ze Hong (Peter Hong) FIFO_MODE_MASK | RXFTHR_MODE_MASK, 246c2236facSJi-Ze Hong (Peter Hong) FIFO_MODE_128 | RXFTHR_MODE_4X); 247c2236facSJi-Ze Hong (Peter Hong) break; 248c2236facSJi-Ze Hong (Peter Hong) 249c2236facSJi-Ze Hong (Peter Hong) default: /* Default 16Bytes FIFO */ 250c2236facSJi-Ze Hong (Peter Hong) break; 251c2236facSJi-Ze Hong (Peter Hong) } 252c2236facSJi-Ze Hong (Peter Hong) } 253c2236facSJi-Ze Hong (Peter Hong) 25406e39572SJi-Ze Hong (Peter Hong) static int probe_setup_port(struct fintek_8250 *pdata, u16 io_address, 25506e39572SJi-Ze Hong (Peter Hong) unsigned int irq) 256017bec38SRicardo Ribalda Delgado { 257017bec38SRicardo Ribalda Delgado static const u16 addr[] = {0x4e, 0x2e}; 258ce8c267eSRicardo Ribalda Delgado static const u8 keys[] = {0x77, 0xa0, 0x87, 0x67}; 25906e39572SJi-Ze Hong (Peter Hong) struct irq_data *irq_data; 26006e39572SJi-Ze Hong (Peter Hong) bool level_mode = false; 261*da60d6afSJi-Ze Hong (Peter Hong) int i, j, k, min, max; 262017bec38SRicardo Ribalda Delgado 263017bec38SRicardo Ribalda Delgado for (i = 0; i < ARRAY_SIZE(addr); i++) { 264ce8c267eSRicardo Ribalda Delgado for (j = 0; j < ARRAY_SIZE(keys); j++) { 265f1232ac2SJi-Ze Hong (Peter Hong) pdata->base_port = addr[i]; 266f1232ac2SJi-Ze Hong (Peter Hong) pdata->key = keys[j]; 267017bec38SRicardo Ribalda Delgado 268ce8c267eSRicardo Ribalda Delgado if (fintek_8250_enter_key(addr[i], keys[j])) 269017bec38SRicardo Ribalda Delgado continue; 270*da60d6afSJi-Ze Hong (Peter Hong) if (fintek_8250_check_id(pdata) || 271*da60d6afSJi-Ze Hong (Peter Hong) fintek_8250_get_ldn_range(pdata, &min, &max)) { 272017bec38SRicardo Ribalda Delgado fintek_8250_exit_key(addr[i]); 27329d58642SRicardo Ribalda Delgado continue; 27429d58642SRicardo Ribalda Delgado } 27529d58642SRicardo Ribalda Delgado 276*da60d6afSJi-Ze Hong (Peter Hong) for (k = min; k < max; k++) { 27729d58642SRicardo Ribalda Delgado u16 aux; 27829d58642SRicardo Ribalda Delgado 279f1232ac2SJi-Ze Hong (Peter Hong) sio_write_reg(pdata, LDN, k); 280f1232ac2SJi-Ze Hong (Peter Hong) aux = sio_read_reg(pdata, IO_ADDR1); 281f1232ac2SJi-Ze Hong (Peter Hong) aux |= sio_read_reg(pdata, IO_ADDR2) << 8; 28229d58642SRicardo Ribalda Delgado if (aux != io_address) 28329d58642SRicardo Ribalda Delgado continue; 28429d58642SRicardo Ribalda Delgado 285fa01e2caSRicardo Ribalda Delgado pdata->index = k; 286fa01e2caSRicardo Ribalda Delgado 28706e39572SJi-Ze Hong (Peter Hong) irq_data = irq_get_irq_data(irq); 28806e39572SJi-Ze Hong (Peter Hong) if (irq_data) 28906e39572SJi-Ze Hong (Peter Hong) level_mode = 29006e39572SJi-Ze Hong (Peter Hong) irqd_is_level_type(irq_data); 29106e39572SJi-Ze Hong (Peter Hong) 29206e39572SJi-Ze Hong (Peter Hong) fintek_8250_set_irq_mode(pdata, level_mode); 293c2236facSJi-Ze Hong (Peter Hong) fintek_8250_set_max_fifo(pdata); 29406e39572SJi-Ze Hong (Peter Hong) fintek_8250_exit_key(addr[i]); 29506e39572SJi-Ze Hong (Peter Hong) 296fa01e2caSRicardo Ribalda Delgado return 0; 297017bec38SRicardo Ribalda Delgado } 298fa01e2caSRicardo Ribalda Delgado 29929d58642SRicardo Ribalda Delgado fintek_8250_exit_key(addr[i]); 300ce8c267eSRicardo Ribalda Delgado } 301ce8c267eSRicardo Ribalda Delgado } 302017bec38SRicardo Ribalda Delgado 303017bec38SRicardo Ribalda Delgado return -ENODEV; 304017bec38SRicardo Ribalda Delgado } 305017bec38SRicardo Ribalda Delgado 3061e26c472SJi-Ze Hong (Peter Hong) static void fintek_8250_set_rs485_handler(struct uart_8250_port *uart) 3071e26c472SJi-Ze Hong (Peter Hong) { 3081e26c472SJi-Ze Hong (Peter Hong) struct fintek_8250 *pdata = uart->port.private_data; 3091e26c472SJi-Ze Hong (Peter Hong) 3101e26c472SJi-Ze Hong (Peter Hong) switch (pdata->pid) { 3111e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216AD: 3121e26c472SJi-Ze Hong (Peter Hong) case CHIP_ID_F81216H: 313*da60d6afSJi-Ze Hong (Peter Hong) case CHIP_ID_F81866: 3141e26c472SJi-Ze Hong (Peter Hong) uart->port.rs485_config = fintek_8250_rs485_config; 3151e26c472SJi-Ze Hong (Peter Hong) break; 3161e26c472SJi-Ze Hong (Peter Hong) 3171e26c472SJi-Ze Hong (Peter Hong) default: /* No RS485 Auto direction functional */ 3181e26c472SJi-Ze Hong (Peter Hong) break; 3191e26c472SJi-Ze Hong (Peter Hong) } 3201e26c472SJi-Ze Hong (Peter Hong) } 3211e26c472SJi-Ze Hong (Peter Hong) 322fa01e2caSRicardo Ribalda Delgado int fintek_8250_probe(struct uart_8250_port *uart) 32328e3fb6cSRicardo Ribalda Delgado { 32492a5f11aSRicardo Ribalda Delgado struct fintek_8250 *pdata; 325fa01e2caSRicardo Ribalda Delgado struct fintek_8250 probe_data; 32628e3fb6cSRicardo Ribalda Delgado 32706e39572SJi-Ze Hong (Peter Hong) if (probe_setup_port(&probe_data, uart->port.iobase, uart->port.irq)) 32828e3fb6cSRicardo Ribalda Delgado return -ENODEV; 32928e3fb6cSRicardo Ribalda Delgado 330fa01e2caSRicardo Ribalda Delgado pdata = devm_kzalloc(uart->port.dev, sizeof(*pdata), GFP_KERNEL); 33192a5f11aSRicardo Ribalda Delgado if (!pdata) 33292a5f11aSRicardo Ribalda Delgado return -ENOMEM; 33392a5f11aSRicardo Ribalda Delgado 334fa01e2caSRicardo Ribalda Delgado memcpy(pdata, &probe_data, sizeof(probe_data)); 335fa01e2caSRicardo Ribalda Delgado uart->port.private_data = pdata; 3361e26c472SJi-Ze Hong (Peter Hong) fintek_8250_set_rs485_handler(uart); 33728e3fb6cSRicardo Ribalda Delgado 33806e39572SJi-Ze Hong (Peter Hong) return 0; 33928e3fb6cSRicardo Ribalda Delgado } 340