Fix build errors, add some debug logging.

Acked-by: Sumit Garg <sumit.g...@linaro.org>
Signed-off-by: Caleb Connolly <caleb.conno...@linaro.org>
---
 drivers/soc/qcom/rpmh.c | 53 +++++++++++++++++++------------------------------
 include/soc/qcom/rpmh.h |  4 ++--
 2 files changed, 22 insertions(+), 35 deletions(-)

diff --git a/drivers/soc/qcom/rpmh.c b/drivers/soc/qcom/rpmh.c
index 22605e0291a1..96f14a9afdf2 100644
--- a/drivers/soc/qcom/rpmh.c
+++ b/drivers/soc/qcom/rpmh.c
@@ -15,27 +15,30 @@
 #include "rpmh-internal.h"
 
 #define RPMH_TIMEOUT_MS                        msecs_to_jiffies(10000)
 
-#define DEFINE_RPMH_MSG_ONSTACK(device, s, q, name)    \
+#define DEFINE_RPMH_MSG_ONSTACK(device, s, name)       \
        struct rpmh_request name = {                    \
                .msg = {                                \
                        .state = s,                     \
                        .cmds = name.cmd,               \
                        .num_cmds = 0,                  \
-                       .wait_for_compl = true,         \
                },                                      \
                .cmd = { { 0 } },                       \
-               .completion = q,                        \
                .dev = device,                          \
-               .needs_free = false,                            \
+               .needs_free = false,                    \
        }
 
 #define ctrlr_to_drv(ctrlr) container_of(ctrlr, struct rsc_drv, client)
 
-static struct rpmh_ctrlr *get_rpmh_ctrlr(const struct device *dev)
+static struct rpmh_ctrlr *get_rpmh_ctrlr(const struct udevice *dev)
 {
-       struct rsc_drv *drv = dev_get_drvdata(dev->parent);
+       struct rsc_drv *drv = (struct rsc_drv *)dev_get_priv(dev->parent);
+
+       if (!drv) {
+               log_err("BUG: no RPMh driver for %s (parent %s)\n", dev->name, 
dev->parent->name);
+               BUG();
+       }
 
        return &drv->client;
 }
 
@@ -49,36 +52,23 @@ static struct rpmh_ctrlr *get_rpmh_ctrlr(const struct 
device *dev)
  * Cache the RPMH request and send if the state is ACTIVE_ONLY.
  * SLEEP/WAKE_ONLY requests are not sent to the controller at
  * this time. Use rpmh_flush() to send them to the controller.
  */
-static int __rpmh_write(const struct device *dev, enum rpmh_state state,
+static int __rpmh_write(const struct udevice *dev, enum rpmh_state state,
                        struct rpmh_request *rpm_msg)
 {
        struct rpmh_ctrlr *ctrlr = get_rpmh_ctrlr(dev);
-       int ret = -EINVAL;
-       struct cache_req *req;
-       int i;
 
-       /* Cache the request in our store and link the payload */
-       for (i = 0; i < rpm_msg->msg.num_cmds; i++) {
-               req = cache_rpm_request(ctrlr, state, &rpm_msg->msg.cmds[i]);
-               if (IS_ERR(req))
-                       return PTR_ERR(req);
+       if (state != RPMH_ACTIVE_ONLY_STATE) {
+               log_err("only ACTIVE_ONLY state supported\n");
+               return -EINVAL;
        }
 
-       if (state == RPMH_ACTIVE_ONLY_STATE) {
-               ret = rpmh_rsc_send_data(ctrlr_to_drv(ctrlr), &rpm_msg->msg);
-       } else {
-               /* Clean up our call by spoofing tx_done */
-               ret = 0;
-               rpmh_tx_done(&rpm_msg->msg);
-       }
-
-       return ret;
+       return rpmh_rsc_send_data(ctrlr_to_drv(ctrlr), &rpm_msg->msg);
 }
 
 static int __fill_rpmh_msg(struct rpmh_request *req, enum rpmh_state state,
-               const struct tcs_cmd *cmd, u32 n)
+                          const struct tcs_cmd *cmd, u32 n)
 {
        if (!cmd || !n || n > MAX_RPMH_PAYLOAD)
                return -EINVAL;
 
@@ -87,8 +77,10 @@ static int __fill_rpmh_msg(struct rpmh_request *req, enum 
rpmh_state state,
        req->msg.state = state;
        req->msg.cmds = req->cmd;
        req->msg.num_cmds = n;
 
+       debug("rpmh_msg: %d, %d cmds [first %#x/%#x]\n", state, n, cmd->addr, 
cmd->data);
+
        return 0;
 }
 
 /**
@@ -100,24 +92,19 @@ static int __fill_rpmh_msg(struct rpmh_request *req, enum 
rpmh_state state,
  * @n: The number of elements in @cmd
  *
  * May sleep. Do not call from atomic contexts.
  */
-int rpmh_write(const struct device *dev, enum rpmh_state state,
+int rpmh_write(const struct udevice *dev, enum rpmh_state state,
               const struct tcs_cmd *cmd, u32 n)
 {
-       DECLARE_COMPLETION_ONSTACK(compl);
-       DEFINE_RPMH_MSG_ONSTACK(dev, state, &compl, rpm_msg);
+       DEFINE_RPMH_MSG_ONSTACK(dev, state, rpm_msg);
        int ret;
 
        ret = __fill_rpmh_msg(&rpm_msg, state, cmd, n);
        if (ret)
                return ret;
 
        ret = __rpmh_write(dev, state, &rpm_msg);
-       if (ret)
-               return ret;
 
-       ret = wait_for_completion_timeout(&compl, RPMH_TIMEOUT_MS);
-       WARN_ON(!ret);
-       return (ret > 0) ? 0 : -ETIMEDOUT;
+       return ret;
 }
 EXPORT_SYMBOL_GPL(rpmh_write);
diff --git a/include/soc/qcom/rpmh.h b/include/soc/qcom/rpmh.h
index 9a5c5d992e04..3421fbf1ee3e 100644
--- a/include/soc/qcom/rpmh.h
+++ b/include/soc/qcom/rpmh.h
@@ -5,14 +5,14 @@
 
 #ifndef __SOC_QCOM_RPMH_H__
 #define __SOC_QCOM_RPMH_H__
 
+#include <dm/device-internal.h>
 #include <soc/qcom/tcs.h>
-#include <linux/platform_device.h>
 
 
 #if IS_ENABLED(CONFIG_QCOM_RPMH)
-int rpmh_write(const struct device *dev, enum rpmh_state state,
+int rpmh_write(const struct udevice *dev, enum rpmh_state state,
               const struct tcs_cmd *cmd, u32 n);
 
 #else
 

-- 
2.45.2

Reply via email to