xref: /openbmc/linux/drivers/tty/serial/8250/8250_fintek.c (revision e3b3d0f549c1d19b94e6ac55c66643166ea649ef)
1*e3b3d0f5SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
228e3fb6cSRicardo Ribalda Delgado /*
328e3fb6cSRicardo Ribalda Delgado  *  Probe for F81216A LPC to 4 UART
428e3fb6cSRicardo Ribalda Delgado  *
5fa01e2caSRicardo Ribalda Delgado  *  Copyright (C) 2014-2016 Ricardo Ribalda, Qtechnology A/S
628e3fb6cSRicardo Ribalda Delgado  *
728e3fb6cSRicardo Ribalda Delgado  *
828e3fb6cSRicardo Ribalda Delgado  * This program is free software; you can redistribute it and/or modify
928e3fb6cSRicardo Ribalda Delgado  * it under the terms of the GNU General Public License as published by
1028e3fb6cSRicardo Ribalda Delgado  * the Free Software Foundation; either version 2 of the License.
1128e3fb6cSRicardo Ribalda Delgado  */
1228e3fb6cSRicardo Ribalda Delgado #include <linux/module.h>
1328e3fb6cSRicardo Ribalda Delgado #include <linux/pci.h>
1428e3fb6cSRicardo Ribalda Delgado #include <linux/pnp.h>
1528e3fb6cSRicardo Ribalda Delgado #include <linux/kernel.h>
1628e3fb6cSRicardo Ribalda Delgado #include <linux/serial_core.h>
174da22f14SJi-Ze Hong (Peter Hong) #include <linux/irq.h>
1828e3fb6cSRicardo Ribalda Delgado #include  "8250.h"
1928e3fb6cSRicardo Ribalda Delgado 
20017bec38SRicardo Ribalda Delgado #define ADDR_PORT 0
21017bec38SRicardo Ribalda Delgado #define DATA_PORT 1
2228e3fb6cSRicardo Ribalda Delgado #define EXIT_KEY 0xAA
2328e3fb6cSRicardo Ribalda Delgado #define CHIP_ID1  0x20
2428e3fb6cSRicardo Ribalda Delgado #define CHIP_ID2  0x21
25de48b099SJi-Ze Hong (Peter Hong) #define CHIP_ID_F81865 0x0407
26da60d6afSJi-Ze Hong (Peter Hong) #define CHIP_ID_F81866 0x1010
27c2236facSJi-Ze Hong (Peter Hong) #define CHIP_ID_F81216AD 0x1602
28c2236facSJi-Ze Hong (Peter Hong) #define CHIP_ID_F81216H 0x0501
291e26c472SJi-Ze Hong (Peter Hong) #define CHIP_ID_F81216 0x0802
3028e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID1 0x23
3128e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID1_VAL 0x19
3228e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID2 0x24
3328e3fb6cSRicardo Ribalda Delgado #define VENDOR_ID2_VAL 0x34
3429d58642SRicardo Ribalda Delgado #define IO_ADDR1 0x61
3529d58642SRicardo Ribalda Delgado #define IO_ADDR2 0x60
3628e3fb6cSRicardo Ribalda Delgado #define LDN 0x7
3728e3fb6cSRicardo Ribalda Delgado 
3887a713c8SArnd Bergmann #define FINTEK_IRQ_MODE	0x70
394da22f14SJi-Ze Hong (Peter Hong) #define IRQ_SHARE	BIT(4)
404da22f14SJi-Ze Hong (Peter Hong) #define IRQ_MODE_MASK	(BIT(6) | BIT(5))
414da22f14SJi-Ze Hong (Peter Hong) #define IRQ_LEVEL_LOW	0
424da22f14SJi-Ze Hong (Peter Hong) #define IRQ_EDGE_HIGH	BIT(5)
434da22f14SJi-Ze Hong (Peter Hong) 
4458178914SJi-Ze Hong (Peter Hong) /*
4558178914SJi-Ze Hong (Peter Hong)  * F81216H clock source register, the value and mask is the same with F81866,
4658178914SJi-Ze Hong (Peter Hong)  * but it's on F0h.
4758178914SJi-Ze Hong (Peter Hong)  *
4858178914SJi-Ze Hong (Peter Hong)  * Clock speeds for UART (register F0h)
4958178914SJi-Ze Hong (Peter Hong)  * 00: 1.8432MHz.
5058178914SJi-Ze Hong (Peter Hong)  * 01: 18.432MHz.
5158178914SJi-Ze Hong (Peter Hong)  * 10: 24MHz.
5258178914SJi-Ze Hong (Peter Hong)  * 11: 14.769MHz.
5358178914SJi-Ze Hong (Peter Hong)  */
5428e3fb6cSRicardo Ribalda Delgado #define RS485  0xF0
5528e3fb6cSRicardo Ribalda Delgado #define RTS_INVERT BIT(5)
5628e3fb6cSRicardo Ribalda Delgado #define RS485_URA BIT(4)
5728e3fb6cSRicardo Ribalda Delgado #define RXW4C_IRA BIT(3)
5828e3fb6cSRicardo Ribalda Delgado #define TXW4C_IRA BIT(2)
5928e3fb6cSRicardo Ribalda Delgado 
60c2236facSJi-Ze Hong (Peter Hong) #define FIFO_CTRL		0xF6
61c2236facSJi-Ze Hong (Peter Hong) #define FIFO_MODE_MASK		(BIT(1) | BIT(0))
62c2236facSJi-Ze Hong (Peter Hong) #define FIFO_MODE_128		(BIT(1) | BIT(0))
63c2236facSJi-Ze Hong (Peter Hong) #define RXFTHR_MODE_MASK	(BIT(5) | BIT(4))
64c2236facSJi-Ze Hong (Peter Hong) #define RXFTHR_MODE_4X		BIT(5)
65c2236facSJi-Ze Hong (Peter Hong) 
66da60d6afSJi-Ze Hong (Peter Hong) #define F81216_LDN_LOW	0x0
67da60d6afSJi-Ze Hong (Peter Hong) #define F81216_LDN_HIGH	0x4
68da60d6afSJi-Ze Hong (Peter Hong) 
69da60d6afSJi-Ze Hong (Peter Hong) /*
70da60d6afSJi-Ze Hong (Peter Hong)  * F81866 registers
71da60d6afSJi-Ze Hong (Peter Hong)  *
72da60d6afSJi-Ze Hong (Peter Hong)  * The IRQ setting mode of F81866 is not the same with F81216 series.
73da60d6afSJi-Ze Hong (Peter Hong)  *	Level/Low: IRQ_MODE0:0, IRQ_MODE1:0
74da60d6afSJi-Ze Hong (Peter Hong)  *	Edge/High: IRQ_MODE0:1, IRQ_MODE1:0
75fab8a02bSLukas Redlinger  *
76fab8a02bSLukas Redlinger  * Clock speeds for UART (register F2h)
77fab8a02bSLukas Redlinger  * 00: 1.8432MHz.
78fab8a02bSLukas Redlinger  * 01: 18.432MHz.
79fab8a02bSLukas Redlinger  * 10: 24MHz.
80fab8a02bSLukas Redlinger  * 11: 14.769MHz.
81da60d6afSJi-Ze Hong (Peter Hong)  */
82da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_MODE		0xf0
83da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_SHARE	BIT(0)
84da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_MODE0	BIT(1)
85da60d6afSJi-Ze Hong (Peter Hong) 
86da60d6afSJi-Ze Hong (Peter Hong) #define F81866_FIFO_CTRL	FIFO_CTRL
87da60d6afSJi-Ze Hong (Peter Hong) #define F81866_IRQ_MODE1	BIT(3)
88da60d6afSJi-Ze Hong (Peter Hong) 
89da60d6afSJi-Ze Hong (Peter Hong) #define F81866_LDN_LOW		0x10
90da60d6afSJi-Ze Hong (Peter Hong) #define F81866_LDN_HIGH		0x16
91da60d6afSJi-Ze Hong (Peter Hong) 
92fab8a02bSLukas Redlinger #define F81866_UART_CLK 0xF2
93fab8a02bSLukas Redlinger #define F81866_UART_CLK_MASK (BIT(1) | BIT(0))
94fab8a02bSLukas Redlinger #define F81866_UART_CLK_1_8432MHZ 0
95fab8a02bSLukas Redlinger #define F81866_UART_CLK_14_769MHZ (BIT(1) | BIT(0))
96fab8a02bSLukas Redlinger #define F81866_UART_CLK_18_432MHZ BIT(0)
97fab8a02bSLukas Redlinger #define F81866_UART_CLK_24MHZ BIT(1)
98fab8a02bSLukas Redlinger 
9992a5f11aSRicardo Ribalda Delgado struct fintek_8250 {
100c2236facSJi-Ze Hong (Peter Hong) 	u16 pid;
101017bec38SRicardo Ribalda Delgado 	u16 base_port;
10292a5f11aSRicardo Ribalda Delgado 	u8 index;
103ce8c267eSRicardo Ribalda Delgado 	u8 key;
10492a5f11aSRicardo Ribalda Delgado };
10592a5f11aSRicardo Ribalda Delgado 
106f1232ac2SJi-Ze Hong (Peter Hong) static u8 sio_read_reg(struct fintek_8250 *pdata, u8 reg)
107f1232ac2SJi-Ze Hong (Peter Hong) {
108f1232ac2SJi-Ze Hong (Peter Hong) 	outb(reg, pdata->base_port + ADDR_PORT);
109f1232ac2SJi-Ze Hong (Peter Hong) 	return inb(pdata->base_port + DATA_PORT);
110f1232ac2SJi-Ze Hong (Peter Hong) }
111f1232ac2SJi-Ze Hong (Peter Hong) 
112f1232ac2SJi-Ze Hong (Peter Hong) static void sio_write_reg(struct fintek_8250 *pdata, u8 reg, u8 data)
113f1232ac2SJi-Ze Hong (Peter Hong) {
114f1232ac2SJi-Ze Hong (Peter Hong) 	outb(reg, pdata->base_port + ADDR_PORT);
115f1232ac2SJi-Ze Hong (Peter Hong) 	outb(data, pdata->base_port + DATA_PORT);
116f1232ac2SJi-Ze Hong (Peter Hong) }
117f1232ac2SJi-Ze Hong (Peter Hong) 
118f1232ac2SJi-Ze Hong (Peter Hong) static void sio_write_mask_reg(struct fintek_8250 *pdata, u8 reg, u8 mask,
119f1232ac2SJi-Ze Hong (Peter Hong) 			       u8 data)
120f1232ac2SJi-Ze Hong (Peter Hong) {
121f1232ac2SJi-Ze Hong (Peter Hong) 	u8 tmp;
122f1232ac2SJi-Ze Hong (Peter Hong) 
123f1232ac2SJi-Ze Hong (Peter Hong) 	tmp = (sio_read_reg(pdata, reg) & ~mask) | (mask & data);
124f1232ac2SJi-Ze Hong (Peter Hong) 	sio_write_reg(pdata, reg, tmp);
125f1232ac2SJi-Ze Hong (Peter Hong) }
126f1232ac2SJi-Ze Hong (Peter Hong) 
127ce8c267eSRicardo Ribalda Delgado static int fintek_8250_enter_key(u16 base_port, u8 key)
128017bec38SRicardo Ribalda Delgado {
129fa01e2caSRicardo Ribalda Delgado 	if (!request_muxed_region(base_port, 2, "8250_fintek"))
13028e3fb6cSRicardo Ribalda Delgado 		return -EBUSY;
13128e3fb6cSRicardo Ribalda Delgado 
132fd97e66cSJi-Ze Hong (Peter Hong) 	/* Force to deactive all SuperIO in this base_port */
133fd97e66cSJi-Ze Hong (Peter Hong) 	outb(EXIT_KEY, base_port + ADDR_PORT);
134fd97e66cSJi-Ze Hong (Peter Hong) 
135ce8c267eSRicardo Ribalda Delgado 	outb(key, base_port + ADDR_PORT);
136ce8c267eSRicardo Ribalda Delgado 	outb(key, base_port + ADDR_PORT);
13728e3fb6cSRicardo Ribalda Delgado 	return 0;
13828e3fb6cSRicardo Ribalda Delgado }
13928e3fb6cSRicardo Ribalda Delgado 
140017bec38SRicardo Ribalda Delgado static void fintek_8250_exit_key(u16 base_port)
141017bec38SRicardo Ribalda Delgado {
14228e3fb6cSRicardo Ribalda Delgado 
143017bec38SRicardo Ribalda Delgado 	outb(EXIT_KEY, base_port + ADDR_PORT);
144017bec38SRicardo Ribalda Delgado 	release_region(base_port + ADDR_PORT, 2);
14528e3fb6cSRicardo Ribalda Delgado }
14628e3fb6cSRicardo Ribalda Delgado 
147f1232ac2SJi-Ze Hong (Peter Hong) static int fintek_8250_check_id(struct fintek_8250 *pdata)
14828e3fb6cSRicardo Ribalda Delgado {
149dae77f75SRicardo Ribalda Delgado 	u16 chip;
15028e3fb6cSRicardo Ribalda Delgado 
151f1232ac2SJi-Ze Hong (Peter Hong) 	if (sio_read_reg(pdata, VENDOR_ID1) != VENDOR_ID1_VAL)
15228e3fb6cSRicardo Ribalda Delgado 		return -ENODEV;
15328e3fb6cSRicardo Ribalda Delgado 
154f1232ac2SJi-Ze Hong (Peter Hong) 	if (sio_read_reg(pdata, VENDOR_ID2) != VENDOR_ID2_VAL)
15528e3fb6cSRicardo Ribalda Delgado 		return -ENODEV;
15628e3fb6cSRicardo Ribalda Delgado 
157f1232ac2SJi-Ze Hong (Peter Hong) 	chip = sio_read_reg(pdata, CHIP_ID1);
158f1232ac2SJi-Ze Hong (Peter Hong) 	chip |= sio_read_reg(pdata, CHIP_ID2) << 8;
159dae77f75SRicardo Ribalda Delgado 
1601e26c472SJi-Ze Hong (Peter Hong) 	switch (chip) {
161de48b099SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81865:
162da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81866:
1631e26c472SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216AD:
1641e26c472SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216H:
1651e26c472SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216:
1661e26c472SJi-Ze Hong (Peter Hong) 		break;
1671e26c472SJi-Ze Hong (Peter Hong) 	default:
168dae77f75SRicardo Ribalda Delgado 		return -ENODEV;
1691e26c472SJi-Ze Hong (Peter Hong) 	}
170dae77f75SRicardo Ribalda Delgado 
171c2236facSJi-Ze Hong (Peter Hong) 	pdata->pid = chip;
17228e3fb6cSRicardo Ribalda Delgado 	return 0;
17328e3fb6cSRicardo Ribalda Delgado }
17428e3fb6cSRicardo Ribalda Delgado 
175da60d6afSJi-Ze Hong (Peter Hong) static int fintek_8250_get_ldn_range(struct fintek_8250 *pdata, int *min,
176da60d6afSJi-Ze Hong (Peter Hong) 				     int *max)
177da60d6afSJi-Ze Hong (Peter Hong) {
178da60d6afSJi-Ze Hong (Peter Hong) 	switch (pdata->pid) {
179de48b099SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81865:
180da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81866:
181da60d6afSJi-Ze Hong (Peter Hong) 		*min = F81866_LDN_LOW;
182da60d6afSJi-Ze Hong (Peter Hong) 		*max = F81866_LDN_HIGH;
183da60d6afSJi-Ze Hong (Peter Hong) 		return 0;
184da60d6afSJi-Ze Hong (Peter Hong) 
185da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216AD:
186da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216H:
187da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216:
188da60d6afSJi-Ze Hong (Peter Hong) 		*min = F81216_LDN_LOW;
189da60d6afSJi-Ze Hong (Peter Hong) 		*max = F81216_LDN_HIGH;
190da60d6afSJi-Ze Hong (Peter Hong) 		return 0;
191da60d6afSJi-Ze Hong (Peter Hong) 	}
192da60d6afSJi-Ze Hong (Peter Hong) 
193da60d6afSJi-Ze Hong (Peter Hong) 	return -ENODEV;
194da60d6afSJi-Ze Hong (Peter Hong) }
195da60d6afSJi-Ze Hong (Peter Hong) 
19641e69093SRicardo Ribalda Delgado static int fintek_8250_rs485_config(struct uart_port *port,
19728e3fb6cSRicardo Ribalda Delgado 			      struct serial_rs485 *rs485)
19828e3fb6cSRicardo Ribalda Delgado {
19928e3fb6cSRicardo Ribalda Delgado 	uint8_t config = 0;
20092a5f11aSRicardo Ribalda Delgado 	struct fintek_8250 *pdata = port->private_data;
20128e3fb6cSRicardo Ribalda Delgado 
20292a5f11aSRicardo Ribalda Delgado 	if (!pdata)
20328e3fb6cSRicardo Ribalda Delgado 		return -EINVAL;
20428e3fb6cSRicardo Ribalda Delgado 
20528e3fb6cSRicardo Ribalda Delgado 	if (rs485->flags & SER_RS485_ENABLED)
20628e3fb6cSRicardo Ribalda Delgado 		memset(rs485->padding, 0, sizeof(rs485->padding));
20728e3fb6cSRicardo Ribalda Delgado 	else
20828e3fb6cSRicardo Ribalda Delgado 		memset(rs485, 0, sizeof(*rs485));
20928e3fb6cSRicardo Ribalda Delgado 
21028e3fb6cSRicardo Ribalda Delgado 	rs485->flags &= SER_RS485_ENABLED | SER_RS485_RTS_ON_SEND |
21128e3fb6cSRicardo Ribalda Delgado 			SER_RS485_RTS_AFTER_SEND;
21228e3fb6cSRicardo Ribalda Delgado 
21328e3fb6cSRicardo Ribalda Delgado 	if (rs485->delay_rts_before_send) {
21428e3fb6cSRicardo Ribalda Delgado 		rs485->delay_rts_before_send = 1;
21528e3fb6cSRicardo Ribalda Delgado 		config |= TXW4C_IRA;
21628e3fb6cSRicardo Ribalda Delgado 	}
21728e3fb6cSRicardo Ribalda Delgado 
21828e3fb6cSRicardo Ribalda Delgado 	if (rs485->delay_rts_after_send) {
21928e3fb6cSRicardo Ribalda Delgado 		rs485->delay_rts_after_send = 1;
22028e3fb6cSRicardo Ribalda Delgado 		config |= RXW4C_IRA;
22128e3fb6cSRicardo Ribalda Delgado 	}
22228e3fb6cSRicardo Ribalda Delgado 
22328e3fb6cSRicardo Ribalda Delgado 	if ((!!(rs485->flags & SER_RS485_RTS_ON_SEND)) ==
22428e3fb6cSRicardo Ribalda Delgado 			(!!(rs485->flags & SER_RS485_RTS_AFTER_SEND)))
2253236a965SLukas Wunner 		rs485->flags &= ~SER_RS485_ENABLED;
22628e3fb6cSRicardo Ribalda Delgado 	else
22728e3fb6cSRicardo Ribalda Delgado 		config |= RS485_URA;
22828e3fb6cSRicardo Ribalda Delgado 
22928e3fb6cSRicardo Ribalda Delgado 	if (rs485->flags & SER_RS485_RTS_ON_SEND)
23028e3fb6cSRicardo Ribalda Delgado 		config |= RTS_INVERT;
23128e3fb6cSRicardo Ribalda Delgado 
232ce8c267eSRicardo Ribalda Delgado 	if (fintek_8250_enter_key(pdata->base_port, pdata->key))
23328e3fb6cSRicardo Ribalda Delgado 		return -EBUSY;
23428e3fb6cSRicardo Ribalda Delgado 
235f1232ac2SJi-Ze Hong (Peter Hong) 	sio_write_reg(pdata, LDN, pdata->index);
236f1232ac2SJi-Ze Hong (Peter Hong) 	sio_write_reg(pdata, RS485, config);
237017bec38SRicardo Ribalda Delgado 	fintek_8250_exit_key(pdata->base_port);
23828e3fb6cSRicardo Ribalda Delgado 
23941e69093SRicardo Ribalda Delgado 	port->rs485 = *rs485;
24041e69093SRicardo Ribalda Delgado 
24128e3fb6cSRicardo Ribalda Delgado 	return 0;
24228e3fb6cSRicardo Ribalda Delgado }
24328e3fb6cSRicardo Ribalda Delgado 
24406e39572SJi-Ze Hong (Peter Hong) static void fintek_8250_set_irq_mode(struct fintek_8250 *pdata, bool is_level)
24506e39572SJi-Ze Hong (Peter Hong) {
24606e39572SJi-Ze Hong (Peter Hong) 	sio_write_reg(pdata, LDN, pdata->index);
247da60d6afSJi-Ze Hong (Peter Hong) 
248da60d6afSJi-Ze Hong (Peter Hong) 	switch (pdata->pid) {
249da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81866:
250da60d6afSJi-Ze Hong (Peter Hong) 		sio_write_mask_reg(pdata, F81866_FIFO_CTRL, F81866_IRQ_MODE1,
251da60d6afSJi-Ze Hong (Peter Hong) 				   0);
252de48b099SJi-Ze Hong (Peter Hong) 		/* fall through */
253de48b099SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81865:
254da60d6afSJi-Ze Hong (Peter Hong) 		sio_write_mask_reg(pdata, F81866_IRQ_MODE, F81866_IRQ_SHARE,
255da60d6afSJi-Ze Hong (Peter Hong) 				   F81866_IRQ_SHARE);
256da60d6afSJi-Ze Hong (Peter Hong) 		sio_write_mask_reg(pdata, F81866_IRQ_MODE, F81866_IRQ_MODE0,
257da60d6afSJi-Ze Hong (Peter Hong) 				   is_level ? 0 : F81866_IRQ_MODE0);
258da60d6afSJi-Ze Hong (Peter Hong) 		break;
259da60d6afSJi-Ze Hong (Peter Hong) 
260da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216AD:
261da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216H:
262da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216:
263da60d6afSJi-Ze Hong (Peter Hong) 		sio_write_mask_reg(pdata, FINTEK_IRQ_MODE, IRQ_SHARE,
264da60d6afSJi-Ze Hong (Peter Hong) 				   IRQ_SHARE);
26506e39572SJi-Ze Hong (Peter Hong) 		sio_write_mask_reg(pdata, FINTEK_IRQ_MODE, IRQ_MODE_MASK,
26606e39572SJi-Ze Hong (Peter Hong) 				   is_level ? IRQ_LEVEL_LOW : IRQ_EDGE_HIGH);
267da60d6afSJi-Ze Hong (Peter Hong) 		break;
268da60d6afSJi-Ze Hong (Peter Hong) 	}
26906e39572SJi-Ze Hong (Peter Hong) }
27006e39572SJi-Ze Hong (Peter Hong) 
271c2236facSJi-Ze Hong (Peter Hong) static void fintek_8250_set_max_fifo(struct fintek_8250 *pdata)
272c2236facSJi-Ze Hong (Peter Hong) {
273c2236facSJi-Ze Hong (Peter Hong) 	switch (pdata->pid) {
274c2236facSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216H: /* 128Bytes FIFO */
275da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81866:
276c2236facSJi-Ze Hong (Peter Hong) 		sio_write_mask_reg(pdata, FIFO_CTRL,
277c2236facSJi-Ze Hong (Peter Hong) 				   FIFO_MODE_MASK | RXFTHR_MODE_MASK,
278c2236facSJi-Ze Hong (Peter Hong) 				   FIFO_MODE_128 | RXFTHR_MODE_4X);
279c2236facSJi-Ze Hong (Peter Hong) 		break;
280c2236facSJi-Ze Hong (Peter Hong) 
281c2236facSJi-Ze Hong (Peter Hong) 	default: /* Default 16Bytes FIFO */
282c2236facSJi-Ze Hong (Peter Hong) 		break;
283c2236facSJi-Ze Hong (Peter Hong) 	}
284c2236facSJi-Ze Hong (Peter Hong) }
285c2236facSJi-Ze Hong (Peter Hong) 
286fab8a02bSLukas Redlinger static void fintek_8250_goto_highspeed(struct uart_8250_port *uart,
287fab8a02bSLukas Redlinger 			      struct fintek_8250 *pdata)
288fab8a02bSLukas Redlinger {
289fab8a02bSLukas Redlinger 	sio_write_reg(pdata, LDN, pdata->index);
290fab8a02bSLukas Redlinger 
291fab8a02bSLukas Redlinger 	switch (pdata->pid) {
292fab8a02bSLukas Redlinger 	case CHIP_ID_F81866: /* set uart clock for high speed serial mode */
293fab8a02bSLukas Redlinger 		sio_write_mask_reg(pdata, F81866_UART_CLK,
294fab8a02bSLukas Redlinger 			F81866_UART_CLK_MASK,
295fab8a02bSLukas Redlinger 			F81866_UART_CLK_14_769MHZ);
296fab8a02bSLukas Redlinger 
297fab8a02bSLukas Redlinger 		uart->port.uartclk = 921600 * 16;
298fab8a02bSLukas Redlinger 		break;
299fab8a02bSLukas Redlinger 	default: /* leave clock speed untouched */
300fab8a02bSLukas Redlinger 		break;
301fab8a02bSLukas Redlinger 	}
302fab8a02bSLukas Redlinger }
303fab8a02bSLukas Redlinger 
304195638b6SJi-Ze Hong (Peter Hong) void fintek_8250_set_termios(struct uart_port *port, struct ktermios *termios,
305195638b6SJi-Ze Hong (Peter Hong) 			struct ktermios *old)
306195638b6SJi-Ze Hong (Peter Hong) {
307195638b6SJi-Ze Hong (Peter Hong) 	struct fintek_8250 *pdata = port->private_data;
308195638b6SJi-Ze Hong (Peter Hong) 	unsigned int baud = tty_termios_baud_rate(termios);
309195638b6SJi-Ze Hong (Peter Hong) 	int i;
31058178914SJi-Ze Hong (Peter Hong) 	u8 reg;
311195638b6SJi-Ze Hong (Peter Hong) 	static u32 baudrate_table[] = {115200, 921600, 1152000, 1500000};
312195638b6SJi-Ze Hong (Peter Hong) 	static u8 clock_table[] = { F81866_UART_CLK_1_8432MHZ,
313195638b6SJi-Ze Hong (Peter Hong) 			F81866_UART_CLK_14_769MHZ, F81866_UART_CLK_18_432MHZ,
314195638b6SJi-Ze Hong (Peter Hong) 			F81866_UART_CLK_24MHZ };
315195638b6SJi-Ze Hong (Peter Hong) 
31658178914SJi-Ze Hong (Peter Hong) 	switch (pdata->pid) {
31758178914SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216H:
31858178914SJi-Ze Hong (Peter Hong) 		reg = RS485;
31958178914SJi-Ze Hong (Peter Hong) 		break;
32058178914SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81866:
32158178914SJi-Ze Hong (Peter Hong) 		reg = F81866_UART_CLK;
32258178914SJi-Ze Hong (Peter Hong) 		break;
32358178914SJi-Ze Hong (Peter Hong) 	default:
32458178914SJi-Ze Hong (Peter Hong) 		/* Don't change clocksource with unknown PID */
32558178914SJi-Ze Hong (Peter Hong) 		dev_warn(port->dev,
32658178914SJi-Ze Hong (Peter Hong) 			"%s: pid: %x Not support. use default set_termios.\n",
32758178914SJi-Ze Hong (Peter Hong) 			__func__, pdata->pid);
32858178914SJi-Ze Hong (Peter Hong) 		serial8250_do_set_termios(port, termios, old);
32958178914SJi-Ze Hong (Peter Hong) 		return;
33058178914SJi-Ze Hong (Peter Hong) 	}
33158178914SJi-Ze Hong (Peter Hong) 
332195638b6SJi-Ze Hong (Peter Hong) 	for (i = 0; i < ARRAY_SIZE(baudrate_table); ++i) {
333195638b6SJi-Ze Hong (Peter Hong) 		if (baud > baudrate_table[i] || baudrate_table[i] % baud != 0)
334195638b6SJi-Ze Hong (Peter Hong) 			continue;
335195638b6SJi-Ze Hong (Peter Hong) 
336195638b6SJi-Ze Hong (Peter Hong) 		if (port->uartclk == baudrate_table[i] * 16)
337195638b6SJi-Ze Hong (Peter Hong) 			break;
338195638b6SJi-Ze Hong (Peter Hong) 
339195638b6SJi-Ze Hong (Peter Hong) 		if (fintek_8250_enter_key(pdata->base_port, pdata->key))
340195638b6SJi-Ze Hong (Peter Hong) 			continue;
341195638b6SJi-Ze Hong (Peter Hong) 
342195638b6SJi-Ze Hong (Peter Hong) 		port->uartclk = baudrate_table[i] * 16;
343195638b6SJi-Ze Hong (Peter Hong) 
344195638b6SJi-Ze Hong (Peter Hong) 		sio_write_reg(pdata, LDN, pdata->index);
34558178914SJi-Ze Hong (Peter Hong) 		sio_write_mask_reg(pdata, reg, F81866_UART_CLK_MASK,
34658178914SJi-Ze Hong (Peter Hong) 				clock_table[i]);
347195638b6SJi-Ze Hong (Peter Hong) 
348195638b6SJi-Ze Hong (Peter Hong) 		fintek_8250_exit_key(pdata->base_port);
349195638b6SJi-Ze Hong (Peter Hong) 		break;
350195638b6SJi-Ze Hong (Peter Hong) 	}
351195638b6SJi-Ze Hong (Peter Hong) 
352195638b6SJi-Ze Hong (Peter Hong) 	if (i == ARRAY_SIZE(baudrate_table)) {
353195638b6SJi-Ze Hong (Peter Hong) 		baud = tty_termios_baud_rate(old);
354195638b6SJi-Ze Hong (Peter Hong) 		tty_termios_encode_baud_rate(termios, baud, baud);
355195638b6SJi-Ze Hong (Peter Hong) 	}
356195638b6SJi-Ze Hong (Peter Hong) 
357195638b6SJi-Ze Hong (Peter Hong) 	serial8250_do_set_termios(port, termios, old);
358195638b6SJi-Ze Hong (Peter Hong) }
359195638b6SJi-Ze Hong (Peter Hong) 
360195638b6SJi-Ze Hong (Peter Hong) static void fintek_8250_set_termios_handler(struct uart_8250_port *uart)
361195638b6SJi-Ze Hong (Peter Hong) {
362195638b6SJi-Ze Hong (Peter Hong) 	struct fintek_8250 *pdata = uart->port.private_data;
363195638b6SJi-Ze Hong (Peter Hong) 
364195638b6SJi-Ze Hong (Peter Hong) 	switch (pdata->pid) {
36558178914SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216H:
366195638b6SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81866:
367195638b6SJi-Ze Hong (Peter Hong) 		uart->port.set_termios = fintek_8250_set_termios;
368195638b6SJi-Ze Hong (Peter Hong) 		break;
369195638b6SJi-Ze Hong (Peter Hong) 
370195638b6SJi-Ze Hong (Peter Hong) 	default:
371195638b6SJi-Ze Hong (Peter Hong) 		break;
372195638b6SJi-Ze Hong (Peter Hong) 	}
373195638b6SJi-Ze Hong (Peter Hong) }
374195638b6SJi-Ze Hong (Peter Hong) 
375fab8a02bSLukas Redlinger static int probe_setup_port(struct fintek_8250 *pdata,
376fab8a02bSLukas Redlinger 					struct uart_8250_port *uart)
377017bec38SRicardo Ribalda Delgado {
378017bec38SRicardo Ribalda Delgado 	static const u16 addr[] = {0x4e, 0x2e};
379ce8c267eSRicardo Ribalda Delgado 	static const u8 keys[] = {0x77, 0xa0, 0x87, 0x67};
38006e39572SJi-Ze Hong (Peter Hong) 	struct irq_data *irq_data;
38106e39572SJi-Ze Hong (Peter Hong) 	bool level_mode = false;
382da60d6afSJi-Ze Hong (Peter Hong) 	int i, j, k, min, max;
383017bec38SRicardo Ribalda Delgado 
384017bec38SRicardo Ribalda Delgado 	for (i = 0; i < ARRAY_SIZE(addr); i++) {
385ce8c267eSRicardo Ribalda Delgado 		for (j = 0; j < ARRAY_SIZE(keys); j++) {
386f1232ac2SJi-Ze Hong (Peter Hong) 			pdata->base_port = addr[i];
387f1232ac2SJi-Ze Hong (Peter Hong) 			pdata->key = keys[j];
388017bec38SRicardo Ribalda Delgado 
389ce8c267eSRicardo Ribalda Delgado 			if (fintek_8250_enter_key(addr[i], keys[j]))
390017bec38SRicardo Ribalda Delgado 				continue;
391da60d6afSJi-Ze Hong (Peter Hong) 			if (fintek_8250_check_id(pdata) ||
392da60d6afSJi-Ze Hong (Peter Hong) 			    fintek_8250_get_ldn_range(pdata, &min, &max)) {
393017bec38SRicardo Ribalda Delgado 				fintek_8250_exit_key(addr[i]);
39429d58642SRicardo Ribalda Delgado 				continue;
39529d58642SRicardo Ribalda Delgado 			}
39629d58642SRicardo Ribalda Delgado 
397da60d6afSJi-Ze Hong (Peter Hong) 			for (k = min; k < max; k++) {
39829d58642SRicardo Ribalda Delgado 				u16 aux;
39929d58642SRicardo Ribalda Delgado 
400f1232ac2SJi-Ze Hong (Peter Hong) 				sio_write_reg(pdata, LDN, k);
401f1232ac2SJi-Ze Hong (Peter Hong) 				aux = sio_read_reg(pdata, IO_ADDR1);
402f1232ac2SJi-Ze Hong (Peter Hong) 				aux |= sio_read_reg(pdata, IO_ADDR2) << 8;
403fab8a02bSLukas Redlinger 				if (aux != uart->port.iobase)
40429d58642SRicardo Ribalda Delgado 					continue;
40529d58642SRicardo Ribalda Delgado 
406fa01e2caSRicardo Ribalda Delgado 				pdata->index = k;
407fa01e2caSRicardo Ribalda Delgado 
408fab8a02bSLukas Redlinger 				irq_data = irq_get_irq_data(uart->port.irq);
40906e39572SJi-Ze Hong (Peter Hong) 				if (irq_data)
41006e39572SJi-Ze Hong (Peter Hong) 					level_mode =
41106e39572SJi-Ze Hong (Peter Hong) 						irqd_is_level_type(irq_data);
41206e39572SJi-Ze Hong (Peter Hong) 
41306e39572SJi-Ze Hong (Peter Hong) 				fintek_8250_set_irq_mode(pdata, level_mode);
414c2236facSJi-Ze Hong (Peter Hong) 				fintek_8250_set_max_fifo(pdata);
415fab8a02bSLukas Redlinger 				fintek_8250_goto_highspeed(uart, pdata);
416fab8a02bSLukas Redlinger 
41706e39572SJi-Ze Hong (Peter Hong) 				fintek_8250_exit_key(addr[i]);
41806e39572SJi-Ze Hong (Peter Hong) 
419fa01e2caSRicardo Ribalda Delgado 				return 0;
420017bec38SRicardo Ribalda Delgado 			}
421fa01e2caSRicardo Ribalda Delgado 
42229d58642SRicardo Ribalda Delgado 			fintek_8250_exit_key(addr[i]);
423ce8c267eSRicardo Ribalda Delgado 		}
424ce8c267eSRicardo Ribalda Delgado 	}
425017bec38SRicardo Ribalda Delgado 
426017bec38SRicardo Ribalda Delgado 	return -ENODEV;
427017bec38SRicardo Ribalda Delgado }
428017bec38SRicardo Ribalda Delgado 
4291e26c472SJi-Ze Hong (Peter Hong) static void fintek_8250_set_rs485_handler(struct uart_8250_port *uart)
4301e26c472SJi-Ze Hong (Peter Hong) {
4311e26c472SJi-Ze Hong (Peter Hong) 	struct fintek_8250 *pdata = uart->port.private_data;
4321e26c472SJi-Ze Hong (Peter Hong) 
4331e26c472SJi-Ze Hong (Peter Hong) 	switch (pdata->pid) {
4341e26c472SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216AD:
4351e26c472SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81216H:
436da60d6afSJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81866:
437de48b099SJi-Ze Hong (Peter Hong) 	case CHIP_ID_F81865:
4381e26c472SJi-Ze Hong (Peter Hong) 		uart->port.rs485_config = fintek_8250_rs485_config;
4391e26c472SJi-Ze Hong (Peter Hong) 		break;
4401e26c472SJi-Ze Hong (Peter Hong) 
4411e26c472SJi-Ze Hong (Peter Hong) 	default: /* No RS485 Auto direction functional */
4421e26c472SJi-Ze Hong (Peter Hong) 		break;
4431e26c472SJi-Ze Hong (Peter Hong) 	}
4441e26c472SJi-Ze Hong (Peter Hong) }
4451e26c472SJi-Ze Hong (Peter Hong) 
446fa01e2caSRicardo Ribalda Delgado int fintek_8250_probe(struct uart_8250_port *uart)
44728e3fb6cSRicardo Ribalda Delgado {
44892a5f11aSRicardo Ribalda Delgado 	struct fintek_8250 *pdata;
449fa01e2caSRicardo Ribalda Delgado 	struct fintek_8250 probe_data;
45028e3fb6cSRicardo Ribalda Delgado 
451fab8a02bSLukas Redlinger 	if (probe_setup_port(&probe_data, uart))
45228e3fb6cSRicardo Ribalda Delgado 		return -ENODEV;
45328e3fb6cSRicardo Ribalda Delgado 
454fa01e2caSRicardo Ribalda Delgado 	pdata = devm_kzalloc(uart->port.dev, sizeof(*pdata), GFP_KERNEL);
45592a5f11aSRicardo Ribalda Delgado 	if (!pdata)
45692a5f11aSRicardo Ribalda Delgado 		return -ENOMEM;
45792a5f11aSRicardo Ribalda Delgado 
458fa01e2caSRicardo Ribalda Delgado 	memcpy(pdata, &probe_data, sizeof(probe_data));
459fa01e2caSRicardo Ribalda Delgado 	uart->port.private_data = pdata;
4601e26c472SJi-Ze Hong (Peter Hong) 	fintek_8250_set_rs485_handler(uart);
461195638b6SJi-Ze Hong (Peter Hong) 	fintek_8250_set_termios_handler(uart);
46228e3fb6cSRicardo Ribalda Delgado 
46306e39572SJi-Ze Hong (Peter Hong) 	return 0;
46428e3fb6cSRicardo Ribalda Delgado }
465