Merge tag 'driver-core-4.9-rc3' of git://git.kernel.org/pub/scm/linux/kernel/git...
[cascardo/linux.git] / drivers / tty / serial / 8250 / 8250_uniphier.c
1 /*
2  * Copyright (C) 2015 Masahiro Yamada <yamada.masahiro@socionext.com>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; either version 2 of the License, or
7  * (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  * GNU General Public License for more details.
13  */
14
15 #include <linux/clk.h>
16 #include <linux/console.h>
17 #include <linux/io.h>
18 #include <linux/module.h>
19 #include <linux/of.h>
20 #include <linux/platform_device.h>
21
22 #include "8250.h"
23
24 /* Most (but not all) of UniPhier UART devices have 64-depth FIFO. */
25 #define UNIPHIER_UART_DEFAULT_FIFO_SIZE 64
26
27 #define UNIPHIER_UART_CHAR_FCR  3       /* Character / FIFO Control Register */
28 #define UNIPHIER_UART_LCR_MCR   4       /* Line/Modem Control Register */
29 #define   UNIPHIER_UART_LCR_SHIFT       8
30 #define UNIPHIER_UART_DLR       9       /* Divisor Latch Register */
31
32 struct uniphier8250_priv {
33         int line;
34         struct clk *clk;
35         spinlock_t atomic_write_lock;
36 };
37
38 #ifdef CONFIG_SERIAL_8250_CONSOLE
39 static int __init uniphier_early_console_setup(struct earlycon_device *device,
40                                                const char *options)
41 {
42         if (!device->port.membase)
43                 return -ENODEV;
44
45         /* This hardware always expects MMIO32 register interface. */
46         device->port.iotype = UPIO_MEM32;
47         device->port.regshift = 2;
48
49         /*
50          * Do not touch the divisor register in early_serial8250_setup();
51          * we assume it has been initialized by a boot loader.
52          */
53         device->baud = 0;
54
55         return early_serial8250_setup(device, options);
56 }
57 OF_EARLYCON_DECLARE(uniphier, "socionext,uniphier-uart",
58                     uniphier_early_console_setup);
59 #endif
60
61 /*
62  * The register map is slightly different from that of 8250.
63  * IO callbacks must be overridden for correct access to FCR, LCR, and MCR.
64  */
65 static unsigned int uniphier_serial_in(struct uart_port *p, int offset)
66 {
67         unsigned int valshift = 0;
68
69         switch (offset) {
70         case UART_LCR:
71                 valshift = UNIPHIER_UART_LCR_SHIFT;
72                 /* fall through */
73         case UART_MCR:
74                 offset = UNIPHIER_UART_LCR_MCR;
75                 break;
76         default:
77                 break;
78         }
79
80         offset <<= p->regshift;
81
82         /*
83          * The return value must be masked with 0xff because LCR and MCR reside
84          * in the same register that must be accessed by 32-bit write/read.
85          * 8 or 16 bit access to this hardware result in unexpected behavior.
86          */
87         return (readl(p->membase + offset) >> valshift) & 0xff;
88 }
89
90 static void uniphier_serial_out(struct uart_port *p, int offset, int value)
91 {
92         unsigned int valshift = 0;
93         bool normal = false;
94
95         switch (offset) {
96         case UART_FCR:
97                 offset = UNIPHIER_UART_CHAR_FCR;
98                 break;
99         case UART_LCR:
100                 valshift = UNIPHIER_UART_LCR_SHIFT;
101                 /* Divisor latch access bit does not exist. */
102                 value &= ~UART_LCR_DLAB;
103                 /* fall through */
104         case UART_MCR:
105                 offset = UNIPHIER_UART_LCR_MCR;
106                 break;
107         default:
108                 normal = true;
109                 break;
110         }
111
112         offset <<= p->regshift;
113
114         if (normal) {
115                 writel(value, p->membase + offset);
116         } else {
117                 /*
118                  * Special case: two registers share the same address that
119                  * must be 32-bit accessed.  As this is not longer atomic safe,
120                  * take a lock just in case.
121                  */
122                 struct uniphier8250_priv *priv = p->private_data;
123                 unsigned long flags;
124                 u32 tmp;
125
126                 spin_lock_irqsave(&priv->atomic_write_lock, flags);
127                 tmp = readl(p->membase + offset);
128                 tmp &= ~(0xff << valshift);
129                 tmp |= value << valshift;
130                 writel(tmp, p->membase + offset);
131                 spin_unlock_irqrestore(&priv->atomic_write_lock, flags);
132         }
133 }
134
135 /*
136  * This hardware does not have the divisor latch access bit.
137  * The divisor latch register exists at different address.
138  * Override dl_read/write callbacks.
139  */
140 static int uniphier_serial_dl_read(struct uart_8250_port *up)
141 {
142         int offset = UNIPHIER_UART_DLR << up->port.regshift;
143
144         return readl(up->port.membase + offset);
145 }
146
147 static void uniphier_serial_dl_write(struct uart_8250_port *up, int value)
148 {
149         int offset = UNIPHIER_UART_DLR << up->port.regshift;
150
151         writel(value, up->port.membase + offset);
152 }
153
154 static int uniphier_of_serial_setup(struct device *dev, struct uart_port *port,
155                                     struct uniphier8250_priv *priv)
156 {
157         int ret;
158         u32 prop;
159         struct device_node *np = dev->of_node;
160
161         ret = of_alias_get_id(np, "serial");
162         if (ret < 0) {
163                 dev_err(dev, "failed to get alias id\n");
164                 return ret;
165         }
166         port->line = priv->line = ret;
167
168         /* Get clk rate through clk driver */
169         priv->clk = devm_clk_get(dev, NULL);
170         if (IS_ERR(priv->clk)) {
171                 dev_err(dev, "failed to get clock\n");
172                 return PTR_ERR(priv->clk);
173         }
174
175         ret = clk_prepare_enable(priv->clk);
176         if (ret < 0)
177                 return ret;
178
179         port->uartclk = clk_get_rate(priv->clk);
180
181         /* Check for fifo size */
182         if (of_property_read_u32(np, "fifo-size", &prop) == 0)
183                 port->fifosize = prop;
184         else
185                 port->fifosize = UNIPHIER_UART_DEFAULT_FIFO_SIZE;
186
187         return 0;
188 }
189
190 static int uniphier_uart_probe(struct platform_device *pdev)
191 {
192         struct device *dev = &pdev->dev;
193         struct uart_8250_port up;
194         struct uniphier8250_priv *priv;
195         struct resource *regs;
196         void __iomem *membase;
197         int irq;
198         int ret;
199
200         regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
201         if (!regs) {
202                 dev_err(dev, "failed to get memory resource\n");
203                 return -EINVAL;
204         }
205
206         membase = devm_ioremap(dev, regs->start, resource_size(regs));
207         if (!membase)
208                 return -ENOMEM;
209
210         irq = platform_get_irq(pdev, 0);
211         if (irq < 0) {
212                 dev_err(dev, "failed to get IRQ number\n");
213                 return irq;
214         }
215
216         priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
217         if (!priv)
218                 return -ENOMEM;
219
220         memset(&up, 0, sizeof(up));
221
222         ret = uniphier_of_serial_setup(dev, &up.port, priv);
223         if (ret < 0)
224                 return ret;
225
226         spin_lock_init(&priv->atomic_write_lock);
227
228         up.port.dev = dev;
229         up.port.private_data = priv;
230         up.port.mapbase = regs->start;
231         up.port.mapsize = resource_size(regs);
232         up.port.membase = membase;
233         up.port.irq = irq;
234
235         up.port.type = PORT_16550A;
236         up.port.iotype = UPIO_MEM32;
237         up.port.regshift = 2;
238         up.port.flags = UPF_FIXED_PORT | UPF_FIXED_TYPE;
239         up.capabilities = UART_CAP_FIFO;
240
241         up.port.serial_in = uniphier_serial_in;
242         up.port.serial_out = uniphier_serial_out;
243         up.dl_read = uniphier_serial_dl_read;
244         up.dl_write = uniphier_serial_dl_write;
245
246         ret = serial8250_register_8250_port(&up);
247         if (ret < 0) {
248                 dev_err(dev, "failed to register 8250 port\n");
249                 clk_disable_unprepare(priv->clk);
250                 return ret;
251         }
252
253         platform_set_drvdata(pdev, priv);
254
255         return 0;
256 }
257
258 static int uniphier_uart_remove(struct platform_device *pdev)
259 {
260         struct uniphier8250_priv *priv = platform_get_drvdata(pdev);
261
262         serial8250_unregister_port(priv->line);
263         clk_disable_unprepare(priv->clk);
264
265         return 0;
266 }
267
268 static const struct of_device_id uniphier_uart_match[] = {
269         { .compatible = "socionext,uniphier-uart" },
270         { /* sentinel */ }
271 };
272 MODULE_DEVICE_TABLE(of, uniphier_uart_match);
273
274 static struct platform_driver uniphier_uart_platform_driver = {
275         .probe          = uniphier_uart_probe,
276         .remove         = uniphier_uart_remove,
277         .driver = {
278                 .name   = "uniphier-uart",
279                 .of_match_table = uniphier_uart_match,
280         },
281 };
282 module_platform_driver(uniphier_uart_platform_driver);
283
284 MODULE_AUTHOR("Masahiro Yamada <yamada.masahiro@socionext.com>");
285 MODULE_DESCRIPTION("UniPhier UART driver");
286 MODULE_LICENSE("GPL");