Lines Matching +full:rst +full:- +full:syscon
1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (C) STMicroelectronics 2018 - All Rights Reserved
8 #include <linux/arm-smccc.h>
9 #include <linux/dma-mapping.h>
13 #include <linux/mfd/syscon.h>
80 struct reset_control *rst; member
97 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_pa_to_da()
100 for (i = 0; i < ddata->nb_rmems; i++) { in stm32_rproc_pa_to_da()
101 p_mem = &ddata->rmems[i]; in stm32_rproc_pa_to_da()
103 if (pa < p_mem->bus_addr || in stm32_rproc_pa_to_da()
104 pa >= p_mem->bus_addr + p_mem->size) in stm32_rproc_pa_to_da()
106 *da = pa - p_mem->bus_addr + p_mem->dev_addr; in stm32_rproc_pa_to_da()
107 dev_dbg(rproc->dev.parent, "pa %pa to da %llx\n", &pa, *da); in stm32_rproc_pa_to_da()
111 return -EINVAL; in stm32_rproc_pa_to_da()
117 struct device *dev = rproc->dev.parent; in stm32_rproc_mem_alloc()
120 dev_dbg(dev, "map memory: %pa+%x\n", &mem->dma, mem->len); in stm32_rproc_mem_alloc()
121 va = ioremap_wc(mem->dma, mem->len); in stm32_rproc_mem_alloc()
124 &mem->dma, mem->len); in stm32_rproc_mem_alloc()
125 return -ENOMEM; in stm32_rproc_mem_alloc()
129 mem->va = va; in stm32_rproc_mem_alloc()
137 dev_dbg(rproc->dev.parent, "unmap memory: %pa\n", &mem->dma); in stm32_rproc_mem_release()
138 iounmap(mem->va); in stm32_rproc_mem_release()
146 struct device *parent, *dev = &pdev->dev; in stm32_rproc_of_memory_translations()
152 parent = dev->parent; in stm32_rproc_of_memory_translations()
153 np = parent->of_node; in stm32_rproc_of_memory_translations()
155 cnt = of_property_count_elems_of_size(np, "dma-ranges", in stm32_rproc_of_memory_translations()
158 dev_err(dev, "%s: dma-ranges property not defined\n", __func__); in stm32_rproc_of_memory_translations()
159 return -EINVAL; in stm32_rproc_of_memory_translations()
164 return -ENOMEM; in stm32_rproc_of_memory_translations()
167 return -ENOMEM; in stm32_rproc_of_memory_translations()
171 ret = of_property_read_u32_array(np, "dma-ranges", in stm32_rproc_of_memory_translations()
174 dev_err(dev, "error while get dma-ranges property: %x\n", ret); in stm32_rproc_of_memory_translations()
188 ddata->rmems = p_mems; in stm32_rproc_of_memory_translations()
189 ddata->nb_rmems = cnt; in stm32_rproc_of_memory_translations()
198 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_mbox_idx()
201 for (i = 0; i < ARRAY_SIZE(ddata->mb); i++) { in stm32_rproc_mbox_idx()
202 if (!strncmp(ddata->mb[i].name, name, strlen(name))) in stm32_rproc_mbox_idx()
205 dev_err(&rproc->dev, "mailbox %s not found\n", name); in stm32_rproc_mbox_idx()
207 return -EINVAL; in stm32_rproc_mbox_idx()
214 dev_warn(&rproc->dev, "no resource table found for this firmware\n"); in stm32_rproc_elf_load_rsc_table()
221 struct device *dev = rproc->dev.parent; in stm32_rproc_parse_memory_regions()
222 struct device_node *np = dev->of_node; in stm32_rproc_parse_memory_regions()
230 of_phandle_iterator_init(&it, np, "memory-region", NULL, 0); in stm32_rproc_parse_memory_regions()
235 dev_err(dev, "unable to acquire memory-region\n"); in stm32_rproc_parse_memory_regions()
236 return -EINVAL; in stm32_rproc_parse_memory_regions()
239 if (stm32_rproc_pa_to_da(rproc, rmem->base, &da) < 0) { in stm32_rproc_parse_memory_regions()
242 &rmem->base); in stm32_rproc_parse_memory_regions()
243 return -EINVAL; in stm32_rproc_parse_memory_regions()
247 if (strcmp(it.node->name, "vdev0buffer")) { in stm32_rproc_parse_memory_regions()
250 (dma_addr_t)rmem->base, in stm32_rproc_parse_memory_regions()
251 rmem->size, da, in stm32_rproc_parse_memory_regions()
254 it.node->name); in stm32_rproc_parse_memory_regions()
258 rmem->size); in stm32_rproc_parse_memory_regions()
262 rmem->size, in stm32_rproc_parse_memory_regions()
263 rmem->base, in stm32_rproc_parse_memory_regions()
264 it.node->name); in stm32_rproc_parse_memory_regions()
269 return -ENOMEM; in stm32_rproc_parse_memory_regions()
302 struct rproc *rproc = dev_get_drvdata(mb->client.dev); in stm32_rproc_mb_vq_work()
304 mutex_lock(&rproc->lock); in stm32_rproc_mb_vq_work()
306 if (rproc->state != RPROC_RUNNING) in stm32_rproc_mb_vq_work()
309 if (rproc_vq_interrupt(rproc, mb->vq_id) == IRQ_NONE) in stm32_rproc_mb_vq_work()
310 dev_dbg(&rproc->dev, "no message found in vq%d\n", mb->vq_id); in stm32_rproc_mb_vq_work()
313 mutex_unlock(&rproc->lock); in stm32_rproc_mb_vq_work()
318 struct rproc *rproc = dev_get_drvdata(cl->dev); in stm32_rproc_mb_callback()
320 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_mb_callback()
322 queue_work(ddata->workqueue, &mb->vq_work); in stm32_rproc_mb_callback()
327 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_free_mbox()
330 for (i = 0; i < ARRAY_SIZE(ddata->mb); i++) { in stm32_rproc_free_mbox()
331 if (ddata->mb[i].chan) in stm32_rproc_free_mbox()
332 mbox_free_channel(ddata->mb[i].chan); in stm32_rproc_free_mbox()
333 ddata->mb[i].chan = NULL; in stm32_rproc_free_mbox()
356 .vq_id = -1,
367 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_request_mbox()
368 struct device *dev = &rproc->dev; in stm32_rproc_request_mbox()
375 memcpy(ddata->mb, stm32_rproc_mbox, sizeof(stm32_rproc_mbox)); in stm32_rproc_request_mbox()
378 name = ddata->mb[i].name; in stm32_rproc_request_mbox()
380 cl = &ddata->mb[i].client; in stm32_rproc_request_mbox()
381 cl->dev = dev->parent; in stm32_rproc_request_mbox()
383 ddata->mb[i].chan = mbox_request_channel_byname(cl, name); in stm32_rproc_request_mbox()
384 if (IS_ERR(ddata->mb[i].chan)) { in stm32_rproc_request_mbox()
385 if (PTR_ERR(ddata->mb[i].chan) == -EPROBE_DEFER) in stm32_rproc_request_mbox()
388 ddata->mb[i].chan = NULL; in stm32_rproc_request_mbox()
390 if (ddata->mb[i].vq_id >= 0) { in stm32_rproc_request_mbox()
391 INIT_WORK(&ddata->mb[i].vq_work, in stm32_rproc_request_mbox()
399 for (j = i - 1; j >= 0; j--) in stm32_rproc_request_mbox()
400 if (ddata->mb[j].chan) in stm32_rproc_request_mbox()
401 mbox_free_channel(ddata->mb[j].chan); in stm32_rproc_request_mbox()
402 return -EPROBE_DEFER; in stm32_rproc_request_mbox()
407 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_set_hold_boot()
408 struct stm32_syscon hold_boot = ddata->hold_boot; in stm32_rproc_set_hold_boot()
414 if (IS_ENABLED(CONFIG_HAVE_ARM_SMCCC) && ddata->secured_soc) { in stm32_rproc_set_hold_boot()
424 dev_err(&rproc->dev, "failed to set hold boot\n"); in stm32_rproc_set_hold_boot()
435 list_for_each_entry(trace, &rproc->traces, node) { in stm32_rproc_add_coredump_trace()
438 list_for_each_entry(segment, &rproc->dump_segments, node) { in stm32_rproc_add_coredump_trace()
439 if (segment->da == trace->trace_mem.da) { in stm32_rproc_add_coredump_trace()
446 rproc_coredump_add_segment(rproc, trace->trace_mem.da, in stm32_rproc_add_coredump_trace()
447 trace->trace_mem.len); in stm32_rproc_add_coredump_trace()
453 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_start()
459 if (ddata->pdds.map) { in stm32_rproc_start()
460 err = regmap_update_bits(ddata->pdds.map, ddata->pdds.reg, in stm32_rproc_start()
461 ddata->pdds.mask, 0); in stm32_rproc_start()
463 dev_err(&rproc->dev, "failed to clear pdds\n"); in stm32_rproc_start()
484 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_stop()
488 if (rproc->state != RPROC_OFFLINE) { in stm32_rproc_stop()
490 if (idx >= 0 && ddata->mb[idx].chan) { in stm32_rproc_stop()
492 err = mbox_send_message(ddata->mb[idx].chan, in stm32_rproc_stop()
495 dev_warn(&rproc->dev, "warning: remote FW shutdown without ack\n"); in stm32_rproc_stop()
503 err = reset_control_assert(ddata->rst); in stm32_rproc_stop()
505 dev_err(&rproc->dev, "failed to assert the reset\n"); in stm32_rproc_stop()
510 if (ddata->pdds.map) { in stm32_rproc_stop()
511 err = regmap_update_bits(ddata->pdds.map, ddata->pdds.reg, in stm32_rproc_stop()
512 ddata->pdds.mask, 1); in stm32_rproc_stop()
514 dev_err(&rproc->dev, "failed to set pdds\n"); in stm32_rproc_stop()
520 if (ddata->m4_state.map) { in stm32_rproc_stop()
521 err = regmap_update_bits(ddata->m4_state.map, in stm32_rproc_stop()
522 ddata->m4_state.reg, in stm32_rproc_stop()
523 ddata->m4_state.mask, in stm32_rproc_stop()
526 dev_err(&rproc->dev, "failed to set copro state\n"); in stm32_rproc_stop()
536 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_kick()
544 if (vqid != ddata->mb[i].vq_id) in stm32_rproc_kick()
546 if (!ddata->mb[i].chan) in stm32_rproc_kick()
548 err = mbox_send_message(ddata->mb[i].chan, (void *)(long)vqid); in stm32_rproc_kick()
550 dev_err(&rproc->dev, "%s: failed (%s, err:%d)\n", in stm32_rproc_kick()
551 __func__, ddata->mb[i].name, err); in stm32_rproc_kick()
569 { .compatible = "st,stm32mp1-m4" },
575 struct stm32_syscon *syscon) in stm32_rproc_get_syscon() argument
579 syscon->map = syscon_regmap_lookup_by_phandle(np, prop); in stm32_rproc_get_syscon()
580 if (IS_ERR(syscon->map)) { in stm32_rproc_get_syscon()
581 err = PTR_ERR(syscon->map); in stm32_rproc_get_syscon()
582 syscon->map = NULL; in stm32_rproc_get_syscon()
586 err = of_property_read_u32_index(np, prop, 1, &syscon->reg); in stm32_rproc_get_syscon()
590 err = of_property_read_u32_index(np, prop, 2, &syscon->mask); in stm32_rproc_get_syscon()
599 struct device *dev = &pdev->dev; in stm32_rproc_parse_dt()
600 struct device_node *np = dev->of_node; in stm32_rproc_parse_dt()
606 if (irq == -EPROBE_DEFER) in stm32_rproc_parse_dt()
607 return -EPROBE_DEFER; in stm32_rproc_parse_dt()
617 ddata->wdg_irq = irq; in stm32_rproc_parse_dt()
619 if (of_property_read_bool(np, "wakeup-source")) { in stm32_rproc_parse_dt()
627 ddata->rst = devm_reset_control_get_by_index(dev, 0); in stm32_rproc_parse_dt()
628 if (IS_ERR(ddata->rst)) { in stm32_rproc_parse_dt()
630 return PTR_ERR(ddata->rst); in stm32_rproc_parse_dt()
638 err = stm32_rproc_get_syscon(np, "st,syscfg-tz", &tz); in stm32_rproc_parse_dt()
649 ddata->secured_soc = tzen & tz.mask; in stm32_rproc_parse_dt()
651 err = stm32_rproc_get_syscon(np, "st,syscfg-holdboot", in stm32_rproc_parse_dt()
652 &ddata->hold_boot); in stm32_rproc_parse_dt()
658 err = stm32_rproc_get_syscon(np, "st,syscfg-pdds", &ddata->pdds); in stm32_rproc_parse_dt()
662 *auto_boot = of_property_read_bool(np, "st,auto-boot"); in stm32_rproc_parse_dt()
668 err = stm32_rproc_get_syscon(np, "st,syscfg-m4-state", in stm32_rproc_parse_dt()
669 &ddata->m4_state); in stm32_rproc_parse_dt()
672 ddata->m4_state.map = NULL; in stm32_rproc_parse_dt()
673 /* no coprocessor state syscon (optional) */ in stm32_rproc_parse_dt()
681 err = stm32_rproc_get_syscon(np, "st,syscfg-rsc-tbl", in stm32_rproc_parse_dt()
682 &ddata->rsctbl); in stm32_rproc_parse_dt()
684 /* no rsc table syscon (optional) */ in stm32_rproc_parse_dt()
685 dev_warn(dev, "rsc tbl syscon not supported\n"); in stm32_rproc_parse_dt()
695 if (!ddata->m4_state.map) { in stm32_rproc_get_m4_status()
704 return regmap_read(ddata->m4_state.map, ddata->m4_state.reg, state); in stm32_rproc_get_m4_status()
711 struct device *dev = &pdev->dev; in stm32_rproc_da_to_pa()
715 for (i = 0; i < ddata->nb_rmems; i++) { in stm32_rproc_da_to_pa()
716 p_mem = &ddata->rmems[i]; in stm32_rproc_da_to_pa()
718 if (da < p_mem->dev_addr || in stm32_rproc_da_to_pa()
719 da >= p_mem->dev_addr + p_mem->size) in stm32_rproc_da_to_pa()
722 *pa = da - p_mem->dev_addr + p_mem->bus_addr; in stm32_rproc_da_to_pa()
730 return -EINVAL; in stm32_rproc_da_to_pa()
737 struct device *dev = &pdev->dev; in stm32_rproc_get_loaded_rsc_table()
742 err = regmap_read(ddata->rsctbl.map, ddata->rsctbl.reg, &rsc_da); in stm32_rproc_get_loaded_rsc_table()
756 ddata->rsc_va = devm_ioremap_wc(dev, rsc_pa, RSC_TBL_SIZE); in stm32_rproc_get_loaded_rsc_table()
757 if (IS_ERR_OR_NULL(ddata->rsc_va)) { in stm32_rproc_get_loaded_rsc_table()
760 ddata->rsc_va = NULL; in stm32_rproc_get_loaded_rsc_table()
761 return -ENOMEM; in stm32_rproc_get_loaded_rsc_table()
768 rproc->cached_table = NULL; in stm32_rproc_get_loaded_rsc_table()
770 rproc->table_sz = RSC_TBL_SIZE; in stm32_rproc_get_loaded_rsc_table()
771 rproc->table_ptr = (struct resource_table *)ddata->rsc_va; in stm32_rproc_get_loaded_rsc_table()
778 struct device *dev = &pdev->dev; in stm32_rproc_probe()
780 struct device_node *np = dev->of_node; in stm32_rproc_probe()
789 rproc = rproc_alloc(dev, np->name, &st_rproc_ops, NULL, sizeof(*ddata)); in stm32_rproc_probe()
791 return -ENOMEM; in stm32_rproc_probe()
793 ddata = rproc->priv; in stm32_rproc_probe()
797 ret = stm32_rproc_parse_dt(pdev, ddata, &rproc->auto_boot); in stm32_rproc_probe()
810 rproc->state = RPROC_DETACHED; in stm32_rproc_probe()
821 rproc->has_iommu = false; in stm32_rproc_probe()
822 ddata->workqueue = create_workqueue(dev_name(dev)); in stm32_rproc_probe()
823 if (!ddata->workqueue) { in stm32_rproc_probe()
825 ret = -ENOMEM; in stm32_rproc_probe()
844 destroy_workqueue(ddata->workqueue); in stm32_rproc_probe()
859 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_remove()
860 struct device *dev = &pdev->dev; in stm32_rproc_remove()
862 if (atomic_read(&rproc->power) > 0) in stm32_rproc_remove()
867 destroy_workqueue(ddata->workqueue); in stm32_rproc_remove()
881 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_suspend()
884 return enable_irq_wake(ddata->wdg_irq); in stm32_rproc_suspend()
892 struct stm32_rproc *ddata = rproc->priv; in stm32_rproc_resume()
895 return disable_irq_wake(ddata->wdg_irq); in stm32_rproc_resume()
907 .name = "stm32-rproc",