@@ -1006,22 +1006,31 @@ EXPORT_SYMBOL_GPL(scp_mapping_dm_addr);
static int scp_map_memory_region(struct mtk_scp *scp)
{
- int ret;
+ int ret, i, err;
const struct mtk_scp_sizes_data *scp_sizes;
+ struct device_node *node = scp->dev->of_node;
+ struct of_phandle_iterator it;
+
+ i = 0;
+ of_for_each_phandle(&it, err, node, "memory-region", NULL, 0) {
+ ret = of_reserved_mem_device_init_by_idx(scp->dev, node, i);
+
+ if (ret) {
+ dev_err(scp->dev, "failed to assign memory-region: %s\n",
+ it.node->name);
+ of_node_put(it.node);
+ return -ENOMEM;
+ }
- ret = of_reserved_mem_device_init(scp->dev);
+ i++;
+ }
/* reserved memory is optional. */
- if (ret == -ENODEV) {
+ if (!i) {
dev_info(scp->dev, "skipping reserved memory initialization.");
return 0;
}
- if (ret) {
- dev_err(scp->dev, "failed to assign memory-region: %d\n", ret);
- return -ENOMEM;
- }
-
/* Reserved SCP code size */
scp_sizes = scp->data->scp_sizes;
scp->cpu_addr = dma_alloc_coherent(scp->dev, scp_sizes->max_dram_size,