rmnet: Convert to use remoteproc notifications

Support rmnet_ipa driver to register for remoteproc notifications
along with legacy subsys notifier.

Change-Id: Ibce7ad0efa5c264f9649f69ee2f98fc0bdc66ad9
Signed-off-by: Michael Adisumarta <madisuma@codeaurora.org>
Dieser Commit ist enthalten in:
Michael Adisumarta
2020-12-28 17:57:05 -08:00
Ursprung b54510f96d
Commit eb1d4087ae

Datei anzeigen

@@ -24,6 +24,7 @@
#include <net/pkt_sched.h>
#include <soc/qcom/subsystem_restart.h>
#include <soc/qcom/subsystem_notif.h>
#include <linux/remoteproc/qcom_rproc.h>
#include "ipa_qmi_service.h"
#include <linux/rmnet_ipa_fd_ioctl.h>
#include <linux/ipa.h>
@@ -2884,7 +2885,11 @@ static int ipa3_lcl_mdm_ssr_notifier_cb(struct notifier_block *this,
}
switch (code) {
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
case QCOM_SSR_BEFORE_SHUTDOWN:
#else
case SUBSYS_BEFORE_SHUTDOWN:
#endif
IPAWANINFO("IPA received MPSS BEFORE_SHUTDOWN\n");
/* send SSR before-shutdown notification to IPACM */
rmnet_ipa_send_ssr_notification(false);
@@ -2905,7 +2910,11 @@ static int ipa3_lcl_mdm_ssr_notifier_cb(struct notifier_block *this,
ipa3_odl_pipe_cleanup(true);
IPAWANINFO("IPA BEFORE_SHUTDOWN handling is complete\n");
break;
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
case QCOM_SSR_AFTER_SHUTDOWN:
#else
case SUBSYS_AFTER_SHUTDOWN:
#endif
IPAWANINFO("IPA Received MPSS AFTER_SHUTDOWN\n");
if (atomic_read(&rmnet_ipa3_ctx->is_ssr) &&
ipa3_ctx_get_type(IPA_HW_TYPE) < IPA_HW_v4_0)
@@ -2916,7 +2925,11 @@ static int ipa3_lcl_mdm_ssr_notifier_cb(struct notifier_block *this,
IPAWANINFO("IPA AFTER_SHUTDOWN handling is complete\n");
break;
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
case QCOM_SSR_BEFORE_POWERUP:
#else
case SUBSYS_BEFORE_POWERUP:
#endif
IPAWANINFO("IPA received MPSS BEFORE_POWERUP\n");
if (atomic_read(&rmnet_ipa3_ctx->is_ssr)) {
/* clean up cached QMI msg/handlers */
@@ -2928,7 +2941,11 @@ static int ipa3_lcl_mdm_ssr_notifier_cb(struct notifier_block *this,
ipa3_reset_freeze_vote();
IPAWANINFO("IPA BEFORE_POWERUP handling is complete\n");
break;
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
case QCOM_SSR_AFTER_POWERUP:
#else
case SUBSYS_AFTER_POWERUP:
#endif
IPAWANINFO("IPA received MPSS AFTER_POWERUP\n");
if (!atomic_read(&rmnet_ipa3_ctx->is_initialized) &&
atomic_read(&rmnet_ipa3_ctx->is_ssr))
@@ -2962,16 +2979,32 @@ static int ipa3_rmt_mdm_ssr_notifier_cb(struct notifier_block *this,
}
switch (code) {
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
case QCOM_SSR_BEFORE_SHUTDOWN:
#else
case SUBSYS_BEFORE_SHUTDOWN:
#endif
IPAWANINFO("IPA received RMT MPSS BEFORE_SHUTDOWN\n");
break;
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
case QCOM_SSR_AFTER_SHUTDOWN:
#else
case SUBSYS_AFTER_SHUTDOWN:
#endif
IPAWANINFO("IPA Received RMT MPSS AFTER_SHUTDOWN\n");
break;
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
case QCOM_SSR_BEFORE_POWERUP:
#else
case SUBSYS_BEFORE_POWERUP:
#endif
IPAWANINFO("IPA received RMT MPSS BEFORE_POWERUP\n");
break;
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
case QCOM_SSR_AFTER_POWERUP:
#else
case SUBSYS_AFTER_POWERUP:
#endif
IPAWANINFO("IPA received RMT MPSS AFTER_POWERUP\n");
break;
default:
@@ -4938,8 +4971,13 @@ int ipa3_wwan_init(void)
rmnet_ipa_debugfs_init();
/* Register for Local Modem SSR */
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
ssr_hdl = qcom_register_ssr_notifier(SUBSYS_LOCAL_MODEM,
&ipa3_lcl_mdm_ssr_notifier);
#else
ssr_hdl = subsys_notif_register_notifier(SUBSYS_LOCAL_MODEM,
&ipa3_lcl_mdm_ssr_notifier);
#endif
if (!IS_ERR(ssr_hdl))
rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle = ssr_hdl;
else if (!rmnet_ipa3_ctx->ipa_config_is_apq) {
@@ -4950,8 +4988,13 @@ int ipa3_wwan_init(void)
if (rmnet_ipa3_ctx->ipa_config_is_apq) {
/* Register for Remote Modem SSR */
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
ssr_hdl = qcom_register_ssr_notifier(SUBSYS_REMOTE_MODEM,
&ipa3_rmt_mdm_ssr_notifier);
#else
ssr_hdl = subsys_notif_register_notifier(SUBSYS_REMOTE_MODEM,
&ipa3_rmt_mdm_ssr_notifier);
#endif
if (IS_ERR(ssr_hdl)) {
rc = PTR_ERR(ssr_hdl);
IPAWANERR_RL("remote modem ssr register fail rc=%d\n",
@@ -4967,9 +5010,15 @@ int ipa3_wwan_init(void)
fail_unreg_lcl_mdm_ssr:
if (rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle) {
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
qcom_unregister_ssr_notifier(
rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle,
&ipa3_lcl_mdm_ssr_notifier);
#else
subsys_notif_unregister_notifier(
rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle,
&ipa3_lcl_mdm_ssr_notifier);
#endif
rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle = NULL;
}
fail_dbgfs_rm:
@@ -4983,18 +5032,30 @@ void ipa3_wwan_cleanup(void)
platform_driver_unregister(&rmnet_ipa_driver);
if (rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle) {
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
ret = qcom_unregister_ssr_notifier(
rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle,
&ipa3_lcl_mdm_ssr_notifier);
#else
ret = subsys_notif_unregister_notifier(
rmnet_ipa3_ctx->lcl_mdm_subsys_notify_handle,
&ipa3_lcl_mdm_ssr_notifier);
#endif
if (ret)
IPAWANERR(
"Failed to unregister subsys %s notifier ret=%d\n",
SUBSYS_LOCAL_MODEM, ret);
}
if (rmnet_ipa3_ctx->rmt_mdm_subsys_notify_handle) {
#if IS_ENABLED(CONFIG_QCOM_Q6V5_PAS)
ret = qcom_unregister_ssr_notifier(
rmnet_ipa3_ctx->rmt_mdm_subsys_notify_handle,
&ipa3_rmt_mdm_ssr_notifier);
#else
ret = subsys_notif_unregister_notifier(
rmnet_ipa3_ctx->rmt_mdm_subsys_notify_handle,
&ipa3_rmt_mdm_ssr_notifier);
#endif
if (ret)
IPAWANERR(
"Failed to unregister subsys %s notifier ret=%d\n",