static int modem_shutdown(const struct subsys_desc *subsys, bool force_stop)
{
struct modem_data *drv = subsys_to_drv(subsys);
unsigned long ret;
if (subsys->is_not_loadable)
return 0;
if (!subsys_get_crash_status(drv->subsys) && force_stop &&
subsys->force_stop_gpio) {
gpio_set_value(subsys->force_stop_gpio, 1);
ret = wait_for_completion_timeout(&drv->stop_ack,
msecs_to_jiffies(STOP_ACK_TIMEOUT_MS));
if (!ret)
pr_warn("Timed out on stop ack from modem.\n");
gpio_set_value(subsys->force_stop_gpio, 0);
}
if (drv->subsys_desc.ramdump_disable_gpio) {
drv->subsys_desc.ramdump_disable = gpio_get_value(
drv->subsys_desc.ramdump_disable_gpio);
pr_warn("Ramdump disable gpio value is %d\n",
drv->subsys_desc.ramdump_disable);
}
pil_shutdown(&drv->q6->desc);
return 0;
}
static void modem_crash_shutdown(const struct subsys_desc *subsys)
{
struct modem_data *drv = subsys_to_drv(subsys);
drv->crash_shutdown = true;
if (!subsys_get_crash_status(drv->subsys)) {
gpio_set_value(subsys->force_stop_gpio, 1);
mdelay(STOP_ACK_TIMEOUT_MS);
}
}
static void subsys_crash_shutdown(const struct subsys_desc *subsys)
{
struct pil_tz_data *d = subsys_to_data(subsys);
if (subsys->force_stop_gpio > 0 &&
!subsys_get_crash_status(d->subsys)) {
gpio_set_value(subsys->force_stop_gpio, 1);
mdelay(CRASH_STOP_ACK_TO_MS);
}
}
static irqreturn_t subsys_wdog_bite_irq_handler(int irq, void *dev_id)
{
struct pil_tz_data *d = subsys_to_data(dev_id);
pr_err("Watchdog bite received from %s!\n", d->subsys_desc.name);
if (subsys_get_crash_status(d->subsys)) {
pr_err("%s: Ignoring wdog bite IRQ, restart in progress\n",
d->subsys_desc.name);
return IRQ_HANDLED;
}
subsys_set_crash_status(d->subsys, true);
log_failure_reason(d);
subsystem_restart_dev(d->subsys);
return IRQ_HANDLED;
}
static irqreturn_t subsys_err_fatal_intr_handler (int irq, void *dev_id)
{
struct pil_tz_data *d = subsys_to_data(dev_id);
pr_err("Fatal error on %s!\n", d->subsys_desc.name);
if (subsys_get_crash_status(d->subsys)) {
pr_err("%s: Ignoring error fatal, restart in progress\n",
d->subsys_desc.name);
return IRQ_HANDLED;
}
subsys_set_crash_status(d->subsys, true);
log_failure_reason(d);
subsystem_restart_dev(d->subsys);
return IRQ_HANDLED;
}
static int subsys_shutdown(const struct subsys_desc *subsys, bool force_stop)
{
struct pil_tz_data *d = subsys_to_data(subsys);
int ret;
if (!subsys_get_crash_status(d->subsys) && force_stop &&
subsys->force_stop_gpio) {
gpio_set_value(subsys->force_stop_gpio, 1);
ret = wait_for_completion_timeout(&d->stop_ack,
msecs_to_jiffies(STOP_ACK_TIMEOUT_MS));
if (!ret)
pr_warn("Timed out on stop ack from %s.\n",
subsys->name);
gpio_set_value(subsys->force_stop_gpio, 0);
}
pil_shutdown(&d->desc);
return 0;
}
static void modem_crash_shutdown(const struct subsys_desc *subsys)
{
struct modem_data *drv = subsys_to_drv(subsys);
drv->crash_shutdown = true;
#ifdef CONFIG_LGE_HANDLE_PANIC
if (!subsys_get_crash_status(drv->subsys) && (lge_get_modem_panic() != 3)) {
#else
if (!subsys_get_crash_status(drv->subsys)) {
#endif
gpio_set_value(subsys->force_stop_gpio, 1);
mdelay(STOP_ACK_TIMEOUT_MS);
}
}
static int modem_ramdump(int enable, const struct subsys_desc *subsys)
{
struct modem_data *drv = subsys_to_drv(subsys);
int ret;
if (!enable)
return 0;
ret = pil_boot(&drv->q6->desc);
if (ret)
return ret;
ret = pil_do_ramdump(&drv->mba->desc, drv->ramdump_dev);
if (ret < 0)
pr_err("Unable to dump modem fw memory (rc = %d).\n", ret);
pil_shutdown(&drv->q6->desc);
return ret;
}
static int adsp_state_notifier_fn(struct notifier_block *this,
unsigned long code, void *ss_handle)
{
int ret;
ret = sysmon_send_event(SYSMON_SS_MODEM, "adsp", code);
if (ret < 0)
pr_err("%s: sysmon_send_event failed (%d).", __func__, ret);
return NOTIFY_DONE;
}
static struct notifier_block adsp_state_notifier_block = {
.notifier_call = adsp_state_notifier_fn,
};
static irqreturn_t modem_wdog_bite_intr_handler(int irq, void *dev_id)
{
struct modem_data *drv = subsys_to_drv(dev_id);
if (drv->ignore_errors)
return IRQ_HANDLED;
/* START : subsys_modem_restart : testmode */
if (ignore_errors_by_subsys_modem_restart) {
pr_err("IGNORE watchdog bite received from modem software!\n");
return IRQ_HANDLED;
}
/* END : subsys_modem_restart : testmode */
if (check_modem_reset(drv) == 0) {
pr_err("IGNORE watchdog bite received from modem software during check_modem_reset!\n");
return IRQ_HANDLED;
}
pr_err("Watchdog bite received from modem software!\n");
#if defined(CONFIG_PRE_SELF_DIAGNOSIS)
lge_pre_self_diagnosis((char *) "modem", 2, (char *) "Watchdog bite Intr", (char *) "_", 20000);
#endif
subsys_set_crash_status(drv->subsys, true);
restart_modem(drv);
return IRQ_HANDLED;
}
static int mss_start(const struct subsys_desc *desc)
{
int ret;
struct modem_data *drv = subsys_to_drv(desc);
if (desc->is_not_loadable)
return 0;
INIT_COMPLETION(drv->stop_ack);
ret = pil_boot(&drv->q6->desc);
if (ret)
return ret;
ret = pil_boot(&drv->mba->desc);
if (ret)
pil_shutdown(&drv->q6->desc);
return ret;
}
