Lines Matching +full:rpmsg +full:- +full:out
1 // SPDX-License-Identifier: GPL-2.0-only
8 * Ohad Ben-Cohen <ohad@wizery.com>
12 * Suman Anna <s-anna@ti.com>
26 #include <linux/dma-mapping.h>
97 return -ENOSYS; in rproc_iommu_fault()
103 struct device *dev = rproc->dev.parent; in rproc_enable_iommu()
106 if (!rproc->has_iommu) { in rproc_enable_iommu()
111 domain = iommu_domain_alloc(dev->bus); in rproc_enable_iommu()
114 return -ENOMEM; in rproc_enable_iommu()
125 rproc->domain = domain; in rproc_enable_iommu()
136 struct iommu_domain *domain = rproc->domain; in rproc_disable_iommu()
137 struct device *dev = rproc->dev.parent; in rproc_disable_iommu()
150 * - in vmalloc: if region ioremapped or defined as dma_alloc_coherent in rproc_va_to_pa()
151 * - in kernel: if region allocated in generic dma memory pool in rproc_va_to_pa()
164 * rproc_da_to_va() - lookup the kernel virtual address for a remoteproc address
186 * Note: phys_to_virt(iommu_iova_to_phys(rproc->domain, da)) will work too,
198 if (rproc->ops->da_to_va) { in rproc_da_to_va()
199 ptr = rproc->ops->da_to_va(rproc, da, len, is_iomem); in rproc_da_to_va()
201 goto out; in rproc_da_to_va()
204 list_for_each_entry(carveout, &rproc->carveouts, node) { in rproc_da_to_va()
205 int offset = da - carveout->da; in rproc_da_to_va()
208 if (!carveout->va) in rproc_da_to_va()
216 if (offset + len > carveout->len) in rproc_da_to_va()
219 ptr = carveout->va + offset; in rproc_da_to_va()
222 *is_iomem = carveout->is_iomem; in rproc_da_to_va()
227 out: in rproc_da_to_va()
233 * rproc_find_carveout_by_name() - lookup the carveout region by a name
238 * Platform driver has the capability to register some pre-allacoted carveout
265 list_for_each_entry(carveout, &rproc->carveouts, node) { in rproc_find_carveout_by_name()
267 if (!strcmp(carveout->name, _name)) { in rproc_find_carveout_by_name()
277 * rproc_check_carveout_da() - Check specified carveout da configuration
293 struct device *dev = &rproc->dev; in rproc_check_carveout_da()
297 if (len > mem->len) { in rproc_check_carveout_da()
299 return -EINVAL; in rproc_check_carveout_da()
302 if (da != FW_RSC_ADDR_ANY && mem->da == FW_RSC_ADDR_ANY) { in rproc_check_carveout_da()
304 return -EINVAL; in rproc_check_carveout_da()
305 } else if (da != FW_RSC_ADDR_ANY && mem->da != FW_RSC_ADDR_ANY) { in rproc_check_carveout_da()
306 delta = da - mem->da; in rproc_check_carveout_da()
312 return -EINVAL; in rproc_check_carveout_da()
315 if (delta + len > mem->len) { in rproc_check_carveout_da()
318 return -EINVAL; in rproc_check_carveout_da()
327 struct rproc *rproc = rvdev->rproc; in rproc_alloc_vring()
328 struct device *dev = &rproc->dev; in rproc_alloc_vring()
329 struct rproc_vring *rvring = &rvdev->vring[i]; in rproc_alloc_vring()
336 size = PAGE_ALIGN(vring_size(rvring->num, rvring->align)); in rproc_alloc_vring()
338 rsc = (void *)rproc->table_ptr + rvdev->rsc_offset; in rproc_alloc_vring()
340 /* Search for pre-registered carveout */ in rproc_alloc_vring()
341 mem = rproc_find_carveout_by_name(rproc, "vdev%dvring%d", rvdev->index, in rproc_alloc_vring()
344 if (rproc_check_carveout_da(rproc, mem, rsc->vring[i].da, size)) in rproc_alloc_vring()
345 return -ENOMEM; in rproc_alloc_vring()
349 size, rsc->vring[i].da, in rproc_alloc_vring()
353 rvdev->index, i); in rproc_alloc_vring()
356 return -ENOMEM; in rproc_alloc_vring()
363 * Assign an rproc-wide unique index for this vring in rproc_alloc_vring()
367 ret = idr_alloc(&rproc->notifyids, rvring, 0, 0, GFP_KERNEL); in rproc_alloc_vring()
375 if (notifyid > rproc->max_notifyid) in rproc_alloc_vring()
376 rproc->max_notifyid = notifyid; in rproc_alloc_vring()
378 rvring->notifyid = notifyid; in rproc_alloc_vring()
381 rsc->vring[i].notifyid = notifyid; in rproc_alloc_vring()
388 struct rproc *rproc = rvdev->rproc; in rproc_parse_vring()
389 struct device *dev = &rproc->dev; in rproc_parse_vring()
390 struct fw_rsc_vdev_vring *vring = &rsc->vring[i]; in rproc_parse_vring()
391 struct rproc_vring *rvring = &rvdev->vring[i]; in rproc_parse_vring()
394 i, vring->da, vring->num, vring->align); in rproc_parse_vring()
397 if (!vring->num || !vring->align) { in rproc_parse_vring()
399 vring->num, vring->align); in rproc_parse_vring()
400 return -EINVAL; in rproc_parse_vring()
403 rvring->num = vring->num; in rproc_parse_vring()
404 rvring->align = vring->align; in rproc_parse_vring()
405 rvring->rvdev = rvdev; in rproc_parse_vring()
412 struct rproc *rproc = rvring->rvdev->rproc; in rproc_free_vring()
413 int idx = rvring - rvring->rvdev->vring; in rproc_free_vring()
416 idr_remove(&rproc->notifyids, rvring->notifyid); in rproc_free_vring()
421 * such and as per rproc_stop(), rproc->table_ptr points to the cached in rproc_free_vring()
422 * resource table (rproc->cached_table). The cached resource table is in rproc_free_vring()
429 if (rproc->table_ptr) { in rproc_free_vring()
430 rsc = (void *)rproc->table_ptr + rvring->rvdev->rsc_offset; in rproc_free_vring()
431 rsc->vring[idx].da = 0; in rproc_free_vring()
432 rsc->vring[idx].notifyid = -1; in rproc_free_vring()
439 list_add_tail(&rvdev->node, &rproc->rvdevs); in rproc_add_rvdev()
445 list_del(&rvdev->node); in rproc_remove_rvdev()
448 * rproc_handle_vdev() - handle a vdev fw resource
459 * Before registering the vdev, the vrings are allocated from non-cacheable
462 * doing the vring allocation only later when ->find_vqs() is invoked, and
463 * then release them upon ->del_vqs().
468 * going to be taken care of when the generic iommu-based DMA API will be
469 * merged. Meanwhile, statically-addressed iommu-based firmware images should
479 struct device *dev = &rproc->dev; in rproc_handle_vdev()
486 rsc_size = struct_size(rsc, vring, rsc->num_of_vrings); in rproc_handle_vdev()
487 if (size_add(rsc_size, rsc->config_len) > avail) { in rproc_handle_vdev()
489 return -EINVAL; in rproc_handle_vdev()
493 if (rsc->reserved[0] || rsc->reserved[1]) { in rproc_handle_vdev()
495 return -EINVAL; in rproc_handle_vdev()
499 rsc->id, rsc->dfeatures, rsc->config_len, rsc->num_of_vrings); in rproc_handle_vdev()
502 if (rsc->num_of_vrings > ARRAY_SIZE(rvdev->vring)) { in rproc_handle_vdev()
503 dev_err(dev, "too many vrings: %d\n", rsc->num_of_vrings); in rproc_handle_vdev()
504 return -EINVAL; in rproc_handle_vdev()
507 rvdev_data.id = rsc->id; in rproc_handle_vdev()
508 rvdev_data.index = rproc->nb_vdev++; in rproc_handle_vdev()
513 * When there is more than one remote processor, rproc->nb_vdev number is in rproc_handle_vdev()
518 pdev = platform_device_register_data(dev, "rproc-virtio", PLATFORM_DEVID_AUTO, &rvdev_data, in rproc_handle_vdev()
521 dev_err(dev, "failed to create rproc-virtio device\n"); in rproc_handle_vdev()
529 * rproc_handle_trace() - handle a shared trace buffer resource
550 struct device *dev = &rproc->dev; in rproc_handle_trace()
555 return -EINVAL; in rproc_handle_trace()
559 if (rsc->reserved) { in rproc_handle_trace()
561 return -EINVAL; in rproc_handle_trace()
566 return -ENOMEM; in rproc_handle_trace()
569 trace->trace_mem.len = rsc->len; in rproc_handle_trace()
570 trace->trace_mem.da = rsc->da; in rproc_handle_trace()
573 trace->rproc = rproc; in rproc_handle_trace()
576 snprintf(name, sizeof(name), "trace%d", rproc->num_traces); in rproc_handle_trace()
579 trace->tfile = rproc_create_trace_file(name, rproc, trace); in rproc_handle_trace()
581 list_add_tail(&trace->node, &rproc->traces); in rproc_handle_trace()
583 rproc->num_traces++; in rproc_handle_trace()
586 name, rsc->da, rsc->len); in rproc_handle_trace()
592 * rproc_handle_devmem() - handle devmem resource entry
598 * Remote processors commonly need to access certain on-chip peripherals.
602 * the on-chip peripherals they need.
624 struct device *dev = &rproc->dev; in rproc_handle_devmem()
628 if (!rproc->domain) in rproc_handle_devmem()
629 return -EINVAL; in rproc_handle_devmem()
633 return -EINVAL; in rproc_handle_devmem()
637 if (rsc->reserved) { in rproc_handle_devmem()
639 return -EINVAL; in rproc_handle_devmem()
644 return -ENOMEM; in rproc_handle_devmem()
646 ret = iommu_map(rproc->domain, rsc->da, rsc->pa, rsc->len, rsc->flags, in rproc_handle_devmem()
650 goto out; in rproc_handle_devmem()
660 mapping->da = rsc->da; in rproc_handle_devmem()
661 mapping->len = rsc->len; in rproc_handle_devmem()
662 list_add_tail(&mapping->node, &rproc->mappings); in rproc_handle_devmem()
665 rsc->pa, rsc->da, rsc->len); in rproc_handle_devmem()
669 out: in rproc_handle_devmem()
675 * rproc_alloc_carveout() - allocated specified carveout
688 struct device *dev = &rproc->dev; in rproc_alloc_carveout()
693 va = dma_alloc_coherent(dev->parent, mem->len, &dma, GFP_KERNEL); in rproc_alloc_carveout()
695 dev_err(dev->parent, in rproc_alloc_carveout()
697 mem->len); in rproc_alloc_carveout()
698 return -ENOMEM; in rproc_alloc_carveout()
702 va, &dma, mem->len); in rproc_alloc_carveout()
704 if (mem->da != FW_RSC_ADDR_ANY && !rproc->domain) { in rproc_alloc_carveout()
711 if (mem->da != (u32)dma) in rproc_alloc_carveout()
712 dev_warn(dev->parent, in rproc_alloc_carveout()
717 * Ok, this is non-standard. in rproc_alloc_carveout()
719 * Sometimes we can't rely on the generic iommu-based DMA API in rproc_alloc_carveout()
730 * to use the iommu-based DMA API: we expect 'dma' to contain the in rproc_alloc_carveout()
733 if (mem->da != FW_RSC_ADDR_ANY && rproc->domain) { in rproc_alloc_carveout()
736 ret = -ENOMEM; in rproc_alloc_carveout()
740 ret = iommu_map(rproc->domain, mem->da, dma, mem->len, in rproc_alloc_carveout()
741 mem->flags, GFP_KERNEL); in rproc_alloc_carveout()
754 mapping->da = mem->da; in rproc_alloc_carveout()
755 mapping->len = mem->len; in rproc_alloc_carveout()
756 list_add_tail(&mapping->node, &rproc->mappings); in rproc_alloc_carveout()
759 mem->da, &dma); in rproc_alloc_carveout()
762 if (mem->da == FW_RSC_ADDR_ANY) { in rproc_alloc_carveout()
767 mem->da = (u32)dma; in rproc_alloc_carveout()
770 mem->dma = dma; in rproc_alloc_carveout()
771 mem->va = va; in rproc_alloc_carveout()
778 dma_free_coherent(dev->parent, mem->len, va, dma); in rproc_alloc_carveout()
783 * rproc_release_carveout() - release acquired carveout
795 struct device *dev = &rproc->dev; in rproc_release_carveout()
798 dma_free_coherent(dev->parent, mem->len, mem->va, mem->dma); in rproc_release_carveout()
803 * rproc_handle_carveout() - handle phys contig memory allocation requests
828 struct device *dev = &rproc->dev; in rproc_handle_carveout()
832 return -EINVAL; in rproc_handle_carveout()
836 if (rsc->reserved) { in rproc_handle_carveout()
838 return -EINVAL; in rproc_handle_carveout()
842 rsc->name, rsc->da, rsc->pa, rsc->len, rsc->flags); in rproc_handle_carveout()
848 carveout = rproc_find_carveout_by_name(rproc, rsc->name); in rproc_handle_carveout()
851 if (carveout->rsc_offset != FW_RSC_ADDR_ANY) { in rproc_handle_carveout()
854 return -ENOMEM; in rproc_handle_carveout()
857 if (rproc_check_carveout_da(rproc, carveout, rsc->da, rsc->len)) in rproc_handle_carveout()
858 return -ENOMEM; in rproc_handle_carveout()
861 carveout->rsc_offset = offset; in rproc_handle_carveout()
862 carveout->flags = rsc->flags; in rproc_handle_carveout()
868 carveout = rproc_mem_entry_init(dev, NULL, 0, rsc->len, rsc->da, in rproc_handle_carveout()
870 rproc_release_carveout, rsc->name); in rproc_handle_carveout()
873 return -ENOMEM; in rproc_handle_carveout()
876 carveout->flags = rsc->flags; in rproc_handle_carveout()
877 carveout->rsc_offset = offset; in rproc_handle_carveout()
884 * rproc_add_carveout() - register an allocated carveout region
893 list_add_tail(&mem->node, &rproc->carveouts); in rproc_add_carveout()
898 * rproc_mem_entry_init() - allocate and initialize rproc_mem_entry struct
928 mem->va = va; in rproc_mem_entry_init()
929 mem->dma = dma; in rproc_mem_entry_init()
930 mem->da = da; in rproc_mem_entry_init()
931 mem->len = len; in rproc_mem_entry_init()
932 mem->alloc = alloc; in rproc_mem_entry_init()
933 mem->release = release; in rproc_mem_entry_init()
934 mem->rsc_offset = FW_RSC_ADDR_ANY; in rproc_mem_entry_init()
935 mem->of_resm_idx = -1; in rproc_mem_entry_init()
938 vsnprintf(mem->name, sizeof(mem->name), name, args); in rproc_mem_entry_init()
946 * rproc_of_resm_mem_entry_init() - allocate and initialize rproc_mem_entry struct
949 * @of_resm_idx: reserved memory phandle index in "memory-region"
971 mem->da = da; in rproc_of_resm_mem_entry_init()
972 mem->len = len; in rproc_of_resm_mem_entry_init()
973 mem->rsc_offset = FW_RSC_ADDR_ANY; in rproc_of_resm_mem_entry_init()
974 mem->of_resm_idx = of_resm_idx; in rproc_of_resm_mem_entry_init()
977 vsnprintf(mem->name, sizeof(mem->name), name, args); in rproc_of_resm_mem_entry_init()
985 * rproc_of_parse_firmware() - parse and return the firmware-name
987 * @index: index to use for the firmware-name retrieval
992 * the "firmware-name" property and returns the firmware name pointer
1001 ret = of_property_read_string_index(dev->of_node, "firmware-name", in rproc_of_parse_firmware()
1022 struct device *dev = &rproc->dev; in rproc_handle_resources()
1026 if (!rproc->table_ptr) in rproc_handle_resources()
1029 for (i = 0; i < rproc->table_ptr->num; i++) { in rproc_handle_resources()
1030 int offset = rproc->table_ptr->offset[i]; in rproc_handle_resources()
1031 struct fw_rsc_hdr *hdr = (void *)rproc->table_ptr + offset; in rproc_handle_resources()
1032 int avail = rproc->table_sz - offset - sizeof(*hdr); in rproc_handle_resources()
1038 return -EINVAL; in rproc_handle_resources()
1041 dev_dbg(dev, "rsc: type %d\n", hdr->type); in rproc_handle_resources()
1043 if (hdr->type >= RSC_VENDOR_START && in rproc_handle_resources()
1044 hdr->type <= RSC_VENDOR_END) { in rproc_handle_resources()
1045 ret = rproc_handle_rsc(rproc, hdr->type, rsc, in rproc_handle_resources()
1053 hdr->type); in rproc_handle_resources()
1057 if (hdr->type >= RSC_LAST) { in rproc_handle_resources()
1058 dev_warn(dev, "unsupported resource %d\n", hdr->type); in rproc_handle_resources()
1062 handler = handlers[hdr->type]; in rproc_handle_resources()
1079 list_for_each_entry(subdev, &rproc->subdevs, node) { in rproc_prepare_subdevices()
1080 if (subdev->prepare) { in rproc_prepare_subdevices()
1081 ret = subdev->prepare(subdev); in rproc_prepare_subdevices()
1090 list_for_each_entry_continue_reverse(subdev, &rproc->subdevs, node) { in rproc_prepare_subdevices()
1091 if (subdev->unprepare) in rproc_prepare_subdevices()
1092 subdev->unprepare(subdev); in rproc_prepare_subdevices()
1103 list_for_each_entry(subdev, &rproc->subdevs, node) { in rproc_start_subdevices()
1104 if (subdev->start) { in rproc_start_subdevices()
1105 ret = subdev->start(subdev); in rproc_start_subdevices()
1114 list_for_each_entry_continue_reverse(subdev, &rproc->subdevs, node) { in rproc_start_subdevices()
1115 if (subdev->stop) in rproc_start_subdevices()
1116 subdev->stop(subdev, true); in rproc_start_subdevices()
1126 list_for_each_entry_reverse(subdev, &rproc->subdevs, node) { in rproc_stop_subdevices()
1127 if (subdev->stop) in rproc_stop_subdevices()
1128 subdev->stop(subdev, crashed); in rproc_stop_subdevices()
1136 list_for_each_entry_reverse(subdev, &rproc->subdevs, node) { in rproc_unprepare_subdevices()
1137 if (subdev->unprepare) in rproc_unprepare_subdevices()
1138 subdev->unprepare(subdev); in rproc_unprepare_subdevices()
1143 * rproc_alloc_registered_carveouts() - allocate all carveouts registered
1157 struct device *dev = &rproc->dev; in rproc_alloc_registered_carveouts()
1161 list_for_each_entry_safe(entry, tmp, &rproc->carveouts, node) { in rproc_alloc_registered_carveouts()
1162 if (entry->alloc) { in rproc_alloc_registered_carveouts()
1163 ret = entry->alloc(rproc, entry); in rproc_alloc_registered_carveouts()
1166 entry->name, ret); in rproc_alloc_registered_carveouts()
1167 return -ENOMEM; in rproc_alloc_registered_carveouts()
1171 if (entry->rsc_offset != FW_RSC_ADDR_ANY) { in rproc_alloc_registered_carveouts()
1173 rsc = (void *)rproc->table_ptr + entry->rsc_offset; in rproc_alloc_registered_carveouts()
1179 * on-chip hardware accelerators that are not behind in rproc_alloc_registered_carveouts()
1188 * Non-IOMMU processors might also want to have this info. in rproc_alloc_registered_carveouts()
1194 if (entry->va) in rproc_alloc_registered_carveouts()
1195 pa = (u64)rproc_va_to_pa(entry->va); in rproc_alloc_registered_carveouts()
1197 pa = (u64)entry->dma; in rproc_alloc_registered_carveouts()
1203 rsc->pa = (u32)pa; in rproc_alloc_registered_carveouts()
1204 rsc->da = entry->da; in rproc_alloc_registered_carveouts()
1205 rsc->len = entry->len; in rproc_alloc_registered_carveouts()
1214 * rproc_resource_cleanup() - clean up and free all acquired resources
1225 struct device *dev = &rproc->dev; in rproc_resource_cleanup()
1228 list_for_each_entry_safe(trace, ttmp, &rproc->traces, node) { in rproc_resource_cleanup()
1229 rproc_remove_trace_file(trace->tfile); in rproc_resource_cleanup()
1230 rproc->num_traces--; in rproc_resource_cleanup()
1231 list_del(&trace->node); in rproc_resource_cleanup()
1236 list_for_each_entry_safe(entry, tmp, &rproc->mappings, node) { in rproc_resource_cleanup()
1239 unmapped = iommu_unmap(rproc->domain, entry->da, entry->len); in rproc_resource_cleanup()
1240 if (unmapped != entry->len) { in rproc_resource_cleanup()
1242 dev_err(dev, "failed to unmap %zx/%zu\n", entry->len, in rproc_resource_cleanup()
1246 list_del(&entry->node); in rproc_resource_cleanup()
1251 list_for_each_entry_safe(entry, tmp, &rproc->carveouts, node) { in rproc_resource_cleanup()
1252 if (entry->release) in rproc_resource_cleanup()
1253 entry->release(rproc, entry); in rproc_resource_cleanup()
1254 list_del(&entry->node); in rproc_resource_cleanup()
1259 list_for_each_entry_safe(rvdev, rvtmp, &rproc->rvdevs, node) in rproc_resource_cleanup()
1260 platform_device_unregister(rvdev->pdev); in rproc_resource_cleanup()
1269 struct device *dev = &rproc->dev; in rproc_start()
1280 * The starting device has been given the rproc->cached_table as the in rproc_start()
1289 memcpy(loaded_table, rproc->cached_table, rproc->table_sz); in rproc_start()
1290 rproc->table_ptr = loaded_table; in rproc_start()
1296 rproc->name, ret); in rproc_start()
1301 ret = rproc->ops->start(rproc); in rproc_start()
1303 dev_err(dev, "can't start rproc %s: %d\n", rproc->name, ret); in rproc_start()
1311 rproc->name, ret); in rproc_start()
1315 rproc->state = RPROC_RUNNING; in rproc_start()
1317 dev_info(dev, "remote processor %s is now up\n", rproc->name); in rproc_start()
1322 rproc->ops->stop(rproc); in rproc_start()
1326 rproc->table_ptr = rproc->cached_table; in rproc_start()
1333 struct device *dev = &rproc->dev; in __rproc_attach()
1339 rproc->name, ret); in __rproc_attach()
1340 goto out; in __rproc_attach()
1347 rproc->name, ret); in __rproc_attach()
1355 rproc->name, ret); in __rproc_attach()
1359 rproc->state = RPROC_ATTACHED; in __rproc_attach()
1361 dev_info(dev, "remote processor %s is now attached\n", rproc->name); in __rproc_attach()
1366 rproc->ops->stop(rproc); in __rproc_attach()
1369 out: in __rproc_attach()
1378 struct device *dev = &rproc->dev; in rproc_fw_boot()
1379 const char *name = rproc->firmware; in rproc_fw_boot()
1386 dev_info(dev, "Booting fw image %s, size %zd\n", name, fw->size); in rproc_fw_boot()
1401 dev_err(dev, "can't prepare rproc %s: %d\n", rproc->name, ret); in rproc_fw_boot()
1405 rproc->bootaddr = rproc_get_boot_addr(rproc, fw); in rproc_fw_boot()
1413 rproc->max_notifyid = -1; in rproc_fw_boot()
1416 rproc->nb_vdev = 0; in rproc_fw_boot()
1441 kfree(rproc->cached_table); in rproc_fw_boot()
1442 rproc->cached_table = NULL; in rproc_fw_boot()
1443 rproc->table_ptr = NULL; in rproc_fw_boot()
1455 struct device *dev = &rproc->dev; in rproc_set_rsc_table()
1474 * the remote processor is re-attached, that is: in rproc_set_rsc_table()
1476 * DETACHED -> ATTACHED -> DETACHED -> ATTACHED in rproc_set_rsc_table()
1481 if (rproc->ops->detach) { in rproc_set_rsc_table()
1482 rproc->clean_table = kmemdup(table_ptr, table_sz, GFP_KERNEL); in rproc_set_rsc_table()
1483 if (!rproc->clean_table) in rproc_set_rsc_table()
1484 return -ENOMEM; in rproc_set_rsc_table()
1486 rproc->clean_table = NULL; in rproc_set_rsc_table()
1489 rproc->cached_table = NULL; in rproc_set_rsc_table()
1490 rproc->table_ptr = table_ptr; in rproc_set_rsc_table()
1491 rproc->table_sz = table_sz; in rproc_set_rsc_table()
1501 if (!rproc->table_ptr) in rproc_reset_rsc_table_on_detach()
1509 if (WARN_ON(!rproc->clean_table)) in rproc_reset_rsc_table_on_detach()
1510 return -EINVAL; in rproc_reset_rsc_table_on_detach()
1513 table_ptr = rproc->table_ptr; in rproc_reset_rsc_table_on_detach()
1522 rproc->cached_table = kmemdup(rproc->table_ptr, in rproc_reset_rsc_table_on_detach()
1523 rproc->table_sz, GFP_KERNEL); in rproc_reset_rsc_table_on_detach()
1524 if (!rproc->cached_table) in rproc_reset_rsc_table_on_detach()
1525 return -ENOMEM; in rproc_reset_rsc_table_on_detach()
1531 rproc->table_ptr = rproc->cached_table; in rproc_reset_rsc_table_on_detach()
1535 * to its original value. That way when we re-attach the remote in rproc_reset_rsc_table_on_detach()
1538 memcpy(table_ptr, rproc->clean_table, rproc->table_sz); in rproc_reset_rsc_table_on_detach()
1544 kfree(rproc->clean_table); in rproc_reset_rsc_table_on_detach()
1552 if (!rproc->table_ptr) in rproc_reset_rsc_table_on_stop()
1560 if (rproc->cached_table) in rproc_reset_rsc_table_on_stop()
1561 goto out; in rproc_reset_rsc_table_on_stop()
1570 rproc->cached_table = kmemdup(rproc->table_ptr, in rproc_reset_rsc_table_on_stop()
1571 rproc->table_sz, GFP_KERNEL); in rproc_reset_rsc_table_on_stop()
1572 if (!rproc->cached_table) in rproc_reset_rsc_table_on_stop()
1573 return -ENOMEM; in rproc_reset_rsc_table_on_stop()
1579 kfree(rproc->clean_table); in rproc_reset_rsc_table_on_stop()
1581 out: in rproc_reset_rsc_table_on_stop()
1586 rproc->table_ptr = rproc->cached_table; in rproc_reset_rsc_table_on_stop()
1591 * Attach to remote processor - similar to rproc_fw_boot() but without
1596 struct device *dev = &rproc->dev; in rproc_attach()
1612 dev_err(dev, "can't prepare rproc %s: %d\n", rproc->name, ret); in rproc_attach()
1623 rproc->max_notifyid = -1; in rproc_attach()
1626 rproc->nb_vdev = 0; in rproc_attach()
1631 * we expect the platform driver to properly set rproc->table_ptr. in rproc_attach()
1690 if (rproc->state == RPROC_DETACHED) in rproc_trigger_auto_boot()
1695 * be built-in kernel code, without hanging the boot process. in rproc_trigger_auto_boot()
1698 rproc->firmware, &rproc->dev, GFP_KERNEL, in rproc_trigger_auto_boot()
1701 dev_err(&rproc->dev, "request_firmware_nowait err: %d\n", ret); in rproc_trigger_auto_boot()
1708 struct device *dev = &rproc->dev; in rproc_stop()
1712 if (!rproc->ops->stop) in rproc_stop()
1713 return -EINVAL; in rproc_stop()
1727 ret = rproc->ops->stop(rproc); in rproc_stop()
1735 rproc->state = RPROC_OFFLINE; in rproc_stop()
1737 dev_info(dev, "stopped remote processor %s\n", rproc->name); in rproc_stop()
1747 struct device *dev = &rproc->dev; in __rproc_detach()
1751 if (!rproc->ops->detach) in __rproc_detach()
1752 return -EINVAL; in __rproc_detach()
1765 ret = rproc->ops->detach(rproc); in __rproc_detach()
1773 rproc->state = RPROC_DETACHED; in __rproc_detach()
1775 dev_info(dev, "detached remote processor %s\n", rproc->name); in __rproc_detach()
1794 struct device *dev = &rproc->dev; in rproc_boot_recovery()
1802 rproc->ops->coredump(rproc); in rproc_boot_recovery()
1805 ret = request_firmware(&firmware_p, rproc->firmware, dev); in rproc_boot_recovery()
1820 * rproc_trigger_recovery() - recover a remoteproc
1824 * rpmsg drivers will be reseted along with the remote processor making the
1833 struct device *dev = &rproc->dev; in rproc_trigger_recovery()
1836 ret = mutex_lock_interruptible(&rproc->lock); in rproc_trigger_recovery()
1841 if (rproc->state != RPROC_CRASHED) in rproc_trigger_recovery()
1844 dev_err(dev, "recovering %s\n", rproc->name); in rproc_trigger_recovery()
1852 mutex_unlock(&rproc->lock); in rproc_trigger_recovery()
1857 * rproc_crash_handler_work() - handle a crash
1866 struct device *dev = &rproc->dev; in rproc_crash_handler_work()
1870 mutex_lock(&rproc->lock); in rproc_crash_handler_work()
1872 if (rproc->state == RPROC_CRASHED) { in rproc_crash_handler_work()
1874 mutex_unlock(&rproc->lock); in rproc_crash_handler_work()
1878 if (rproc->state == RPROC_OFFLINE) { in rproc_crash_handler_work()
1880 mutex_unlock(&rproc->lock); in rproc_crash_handler_work()
1881 goto out; in rproc_crash_handler_work()
1884 rproc->state = RPROC_CRASHED; in rproc_crash_handler_work()
1885 dev_err(dev, "handling crash #%u in %s\n", ++rproc->crash_cnt, in rproc_crash_handler_work()
1886 rproc->name); in rproc_crash_handler_work()
1888 mutex_unlock(&rproc->lock); in rproc_crash_handler_work()
1890 if (!rproc->recovery_disabled) in rproc_crash_handler_work()
1893 out: in rproc_crash_handler_work()
1894 pm_relax(rproc->dev.parent); in rproc_crash_handler_work()
1898 * rproc_boot() - boot a remote processor
1916 return -EINVAL; in rproc_boot()
1919 dev = &rproc->dev; in rproc_boot()
1921 ret = mutex_lock_interruptible(&rproc->lock); in rproc_boot()
1923 dev_err(dev, "can't lock rproc %s: %d\n", rproc->name, ret); in rproc_boot()
1927 if (rproc->state == RPROC_DELETED) { in rproc_boot()
1928 ret = -ENODEV; in rproc_boot()
1929 dev_err(dev, "can't boot deleted rproc %s\n", rproc->name); in rproc_boot()
1934 if (atomic_inc_return(&rproc->power) > 1) { in rproc_boot()
1939 if (rproc->state == RPROC_DETACHED) { in rproc_boot()
1940 dev_info(dev, "attaching to %s\n", rproc->name); in rproc_boot()
1944 dev_info(dev, "powering up %s\n", rproc->name); in rproc_boot()
1947 ret = request_firmware(&firmware_p, rproc->firmware, dev); in rproc_boot()
1960 atomic_dec(&rproc->power); in rproc_boot()
1962 mutex_unlock(&rproc->lock); in rproc_boot()
1968 * rproc_shutdown() - power off the remote processor
1981 * - we're not decrementing the rproc's refcount, only the power refcount.
1990 struct device *dev = &rproc->dev; in rproc_shutdown()
1993 ret = mutex_lock_interruptible(&rproc->lock); in rproc_shutdown()
1995 dev_err(dev, "can't lock rproc %s: %d\n", rproc->name, ret); in rproc_shutdown()
1999 if (rproc->state != RPROC_RUNNING && in rproc_shutdown()
2000 rproc->state != RPROC_ATTACHED) { in rproc_shutdown()
2001 ret = -EINVAL; in rproc_shutdown()
2002 goto out; in rproc_shutdown()
2005 /* if the remote proc is still needed, bail out */ in rproc_shutdown()
2006 if (!atomic_dec_and_test(&rproc->power)) in rproc_shutdown()
2007 goto out; in rproc_shutdown()
2011 atomic_inc(&rproc->power); in rproc_shutdown()
2012 goto out; in rproc_shutdown()
2024 kfree(rproc->cached_table); in rproc_shutdown()
2025 rproc->cached_table = NULL; in rproc_shutdown()
2026 rproc->table_ptr = NULL; in rproc_shutdown()
2027 out: in rproc_shutdown()
2028 mutex_unlock(&rproc->lock); in rproc_shutdown()
2034 * rproc_detach() - Detach the remote processor from the
2055 struct device *dev = &rproc->dev; in rproc_detach()
2058 ret = mutex_lock_interruptible(&rproc->lock); in rproc_detach()
2060 dev_err(dev, "can't lock rproc %s: %d\n", rproc->name, ret); in rproc_detach()
2064 if (rproc->state != RPROC_ATTACHED) { in rproc_detach()
2065 ret = -EINVAL; in rproc_detach()
2066 goto out; in rproc_detach()
2069 /* if the remote proc is still needed, bail out */ in rproc_detach()
2070 if (!atomic_dec_and_test(&rproc->power)) { in rproc_detach()
2072 goto out; in rproc_detach()
2077 atomic_inc(&rproc->power); in rproc_detach()
2078 goto out; in rproc_detach()
2090 kfree(rproc->cached_table); in rproc_detach()
2091 rproc->cached_table = NULL; in rproc_detach()
2092 rproc->table_ptr = NULL; in rproc_detach()
2093 out: in rproc_detach()
2094 mutex_unlock(&rproc->lock); in rproc_detach()
2100 * rproc_get_by_phandle() - find a remote processor by phandle
2123 if (r->dev.parent && device_match_of_node(r->dev.parent, np)) { in rproc_get_by_phandle()
2125 if (!try_module_get(r->dev.parent->driver->owner)) { in rproc_get_by_phandle()
2126 dev_err(&r->dev, "can't get owner\n"); in rproc_get_by_phandle()
2131 get_device(&rproc->dev); in rproc_get_by_phandle()
2150 * rproc_set_firmware() - assign a new firmware
2161 * sysfs or a kernel-level remoteproc or a remoteproc client driver to set
2174 return -EINVAL; in rproc_set_firmware()
2176 dev = rproc->dev.parent; in rproc_set_firmware()
2178 ret = mutex_lock_interruptible(&rproc->lock); in rproc_set_firmware()
2180 dev_err(dev, "can't lock rproc %s: %d\n", rproc->name, ret); in rproc_set_firmware()
2181 return -EINVAL; in rproc_set_firmware()
2184 if (rproc->state != RPROC_OFFLINE) { in rproc_set_firmware()
2186 ret = -EBUSY; in rproc_set_firmware()
2187 goto out; in rproc_set_firmware()
2193 ret = -EINVAL; in rproc_set_firmware()
2194 goto out; in rproc_set_firmware()
2199 ret = -ENOMEM; in rproc_set_firmware()
2200 goto out; in rproc_set_firmware()
2203 kfree_const(rproc->firmware); in rproc_set_firmware()
2204 rproc->firmware = p; in rproc_set_firmware()
2206 out: in rproc_set_firmware()
2207 mutex_unlock(&rproc->lock); in rproc_set_firmware()
2214 switch (rproc->state) { in rproc_validate()
2220 if (!rproc->ops->start) in rproc_validate()
2221 return -EINVAL; in rproc_validate()
2228 if (!rproc->ops->attach) in rproc_validate()
2229 return -EINVAL; in rproc_validate()
2235 if (rproc->cached_table) in rproc_validate()
2236 return -EINVAL; in rproc_validate()
2243 return -EINVAL; in rproc_validate()
2250 * rproc_add() - register a remote processor
2256 * This is called by the platform-specific rproc implementation, whenever
2271 struct device *dev = &rproc->dev; in rproc_add()
2289 dev_info(dev, "%s is available\n", rproc->name); in rproc_add()
2294 /* if rproc is marked always-on, request it to boot */ in rproc_add()
2295 if (rproc->auto_boot) { in rproc_add()
2303 list_add_rcu(&rproc->node, &rproc_list); in rproc_add()
2323 * devm_rproc_add() - resource managed rproc_add()
2345 * rproc_type_release() - release a remote processor instance
2357 dev_info(&rproc->dev, "releasing %s\n", rproc->name); in rproc_type_release()
2359 idr_destroy(&rproc->notifyids); in rproc_type_release()
2361 if (rproc->index >= 0) in rproc_type_release()
2362 ida_free(&rproc_dev_index, rproc->index); in rproc_type_release()
2364 kfree_const(rproc->firmware); in rproc_type_release()
2365 kfree_const(rproc->name); in rproc_type_release()
2366 kfree(rproc->ops); in rproc_type_release()
2387 p = kasprintf(GFP_KERNEL, "rproc-%s-fw", name); in rproc_alloc_firmware()
2390 return -ENOMEM; in rproc_alloc_firmware()
2392 rproc->firmware = p; in rproc_alloc_firmware()
2399 rproc->ops = kmemdup(ops, sizeof(*ops), GFP_KERNEL); in rproc_alloc_ops()
2400 if (!rproc->ops) in rproc_alloc_ops()
2401 return -ENOMEM; in rproc_alloc_ops()
2404 if (!rproc->ops->coredump) in rproc_alloc_ops()
2405 rproc->ops->coredump = rproc_coredump; in rproc_alloc_ops()
2407 if (rproc->ops->load) in rproc_alloc_ops()
2411 rproc->ops->load = rproc_elf_load_segments; in rproc_alloc_ops()
2412 rproc->ops->parse_fw = rproc_elf_load_rsc_table; in rproc_alloc_ops()
2413 rproc->ops->find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table; in rproc_alloc_ops()
2414 rproc->ops->sanity_check = rproc_elf_sanity_check; in rproc_alloc_ops()
2415 rproc->ops->get_boot_addr = rproc_elf_get_boot_addr; in rproc_alloc_ops()
2421 * rproc_alloc() - allocate a remote processor handle
2424 * @ops: platform-specific handlers (mainly start/stop)
2456 rproc->priv = &rproc[1]; in rproc_alloc()
2457 rproc->auto_boot = true; in rproc_alloc()
2458 rproc->elf_class = ELFCLASSNONE; in rproc_alloc()
2459 rproc->elf_machine = EM_NONE; in rproc_alloc()
2461 device_initialize(&rproc->dev); in rproc_alloc()
2462 rproc->dev.parent = dev; in rproc_alloc()
2463 rproc->dev.type = &rproc_type; in rproc_alloc()
2464 rproc->dev.class = &rproc_class; in rproc_alloc()
2465 rproc->dev.driver_data = rproc; in rproc_alloc()
2466 idr_init(&rproc->notifyids); in rproc_alloc()
2469 rproc->index = ida_alloc(&rproc_dev_index, GFP_KERNEL); in rproc_alloc()
2470 if (rproc->index < 0) { in rproc_alloc()
2471 dev_err(dev, "ida_alloc failed: %d\n", rproc->index); in rproc_alloc()
2475 rproc->name = kstrdup_const(name, GFP_KERNEL); in rproc_alloc()
2476 if (!rproc->name) in rproc_alloc()
2485 dev_set_name(&rproc->dev, "remoteproc%d", rproc->index); in rproc_alloc()
2487 atomic_set(&rproc->power, 0); in rproc_alloc()
2489 mutex_init(&rproc->lock); in rproc_alloc()
2491 INIT_LIST_HEAD(&rproc->carveouts); in rproc_alloc()
2492 INIT_LIST_HEAD(&rproc->mappings); in rproc_alloc()
2493 INIT_LIST_HEAD(&rproc->traces); in rproc_alloc()
2494 INIT_LIST_HEAD(&rproc->rvdevs); in rproc_alloc()
2495 INIT_LIST_HEAD(&rproc->subdevs); in rproc_alloc()
2496 INIT_LIST_HEAD(&rproc->dump_segments); in rproc_alloc()
2498 INIT_WORK(&rproc->crash_handler, rproc_crash_handler_work); in rproc_alloc()
2500 rproc->state = RPROC_OFFLINE; in rproc_alloc()
2505 put_device(&rproc->dev); in rproc_alloc()
2511 * rproc_free() - unroll rproc_alloc()
2521 put_device(&rproc->dev); in rproc_free()
2526 * rproc_put() - release rproc reference
2536 module_put(rproc->dev.parent->driver->owner); in rproc_put()
2537 put_device(&rproc->dev); in rproc_put()
2542 * rproc_del() - unregister a remote processor
2554 * Return: 0 on success and -EINVAL if @rproc isn't valid
2559 return -EINVAL; in rproc_del()
2561 /* TODO: make sure this works with rproc->power > 1 */ in rproc_del()
2564 mutex_lock(&rproc->lock); in rproc_del()
2565 rproc->state = RPROC_DELETED; in rproc_del()
2566 mutex_unlock(&rproc->lock); in rproc_del()
2572 list_del_rcu(&rproc->node); in rproc_del()
2578 device_del(&rproc->dev); in rproc_del()
2591 * devm_rproc_alloc() - resource managed rproc_alloc()
2594 * @ops: platform-specific handlers (mainly start/stop)
2626 * rproc_add_subdev() - add a subdevice to a remoteproc
2634 list_add_tail(&subdev->node, &rproc->subdevs); in rproc_add_subdev()
2639 * rproc_remove_subdev() - remove a subdevice from a remoteproc
2645 list_del(&subdev->node); in rproc_remove_subdev()
2650 * rproc_get_by_child() - acquire rproc handle of @dev's ancestor
2657 for (dev = dev->parent; dev; dev = dev->parent) { in rproc_get_by_child()
2658 if (dev->type == &rproc_type) in rproc_get_by_child()
2659 return dev->driver_data; in rproc_get_by_child()
2667 * rproc_report_crash() - rproc crash reporter function
2671 * This function must be called every time a crash is detected by the low-level
2673 * non-remoteproc driver.
2685 pm_stay_awake(rproc->dev.parent); in rproc_report_crash()
2687 dev_err(&rproc->dev, "crash detected in %s: type %s\n", in rproc_report_crash()
2688 rproc->name, rproc_crash_to_string(type)); in rproc_report_crash()
2690 queue_work(rproc_recovery_wq, &rproc->crash_handler); in rproc_report_crash()
2703 if (!rproc->ops->panic) in rproc_panic_handler()
2706 if (rproc->state != RPROC_RUNNING && in rproc_panic_handler()
2707 rproc->state != RPROC_ATTACHED) in rproc_panic_handler()
2710 d = rproc->ops->panic(rproc); in rproc_panic_handler()
2743 return -ENOMEM; in remoteproc_init()