]>
Commit | Line | Data |
---|---|---|
abf12d71 RV |
1 | /* |
2 | * Copyright (C) ST-Ericsson SA 2010 | |
3 | * | |
4 | * Author: Rabin Vincent <rabin.vincent@stericsson.com> for ST-Ericsson | |
5 | * License terms: GNU General Public License (GPL) version 2 | |
6 | */ | |
7 | ||
8 | #include <linux/kernel.h> | |
9 | #include <linux/init.h> | |
10 | #include <linux/io.h> | |
11 | ||
12 | #include <asm/cputype.h> | |
13 | #include <asm/tlbflush.h> | |
14 | #include <asm/cacheflush.h> | |
15 | #include <asm/mach/map.h> | |
16 | ||
17 | #include <mach/hardware.h> | |
18 | #include <mach/setup.h> | |
19 | ||
20 | struct dbx500_asic_id dbx500_id; | |
21 | ||
22 | static unsigned int ux500_read_asicid(phys_addr_t addr) | |
23 | { | |
24 | phys_addr_t base = addr & ~0xfff; | |
25 | struct map_desc desc = { | |
26 | .virtual = IO_ADDRESS(base), | |
27 | .pfn = __phys_to_pfn(base), | |
28 | .length = SZ_16K, | |
29 | .type = MT_DEVICE, | |
30 | }; | |
31 | ||
32 | iotable_init(&desc, 1); | |
33 | ||
34 | /* As in devicemaps_init() */ | |
35 | local_flush_tlb_all(); | |
36 | flush_cache_all(); | |
37 | ||
38 | return readl(__io_address(addr)); | |
39 | } | |
40 | ||
41 | static void ux500_print_soc_info(unsigned int asicid) | |
42 | { | |
43 | unsigned int rev = dbx500_revision(); | |
44 | ||
45 | pr_info("DB%4x ", dbx500_partnumber()); | |
46 | ||
47 | if (rev == 0x01) | |
48 | pr_cont("Early Drop"); | |
49 | else if (rev >= 0xA0) | |
50 | pr_cont("v%d.%d" , (rev >> 4) - 0xA + 1, rev & 0xf); | |
51 | else | |
52 | pr_cont("Unknown"); | |
53 | ||
54 | pr_cont(" [%#010x]\n", asicid); | |
55 | } | |
56 | ||
57 | static unsigned int partnumber(unsigned int asicid) | |
58 | { | |
59 | return (asicid >> 8) & 0xffff; | |
60 | } | |
61 | ||
62 | /* | |
63 | * SOC MIDR ASICID ADDRESS ASICID VALUE | |
64 | * DB8500ed 0x410fc090 0x9001FFF4 0x00850001 | |
65 | * DB8500v1 0x411fc091 0x9001FFF4 0x008500A0 | |
66 | * DB8500v1.1 0x411fc091 0x9001FFF4 0x008500A1 | |
67 | * DB8500v2 0x412fc091 0x9001DBF4 0x008500B0 | |
41c34ae4 | 68 | * DB8520v2.2 0x412fc091 0x9001DBF4 0x008500B2 |
abf12d71 RV |
69 | * DB5500v1 0x412fc091 0x9001FFF4 0x005500A0 |
70 | */ | |
71 | ||
72 | void __init ux500_map_io(void) | |
73 | { | |
74 | unsigned int cpuid = read_cpuid_id(); | |
75 | unsigned int asicid = 0; | |
76 | phys_addr_t addr = 0; | |
77 | ||
78 | switch (cpuid) { | |
79 | case 0x410fc090: /* DB8500ed */ | |
80 | case 0x411fc091: /* DB8500v1 */ | |
81 | addr = 0x9001FFF4; | |
82 | break; | |
83 | ||
41c34ae4 | 84 | case 0x412fc091: /* DB8520 / DB8500v2 / DB5500v1 */ |
abf12d71 | 85 | asicid = ux500_read_asicid(0x9001DBF4); |
41c34ae4 RV |
86 | if (partnumber(asicid) == 0x8500 || |
87 | partnumber(asicid) == 0x8520) | |
abf12d71 RV |
88 | /* DB8500v2 */ |
89 | break; | |
90 | ||
91 | /* DB5500v1 */ | |
92 | addr = 0x9001FFF4; | |
93 | break; | |
94 | } | |
95 | ||
96 | if (addr) | |
97 | asicid = ux500_read_asicid(addr); | |
98 | ||
99 | if (!asicid) { | |
100 | pr_err("Unable to identify SoC\n"); | |
101 | ux500_unknown_soc(); | |
102 | } | |
103 | ||
104 | dbx500_id.process = asicid >> 24; | |
105 | dbx500_id.partnumber = partnumber(asicid); | |
106 | dbx500_id.revision = asicid & 0xff; | |
107 | ||
108 | ux500_print_soc_info(asicid); | |
109 | } |