Merge "icnss: Synchronize idle shutdown and restart" (70fd0b46) · Commits · e / devices / android_kernel_oneplus_sm8150

drivers/soc/qcom/icnss.c

+103 −0

Original line number	Diff line number	Diff line
		@@ -302,6 +302,10 @@ static char *icnss_driver_event_to_str(enum icnss_driver_event_type type)
		return "PD_SERVICE_DOWN";
		case ICNSS_DRIVER_EVENT_FW_EARLY_CRASH_IND:
		return "FW_EARLY_CRASH_IND";
		case ICNSS_DRIVER_EVENT_IDLE_SHUTDOWN:
		return "IDLE_SHUTDOWN";
		case ICNSS_DRIVER_EVENT_IDLE_RESTART:
		return "IDLE_RESTART";
		case ICNSS_DRIVER_EVENT_MAX:
		return "EVENT_MAX";
		}
		@@ -1127,6 +1131,7 @@ static int icnss_pd_restart_complete(struct icnss_priv *priv)
		icnss_call_driver_shutdown(priv);

		clear_bit(ICNSS_PDR, &priv->state);
		clear_bit(ICNSS_MODEM_CRASHED, &priv->state);
		clear_bit(ICNSS_REJUVENATE, &priv->state);
		clear_bit(ICNSS_PD_RESTART, &priv->state);
		priv->early_crash_ind = false;
		@@ -1405,6 +1410,51 @@ static int icnss_driver_event_early_crash_ind(struct icnss_priv *priv,
		return ret;
		}

		static int icnss_driver_event_idle_shutdown(void *data)
		{
		int ret = 0;

		if (!penv->ops \|\| !penv->ops->idle_shutdown)
		return 0;

		if (test_bit(ICNSS_MODEM_CRASHED, &penv->state) \|\|
		test_bit(ICNSS_PDR, &penv->state) \|\|
		test_bit(ICNSS_REJUVENATE, &penv->state)) {
		icnss_pr_err("SSR/PDR is already in-progress during idle shutdown callback\n");
		ret = -EBUSY;
		} else {
		icnss_pr_dbg("Calling driver idle shutdown, state: 0x%lx\n",
		penv->state);
		icnss_block_shutdown(true);
		ret = penv->ops->idle_shutdown(&penv->pdev->dev);
		icnss_block_shutdown(false);
		}

		return ret;
		}

		static int icnss_driver_event_idle_restart(void *data)
		{
		int ret = 0;

		if (!penv->ops \|\| !penv->ops->idle_restart)
		return 0;

		if (test_bit(ICNSS_MODEM_CRASHED, &penv->state) \|\|
		test_bit(ICNSS_PDR, &penv->state) \|\|
		test_bit(ICNSS_REJUVENATE, &penv->state)) {
		icnss_pr_err("SSR/PDR is already in-progress during idle restart callback\n");
		ret = -EBUSY;
		} else {
		icnss_pr_dbg("Calling driver idle restart, state: 0x%lx\n",
		penv->state);
		icnss_block_shutdown(true);
		ret = penv->ops->idle_restart(&penv->pdev->dev);
		icnss_block_shutdown(false);
		}

		return ret;
		}

		static void icnss_driver_event_work(struct work_struct *work)
		{
		@@ -1451,6 +1501,12 @@ static void icnss_driver_event_work(struct work_struct *work)
		ret = icnss_driver_event_early_crash_ind(penv,
		event->data);
		break;
		case ICNSS_DRIVER_EVENT_IDLE_SHUTDOWN:
		ret = icnss_driver_event_idle_shutdown(event->data);
		break;
		case ICNSS_DRIVER_EVENT_IDLE_RESTART:
		ret = icnss_driver_event_idle_restart(event->data);
		break;
		default:
		icnss_pr_err("Invalid Event type: %d", event->type);
		kfree(event);
		@@ -1525,6 +1581,9 @@ static int icnss_modem_notifier_nb(struct notifier_block *nb,

		priv->is_ssr = true;

		if (notif->crashed)
		set_bit(ICNSS_MODEM_CRASHED, &priv->state);

		if (code == SUBSYS_BEFORE_SHUTDOWN && !notif->crashed &&
		atomic_read(&priv->is_shutdown)) {
		atomic_set(&priv->is_shutdown, false);
		@@ -2514,6 +2573,48 @@ int icnss_trigger_recovery(struct device *dev)
		}
		EXPORT_SYMBOL(icnss_trigger_recovery);

		int icnss_idle_shutdown(struct device *dev)
		{
		struct icnss_priv *priv = dev_get_drvdata(dev);

		if (!priv) {
		icnss_pr_err("Invalid drvdata: dev %pK", dev);
		return -EINVAL;
		}

		if (test_bit(ICNSS_MODEM_CRASHED, &priv->state) \|\|
		test_bit(ICNSS_PDR, &priv->state) \|\|
		test_bit(ICNSS_REJUVENATE, &penv->state)) {
		icnss_pr_err("SSR/PDR is already in-progress during idle shutdown\n");
		return -EBUSY;
		}

		return icnss_driver_event_post(ICNSS_DRIVER_EVENT_IDLE_SHUTDOWN,
		ICNSS_EVENT_SYNC_UNINTERRUPTIBLE, NULL);
		}
		EXPORT_SYMBOL(icnss_idle_shutdown);

		int icnss_idle_restart(struct device *dev)
		{
		struct icnss_priv *priv = dev_get_drvdata(dev);

		if (!priv) {
		icnss_pr_err("Invalid drvdata: dev %pK", dev);
		return -EINVAL;
		}

		if (test_bit(ICNSS_MODEM_CRASHED, &priv->state) \|\|
		test_bit(ICNSS_PDR, &priv->state) \|\|
		test_bit(ICNSS_REJUVENATE, &penv->state)) {
		icnss_pr_err("SSR/PDR is already in-progress during idle restart\n");
		return -EBUSY;
		}

		return icnss_driver_event_post(ICNSS_DRIVER_EVENT_IDLE_RESTART,
		ICNSS_EVENT_SYNC_UNINTERRUPTIBLE, NULL);
		}
		EXPORT_SYMBOL(icnss_idle_restart);


		static int icnss_smmu_init(struct icnss_priv *priv)
		{
		@@ -3018,6 +3119,8 @@ static int icnss_stats_show_state(struct seq_file s, struct icnss_priv priv)
		case ICNSS_ESOC_OFF:
		seq_puts(s, "ESOC_OFF");
		continue;
		case ICNSS_MODEM_CRASHED:
		seq_puts(s, "MODEM CRASHED");
		}

		seq_printf(s, "UNKNOWN-%d", i);

drivers/soc/qcom/icnss_private.h

+3 −0

Original line number	Diff line number	Diff line
		@@ -120,6 +120,8 @@ enum icnss_driver_event_type {
		ICNSS_DRIVER_EVENT_UNREGISTER_DRIVER,
		ICNSS_DRIVER_EVENT_PD_SERVICE_DOWN,
		ICNSS_DRIVER_EVENT_FW_EARLY_CRASH_IND,
		ICNSS_DRIVER_EVENT_IDLE_SHUTDOWN,
		ICNSS_DRIVER_EVENT_IDLE_RESTART,
		ICNSS_DRIVER_EVENT_MAX,
		};

		@@ -165,6 +167,7 @@ enum icnss_driver_state {
		ICNSS_PDR,
		ICNSS_CLK_UP,
		ICNSS_ESOC_OFF,
		ICNSS_MODEM_CRASHED,
		};

		struct ce_irq_list {

include/soc/qcom/icnss.h

+4 −0

Original line number	Diff line number	Diff line
		@@ -50,6 +50,8 @@ struct icnss_driver_ops {
		int (suspend_noirq)(struct device dev);
		int (resume_noirq)(struct device dev);
		int (uevent)(struct device dev, struct icnss_uevent_data *uevent);
		int (idle_shutdown)(struct device dev);
		int (idle_restart)(struct device dev);
		};


		@@ -146,4 +148,6 @@ extern bool icnss_is_rejuvenate(void);
		extern int icnss_trigger_recovery(struct device *dev);
		extern void icnss_block_shutdown(bool status);
		extern bool icnss_is_pdr(void);
		extern int icnss_idle_restart(struct device *dev);
		extern int icnss_idle_shutdown(struct device *dev);
		#endif /* _ICNSS_WLAN_H_ */