xref: /openbmc/linux/drivers/tty/serial/8250/8250_fintek.c (revision da60d6afaa3e7be561d202c78b6859eda4c87973)
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