1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/kernel.h>
20#include <linux/types.h>
21#include <linux/serial.h>
22#include <linux/serial_core.h>
23#include <linux/serial_reg.h>
24#include <linux/serial_8250.h>
25#include <linux/clk.h>
26#include <linux/io.h>
27
28#include <mach/hardware.h>
29#include <mach/platform.h>
30#include "common.h"
31
32#define LPC32XX_SUART_FIFO_SIZE 64
33
34struct uartinit {
35 char *uart_ck_name;
36 u32 ck_mode_mask;
37 void __iomem *pdiv_clk_reg;
38 resource_size_t mapbase;
39};
40
41static struct uartinit uartinit_data[] __initdata = {
42 {
43 .uart_ck_name = "uart5_ck",
44 .ck_mode_mask =
45 LPC32XX_UART_CLKMODE_LOAD(LPC32XX_UART_CLKMODE_ON, 5),
46 .pdiv_clk_reg = LPC32XX_CLKPWR_UART5_CLK_CTRL,
47 .mapbase = LPC32XX_UART5_BASE,
48 },
49 {
50 .uart_ck_name = "uart3_ck",
51 .ck_mode_mask =
52 LPC32XX_UART_CLKMODE_LOAD(LPC32XX_UART_CLKMODE_ON, 3),
53 .pdiv_clk_reg = LPC32XX_CLKPWR_UART3_CLK_CTRL,
54 .mapbase = LPC32XX_UART3_BASE,
55 },
56 {
57 .uart_ck_name = "uart4_ck",
58 .ck_mode_mask =
59 LPC32XX_UART_CLKMODE_LOAD(LPC32XX_UART_CLKMODE_ON, 4),
60 .pdiv_clk_reg = LPC32XX_CLKPWR_UART4_CLK_CTRL,
61 .mapbase = LPC32XX_UART4_BASE,
62 },
63 {
64 .uart_ck_name = "uart6_ck",
65 .ck_mode_mask =
66 LPC32XX_UART_CLKMODE_LOAD(LPC32XX_UART_CLKMODE_ON, 6),
67 .pdiv_clk_reg = LPC32XX_CLKPWR_UART6_CLK_CTRL,
68 .mapbase = LPC32XX_UART6_BASE,
69 },
70};
71
72void __init lpc32xx_serial_init(void)
73{
74 u32 tmp, clkmodes = 0;
75 struct clk *clk;
76 unsigned int puart;
77 int i, j;
78
79 for (i = 0; i < ARRAY_SIZE(uartinit_data); i++) {
80 clk = clk_get(NULL, uartinit_data[i].uart_ck_name);
81 if (!IS_ERR(clk)) {
82 clk_enable(clk);
83 }
84
85
86 clkmodes |= uartinit_data[i].ck_mode_mask;
87
88
89 __raw_writel(0x0101, uartinit_data[i].pdiv_clk_reg);
90
91
92
93
94
95 puart = uartinit_data[i].mapbase;
96 __raw_writel(0xC1, LPC32XX_UART_IIR_FCR(puart));
97 __raw_writel(0x00, LPC32XX_UART_DLL_FIFO(puart));
98 j = LPC32XX_SUART_FIFO_SIZE;
99 while (j--)
100 tmp = __raw_readl(
101 LPC32XX_UART_DLL_FIFO(puart));
102 __raw_writel(0, LPC32XX_UART_IIR_FCR(puart));
103 }
104
105
106 __raw_writel(clkmodes, LPC32XX_UARTCTL_CLKMODE);
107 for (i = 0; i < ARRAY_SIZE(uartinit_data); i++) {
108
109 puart = uartinit_data[i].mapbase;
110 __raw_writel(0xC1, LPC32XX_UART_IIR_FCR(puart));
111 __raw_writel(0x00, LPC32XX_UART_DLL_FIFO(puart));
112 j = LPC32XX_SUART_FIFO_SIZE;
113 while (j--)
114 tmp = __raw_readl(LPC32XX_UART_DLL_FIFO(puart));
115 __raw_writel(0, LPC32XX_UART_IIR_FCR(puart));
116 }
117
118
119 tmp = __raw_readl(LPC32XX_UARTCTL_CTRL);
120 tmp |= LPC32XX_UART_UART6_IRDAMOD_BYPASS;
121 __raw_writel(tmp, LPC32XX_UARTCTL_CTRL);
122
123
124 tmp = __raw_readl(LPC32XX_UARTCTL_CTRL);
125 tmp &= ~LPC32XX_UART_U5_ROUTE_TO_USB;
126 __raw_writel(tmp, LPC32XX_UARTCTL_CTRL);
127}
128