2 * reset controller for CSR SiRFprimaII
4 * Copyright (c) 2011 Cambridge Silicon Radio Limited, a CSR plc group company.
6 * Licensed under GPLv2 or later.
9 #include <linux/kernel.h>
10 #include <linux/mutex.h>
12 #include <linux/delay.h>
13 #include <linux/device.h>
15 #include <linux/of_address.h>
16 #include <linux/platform_device.h>
17 #include <linux/reboot.h>
18 #include <linux/reset-controller.h>
20 #include <asm/system_misc.h>
22 #define SIRFSOC_RSTBIT_NUM 64
24 static void __iomem
*sirfsoc_rstc_base
;
25 static DEFINE_MUTEX(rstc_lock
);
27 static int sirfsoc_reset_module(struct reset_controller_dev
*rcdev
,
28 unsigned long sw_reset_idx
)
30 u32 reset_bit
= sw_reset_idx
;
32 if (reset_bit
>= SIRFSOC_RSTBIT_NUM
)
35 mutex_lock(&rstc_lock
);
37 if (of_device_is_compatible(rcdev
->of_node
, "sirf,prima2-rstc")) {
39 * Writing 1 to this bit resets corresponding block. Writing 0 to this
40 * bit de-asserts reset signal of the corresponding block.
41 * datasheet doesn't require explicit delay between the set and clear
42 * of reset bit. it could be shorter if tests pass.
44 writel(readl(sirfsoc_rstc_base
+ (reset_bit
/ 32) * 4) | (1 << reset_bit
),
45 sirfsoc_rstc_base
+ (reset_bit
/ 32) * 4);
47 writel(readl(sirfsoc_rstc_base
+ (reset_bit
/ 32) * 4) & ~(1 << reset_bit
),
48 sirfsoc_rstc_base
+ (reset_bit
/ 32) * 4);
52 * Writing 1 to SET register resets corresponding block. Writing 1 to CLEAR
53 * register de-asserts reset signal of the corresponding block.
54 * datasheet doesn't require explicit delay between the set and clear
55 * of reset bit. it could be shorter if tests pass.
57 writel(1 << reset_bit
, sirfsoc_rstc_base
+ (reset_bit
/ 32) * 8);
59 writel(1 << reset_bit
, sirfsoc_rstc_base
+ (reset_bit
/ 32) * 8 + 4);
62 mutex_unlock(&rstc_lock
);
67 static struct reset_control_ops sirfsoc_rstc_ops
= {
68 .reset
= sirfsoc_reset_module
,
71 static struct reset_controller_dev sirfsoc_reset_controller
= {
72 .ops
= &sirfsoc_rstc_ops
,
73 .nr_resets
= SIRFSOC_RSTBIT_NUM
,
76 #define SIRFSOC_SYS_RST_BIT BIT(31)
78 static void sirfsoc_restart(enum reboot_mode mode
, const char *cmd
)
80 writel(SIRFSOC_SYS_RST_BIT
, sirfsoc_rstc_base
);
83 static int sirfsoc_rstc_probe(struct platform_device
*pdev
)
85 struct device_node
*np
= pdev
->dev
.of_node
;
86 sirfsoc_rstc_base
= of_iomap(np
, 0);
87 if (!sirfsoc_rstc_base
) {
88 dev_err(&pdev
->dev
, "unable to map rstc cpu registers\n");
92 sirfsoc_reset_controller
.of_node
= np
;
93 arm_pm_restart
= sirfsoc_restart
;
95 if (IS_ENABLED(CONFIG_RESET_CONTROLLER
))
96 reset_controller_register(&sirfsoc_reset_controller
);
101 static const struct of_device_id rstc_ids
[] = {
102 { .compatible
= "sirf,prima2-rstc" },
103 { .compatible
= "sirf,marco-rstc" },
107 static struct platform_driver sirfsoc_rstc_driver
= {
108 .probe
= sirfsoc_rstc_probe
,
110 .name
= "sirfsoc_rstc",
111 .owner
= THIS_MODULE
,
112 .of_match_table
= rstc_ids
,
116 static int __init
sirfsoc_rstc_init(void)
118 return platform_driver_register(&sirfsoc_rstc_driver
);
120 subsys_initcall(sirfsoc_rstc_init
);