[AVR32] fix serial port setup on ATSTK1000
[sfrench/cifs-2.6.git] / arch / avr32 / boards / atstk1000 / atstk1002.c
1 /*
2  * ATSTK1002 daughterboard-specific init code
3  *
4  * Copyright (C) 2005-2006 Atmel Corporation
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  */
10 #include <linux/clk.h>
11 #include <linux/etherdevice.h>
12 #include <linux/init.h>
13 #include <linux/kernel.h>
14 #include <linux/platform_device.h>
15 #include <linux/string.h>
16 #include <linux/types.h>
17
18 #include <asm/io.h>
19 #include <asm/setup.h>
20 #include <asm/arch/board.h>
21 #include <asm/arch/init.h>
22
23
24 #define SW2_DEFAULT             /* MMCI and UART_A available */
25
26 struct eth_addr {
27         u8 addr[6];
28 };
29
30 static struct eth_addr __initdata hw_addr[2];
31
32 static struct eth_platform_data __initdata eth_data[2];
33 extern struct lcdc_platform_data atstk1000_fb0_data;
34
35 /*
36  * The next two functions should go away as the boot loader is
37  * supposed to initialize the macb address registers with a valid
38  * ethernet address. But we need to keep it around for a while until
39  * we can be reasonably sure the boot loader does this.
40  *
41  * The phy_id is ignored as the driver will probe for it.
42  */
43 static int __init parse_tag_ethernet(struct tag *tag)
44 {
45         int i;
46
47         i = tag->u.ethernet.mac_index;
48         if (i < ARRAY_SIZE(hw_addr))
49                 memcpy(hw_addr[i].addr, tag->u.ethernet.hw_address,
50                        sizeof(hw_addr[i].addr));
51
52         return 0;
53 }
54 __tagtable(ATAG_ETHERNET, parse_tag_ethernet);
55
56 static void __init set_hw_addr(struct platform_device *pdev)
57 {
58         struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
59         const u8 *addr;
60         void __iomem *regs;
61         struct clk *pclk;
62
63         if (!res)
64                 return;
65         if (pdev->id >= ARRAY_SIZE(hw_addr))
66                 return;
67
68         addr = hw_addr[pdev->id].addr;
69         if (!is_valid_ether_addr(addr))
70                 return;
71
72         /*
73          * Since this is board-specific code, we'll cheat and use the
74          * physical address directly as we happen to know that it's
75          * the same as the virtual address.
76          */
77         regs = (void __iomem __force *)res->start;
78         pclk = clk_get(&pdev->dev, "pclk");
79         if (!pclk)
80                 return;
81
82         clk_enable(pclk);
83         __raw_writel((addr[3] << 24) | (addr[2] << 16)
84                      | (addr[1] << 8) | addr[0], regs + 0x98);
85         __raw_writel((addr[5] << 8) | addr[4], regs + 0x9c);
86         clk_disable(pclk);
87         clk_put(pclk);
88 }
89
90 void __init setup_board(void)
91 {
92 #ifdef  SW2_DEFAULT
93         at32_map_usart(1, 0);   /* USART 1/A: /dev/ttyS0, DB9 */
94 #else
95         at32_map_usart(0, 1);   /* USART 0/B: /dev/ttyS1, IRDA */
96 #endif
97         /* USART 2/unused: expansion connector */
98         at32_map_usart(3, 2);   /* USART 3/C: /dev/ttyS2, DB9 */
99
100         at32_setup_serial_console(0);
101 }
102
103 static int __init atstk1002_init(void)
104 {
105         at32_add_system_devices();
106
107 #ifdef  SW2_DEFAULT
108         at32_add_device_usart(0);
109 #else
110         at32_add_device_usart(1);
111 #endif
112         at32_add_device_usart(2);
113
114         set_hw_addr(at32_add_device_eth(0, &eth_data[0]));
115
116         at32_add_device_spi(0);
117         at32_add_device_lcdc(0, &atstk1000_fb0_data);
118
119         return 0;
120 }
121 postcore_initcall(atstk1002_init);