soc: qcom: smd-rpm: Create RPM interconnect proxy child device

Register a platform device to handle the communication of bus bandwidth
requests with the remote processor. The interconnect proxy device is part
of this remote processor (RPM) hardware. Let's create a icc-smd-rpm proxy
child device to represent the bus throughput functionality that is provided
by the RPM.

Reviewed-by: Bjorn Andersson <bjorn.andersson@linaro.org>
Signed-off-by: Georgi Djakov <georgi.djakov@linaro.org>
Signed-off-by: Bjorn Andersson <bjorn.andersson@linaro.org>

diff --git a/drivers/soc/qcom/smd-rpm.c b/drivers/soc/qcom/smd-rpm.c
index fa9dd12..34cdd63 100644 (file)
--- a/drivers/soc/qcom/smd-rpm.c
+++ b/drivers/soc/qcom/smd-rpm.c
@@ -19,12 +19,14 @@
 /**
  * struct qcom_smd_rpm - state of the rpm device driver
  * @rpm_channel:       reference to the smd channel
+ * @icc:               interconnect proxy device
  * @ack:               completion for acks
  * @lock:              mutual exclusion around the send/complete pair
  * @ack_status:                result of the rpm request
  */
 struct qcom_smd_rpm {
        struct rpmsg_endpoint *rpm_channel;
+       struct platform_device *icc;
        struct device *dev;
 
        struct completion ack;
@@ -193,6 +195,7 @@ static int qcom_smd_rpm_callback(struct rpmsg_device *rpdev,
 static int qcom_smd_rpm_probe(struct rpmsg_device *rpdev)
 {
        struct qcom_smd_rpm *rpm;
+       int ret;
 
        rpm = devm_kzalloc(&rpdev->dev, sizeof(*rpm), GFP_KERNEL);
        if (!rpm)
@@ -205,11 +208,23 @@ static int qcom_smd_rpm_probe(struct rpmsg_device *rpdev)
        rpm->rpm_channel = rpdev->ept;
        dev_set_drvdata(&rpdev->dev, rpm);
 
-       return of_platform_populate(rpdev->dev.of_node, NULL, NULL, &rpdev->dev);
+       rpm->icc = platform_device_register_data(&rpdev->dev, "icc_smd_rpm", -1,
+                                                NULL, 0);
+       if (IS_ERR(rpm->icc))
+               return PTR_ERR(rpm->icc);
+
+       ret = of_platform_populate(rpdev->dev.of_node, NULL, NULL, &rpdev->dev);
+       if (ret)
+               platform_device_unregister(rpm->icc);
+
+       return ret;
 }
 
 static void qcom_smd_rpm_remove(struct rpmsg_device *rpdev)
 {
+       struct qcom_smd_rpm *rpm = dev_get_drvdata(&rpdev->dev);
+
+       platform_device_unregister(rpm->icc);
        of_platform_depopulate(&rpdev->dev);
 }