Allow sleep and wake commands to be cleared from the respective TCSes,
so that they can be re-populated.

Signed-off-by: Lina Iyer <il...@codeaurora.org>
---

Changes in v7:
        - Move bitmap_zero() outside the loop

Changes in v6:
        - remove unnecessary locks around __tcs_invalidate
        - rename function to tcs_invaldiate

Changes in v4:
        - refactored the rphm_rsc_invalidate()
---
 drivers/soc/qcom/rpmh-rsc.c | 45 +++++++++++++++++++++++++++++++++++++
 1 file changed, 45 insertions(+)

diff --git a/drivers/soc/qcom/rpmh-rsc.c b/drivers/soc/qcom/rpmh-rsc.c
index b5894b001ae1..68c25ebbbe09 100644
--- a/drivers/soc/qcom/rpmh-rsc.c
+++ b/drivers/soc/qcom/rpmh-rsc.c
@@ -104,6 +104,51 @@ static struct tcs_group *get_tcs_of_type(struct rsc_drv 
*drv, int type)
        return &drv->tcs[type];
 }
 
+static int tcs_invalidate(struct rsc_drv *drv, int type)
+{
+       int m;
+       struct tcs_group *tcs;
+
+       tcs = get_tcs_of_type(drv, type);
+       if (IS_ERR(tcs))
+               return PTR_ERR(tcs);
+
+       spin_lock(&tcs->lock);
+       if (bitmap_empty(tcs->slots, MAX_TCS_SLOTS)) {
+               spin_unlock(&tcs->lock);
+               return 0;
+       }
+
+       for (m = tcs->offset; m < tcs->offset + tcs->num_tcs; m++) {
+               if (!tcs_is_free(drv, m)) {
+                       spin_unlock(&tcs->lock);
+                       return -EAGAIN;
+               }
+               write_tcs_reg_sync(drv, RSC_DRV_CMD_ENABLE, m, 0);
+       }
+       bitmap_zero(tcs->slots, MAX_TCS_SLOTS);
+       spin_unlock(&tcs->lock);
+
+       return 0;
+}
+
+/**
+ * rpmh_rsc_invalidate - Invalidate sleep and wake TCSes
+ *
+ * @drv: the RSC controller
+ */
+int rpmh_rsc_invalidate(struct rsc_drv *drv)
+{
+       int ret;
+
+       ret = tcs_invalidate(drv, SLEEP_TCS);
+       if (!ret)
+               ret = tcs_invalidate(drv, WAKE_TCS);
+
+       return ret;
+}
+EXPORT_SYMBOL(rpmh_rsc_invalidate);
+
 static struct tcs_group *get_tcs_for_msg(struct rsc_drv *drv,
                                         const struct tcs_request *msg)
 {
-- 
The Qualcomm Innovation Center, Inc. is a member of the Code Aurora Forum,
a Linux Foundation Collaborative Project

Reply via email to