diff options
Diffstat (limited to 'drivers/mfd/ab8500-sysctrl.c')
-rw-r--r-- | drivers/mfd/ab8500-sysctrl.c | 98 |
1 files changed, 87 insertions, 11 deletions
diff --git a/drivers/mfd/ab8500-sysctrl.c b/drivers/mfd/ab8500-sysctrl.c index 108fd86552f0..272479cdb107 100644 --- a/drivers/mfd/ab8500-sysctrl.c +++ b/drivers/mfd/ab8500-sysctrl.c | |||
@@ -15,19 +15,30 @@ | |||
15 | #include <linux/mfd/abx500/ab8500.h> | 15 | #include <linux/mfd/abx500/ab8500.h> |
16 | #include <linux/mfd/abx500/ab8500-sysctrl.h> | 16 | #include <linux/mfd/abx500/ab8500-sysctrl.h> |
17 | 17 | ||
18 | /* RtcCtrl bits */ | ||
19 | #define AB8500_ALARM_MIN_LOW 0x08 | ||
20 | #define AB8500_ALARM_MIN_MID 0x09 | ||
21 | #define RTC_CTRL 0x0B | ||
22 | #define RTC_ALARM_ENABLE 0x4 | ||
23 | |||
18 | static struct device *sysctrl_dev; | 24 | static struct device *sysctrl_dev; |
19 | 25 | ||
20 | void ab8500_power_off(void) | 26 | void ab8500_power_off(void) |
21 | { | 27 | { |
22 | sigset_t old; | 28 | sigset_t old; |
23 | sigset_t all; | 29 | sigset_t all; |
24 | static char *pss[] = {"ab8500_ac", "ab8500_usb"}; | 30 | static char *pss[] = {"ab8500_ac", "pm2301", "ab8500_usb"}; |
25 | int i; | 31 | int i; |
26 | bool charger_present = false; | 32 | bool charger_present = false; |
27 | union power_supply_propval val; | 33 | union power_supply_propval val; |
28 | struct power_supply *psy; | 34 | struct power_supply *psy; |
29 | int ret; | 35 | int ret; |
30 | 36 | ||
37 | if (sysctrl_dev == NULL) { | ||
38 | pr_err("%s: sysctrl not initialized\n", __func__); | ||
39 | return; | ||
40 | } | ||
41 | |||
31 | /* | 42 | /* |
32 | * If we have a charger connected and we're powering off, | 43 | * If we have a charger connected and we're powering off, |
33 | * reboot into charge-only mode. | 44 | * reboot into charge-only mode. |
@@ -74,6 +85,63 @@ shutdown: | |||
74 | } | 85 | } |
75 | } | 86 | } |
76 | 87 | ||
88 | /* | ||
89 | * Use the AB WD to reset the platform. It will perform a hard | ||
90 | * reset instead of a soft reset. Write the reset reason to | ||
91 | * the AB before reset, which can be read upon restart. | ||
92 | */ | ||
93 | void ab8500_restart(char mode, const char *cmd) | ||
94 | { | ||
95 | struct ab8500_platform_data *plat; | ||
96 | struct ab8500_sysctrl_platform_data *pdata; | ||
97 | u16 reason = 0; | ||
98 | u8 val; | ||
99 | |||
100 | if (sysctrl_dev == NULL) { | ||
101 | pr_err("%s: sysctrl not initialized\n", __func__); | ||
102 | return; | ||
103 | } | ||
104 | |||
105 | plat = dev_get_platdata(sysctrl_dev->parent); | ||
106 | pdata = plat->sysctrl; | ||
107 | if (pdata->reboot_reason_code) | ||
108 | reason = pdata->reboot_reason_code(cmd); | ||
109 | else | ||
110 | pr_warn("[%s] No reboot reason set. Default reason %d\n", | ||
111 | __func__, reason); | ||
112 | |||
113 | /* | ||
114 | * Disable RTC alarm, just a precaution so that no alarm | ||
115 | * is running when WD reset is executed. | ||
116 | */ | ||
117 | abx500_get_register_interruptible(sysctrl_dev, AB8500_RTC, | ||
118 | RTC_CTRL , &val); | ||
119 | abx500_set_register_interruptible(sysctrl_dev, AB8500_RTC, | ||
120 | RTC_CTRL , (val & ~RTC_ALARM_ENABLE)); | ||
121 | |||
122 | /* | ||
123 | * Android is not using the RTC alarm registers during reboot | ||
124 | * so we borrow them for writing the reason of reset | ||
125 | */ | ||
126 | |||
127 | /* reason[8 LSB] */ | ||
128 | val = reason & 0xFF; | ||
129 | abx500_set_register_interruptible(sysctrl_dev, AB8500_RTC, | ||
130 | AB8500_ALARM_MIN_LOW , val); | ||
131 | |||
132 | /* reason[8 MSB] */ | ||
133 | val = (reason>>8) & 0xFF; | ||
134 | abx500_set_register_interruptible(sysctrl_dev, AB8500_RTC, | ||
135 | AB8500_ALARM_MIN_MID , val); | ||
136 | |||
137 | /* Setting WD timeout to 0 */ | ||
138 | ab8500_sysctrl_write(AB8500_MAINWDOGTIMER, 0xFF, 0x0); | ||
139 | |||
140 | /* Setting the parameters to AB8500 WD*/ | ||
141 | ab8500_sysctrl_write(AB8500_MAINWDOGCTRL, 0xFF, (AB8500_ENABLE_WD | | ||
142 | AB8500_WD_RESTART_ON_EXPIRE | AB8500_KICK_WD)); | ||
143 | } | ||
144 | |||
77 | static inline bool valid_bank(u8 bank) | 145 | static inline bool valid_bank(u8 bank) |
78 | { | 146 | { |
79 | return ((bank == AB8500_SYS_CTRL1_BLOCK) || | 147 | return ((bank == AB8500_SYS_CTRL1_BLOCK) || |
@@ -85,7 +153,7 @@ int ab8500_sysctrl_read(u16 reg, u8 *value) | |||
85 | u8 bank; | 153 | u8 bank; |
86 | 154 | ||
87 | if (sysctrl_dev == NULL) | 155 | if (sysctrl_dev == NULL) |
88 | return -EAGAIN; | 156 | return -EINVAL; |
89 | 157 | ||
90 | bank = (reg >> 8); | 158 | bank = (reg >> 8); |
91 | if (!valid_bank(bank)) | 159 | if (!valid_bank(bank)) |
@@ -101,7 +169,7 @@ int ab8500_sysctrl_write(u16 reg, u8 mask, u8 value) | |||
101 | u8 bank; | 169 | u8 bank; |
102 | 170 | ||
103 | if (sysctrl_dev == NULL) | 171 | if (sysctrl_dev == NULL) |
104 | return -EAGAIN; | 172 | return -EINVAL; |
105 | 173 | ||
106 | bank = (reg >> 8); | 174 | bank = (reg >> 8); |
107 | if (!valid_bank(bank)) | 175 | if (!valid_bank(bank)) |
@@ -114,28 +182,36 @@ EXPORT_SYMBOL(ab8500_sysctrl_write); | |||
114 | 182 | ||
115 | static int ab8500_sysctrl_probe(struct platform_device *pdev) | 183 | static int ab8500_sysctrl_probe(struct platform_device *pdev) |
116 | { | 184 | { |
185 | struct ab8500 *ab8500 = dev_get_drvdata(pdev->dev.parent); | ||
117 | struct ab8500_platform_data *plat; | 186 | struct ab8500_platform_data *plat; |
118 | struct ab8500_sysctrl_platform_data *pdata; | 187 | struct ab8500_sysctrl_platform_data *pdata; |
119 | 188 | ||
120 | sysctrl_dev = &pdev->dev; | ||
121 | plat = dev_get_platdata(pdev->dev.parent); | 189 | plat = dev_get_platdata(pdev->dev.parent); |
190 | |||
191 | if (!(plat && plat->sysctrl)) | ||
192 | return -EINVAL; | ||
193 | |||
122 | if (plat->pm_power_off) | 194 | if (plat->pm_power_off) |
123 | pm_power_off = ab8500_power_off; | 195 | pm_power_off = ab8500_power_off; |
124 | 196 | ||
125 | pdata = plat->sysctrl; | 197 | pdata = plat->sysctrl; |
126 | 198 | ||
127 | if (pdata) { | 199 | if (pdata) { |
128 | int ret, i, j; | 200 | int last, ret, i, j; |
201 | |||
202 | if (is_ab8505(ab8500)) | ||
203 | last = AB8500_SYSCLKREQ4RFCLKBUF; | ||
204 | else | ||
205 | last = AB8500_SYSCLKREQ8RFCLKBUF; | ||
129 | 206 | ||
130 | for (i = AB8500_SYSCLKREQ1RFCLKBUF; | 207 | for (i = AB8500_SYSCLKREQ1RFCLKBUF; i <= last; i++) { |
131 | i <= AB8500_SYSCLKREQ8RFCLKBUF; i++) { | ||
132 | j = i - AB8500_SYSCLKREQ1RFCLKBUF; | 208 | j = i - AB8500_SYSCLKREQ1RFCLKBUF; |
133 | ret = ab8500_sysctrl_write(i, 0xff, | 209 | ret = ab8500_sysctrl_write(i, 0xff, |
134 | pdata->initial_req_buf_config[j]); | 210 | pdata->initial_req_buf_config[j]); |
135 | dev_dbg(&pdev->dev, | 211 | dev_dbg(&pdev->dev, |
136 | "Setting SysClkReq%dRfClkBuf 0x%X\n", | 212 | "Setting SysClkReq%dRfClkBuf 0x%X\n", |
137 | j + 1, | 213 | j + 1, |
138 | pdata->initial_req_buf_config[j]); | 214 | pdata->initial_req_buf_config[j]); |
139 | if (ret < 0) { | 215 | if (ret < 0) { |
140 | dev_err(&pdev->dev, | 216 | dev_err(&pdev->dev, |
141 | "unable to set sysClkReq%dRfClkBuf: " | 217 | "unable to set sysClkReq%dRfClkBuf: " |