Haavard Skinnemoen | 5f97f7f | 2006-09-25 23:32:13 -0700 | [diff] [blame] | 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 | */ |
Haavard Skinnemoen | c164b90 | 2006-12-04 14:08:39 +0100 | [diff] [blame] | 10 | #include <linux/clk.h> |
| 11 | #include <linux/etherdevice.h> |
Haavard Skinnemoen | 5f97f7f | 2006-09-25 23:32:13 -0700 | [diff] [blame] | 12 | #include <linux/init.h> |
Haavard Skinnemoen | a6f92f3 | 2006-12-04 13:58:27 +0100 | [diff] [blame] | 13 | #include <linux/kernel.h> |
Haavard Skinnemoen | c164b90 | 2006-12-04 14:08:39 +0100 | [diff] [blame] | 14 | #include <linux/platform_device.h> |
Haavard Skinnemoen | a6f92f3 | 2006-12-04 13:58:27 +0100 | [diff] [blame] | 15 | #include <linux/string.h> |
| 16 | #include <linux/types.h> |
Haavard Skinnemoen | 5f97f7f | 2006-09-25 23:32:13 -0700 | [diff] [blame] | 17 | |
Haavard Skinnemoen | c164b90 | 2006-12-04 14:08:39 +0100 | [diff] [blame] | 18 | #include <asm/io.h> |
Haavard Skinnemoen | a6f92f3 | 2006-12-04 13:58:27 +0100 | [diff] [blame] | 19 | #include <asm/setup.h> |
Haavard Skinnemoen | 5f97f7f | 2006-09-25 23:32:13 -0700 | [diff] [blame] | 20 | #include <asm/arch/board.h> |
Haavard Skinnemoen | c194588 | 2006-10-04 16:02:10 +0200 | [diff] [blame] | 21 | #include <asm/arch/init.h> |
Haavard Skinnemoen | 5f97f7f | 2006-09-25 23:32:13 -0700 | [diff] [blame] | 22 | |
David Brownell | a3d912c8 | 2007-01-23 20:14:02 -0800 | [diff] [blame^] | 23 | |
| 24 | #define SW2_DEFAULT /* MMCI and UART_A available */ |
| 25 | |
Haavard Skinnemoen | c164b90 | 2006-12-04 14:08:39 +0100 | [diff] [blame] | 26 | struct eth_addr { |
| 27 | u8 addr[6]; |
| 28 | }; |
| 29 | |
| 30 | static struct eth_addr __initdata hw_addr[2]; |
| 31 | |
Haavard Skinnemoen | a6f92f3 | 2006-12-04 13:58:27 +0100 | [diff] [blame] | 32 | static struct eth_platform_data __initdata eth_data[2]; |
Haavard Skinnemoen | 5f97f7f | 2006-09-25 23:32:13 -0700 | [diff] [blame] | 33 | extern struct lcdc_platform_data atstk1000_fb0_data; |
| 34 | |
Haavard Skinnemoen | c164b90 | 2006-12-04 14:08:39 +0100 | [diff] [blame] | 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 | */ |
Haavard Skinnemoen | a6f92f3 | 2006-12-04 13:58:27 +0100 | [diff] [blame] | 43 | static int __init parse_tag_ethernet(struct tag *tag) |
| 44 | { |
| 45 | int i; |
| 46 | |
| 47 | i = tag->u.ethernet.mac_index; |
Haavard Skinnemoen | c164b90 | 2006-12-04 14:08:39 +0100 | [diff] [blame] | 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 | |
Haavard Skinnemoen | a6f92f3 | 2006-12-04 13:58:27 +0100 | [diff] [blame] | 52 | return 0; |
| 53 | } |
| 54 | __tagtable(ATAG_ETHERNET, parse_tag_ethernet); |
| 55 | |
Haavard Skinnemoen | c164b90 | 2006-12-04 14:08:39 +0100 | [diff] [blame] | 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 | |
Haavard Skinnemoen | c194588 | 2006-10-04 16:02:10 +0200 | [diff] [blame] | 90 | void __init setup_board(void) |
| 91 | { |
David Brownell | a3d912c8 | 2007-01-23 20:14:02 -0800 | [diff] [blame^] | 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 */ |
Haavard Skinnemoen | c194588 | 2006-10-04 16:02:10 +0200 | [diff] [blame] | 99 | |
| 100 | at32_setup_serial_console(0); |
| 101 | } |
| 102 | |
Haavard Skinnemoen | 5f97f7f | 2006-09-25 23:32:13 -0700 | [diff] [blame] | 103 | static int __init atstk1002_init(void) |
| 104 | { |
| 105 | at32_add_system_devices(); |
| 106 | |
David Brownell | a3d912c8 | 2007-01-23 20:14:02 -0800 | [diff] [blame^] | 107 | #ifdef SW2_DEFAULT |
Haavard Skinnemoen | c194588 | 2006-10-04 16:02:10 +0200 | [diff] [blame] | 108 | at32_add_device_usart(0); |
David Brownell | a3d912c8 | 2007-01-23 20:14:02 -0800 | [diff] [blame^] | 109 | #else |
Haavard Skinnemoen | c194588 | 2006-10-04 16:02:10 +0200 | [diff] [blame] | 110 | at32_add_device_usart(1); |
David Brownell | a3d912c8 | 2007-01-23 20:14:02 -0800 | [diff] [blame^] | 111 | #endif |
Haavard Skinnemoen | c194588 | 2006-10-04 16:02:10 +0200 | [diff] [blame] | 112 | at32_add_device_usart(2); |
Haavard Skinnemoen | 5f97f7f | 2006-09-25 23:32:13 -0700 | [diff] [blame] | 113 | |
Haavard Skinnemoen | c164b90 | 2006-12-04 14:08:39 +0100 | [diff] [blame] | 114 | set_hw_addr(at32_add_device_eth(0, ð_data[0])); |
Haavard Skinnemoen | a6f92f3 | 2006-12-04 13:58:27 +0100 | [diff] [blame] | 115 | |
Haavard Skinnemoen | 5f97f7f | 2006-09-25 23:32:13 -0700 | [diff] [blame] | 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); |