1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/clk.h>
18#include <linux/io.h>
19#include <linux/module.h>
20#include <linux/of_irq.h>
21#include <linux/of_platform.h>
22#include <linux/platform_device.h>
23#include <linux/pm_runtime.h>
24#include <linux/serial_8250.h>
25#include <linux/serial_reg.h>
26
27#include "8250.h"
28
29#define UART_MTK_HIGHS 0x09
30#define UART_MTK_SAMPLE_COUNT 0x0a
31#define UART_MTK_SAMPLE_POINT 0x0b
32#define MTK_UART_RATE_FIX 0x0d
33
34struct mtk8250_data {
35 int line;
36 struct clk *uart_clk;
37 struct clk *bus_clk;
38};
39
40static void
41mtk8250_set_termios(struct uart_port *port, struct ktermios *termios,
42 struct ktermios *old)
43{
44 struct uart_8250_port *up = up_to_u8250p(port);
45 unsigned long flags;
46 unsigned int baud, quot;
47
48 serial8250_do_set_termios(port, termios, old);
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63 baud = uart_get_baud_rate(port, termios, old,
64 port->uartclk / 16 / 0xffff,
65 port->uartclk);
66
67 if (baud <= 115200) {
68 serial_port_out(port, UART_MTK_HIGHS, 0x0);
69 quot = uart_get_divisor(port, baud);
70 } else if (baud <= 576000) {
71 serial_port_out(port, UART_MTK_HIGHS, 0x2);
72
73
74 if ((baud == 500000) || (baud == 576000))
75 baud = 460800;
76 quot = DIV_ROUND_UP(port->uartclk, 4 * baud);
77 } else {
78 serial_port_out(port, UART_MTK_HIGHS, 0x3);
79 quot = DIV_ROUND_UP(port->uartclk, 256 * baud);
80 }
81
82
83
84
85
86 spin_lock_irqsave(&port->lock, flags);
87
88
89 serial_port_out(port, UART_LCR, up->lcr | UART_LCR_DLAB);
90 serial_dl_write(up, quot);
91
92
93 serial_port_out(port, UART_LCR, up->lcr);
94
95 if (baud > 460800) {
96 unsigned int tmp;
97
98 tmp = DIV_ROUND_CLOSEST(port->uartclk, quot * baud);
99 serial_port_out(port, UART_MTK_SAMPLE_COUNT, tmp - 1);
100 serial_port_out(port, UART_MTK_SAMPLE_POINT,
101 (tmp - 2) >> 1);
102 } else {
103 serial_port_out(port, UART_MTK_SAMPLE_COUNT, 0x00);
104 serial_port_out(port, UART_MTK_SAMPLE_POINT, 0xff);
105 }
106
107 spin_unlock_irqrestore(&port->lock, flags);
108
109 if (tty_termios_baud_rate(termios))
110 tty_termios_encode_baud_rate(termios, baud, baud);
111}
112
113static int __maybe_unused mtk8250_runtime_suspend(struct device *dev)
114{
115 struct mtk8250_data *data = dev_get_drvdata(dev);
116
117 clk_disable_unprepare(data->uart_clk);
118 clk_disable_unprepare(data->bus_clk);
119
120 return 0;
121}
122
123static int __maybe_unused mtk8250_runtime_resume(struct device *dev)
124{
125 struct mtk8250_data *data = dev_get_drvdata(dev);
126 int err;
127
128 err = clk_prepare_enable(data->uart_clk);
129 if (err) {
130 dev_warn(dev, "Can't enable clock\n");
131 return err;
132 }
133
134 err = clk_prepare_enable(data->bus_clk);
135 if (err) {
136 dev_warn(dev, "Can't enable bus clock\n");
137 return err;
138 }
139
140 return 0;
141}
142
143static void
144mtk8250_do_pm(struct uart_port *port, unsigned int state, unsigned int old)
145{
146 if (!state)
147 pm_runtime_get_sync(port->dev);
148
149 serial8250_do_pm(port, state, old);
150
151 if (state)
152 pm_runtime_put_sync_suspend(port->dev);
153}
154
155static int mtk8250_probe_of(struct platform_device *pdev, struct uart_port *p,
156 struct mtk8250_data *data)
157{
158 data->uart_clk = devm_clk_get(&pdev->dev, "baud");
159 if (IS_ERR(data->uart_clk)) {
160
161
162
163
164 data->uart_clk = devm_clk_get(&pdev->dev, NULL);
165 if (IS_ERR(data->uart_clk)) {
166 dev_warn(&pdev->dev, "Can't get uart clock\n");
167 return PTR_ERR(data->uart_clk);
168 }
169
170 return 0;
171 }
172
173 data->bus_clk = devm_clk_get(&pdev->dev, "bus");
174 if (IS_ERR(data->bus_clk))
175 return PTR_ERR(data->bus_clk);
176
177 return 0;
178}
179
180static int mtk8250_probe(struct platform_device *pdev)
181{
182 struct uart_8250_port uart = {};
183 struct resource *regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
184 struct resource *irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
185 struct mtk8250_data *data;
186 int err;
187
188 if (!regs || !irq) {
189 dev_err(&pdev->dev, "no registers/irq defined\n");
190 return -EINVAL;
191 }
192
193 uart.port.membase = devm_ioremap(&pdev->dev, regs->start,
194 resource_size(regs));
195 if (!uart.port.membase)
196 return -ENOMEM;
197
198 data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
199 if (!data)
200 return -ENOMEM;
201
202 if (pdev->dev.of_node) {
203 err = mtk8250_probe_of(pdev, &uart.port, data);
204 if (err)
205 return err;
206 } else
207 return -ENODEV;
208
209 spin_lock_init(&uart.port.lock);
210 uart.port.mapbase = regs->start;
211 uart.port.irq = irq->start;
212 uart.port.pm = mtk8250_do_pm;
213 uart.port.type = PORT_16550;
214 uart.port.flags = UPF_BOOT_AUTOCONF | UPF_FIXED_PORT;
215 uart.port.dev = &pdev->dev;
216 uart.port.iotype = UPIO_MEM32;
217 uart.port.regshift = 2;
218 uart.port.private_data = data;
219 uart.port.set_termios = mtk8250_set_termios;
220 uart.port.uartclk = clk_get_rate(data->uart_clk);
221
222
223 writel(0x0, uart.port.membase +
224 (MTK_UART_RATE_FIX << uart.port.regshift));
225
226 platform_set_drvdata(pdev, data);
227
228 pm_runtime_enable(&pdev->dev);
229 if (!pm_runtime_enabled(&pdev->dev)) {
230 err = mtk8250_runtime_resume(&pdev->dev);
231 if (err)
232 return err;
233 }
234
235 data->line = serial8250_register_8250_port(&uart);
236 if (data->line < 0)
237 return data->line;
238
239 return 0;
240}
241
242static int mtk8250_remove(struct platform_device *pdev)
243{
244 struct mtk8250_data *data = platform_get_drvdata(pdev);
245
246 pm_runtime_get_sync(&pdev->dev);
247
248 serial8250_unregister_port(data->line);
249
250 pm_runtime_disable(&pdev->dev);
251 pm_runtime_put_noidle(&pdev->dev);
252
253 if (!pm_runtime_status_suspended(&pdev->dev))
254 mtk8250_runtime_suspend(&pdev->dev);
255
256 return 0;
257}
258
259static int __maybe_unused mtk8250_suspend(struct device *dev)
260{
261 struct mtk8250_data *data = dev_get_drvdata(dev);
262
263 serial8250_suspend_port(data->line);
264
265 return 0;
266}
267
268static int __maybe_unused mtk8250_resume(struct device *dev)
269{
270 struct mtk8250_data *data = dev_get_drvdata(dev);
271
272 serial8250_resume_port(data->line);
273
274 return 0;
275}
276
277static const struct dev_pm_ops mtk8250_pm_ops = {
278 SET_SYSTEM_SLEEP_PM_OPS(mtk8250_suspend, mtk8250_resume)
279 SET_RUNTIME_PM_OPS(mtk8250_runtime_suspend, mtk8250_runtime_resume,
280 NULL)
281};
282
283static const struct of_device_id mtk8250_of_match[] = {
284 { .compatible = "mediatek,mt6577-uart" },
285 { }
286};
287MODULE_DEVICE_TABLE(of, mtk8250_of_match);
288
289static struct platform_driver mtk8250_platform_driver = {
290 .driver = {
291 .name = "mt6577-uart",
292 .pm = &mtk8250_pm_ops,
293 .of_match_table = mtk8250_of_match,
294 },
295 .probe = mtk8250_probe,
296 .remove = mtk8250_remove,
297};
298module_platform_driver(mtk8250_platform_driver);
299
300#ifdef CONFIG_SERIAL_8250_CONSOLE
301static int __init early_mtk8250_setup(struct earlycon_device *device,
302 const char *options)
303{
304 if (!device->port.membase)
305 return -ENODEV;
306
307 device->port.iotype = UPIO_MEM32;
308
309 return early_serial8250_setup(device, NULL);
310}
311
312OF_EARLYCON_DECLARE(mtk8250, "mediatek,mt6577-uart", early_mtk8250_setup);
313#endif
314
315MODULE_AUTHOR("Matthias Brugger");
316MODULE_LICENSE("GPL");
317MODULE_DESCRIPTION("Mediatek 8250 serial port driver");
318