2 * Copyright (C) 2007 Atmel Corporation.
3 * Copyright (C) 2011 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
8 #include <linux/module.h>
12 #include <linux/of_address.h>
14 #include <asm/system_misc.h>
15 #include <asm/mach/map.h>
17 #include <mach/hardware.h>
19 #include <mach/at91_dbgu.h>
20 #include <mach/at91_pmc.h>
21 #include <mach/at91_shdwc.h>
26 struct at91_init_soc __initdata at91_boot_soc
;
28 struct at91_socinfo at91_soc_initdata
;
29 EXPORT_SYMBOL(at91_soc_initdata
);
31 void __init
at91rm9200_set_type(int type
)
33 if (type
== ARCH_REVISON_9200_PQFP
)
34 at91_soc_initdata
.subtype
= AT91_SOC_RM9200_PQFP
;
36 at91_soc_initdata
.subtype
= AT91_SOC_RM9200_BGA
;
38 pr_info("AT91: filled in soc subtype: %s\n",
39 at91_get_soc_subtype(&at91_soc_initdata
));
42 void __init
at91_init_irq_default(void)
44 at91_init_interrupts(at91_boot_soc
.default_irq_priority
);
47 void __init
at91_init_interrupts(unsigned int *priority
)
49 /* Initialize the AIC interrupt controller */
50 at91_aic_init(priority
);
52 /* Enable GPIO interrupts */
53 at91_gpio_irq_setup();
56 void __iomem
*at91_ramc_base
[2];
57 EXPORT_SYMBOL_GPL(at91_ramc_base
);
59 void __init
at91_ioremap_ramc(int id
, u32 addr
, u32 size
)
61 if (id
< 0 || id
> 1) {
62 pr_emerg("Wrong RAM controller id (%d), cannot continue\n", id
);
65 at91_ramc_base
[id
] = ioremap(addr
, size
);
66 if (!at91_ramc_base
[id
])
67 panic("Impossible to ioremap ramc.%d 0x%x\n", id
, addr
);
70 static struct map_desc sram_desc
[2] __initdata
;
72 void __init
at91_init_sram(int bank
, unsigned long base
, unsigned int length
)
74 struct map_desc
*desc
= &sram_desc
[bank
];
76 desc
->virtual = AT91_IO_VIRT_BASE
- length
;
78 desc
->virtual -= sram_desc
[bank
- 1].length
;
80 desc
->pfn
= __phys_to_pfn(base
);
81 desc
->length
= length
;
82 desc
->type
= MT_DEVICE
;
84 pr_info("AT91: sram at 0x%lx of 0x%x mapped at 0x%lx\n",
85 base
, length
, desc
->virtual);
87 iotable_init(desc
, 1);
90 static struct map_desc at91_io_desc __initdata
= {
91 .virtual = AT91_VA_BASE_SYS
,
92 .pfn
= __phys_to_pfn(AT91_BASE_SYS
),
97 static void __init
soc_detect(u32 dbgu_base
)
101 cidr
= __raw_readl(AT91_IO_P2V(dbgu_base
) + AT91_DBGU_CIDR
);
102 socid
= cidr
& ~AT91_CIDR_VERSION
;
105 case ARCH_ID_AT91RM9200
:
106 at91_soc_initdata
.type
= AT91_SOC_RM9200
;
107 at91_boot_soc
= at91rm9200_soc
;
110 case ARCH_ID_AT91SAM9260
:
111 at91_soc_initdata
.type
= AT91_SOC_SAM9260
;
112 at91_boot_soc
= at91sam9260_soc
;
115 case ARCH_ID_AT91SAM9261
:
116 at91_soc_initdata
.type
= AT91_SOC_SAM9261
;
117 at91_boot_soc
= at91sam9261_soc
;
120 case ARCH_ID_AT91SAM9263
:
121 at91_soc_initdata
.type
= AT91_SOC_SAM9263
;
122 at91_boot_soc
= at91sam9263_soc
;
125 case ARCH_ID_AT91SAM9G20
:
126 at91_soc_initdata
.type
= AT91_SOC_SAM9G20
;
127 at91_boot_soc
= at91sam9260_soc
;
130 case ARCH_ID_AT91SAM9G45
:
131 at91_soc_initdata
.type
= AT91_SOC_SAM9G45
;
132 if (cidr
== ARCH_ID_AT91SAM9G45ES
)
133 at91_soc_initdata
.subtype
= AT91_SOC_SAM9G45ES
;
134 at91_boot_soc
= at91sam9g45_soc
;
137 case ARCH_ID_AT91SAM9RL64
:
138 at91_soc_initdata
.type
= AT91_SOC_SAM9RL
;
139 at91_boot_soc
= at91sam9rl_soc
;
142 case ARCH_ID_AT91SAM9X5
:
143 at91_soc_initdata
.type
= AT91_SOC_SAM9X5
;
144 at91_boot_soc
= at91sam9x5_soc
;
149 if ((cidr
& ~AT91_CIDR_EXT
) == ARCH_ID_AT91SAM9G10
) {
150 at91_soc_initdata
.type
= AT91_SOC_SAM9G10
;
151 at91_boot_soc
= at91sam9261_soc
;
154 else if ((cidr
& AT91_CIDR_ARCH
) == ARCH_FAMILY_AT91SAM9XE
) {
155 at91_soc_initdata
.type
= AT91_SOC_SAM9260
;
156 at91_soc_initdata
.subtype
= AT91_SOC_SAM9XE
;
157 at91_boot_soc
= at91sam9260_soc
;
160 if (!at91_soc_is_detected())
163 at91_soc_initdata
.cidr
= cidr
;
165 /* sub version of soc */
166 at91_soc_initdata
.exid
= __raw_readl(AT91_IO_P2V(dbgu_base
) + AT91_DBGU_EXID
);
168 if (at91_soc_initdata
.type
== AT91_SOC_SAM9G45
) {
169 switch (at91_soc_initdata
.exid
) {
170 case ARCH_EXID_AT91SAM9M10
:
171 at91_soc_initdata
.subtype
= AT91_SOC_SAM9M10
;
173 case ARCH_EXID_AT91SAM9G46
:
174 at91_soc_initdata
.subtype
= AT91_SOC_SAM9G46
;
176 case ARCH_EXID_AT91SAM9M11
:
177 at91_soc_initdata
.subtype
= AT91_SOC_SAM9M11
;
182 if (at91_soc_initdata
.type
== AT91_SOC_SAM9X5
) {
183 switch (at91_soc_initdata
.exid
) {
184 case ARCH_EXID_AT91SAM9G15
:
185 at91_soc_initdata
.subtype
= AT91_SOC_SAM9G15
;
187 case ARCH_EXID_AT91SAM9G35
:
188 at91_soc_initdata
.subtype
= AT91_SOC_SAM9G35
;
190 case ARCH_EXID_AT91SAM9X35
:
191 at91_soc_initdata
.subtype
= AT91_SOC_SAM9X35
;
193 case ARCH_EXID_AT91SAM9G25
:
194 at91_soc_initdata
.subtype
= AT91_SOC_SAM9G25
;
196 case ARCH_EXID_AT91SAM9X25
:
197 at91_soc_initdata
.subtype
= AT91_SOC_SAM9X25
;
203 static const char *soc_name
[] = {
204 [AT91_SOC_RM9200
] = "at91rm9200",
205 [AT91_SOC_SAM9260
] = "at91sam9260",
206 [AT91_SOC_SAM9261
] = "at91sam9261",
207 [AT91_SOC_SAM9263
] = "at91sam9263",
208 [AT91_SOC_SAM9G10
] = "at91sam9g10",
209 [AT91_SOC_SAM9G20
] = "at91sam9g20",
210 [AT91_SOC_SAM9G45
] = "at91sam9g45",
211 [AT91_SOC_SAM9RL
] = "at91sam9rl",
212 [AT91_SOC_SAM9X5
] = "at91sam9x5",
213 [AT91_SOC_NONE
] = "Unknown"
216 const char *at91_get_soc_type(struct at91_socinfo
*c
)
218 return soc_name
[c
->type
];
220 EXPORT_SYMBOL(at91_get_soc_type
);
222 static const char *soc_subtype_name
[] = {
223 [AT91_SOC_RM9200_BGA
] = "at91rm9200 BGA",
224 [AT91_SOC_RM9200_PQFP
] = "at91rm9200 PQFP",
225 [AT91_SOC_SAM9XE
] = "at91sam9xe",
226 [AT91_SOC_SAM9G45ES
] = "at91sam9g45es",
227 [AT91_SOC_SAM9M10
] = "at91sam9m10",
228 [AT91_SOC_SAM9G46
] = "at91sam9g46",
229 [AT91_SOC_SAM9M11
] = "at91sam9m11",
230 [AT91_SOC_SAM9G15
] = "at91sam9g15",
231 [AT91_SOC_SAM9G35
] = "at91sam9g35",
232 [AT91_SOC_SAM9X35
] = "at91sam9x35",
233 [AT91_SOC_SAM9G25
] = "at91sam9g25",
234 [AT91_SOC_SAM9X25
] = "at91sam9x25",
235 [AT91_SOC_SUBTYPE_NONE
] = "Unknown"
238 const char *at91_get_soc_subtype(struct at91_socinfo
*c
)
240 return soc_subtype_name
[c
->subtype
];
242 EXPORT_SYMBOL(at91_get_soc_subtype
);
244 void __init
at91_map_io(void)
246 /* Map peripherals */
247 iotable_init(&at91_io_desc
, 1);
249 at91_soc_initdata
.type
= AT91_SOC_NONE
;
250 at91_soc_initdata
.subtype
= AT91_SOC_SUBTYPE_NONE
;
252 soc_detect(AT91_BASE_DBGU0
);
253 if (!at91_soc_is_detected())
254 soc_detect(AT91_BASE_DBGU1
);
256 if (!at91_soc_is_detected())
257 panic("AT91: Impossible to detect the SOC type");
259 pr_info("AT91: Detected soc type: %s\n",
260 at91_get_soc_type(&at91_soc_initdata
));
261 pr_info("AT91: Detected soc subtype: %s\n",
262 at91_get_soc_subtype(&at91_soc_initdata
));
264 if (!at91_soc_is_enabled())
265 panic("AT91: Soc not enabled");
267 if (at91_boot_soc
.map_io
)
268 at91_boot_soc
.map_io();
271 void __iomem
*at91_shdwc_base
= NULL
;
273 static void at91sam9_poweroff(void)
275 at91_shdwc_write(AT91_SHDW_CR
, AT91_SHDW_KEY
| AT91_SHDW_SHDW
);
278 void __init
at91_ioremap_shdwc(u32 base_addr
)
280 at91_shdwc_base
= ioremap(base_addr
, 16);
281 if (!at91_shdwc_base
)
282 panic("Impossible to ioremap at91_shdwc_base\n");
283 pm_power_off
= at91sam9_poweroff
;
286 void __iomem
*at91_rstc_base
;
288 void __init
at91_ioremap_rstc(u32 base_addr
)
290 at91_rstc_base
= ioremap(base_addr
, 16);
292 panic("Impossible to ioremap at91_rstc_base\n");
295 void __iomem
*at91_matrix_base
;
297 void __init
at91_ioremap_matrix(u32 base_addr
)
299 at91_matrix_base
= ioremap(base_addr
, 512);
300 if (!at91_matrix_base
)
301 panic("Impossible to ioremap at91_matrix_base\n");
304 #if defined(CONFIG_OF)
305 static struct of_device_id rstc_ids
[] = {
306 { .compatible
= "atmel,at91sam9260-rstc", .data
= at91sam9_alt_restart
},
307 { .compatible
= "atmel,at91sam9g45-rstc", .data
= at91sam9g45_restart
},
311 static void at91_dt_rstc(void)
313 struct device_node
*np
;
314 const struct of_device_id
*of_id
;
316 np
= of_find_matching_node(NULL
, rstc_ids
);
318 panic("unable to find compatible rstc node in dtb\n");
320 at91_rstc_base
= of_iomap(np
, 0);
322 panic("unable to map rstc cpu registers\n");
324 of_id
= of_match_node(rstc_ids
, np
);
326 panic("AT91: rtsc no restart function availlable\n");
328 arm_pm_restart
= of_id
->data
;
333 static struct of_device_id ramc_ids
[] = {
334 { .compatible
= "atmel,at91sam9260-sdramc" },
335 { .compatible
= "atmel,at91sam9g45-ddramc" },
339 static void at91_dt_ramc(void)
341 struct device_node
*np
;
343 np
= of_find_matching_node(NULL
, ramc_ids
);
345 panic("unable to find compatible ram conroller node in dtb\n");
347 at91_ramc_base
[0] = of_iomap(np
, 0);
348 if (!at91_ramc_base
[0])
349 panic("unable to map ramc[0] cpu registers\n");
350 /* the controller may have 2 banks */
351 at91_ramc_base
[1] = of_iomap(np
, 1);
356 static struct of_device_id shdwc_ids
[] = {
357 { .compatible
= "atmel,at91sam9260-shdwc", },
358 { .compatible
= "atmel,at91sam9rl-shdwc", },
359 { .compatible
= "atmel,at91sam9x5-shdwc", },
363 static const char *shdwc_wakeup_modes
[] = {
364 [AT91_SHDW_WKMODE0_NONE
] = "none",
365 [AT91_SHDW_WKMODE0_HIGH
] = "high",
366 [AT91_SHDW_WKMODE0_LOW
] = "low",
367 [AT91_SHDW_WKMODE0_ANYLEVEL
] = "any",
370 const int at91_dtget_shdwc_wakeup_mode(struct device_node
*np
)
375 err
= of_property_read_string(np
, "atmel,wakeup-mode", &pm
);
377 return AT91_SHDW_WKMODE0_ANYLEVEL
;
379 for (i
= 0; i
< ARRAY_SIZE(shdwc_wakeup_modes
); i
++)
380 if (!strcasecmp(pm
, shdwc_wakeup_modes
[i
]))
386 static void at91_dt_shdwc(void)
388 struct device_node
*np
;
393 np
= of_find_matching_node(NULL
, shdwc_ids
);
395 pr_debug("AT91: unable to find compatible shutdown (shdwc) conroller node in dtb\n");
399 at91_shdwc_base
= of_iomap(np
, 0);
400 if (!at91_shdwc_base
)
401 panic("AT91: unable to map shdwc cpu registers\n");
403 wakeup_mode
= at91_dtget_shdwc_wakeup_mode(np
);
404 if (wakeup_mode
< 0) {
405 pr_warn("AT91: shdwc unknown wakeup mode\n");
409 if (!of_property_read_u32(np
, "atmel,wakeup-counter", ®
)) {
410 if (reg
> AT91_SHDW_CPTWK0_MAX
) {
411 pr_warn("AT91: shdwc wakeup conter 0x%x > 0x%x reduce it to 0x%x\n",
412 reg
, AT91_SHDW_CPTWK0_MAX
, AT91_SHDW_CPTWK0_MAX
);
413 reg
= AT91_SHDW_CPTWK0_MAX
;
415 mode
|= AT91_SHDW_CPTWK0_(reg
);
418 if (of_property_read_bool(np
, "atmel,wakeup-rtc-timer"))
419 mode
|= AT91_SHDW_RTCWKEN
;
421 if (of_property_read_bool(np
, "atmel,wakeup-rtt-timer"))
422 mode
|= AT91_SHDW_RTTWKEN
;
424 at91_shdwc_write(AT91_SHDW_MR
, wakeup_mode
| mode
);
427 pm_power_off
= at91sam9_poweroff
;
432 void __init
at91_dt_initialize(void)
438 /* Init clock subsystem */
439 at91_dt_clock_init();
441 /* Register the processor-specific clocks */
442 at91_boot_soc
.register_clocks();
444 at91_boot_soc
.init();
448 void __init
at91_initialize(unsigned long main_clock
)
450 at91_boot_soc
.ioremap_registers();
452 /* Init clock subsystem */
453 at91_clock_init(main_clock
);
455 /* Register the processor-specific clocks */
456 at91_boot_soc
.register_clocks();
458 at91_boot_soc
.init();