Duy Truong | e833aca | 2013-02-12 13:35:08 -0800 | [diff] [blame] | 1 | /* Copyright (c) 2011-2012, The Linux Foundation. All rights reserved. |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 2 | * |
| 3 | * This program is free software; you can redistribute it and/or modify |
| 4 | * it under the terms of the GNU General Public License version 2 and |
| 5 | * only version 2 as published by the Free Software Foundation. |
| 6 | * |
| 7 | * This program is distributed in the hope that it will be useful, |
| 8 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 9 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 10 | * GNU General Public License for more details. |
| 11 | */ |
| 12 | |
| 13 | #include <linux/kernel.h> |
| 14 | #include <linux/interrupt.h> |
| 15 | #include <linux/reboot.h> |
| 16 | #include <linux/workqueue.h> |
| 17 | #include <linux/io.h> |
| 18 | #include <linux/delay.h> |
| 19 | #include <linux/module.h> |
Sameer Thalappil | 409ed35 | 2011-12-07 10:53:31 -0800 | [diff] [blame] | 20 | #include <linux/platform_device.h> |
| 21 | #include <linux/wcnss_wlan.h> |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 22 | #include <linux/err.h> |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 23 | #include <mach/irqs.h> |
| 24 | #include <mach/scm.h> |
| 25 | #include <mach/subsystem_restart.h> |
| 26 | #include <mach/subsystem_notif.h> |
Sameer Thalappil | 7474338 | 2011-11-10 16:38:58 -0800 | [diff] [blame] | 27 | #include <mach/peripheral-loader.h> |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 28 | #include "smd_private.h" |
| 29 | #include "ramdump.h" |
| 30 | |
| 31 | #define MODULE_NAME "wcnss_8960" |
Sunny Kapdi | c6e4288 | 2012-05-30 12:24:48 -0700 | [diff] [blame] | 32 | #define MAX_BUF_SIZE 0x51 |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 33 | |
Sameer Thalappil | 74ce6d0 | 2012-02-22 07:24:51 -0800 | [diff] [blame] | 34 | static struct delayed_work cancel_vote_work; |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 35 | static void *riva_ramdump_dev; |
| 36 | static int riva_crash; |
| 37 | static int ss_restart_inprogress; |
Sameer Thalappil | 7474338 | 2011-11-10 16:38:58 -0800 | [diff] [blame] | 38 | static int enable_riva_ssr; |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 39 | static struct subsys_device *riva_8960_dev; |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 40 | |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 41 | static void smsm_state_cb_hdlr(void *data, uint32_t old_state, |
| 42 | uint32_t new_state) |
| 43 | { |
Sunny Kapdi | c6e4288 | 2012-05-30 12:24:48 -0700 | [diff] [blame] | 44 | char *smem_reset_reason; |
| 45 | char buffer[MAX_BUF_SIZE]; |
| 46 | unsigned smem_reset_size; |
| 47 | unsigned size; |
| 48 | |
Sameer Thalappil | 50d6290 | 2012-06-15 16:05:51 -0700 | [diff] [blame] | 49 | riva_crash = true; |
| 50 | |
| 51 | pr_err("%s: smsm state changed\n", MODULE_NAME); |
| 52 | |
Naresh Jayaram | 1c7a78d | 2013-05-14 12:36:14 +0530 | [diff] [blame] | 53 | wcnss_riva_dump_pmic_regs(); |
| 54 | |
Eric Holmberg | 6866cb7 | 2012-03-05 15:29:44 -0700 | [diff] [blame] | 55 | if (!(new_state & SMSM_RESET)) |
| 56 | return; |
| 57 | |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 58 | if (ss_restart_inprogress) { |
| 59 | pr_err("%s: Ignoring smsm reset req, restart in progress\n", |
| 60 | MODULE_NAME); |
| 61 | return; |
| 62 | } |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 63 | |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 64 | if (!enable_riva_ssr) |
Sameer Thalappil | 50d6290 | 2012-06-15 16:05:51 -0700 | [diff] [blame] | 65 | panic(MODULE_NAME ": SMSM reset request received from Riva"); |
| 66 | |
| 67 | smem_reset_reason = smem_get_entry(SMEM_SSR_REASON_WCNSS0, |
| 68 | &smem_reset_size); |
| 69 | |
| 70 | if (!smem_reset_reason || !smem_reset_size) { |
| 71 | pr_err("%s: wcnss subsystem failure reason: %s\n", |
| 72 | __func__, "(unknown, smem_get_entry failed)"); |
| 73 | } else if (!smem_reset_reason[0]) { |
| 74 | pr_err("%s: wcnss subsystem failure reason: %s\n", |
| 75 | __func__, "(unknown, init string found)"); |
| 76 | } else { |
| 77 | size = smem_reset_size < MAX_BUF_SIZE ? smem_reset_size : |
| 78 | (MAX_BUF_SIZE - 1); |
| 79 | memcpy(buffer, smem_reset_reason, size); |
| 80 | buffer[size] = '\0'; |
| 81 | pr_err("%s: wcnss subsystem failure reason: %s\n", |
| 82 | __func__, buffer); |
| 83 | memset(smem_reset_reason, 0, smem_reset_size); |
| 84 | wmb(); |
| 85 | } |
| 86 | |
| 87 | ss_restart_inprogress = true; |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 88 | subsystem_restart_dev(riva_8960_dev); |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 89 | } |
| 90 | |
| 91 | static irqreturn_t riva_wdog_bite_irq_hdlr(int irq, void *dev_id) |
| 92 | { |
Sameer Thalappil | 50d6290 | 2012-06-15 16:05:51 -0700 | [diff] [blame] | 93 | riva_crash = true; |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 94 | |
| 95 | if (ss_restart_inprogress) { |
| 96 | pr_err("%s: Ignoring riva bite irq, restart in progress\n", |
| 97 | MODULE_NAME); |
| 98 | return IRQ_HANDLED; |
| 99 | } |
Sameer Thalappil | 50d6290 | 2012-06-15 16:05:51 -0700 | [diff] [blame] | 100 | |
| 101 | if (!enable_riva_ssr) |
| 102 | panic(MODULE_NAME ": Watchdog bite received from Riva"); |
| 103 | |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 104 | ss_restart_inprogress = true; |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 105 | subsystem_restart_dev(riva_8960_dev); |
Sameer Thalappil | 50d6290 | 2012-06-15 16:05:51 -0700 | [diff] [blame] | 106 | |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 107 | return IRQ_HANDLED; |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 108 | } |
| 109 | |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 110 | /* SMSM reset Riva */ |
| 111 | static void smsm_riva_reset(void) |
| 112 | { |
| 113 | /* per SS reset request bit is not available now, |
| 114 | * all SS host modules are setting this bit |
| 115 | * This is still under discussion*/ |
| 116 | smsm_change_state(SMSM_APPS_STATE, SMSM_RESET, SMSM_RESET); |
| 117 | } |
| 118 | |
Sameer Thalappil | 74ce6d0 | 2012-02-22 07:24:51 -0800 | [diff] [blame] | 119 | static void riva_post_bootup(struct work_struct *work) |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 120 | { |
Sameer Thalappil | 409ed35 | 2011-12-07 10:53:31 -0800 | [diff] [blame] | 121 | struct platform_device *pdev = wcnss_get_platform_device(); |
| 122 | struct wcnss_wlan_config *pwlanconfig = wcnss_get_wlan_config(); |
Sameer Thalappil | 409ed35 | 2011-12-07 10:53:31 -0800 | [diff] [blame] | 123 | |
Sameer Thalappil | 74ce6d0 | 2012-02-22 07:24:51 -0800 | [diff] [blame] | 124 | pr_debug(MODULE_NAME ": Cancel APPS vote for Iris & Riva\n"); |
| 125 | |
| 126 | wcnss_wlan_power(&pdev->dev, pwlanconfig, |
| 127 | WCNSS_WLAN_SWITCH_OFF); |
| 128 | } |
| 129 | |
| 130 | /* Subsystem handlers */ |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 131 | static int riva_shutdown(const struct subsys_desc *subsys) |
Sameer Thalappil | 74ce6d0 | 2012-02-22 07:24:51 -0800 | [diff] [blame] | 132 | { |
Sameer Thalappil | 7474338 | 2011-11-10 16:38:58 -0800 | [diff] [blame] | 133 | pil_force_shutdown("wcnss"); |
Sameer Thalappil | 74ce6d0 | 2012-02-22 07:24:51 -0800 | [diff] [blame] | 134 | flush_delayed_work(&cancel_vote_work); |
Sameer Thalappil | 13f4518 | 2012-07-23 18:02:45 -0700 | [diff] [blame] | 135 | wcnss_flush_delayed_boot_votes(); |
Sameer Thalappil | 27d3f53 | 2012-03-21 15:02:17 -0700 | [diff] [blame] | 136 | disable_irq_nosync(RIVA_APSS_WDOG_BITE_RESET_RDY_IRQ); |
Sameer Thalappil | 409ed35 | 2011-12-07 10:53:31 -0800 | [diff] [blame] | 137 | |
Sameer Thalappil | 74ce6d0 | 2012-02-22 07:24:51 -0800 | [diff] [blame] | 138 | return 0; |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 139 | } |
| 140 | |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 141 | static int riva_powerup(const struct subsys_desc *subsys) |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 142 | { |
Sameer Thalappil | 409ed35 | 2011-12-07 10:53:31 -0800 | [diff] [blame] | 143 | struct platform_device *pdev = wcnss_get_platform_device(); |
| 144 | struct wcnss_wlan_config *pwlanconfig = wcnss_get_wlan_config(); |
| 145 | int ret = -1; |
| 146 | |
Jeff Johnson | df92998 | 2012-11-02 17:35:26 -0700 | [diff] [blame] | 147 | wcnss_ssr_boot_notify(); |
Mekala Natarajan | f3d7cba | 2012-09-27 22:18:55 -0700 | [diff] [blame] | 148 | |
Sameer Thalappil | 409ed35 | 2011-12-07 10:53:31 -0800 | [diff] [blame] | 149 | if (pdev && pwlanconfig) |
| 150 | ret = wcnss_wlan_power(&pdev->dev, pwlanconfig, |
| 151 | WCNSS_WLAN_SWITCH_ON); |
Sameer Thalappil | 6e727d2 | 2012-02-14 19:37:54 -0800 | [diff] [blame] | 152 | /* delay PIL operation, this SSR may be happening soon after kernel |
| 153 | * resumes because of a SMSM RESET by Riva when APPS was suspended. |
| 154 | * PIL fails to locate the images without this delay */ |
| 155 | if (!ret) { |
| 156 | msleep(1000); |
Sameer Thalappil | 409ed35 | 2011-12-07 10:53:31 -0800 | [diff] [blame] | 157 | pil_force_boot("wcnss"); |
Sameer Thalappil | 6e727d2 | 2012-02-14 19:37:54 -0800 | [diff] [blame] | 158 | } |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 159 | ss_restart_inprogress = false; |
| 160 | enable_irq(RIVA_APSS_WDOG_BITE_RESET_RDY_IRQ); |
Sameer Thalappil | 74ce6d0 | 2012-02-22 07:24:51 -0800 | [diff] [blame] | 161 | schedule_delayed_work(&cancel_vote_work, msecs_to_jiffies(5000)); |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 162 | |
Sameer Thalappil | 409ed35 | 2011-12-07 10:53:31 -0800 | [diff] [blame] | 163 | return ret; |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 164 | } |
| 165 | |
Jeff Johnson | 5398d2b | 2012-10-11 12:09:12 -0700 | [diff] [blame] | 166 | /* 7MB RAM segments for Riva SS; |
| 167 | * Riva 1.1 0x8f000000 - 0x8f700000 |
| 168 | * Riva 1.0 0x8f200000 - 0x8f700000 |
| 169 | */ |
| 170 | static struct ramdump_segment riva_segments[] = {{0x8f000000, |
| 171 | 0x8f700000 - 0x8f000000} }; |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 172 | |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 173 | static int riva_ramdump(int enable, const struct subsys_desc *subsys) |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 174 | { |
| 175 | pr_debug("%s: enable[%d]\n", MODULE_NAME, enable); |
| 176 | if (enable) |
| 177 | return do_ramdump(riva_ramdump_dev, |
| 178 | riva_segments, |
| 179 | ARRAY_SIZE(riva_segments)); |
| 180 | else |
| 181 | return 0; |
| 182 | } |
| 183 | |
| 184 | /* Riva crash handler */ |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 185 | static void riva_crash_shutdown(const struct subsys_desc *subsys) |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 186 | { |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 187 | pr_err("%s: crash shutdown : %d\n", MODULE_NAME, riva_crash); |
Sameer Thalappil | a0c30ae | 2012-08-13 11:13:06 -0700 | [diff] [blame] | 188 | if (riva_crash != true) { |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 189 | smsm_riva_reset(); |
Sameer Thalappil | a0c30ae | 2012-08-13 11:13:06 -0700 | [diff] [blame] | 190 | /* give sufficient time for wcnss to finish it's error |
| 191 | * fatal routine */ |
Jaeseong GIM | 393bd8e | 2012-09-17 17:24:15 +0900 | [diff] [blame] | 192 | mdelay(3000); |
Sameer Thalappil | a0c30ae | 2012-08-13 11:13:06 -0700 | [diff] [blame] | 193 | } |
| 194 | |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 195 | } |
| 196 | |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 197 | static struct subsys_desc riva_8960 = { |
Sameer Thalappil | 3ec03e3 | 2012-10-04 17:22:24 -0700 | [diff] [blame] | 198 | .name = "wcnss", |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 199 | .shutdown = riva_shutdown, |
| 200 | .powerup = riva_powerup, |
| 201 | .ramdump = riva_ramdump, |
| 202 | .crash_shutdown = riva_crash_shutdown |
| 203 | }; |
| 204 | |
Sameer Thalappil | 7474338 | 2011-11-10 16:38:58 -0800 | [diff] [blame] | 205 | static int enable_riva_ssr_set(const char *val, struct kernel_param *kp) |
| 206 | { |
| 207 | int ret; |
| 208 | |
| 209 | ret = param_set_int(val, kp); |
| 210 | if (ret) |
| 211 | return ret; |
| 212 | |
| 213 | if (enable_riva_ssr) |
| 214 | pr_info(MODULE_NAME ": Subsystem restart activated for riva.\n"); |
| 215 | |
| 216 | return 0; |
| 217 | } |
| 218 | |
| 219 | module_param_call(enable_riva_ssr, enable_riva_ssr_set, param_get_int, |
| 220 | &enable_riva_ssr, S_IRUGO | S_IWUSR); |
| 221 | |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 222 | static int __init riva_restart_init(void) |
| 223 | { |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 224 | riva_8960_dev = subsys_register(&riva_8960); |
| 225 | if (IS_ERR(riva_8960_dev)) |
| 226 | return PTR_ERR(riva_8960_dev); |
| 227 | return 0; |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 228 | } |
| 229 | |
| 230 | static int __init riva_ssr_module_init(void) |
| 231 | { |
| 232 | int ret; |
| 233 | |
| 234 | ret = smsm_state_cb_register(SMSM_WCNSS_STATE, SMSM_RESET, |
| 235 | smsm_state_cb_hdlr, 0); |
| 236 | if (ret < 0) { |
Sameer Thalappil | 50d6290 | 2012-06-15 16:05:51 -0700 | [diff] [blame] | 237 | pr_err("%s: Unable to register smsm callback for Riva Reset! %d\n", |
| 238 | MODULE_NAME, ret); |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 239 | goto out; |
| 240 | } |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 241 | ret = request_irq(RIVA_APSS_WDOG_BITE_RESET_RDY_IRQ, |
Sameer Thalappil | c0b5b1b | 2012-11-29 14:10:48 -0800 | [diff] [blame] | 242 | riva_wdog_bite_irq_hdlr, IRQF_TRIGGER_RISING, |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 243 | "riva_wdog", NULL); |
| 244 | |
| 245 | if (ret < 0) { |
Sameer Thalappil | 50d6290 | 2012-06-15 16:05:51 -0700 | [diff] [blame] | 246 | pr_err("%s: Unable to register for Riva bite interrupt (%d)\n", |
| 247 | MODULE_NAME, ret); |
Sameer Thalappil | d87cf66 | 2011-12-12 13:37:31 -0800 | [diff] [blame] | 248 | goto out; |
| 249 | } |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 250 | ret = riva_restart_init(); |
| 251 | if (ret < 0) { |
| 252 | pr_err("%s: Unable to register with ssr. (%d)\n", |
| 253 | MODULE_NAME, ret); |
| 254 | goto out; |
| 255 | } |
| 256 | riva_ramdump_dev = create_ramdump_device("riva"); |
| 257 | if (!riva_ramdump_dev) { |
| 258 | pr_err("%s: Unable to create ramdump device.\n", |
| 259 | MODULE_NAME); |
| 260 | ret = -ENOMEM; |
| 261 | goto out; |
| 262 | } |
Sameer Thalappil | 74ce6d0 | 2012-02-22 07:24:51 -0800 | [diff] [blame] | 263 | INIT_DELAYED_WORK(&cancel_vote_work, riva_post_bootup); |
| 264 | |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 265 | pr_info("%s: module initialized\n", MODULE_NAME); |
| 266 | out: |
| 267 | return ret; |
| 268 | } |
| 269 | |
| 270 | static void __exit riva_ssr_module_exit(void) |
| 271 | { |
Stephen Boyd | 0ebf721 | 2012-04-30 20:42:35 -0700 | [diff] [blame] | 272 | subsys_unregister(riva_8960_dev); |
Ankur Nandwani | e258cf0 | 2011-08-19 10:16:38 -0700 | [diff] [blame] | 273 | free_irq(RIVA_APSS_WDOG_BITE_RESET_RDY_IRQ, NULL); |
| 274 | } |
| 275 | |
| 276 | module_init(riva_ssr_module_init); |
| 277 | module_exit(riva_ssr_module_exit); |
| 278 | |
| 279 | MODULE_LICENSE("GPL v2"); |