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