diff options
author | Ingo Molnar <mingo@elte.hu> | 2009-06-17 02:59:01 -0400 |
---|---|---|
committer | Ingo Molnar <mingo@elte.hu> | 2009-06-17 02:59:10 -0400 |
commit | cc4949e1fdade5d063e9f8783cf0e2cc92041ce5 (patch) | |
tree | 4023bd641bfe464efbde518fb504d6865c9df014 /arch/arm/mach-davinci/common.c | |
parent | 28b4868820a56de661f54742ff91b78e12f1e582 (diff) | |
parent | 300df7dc89cc276377fc020704e34875d5c473b6 (diff) |
Merge branch 'linus' into x86/urgent
Merge reason: pull in latest to fix a bug in it.
Signed-off-by: Ingo Molnar <mingo@elte.hu>
Diffstat (limited to 'arch/arm/mach-davinci/common.c')
-rw-r--r-- | arch/arm/mach-davinci/common.c | 108 |
1 files changed, 108 insertions, 0 deletions
diff --git a/arch/arm/mach-davinci/common.c b/arch/arm/mach-davinci/common.c new file mode 100644 index 000000000000..61ede19c6b54 --- /dev/null +++ b/arch/arm/mach-davinci/common.c | |||
@@ -0,0 +1,108 @@ | |||
1 | /* | ||
2 | * Code commons to all DaVinci SoCs. | ||
3 | * | ||
4 | * Author: Mark A. Greer <mgreer@mvista.com> | ||
5 | * | ||
6 | * 2009 (c) MontaVista Software, Inc. This file is licensed under | ||
7 | * the terms of the GNU General Public License version 2. This program | ||
8 | * is licensed "as is" without any warranty of any kind, whether express | ||
9 | * or implied. | ||
10 | */ | ||
11 | #include <linux/module.h> | ||
12 | #include <linux/io.h> | ||
13 | #include <linux/etherdevice.h> | ||
14 | |||
15 | #include <asm/tlb.h> | ||
16 | #include <asm/mach/map.h> | ||
17 | |||
18 | #include <mach/common.h> | ||
19 | #include <mach/cputype.h> | ||
20 | #include <mach/emac.h> | ||
21 | |||
22 | #include "clock.h" | ||
23 | |||
24 | struct davinci_soc_info davinci_soc_info; | ||
25 | EXPORT_SYMBOL(davinci_soc_info); | ||
26 | |||
27 | void __iomem *davinci_intc_base; | ||
28 | int davinci_intc_type; | ||
29 | |||
30 | void davinci_get_mac_addr(struct memory_accessor *mem_acc, void *context) | ||
31 | { | ||
32 | char *mac_addr = davinci_soc_info.emac_pdata->mac_addr; | ||
33 | off_t offset = (off_t)context; | ||
34 | |||
35 | /* Read MAC addr from EEPROM */ | ||
36 | if (mem_acc->read(mem_acc, mac_addr, offset, ETH_ALEN) == ETH_ALEN) | ||
37 | pr_info("Read MAC addr from EEPROM: %pM\n", mac_addr); | ||
38 | } | ||
39 | |||
40 | static struct davinci_id * __init davinci_get_id(u32 jtag_id) | ||
41 | { | ||
42 | int i; | ||
43 | struct davinci_id *dip; | ||
44 | u8 variant = (jtag_id & 0xf0000000) >> 28; | ||
45 | u16 part_no = (jtag_id & 0x0ffff000) >> 12; | ||
46 | |||
47 | for (i = 0, dip = davinci_soc_info.ids; i < davinci_soc_info.ids_num; | ||
48 | i++, dip++) | ||
49 | /* Don't care about the manufacturer right now */ | ||
50 | if ((dip->part_no == part_no) && (dip->variant == variant)) | ||
51 | return dip; | ||
52 | |||
53 | return NULL; | ||
54 | } | ||
55 | |||
56 | void __init davinci_common_init(struct davinci_soc_info *soc_info) | ||
57 | { | ||
58 | int ret; | ||
59 | struct davinci_id *dip; | ||
60 | |||
61 | if (!soc_info) { | ||
62 | ret = -EINVAL; | ||
63 | goto err; | ||
64 | } | ||
65 | |||
66 | memcpy(&davinci_soc_info, soc_info, sizeof(struct davinci_soc_info)); | ||
67 | |||
68 | if (davinci_soc_info.io_desc && (davinci_soc_info.io_desc_num > 0)) | ||
69 | iotable_init(davinci_soc_info.io_desc, | ||
70 | davinci_soc_info.io_desc_num); | ||
71 | |||
72 | /* | ||
73 | * Normally devicemaps_init() would flush caches and tlb after | ||
74 | * mdesc->map_io(), but we must also do it here because of the CPU | ||
75 | * revision check below. | ||
76 | */ | ||
77 | local_flush_tlb_all(); | ||
78 | flush_cache_all(); | ||
79 | |||
80 | /* | ||
81 | * We want to check CPU revision early for cpu_is_xxxx() macros. | ||
82 | * IO space mapping must be initialized before we can do that. | ||
83 | */ | ||
84 | davinci_soc_info.jtag_id = __raw_readl(davinci_soc_info.jtag_id_base); | ||
85 | |||
86 | dip = davinci_get_id(davinci_soc_info.jtag_id); | ||
87 | if (!dip) { | ||
88 | ret = -EINVAL; | ||
89 | goto err; | ||
90 | } | ||
91 | |||
92 | davinci_soc_info.cpu_id = dip->cpu_id; | ||
93 | pr_info("DaVinci %s variant 0x%x\n", dip->name, dip->variant); | ||
94 | |||
95 | if (davinci_soc_info.cpu_clks) { | ||
96 | ret = davinci_clk_init(davinci_soc_info.cpu_clks); | ||
97 | |||
98 | if (ret != 0) | ||
99 | goto err; | ||
100 | } | ||
101 | |||
102 | davinci_intc_base = davinci_soc_info.intc_base; | ||
103 | davinci_intc_type = davinci_soc_info.intc_type; | ||
104 | return; | ||
105 | |||
106 | err: | ||
107 | pr_err("davinci_common_init: SoC Initialization failed\n"); | ||
108 | } | ||