96 static int stm32_rproc_pa_to_da(struct rproc *rproc, phys_addr_t pa, u64 *da)  in stm32_rproc_pa_to_da()  argument
99 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_pa_to_da()
109 		dev_dbg(rproc->dev.parent, "pa %pa to da %llx\n", &pa, *da);  in stm32_rproc_pa_to_da()
116 static int stm32_rproc_mem_alloc(struct rproc *rproc,  in stm32_rproc_mem_alloc()  argument
119 	struct device *dev = rproc->dev.parent;  in stm32_rproc_mem_alloc()
136 static int stm32_rproc_mem_release(struct rproc *rproc,  in stm32_rproc_mem_release()  argument
139 	dev_dbg(rproc->dev.parent, "unmap memory: %pa\n", &mem->dma);  in stm32_rproc_mem_release()
198 static int stm32_rproc_mbox_idx(struct rproc *rproc, const unsigned char *name)  in stm32_rproc_mbox_idx()  argument
200 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_mbox_idx()
207 	dev_err(&rproc->dev, "mailbox %s not found\n", name);  in stm32_rproc_mbox_idx()
212 static int stm32_rproc_prepare(struct rproc *rproc)  in stm32_rproc_prepare()  argument
214 	struct device *dev = rproc->dev.parent;  in stm32_rproc_prepare()
232 		if (stm32_rproc_pa_to_da(rproc, rmem->base, &da) < 0) {  in stm32_rproc_prepare()
250 				rproc_coredump_add_segment(rproc, da,  in stm32_rproc_prepare()
265 		rproc_add_carveout(rproc, mem);  in stm32_rproc_prepare()
272 static int stm32_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw)  in stm32_rproc_parse_fw()  argument
274 	if (rproc_elf_load_rsc_table(rproc, fw))  in stm32_rproc_parse_fw()
275 		dev_warn(&rproc->dev, "no resource table found for this firmware\n");  in stm32_rproc_parse_fw()
283 	struct rproc *rproc = platform_get_drvdata(pdev);  in stm32_rproc_wdg()  local
285 	rproc_report_crash(rproc, RPROC_WATCHDOG);  in stm32_rproc_wdg()
293 	struct rproc *rproc = dev_get_drvdata(mb->client.dev);  in stm32_rproc_mb_vq_work()  local
295 	mutex_lock(&rproc->lock);  in stm32_rproc_mb_vq_work()
297 	if (rproc->state != RPROC_RUNNING && rproc->state != RPROC_ATTACHED)  in stm32_rproc_mb_vq_work()
300 	if (rproc_vq_interrupt(rproc, mb->vq_id) == IRQ_NONE)  in stm32_rproc_mb_vq_work()
301 		dev_dbg(&rproc->dev, "no message found in vq%d\n", mb->vq_id);  in stm32_rproc_mb_vq_work()
304 	mutex_unlock(&rproc->lock);  in stm32_rproc_mb_vq_work()
309 	struct rproc *rproc = dev_get_drvdata(cl->dev);  in stm32_rproc_mb_callback()  local
311 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_mb_callback()
316 static void stm32_rproc_free_mbox(struct rproc *rproc)  in stm32_rproc_free_mbox()  argument
318 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_free_mbox()
365 static int stm32_rproc_request_mbox(struct rproc *rproc)  in stm32_rproc_request_mbox()  argument
367 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_request_mbox()
368 	struct device *dev = &rproc->dev;  in stm32_rproc_request_mbox()
410 static int stm32_rproc_set_hold_boot(struct rproc *rproc, bool hold)  in stm32_rproc_set_hold_boot()  argument
412 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_set_hold_boot()
444 		dev_err(&rproc->dev, "failed to set hold boot\n");  in stm32_rproc_set_hold_boot()
449 static void stm32_rproc_add_coredump_trace(struct rproc *rproc)  in stm32_rproc_add_coredump_trace()  argument
455 	list_for_each_entry(trace, &rproc->traces, node) {  in stm32_rproc_add_coredump_trace()
458 		list_for_each_entry(segment, &rproc->dump_segments, node) {  in stm32_rproc_add_coredump_trace()
466 			rproc_coredump_add_segment(rproc, trace->trace_mem.da,  in stm32_rproc_add_coredump_trace()
471 static int stm32_rproc_start(struct rproc *rproc)  in stm32_rproc_start()  argument
473 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_start()
476 	stm32_rproc_add_coredump_trace(rproc);  in stm32_rproc_start()
483 			dev_err(&rproc->dev, "failed to clear pdds\n");  in stm32_rproc_start()
488 	err = stm32_rproc_set_hold_boot(rproc, false);  in stm32_rproc_start()
492 	return stm32_rproc_set_hold_boot(rproc, true);  in stm32_rproc_start()
495 static int stm32_rproc_attach(struct rproc *rproc)  in stm32_rproc_attach()  argument
497 	stm32_rproc_add_coredump_trace(rproc);  in stm32_rproc_attach()
499 	return stm32_rproc_set_hold_boot(rproc, true);  in stm32_rproc_attach()
502 static int stm32_rproc_detach(struct rproc *rproc)  in stm32_rproc_detach()  argument
504 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_detach()
508 	idx = stm32_rproc_mbox_idx(rproc, STM32_MBX_DETACH);  in stm32_rproc_detach()
512 			dev_warn(&rproc->dev, "warning: remote FW detach without ack\n");  in stm32_rproc_detach()
516 	return stm32_rproc_set_hold_boot(rproc, false);  in stm32_rproc_detach()
519 static int stm32_rproc_stop(struct rproc *rproc)  in stm32_rproc_stop()  argument
521 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_stop()
525 	if (rproc->state != RPROC_OFFLINE && rproc->state != RPROC_CRASHED) {  in stm32_rproc_stop()
526 		idx = stm32_rproc_mbox_idx(rproc, STM32_MBX_SHUTDOWN);  in stm32_rproc_stop()
530 				dev_warn(&rproc->dev, "warning: remote FW shutdown without ack\n");  in stm32_rproc_stop()
534 	err = stm32_rproc_set_hold_boot(rproc, true);  in stm32_rproc_stop()
540 		dev_err(&rproc->dev, "failed to assert the reset\n");  in stm32_rproc_stop()
549 			dev_err(&rproc->dev, "failed to set pdds\n");  in stm32_rproc_stop()
561 			dev_err(&rproc->dev, "failed to set copro state\n");  in stm32_rproc_stop()
569 static void stm32_rproc_kick(struct rproc *rproc, int vqid)  in stm32_rproc_kick()  argument
571 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_kick()
585 			dev_err(&rproc->dev, "%s: failed (%s, err:%d)\n",  in stm32_rproc_kick()
591 static int stm32_rproc_da_to_pa(struct rproc *rproc,  in stm32_rproc_da_to_pa()  argument
594 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_da_to_pa()
595 	struct device *dev = rproc->dev.parent;  in stm32_rproc_da_to_pa()
618 stm32_rproc_get_loaded_rsc_table(struct rproc *rproc, size_t *table_sz)  in stm32_rproc_get_loaded_rsc_table()  argument
620 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_get_loaded_rsc_table()
621 	struct device *dev = rproc->dev.parent;  in stm32_rproc_get_loaded_rsc_table()
640 	err = stm32_rproc_da_to_pa(rproc, rsc_da, &rsc_pa);  in stm32_rproc_get_loaded_rsc_table()
657 	 * entire area by overwriting it with the initial values stored in rproc->clean_table.  in stm32_rproc_get_loaded_rsc_table()
838 	struct rproc *rproc;  in stm32_rproc_probe()  local
846 	rproc = rproc_alloc(dev, np->name, &st_rproc_ops, NULL, sizeof(*ddata));  in stm32_rproc_probe()
847 	if (!rproc)  in stm32_rproc_probe()
850 	ddata = rproc->priv;  in stm32_rproc_probe()
852 	rproc_coredump_set_elf_info(rproc, ELFCLASS32, EM_NONE);  in stm32_rproc_probe()
854 	ret = stm32_rproc_parse_dt(pdev, ddata, &rproc->auto_boot);  in stm32_rproc_probe()
867 		rproc->state = RPROC_DETACHED;  in stm32_rproc_probe()
869 	rproc->has_iommu = false;  in stm32_rproc_probe()
877 	platform_set_drvdata(pdev, rproc);  in stm32_rproc_probe()
879 	ret = stm32_rproc_request_mbox(rproc);  in stm32_rproc_probe()
883 	ret = rproc_add(rproc);  in stm32_rproc_probe()
890 	stm32_rproc_free_mbox(rproc);  in stm32_rproc_probe()
894 	rproc_resource_cleanup(rproc);  in stm32_rproc_probe()
900 	rproc_free(rproc);  in stm32_rproc_probe()
906 	struct rproc *rproc = platform_get_drvdata(pdev);  in stm32_rproc_remove()  local
907 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_remove()
910 	if (atomic_read(&rproc->power) > 0)  in stm32_rproc_remove()
911 		rproc_shutdown(rproc);  in stm32_rproc_remove()
913 	rproc_del(rproc);  in stm32_rproc_remove()
914 	stm32_rproc_free_mbox(rproc);  in stm32_rproc_remove()
921 	rproc_free(rproc);  in stm32_rproc_remove()
926 	struct rproc *rproc = dev_get_drvdata(dev);  in stm32_rproc_suspend()  local
927 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_suspend()
937 	struct rproc *rproc = dev_get_drvdata(dev);  in stm32_rproc_resume()  local
938 	struct stm32_rproc *ddata = rproc->priv;  in stm32_rproc_resume()
953 		.name = "stm32-rproc",