soc: qcom: smd: Use correct remote processor ID

This patch fixes SMEM addressing issues when remote processors need to use
secure SMEM partitions.

Signed-off-by: Andy Gross <agross@codeaurora.org>
Reviewed-by: Bjorn Andersson <bjorn.andersson@sonymobile.com>

1 files changed, 12 insertions, 4 deletions

diff --git a/drivers/soc/qcom/smd.c b/drivers/soc/qcom/smd.c
index 327adcf117c1..edd9d9a37238 100644
--- a/drivers/soc/qcom/smd.c
+++ b/drivers/soc/qcom/smd.c
@@ -96,6 +96,7 @@ static const struct {
  * @smd:                handle to qcom_smd
  * @of_node:            of_node handle for information related to this edge
  * @edge_id:            identifier of this edge
+ * @remote_pid:         identifier of remote processor
  * @irq:                interrupt for signals on this edge
  * @ipc_regmap:         regmap handle holding the outgoing ipc register
  * @ipc_offset:         offset within @ipc_regmap of the register for ipc
@@ -111,6 +112,7 @@ struct qcom_smd_edge {
         struct qcom_smd *smd;
         struct device_node *of_node;
         unsigned edge_id;
+        unsigned remote_pid;
 
         int irq;
 
@@ -572,7 +574,7 @@ static irqreturn_t qcom_smd_edge_intr(int irq, void *data)
          * have to scan if the amount of available space in smem have changed
          * since last scan.
          */
-        available = qcom_smem_get_free_space(edge->edge_id);
+        available = qcom_smem_get_free_space(edge->remote_pid);
         if (available != edge->smem_available) {
                 edge->smem_available = available;
                 edge->need_rescan = true;
@@ -976,7 +978,8 @@ static struct qcom_smd_channel *qcom_smd_create_channel(struct qcom_smd_edge *ed
         spin_lock_init(&channel->recv_lock);
         init_waitqueue_head(&channel->fblockread_event);
 
-        ret = qcom_smem_get(edge->edge_id, smem_info_item, (void **)&info, &info_size);
+        ret = qcom_smem_get(edge->remote_pid, smem_info_item, (void **)&info,
+                            &info_size);
         if (ret)
                 goto free_name_and_channel;
 
@@ -997,7 +1000,8 @@ static struct qcom_smd_channel *qcom_smd_create_channel(struct qcom_smd_edge *ed
                 goto free_name_and_channel;
         }
 
-        ret = qcom_smem_get(edge->edge_id, smem_fifo_item, &fifo_base, &fifo_size);
+        ret = qcom_smem_get(edge->remote_pid, smem_fifo_item, &fifo_base,
+                            &fifo_size);
         if (ret)
                 goto free_name_and_channel;
 
@@ -1041,7 +1045,7 @@ static void qcom_discover_channels(struct qcom_smd_edge *edge)
         int i;
 
         for (tbl = 0; tbl < SMD_ALLOC_TBL_COUNT; tbl++) {
-                ret = qcom_smem_get(edge->edge_id,
+                ret = qcom_smem_get(edge->remote_pid,
                                     smem_items[tbl].alloc_tbl_id,
                                     (void **)&alloc_tbl,
                                     NULL);
@@ -1184,6 +1188,10 @@ static int qcom_smd_parse_edge(struct device *dev,
                 return -EINVAL;
         }
 
+        edge->remote_pid = QCOM_SMEM_HOST_ANY;
+        key = "qcom,remote-pid";
+        of_property_read_u32(node, key, &edge->remote_pid);
+
         syscon_np = of_parse_phandle(node, "qcom,ipc", 0);
         if (!syscon_np) {
                 dev_err(dev, "no qcom,ipc node\n");