1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (C) STMicroelectronics 2018 - All Rights Reserved 4 * Authors: Ludovic Barre <ludovic.barre@st.com> for STMicroelectronics. 5 * Fabien Dessenne <fabien.dessenne@st.com> for STMicroelectronics. 6 */ 7 8 #include <linux/arm-smccc.h> 9 #include <linux/dma-mapping.h> 10 #include <linux/interrupt.h> 11 #include <linux/io.h> 12 #include <linux/mailbox_client.h> 13 #include <linux/mfd/syscon.h> 14 #include <linux/module.h> 15 #include <linux/of_address.h> 16 #include <linux/of_device.h> 17 #include <linux/of_reserved_mem.h> 18 #include <linux/pm_wakeirq.h> 19 #include <linux/regmap.h> 20 #include <linux/remoteproc.h> 21 #include <linux/reset.h> 22 #include <linux/slab.h> 23 #include <linux/workqueue.h> 24 25 #include "remoteproc_internal.h" 26 27 #define HOLD_BOOT 0 28 #define RELEASE_BOOT 1 29 30 #define MBOX_NB_VQ 2 31 #define MBOX_NB_MBX 3 32 33 #define STM32_SMC_RCC 0x82001000 34 #define STM32_SMC_REG_WRITE 0x1 35 36 #define STM32_MBX_VQ0 "vq0" 37 #define STM32_MBX_VQ0_ID 0 38 #define STM32_MBX_VQ1 "vq1" 39 #define STM32_MBX_VQ1_ID 1 40 #define STM32_MBX_SHUTDOWN "shutdown" 41 42 #define RSC_TBL_SIZE 1024 43 44 #define M4_STATE_OFF 0 45 #define M4_STATE_INI 1 46 #define M4_STATE_CRUN 2 47 #define M4_STATE_CSTOP 3 48 #define M4_STATE_STANDBY 4 49 #define M4_STATE_CRASH 5 50 51 struct stm32_syscon { 52 struct regmap *map; 53 u32 reg; 54 u32 mask; 55 }; 56 57 struct stm32_rproc_mem { 58 char name[20]; 59 void __iomem *cpu_addr; 60 phys_addr_t bus_addr; 61 u32 dev_addr; 62 size_t size; 63 }; 64 65 struct stm32_rproc_mem_ranges { 66 u32 dev_addr; 67 u32 bus_addr; 68 u32 size; 69 }; 70 71 struct stm32_mbox { 72 const unsigned char name[10]; 73 struct mbox_chan *chan; 74 struct mbox_client client; 75 struct work_struct vq_work; 76 int vq_id; 77 }; 78 79 struct stm32_rproc { 80 struct reset_control *rst; 81 struct stm32_syscon hold_boot; 82 struct stm32_syscon pdds; 83 struct stm32_syscon m4_state; 84 struct stm32_syscon rsctbl; 85 int wdg_irq; 86 u32 nb_rmems; 87 struct stm32_rproc_mem *rmems; 88 struct stm32_mbox mb[MBOX_NB_MBX]; 89 struct workqueue_struct *workqueue; 90 bool secured_soc; 91 void __iomem *rsc_va; 92 }; 93 94 static int stm32_rproc_pa_to_da(struct rproc *rproc, phys_addr_t pa, u64 *da) 95 { 96 unsigned int i; 97 struct stm32_rproc *ddata = rproc->priv; 98 struct stm32_rproc_mem *p_mem; 99 100 for (i = 0; i < ddata->nb_rmems; i++) { 101 p_mem = &ddata->rmems[i]; 102 103 if (pa < p_mem->bus_addr || 104 pa >= p_mem->bus_addr + p_mem->size) 105 continue; 106 *da = pa - p_mem->bus_addr + p_mem->dev_addr; 107 dev_dbg(rproc->dev.parent, "pa %pa to da %llx\n", &pa, *da); 108 return 0; 109 } 110 111 return -EINVAL; 112 } 113 114 static int stm32_rproc_mem_alloc(struct rproc *rproc, 115 struct rproc_mem_entry *mem) 116 { 117 struct device *dev = rproc->dev.parent; 118 void *va; 119 120 dev_dbg(dev, "map memory: %pa+%x\n", &mem->dma, mem->len); 121 va = ioremap_wc(mem->dma, mem->len); 122 if (IS_ERR_OR_NULL(va)) { 123 dev_err(dev, "Unable to map memory region: %pa+%x\n", 124 &mem->dma, mem->len); 125 return -ENOMEM; 126 } 127 128 /* Update memory entry va */ 129 mem->va = va; 130 131 return 0; 132 } 133 134 static int stm32_rproc_mem_release(struct rproc *rproc, 135 struct rproc_mem_entry *mem) 136 { 137 dev_dbg(rproc->dev.parent, "unmap memory: %pa\n", &mem->dma); 138 iounmap(mem->va); 139 140 return 0; 141 } 142 143 static int stm32_rproc_of_memory_translations(struct platform_device *pdev, 144 struct stm32_rproc *ddata) 145 { 146 struct device *parent, *dev = &pdev->dev; 147 struct device_node *np; 148 struct stm32_rproc_mem *p_mems; 149 struct stm32_rproc_mem_ranges *mem_range; 150 int cnt, array_size, i, ret = 0; 151 152 parent = dev->parent; 153 np = parent->of_node; 154 155 cnt = of_property_count_elems_of_size(np, "dma-ranges", 156 sizeof(*mem_range)); 157 if (cnt <= 0) { 158 dev_err(dev, "%s: dma-ranges property not defined\n", __func__); 159 return -EINVAL; 160 } 161 162 p_mems = devm_kcalloc(dev, cnt, sizeof(*p_mems), GFP_KERNEL); 163 if (!p_mems) 164 return -ENOMEM; 165 mem_range = kcalloc(cnt, sizeof(*mem_range), GFP_KERNEL); 166 if (!mem_range) 167 return -ENOMEM; 168 169 array_size = cnt * sizeof(struct stm32_rproc_mem_ranges) / sizeof(u32); 170 171 ret = of_property_read_u32_array(np, "dma-ranges", 172 (u32 *)mem_range, array_size); 173 if (ret) { 174 dev_err(dev, "error while get dma-ranges property: %x\n", ret); 175 goto free_mem; 176 } 177 178 for (i = 0; i < cnt; i++) { 179 p_mems[i].bus_addr = mem_range[i].bus_addr; 180 p_mems[i].dev_addr = mem_range[i].dev_addr; 181 p_mems[i].size = mem_range[i].size; 182 183 dev_dbg(dev, "memory range[%i]: da %#x, pa %pa, size %#zx:\n", 184 i, p_mems[i].dev_addr, &p_mems[i].bus_addr, 185 p_mems[i].size); 186 } 187 188 ddata->rmems = p_mems; 189 ddata->nb_rmems = cnt; 190 191 free_mem: 192 kfree(mem_range); 193 return ret; 194 } 195 196 static int stm32_rproc_mbox_idx(struct rproc *rproc, const unsigned char *name) 197 { 198 struct stm32_rproc *ddata = rproc->priv; 199 int i; 200 201 for (i = 0; i < ARRAY_SIZE(ddata->mb); i++) { 202 if (!strncmp(ddata->mb[i].name, name, strlen(name))) 203 return i; 204 } 205 dev_err(&rproc->dev, "mailbox %s not found\n", name); 206 207 return -EINVAL; 208 } 209 210 static int stm32_rproc_elf_load_rsc_table(struct rproc *rproc, 211 const struct firmware *fw) 212 { 213 if (rproc_elf_load_rsc_table(rproc, fw)) 214 dev_warn(&rproc->dev, "no resource table found for this firmware\n"); 215 216 return 0; 217 } 218 219 static int stm32_rproc_parse_memory_regions(struct rproc *rproc) 220 { 221 struct device *dev = rproc->dev.parent; 222 struct device_node *np = dev->of_node; 223 struct of_phandle_iterator it; 224 struct rproc_mem_entry *mem; 225 struct reserved_mem *rmem; 226 u64 da; 227 int index = 0; 228 229 /* Register associated reserved memory regions */ 230 of_phandle_iterator_init(&it, np, "memory-region", NULL, 0); 231 while (of_phandle_iterator_next(&it) == 0) { 232 rmem = of_reserved_mem_lookup(it.node); 233 if (!rmem) { 234 dev_err(dev, "unable to acquire memory-region\n"); 235 return -EINVAL; 236 } 237 238 if (stm32_rproc_pa_to_da(rproc, rmem->base, &da) < 0) { 239 dev_err(dev, "memory region not valid %pa\n", 240 &rmem->base); 241 return -EINVAL; 242 } 243 244 /* No need to map vdev buffer */ 245 if (strcmp(it.node->name, "vdev0buffer")) { 246 /* Register memory region */ 247 mem = rproc_mem_entry_init(dev, NULL, 248 (dma_addr_t)rmem->base, 249 rmem->size, da, 250 stm32_rproc_mem_alloc, 251 stm32_rproc_mem_release, 252 it.node->name); 253 254 if (mem) 255 rproc_coredump_add_segment(rproc, da, 256 rmem->size); 257 } else { 258 /* Register reserved memory for vdev buffer alloc */ 259 mem = rproc_of_resm_mem_entry_init(dev, index, 260 rmem->size, 261 rmem->base, 262 it.node->name); 263 } 264 265 if (!mem) 266 return -ENOMEM; 267 268 rproc_add_carveout(rproc, mem); 269 index++; 270 } 271 272 return 0; 273 } 274 275 static int stm32_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw) 276 { 277 int ret = stm32_rproc_parse_memory_regions(rproc); 278 279 if (ret) 280 return ret; 281 282 return stm32_rproc_elf_load_rsc_table(rproc, fw); 283 } 284 285 static irqreturn_t stm32_rproc_wdg(int irq, void *data) 286 { 287 struct platform_device *pdev = data; 288 struct rproc *rproc = platform_get_drvdata(pdev); 289 290 rproc_report_crash(rproc, RPROC_WATCHDOG); 291 292 return IRQ_HANDLED; 293 } 294 295 static void stm32_rproc_mb_vq_work(struct work_struct *work) 296 { 297 struct stm32_mbox *mb = container_of(work, struct stm32_mbox, vq_work); 298 struct rproc *rproc = dev_get_drvdata(mb->client.dev); 299 300 if (rproc_vq_interrupt(rproc, mb->vq_id) == IRQ_NONE) 301 dev_dbg(&rproc->dev, "no message found in vq%d\n", mb->vq_id); 302 } 303 304 static void stm32_rproc_mb_callback(struct mbox_client *cl, void *data) 305 { 306 struct rproc *rproc = dev_get_drvdata(cl->dev); 307 struct stm32_mbox *mb = container_of(cl, struct stm32_mbox, client); 308 struct stm32_rproc *ddata = rproc->priv; 309 310 queue_work(ddata->workqueue, &mb->vq_work); 311 } 312 313 static void stm32_rproc_free_mbox(struct rproc *rproc) 314 { 315 struct stm32_rproc *ddata = rproc->priv; 316 unsigned int i; 317 318 for (i = 0; i < ARRAY_SIZE(ddata->mb); i++) { 319 if (ddata->mb[i].chan) 320 mbox_free_channel(ddata->mb[i].chan); 321 ddata->mb[i].chan = NULL; 322 } 323 } 324 325 static const struct stm32_mbox stm32_rproc_mbox[MBOX_NB_MBX] = { 326 { 327 .name = STM32_MBX_VQ0, 328 .vq_id = STM32_MBX_VQ0_ID, 329 .client = { 330 .rx_callback = stm32_rproc_mb_callback, 331 .tx_block = false, 332 }, 333 }, 334 { 335 .name = STM32_MBX_VQ1, 336 .vq_id = STM32_MBX_VQ1_ID, 337 .client = { 338 .rx_callback = stm32_rproc_mb_callback, 339 .tx_block = false, 340 }, 341 }, 342 { 343 .name = STM32_MBX_SHUTDOWN, 344 .vq_id = -1, 345 .client = { 346 .tx_block = true, 347 .tx_done = NULL, 348 .tx_tout = 500, /* 500 ms time out */ 349 }, 350 } 351 }; 352 353 static int stm32_rproc_request_mbox(struct rproc *rproc) 354 { 355 struct stm32_rproc *ddata = rproc->priv; 356 struct device *dev = &rproc->dev; 357 unsigned int i; 358 int j; 359 const unsigned char *name; 360 struct mbox_client *cl; 361 362 /* Initialise mailbox structure table */ 363 memcpy(ddata->mb, stm32_rproc_mbox, sizeof(stm32_rproc_mbox)); 364 365 for (i = 0; i < MBOX_NB_MBX; i++) { 366 name = ddata->mb[i].name; 367 368 cl = &ddata->mb[i].client; 369 cl->dev = dev->parent; 370 371 ddata->mb[i].chan = mbox_request_channel_byname(cl, name); 372 if (IS_ERR(ddata->mb[i].chan)) { 373 if (PTR_ERR(ddata->mb[i].chan) == -EPROBE_DEFER) 374 goto err_probe; 375 dev_warn(dev, "cannot get %s mbox\n", name); 376 ddata->mb[i].chan = NULL; 377 } 378 if (ddata->mb[i].vq_id >= 0) { 379 INIT_WORK(&ddata->mb[i].vq_work, 380 stm32_rproc_mb_vq_work); 381 } 382 } 383 384 return 0; 385 386 err_probe: 387 for (j = i - 1; j >= 0; j--) 388 if (ddata->mb[j].chan) 389 mbox_free_channel(ddata->mb[j].chan); 390 return -EPROBE_DEFER; 391 } 392 393 static int stm32_rproc_set_hold_boot(struct rproc *rproc, bool hold) 394 { 395 struct stm32_rproc *ddata = rproc->priv; 396 struct stm32_syscon hold_boot = ddata->hold_boot; 397 struct arm_smccc_res smc_res; 398 int val, err; 399 400 val = hold ? HOLD_BOOT : RELEASE_BOOT; 401 402 if (IS_ENABLED(CONFIG_HAVE_ARM_SMCCC) && ddata->secured_soc) { 403 arm_smccc_smc(STM32_SMC_RCC, STM32_SMC_REG_WRITE, 404 hold_boot.reg, val, 0, 0, 0, 0, &smc_res); 405 err = smc_res.a0; 406 } else { 407 err = regmap_update_bits(hold_boot.map, hold_boot.reg, 408 hold_boot.mask, val); 409 } 410 411 if (err) 412 dev_err(&rproc->dev, "failed to set hold boot\n"); 413 414 return err; 415 } 416 417 static void stm32_rproc_add_coredump_trace(struct rproc *rproc) 418 { 419 struct rproc_debug_trace *trace; 420 struct rproc_dump_segment *segment; 421 bool already_added; 422 423 list_for_each_entry(trace, &rproc->traces, node) { 424 already_added = false; 425 426 list_for_each_entry(segment, &rproc->dump_segments, node) { 427 if (segment->da == trace->trace_mem.da) { 428 already_added = true; 429 break; 430 } 431 } 432 433 if (!already_added) 434 rproc_coredump_add_segment(rproc, trace->trace_mem.da, 435 trace->trace_mem.len); 436 } 437 } 438 439 static int stm32_rproc_start(struct rproc *rproc) 440 { 441 struct stm32_rproc *ddata = rproc->priv; 442 int err; 443 444 stm32_rproc_add_coredump_trace(rproc); 445 446 /* clear remote proc Deep Sleep */ 447 if (ddata->pdds.map) { 448 err = regmap_update_bits(ddata->pdds.map, ddata->pdds.reg, 449 ddata->pdds.mask, 0); 450 if (err) { 451 dev_err(&rproc->dev, "failed to clear pdds\n"); 452 return err; 453 } 454 } 455 456 err = stm32_rproc_set_hold_boot(rproc, false); 457 if (err) 458 return err; 459 460 return stm32_rproc_set_hold_boot(rproc, true); 461 } 462 463 static int stm32_rproc_attach(struct rproc *rproc) 464 { 465 stm32_rproc_add_coredump_trace(rproc); 466 467 return stm32_rproc_set_hold_boot(rproc, true); 468 } 469 470 static int stm32_rproc_stop(struct rproc *rproc) 471 { 472 struct stm32_rproc *ddata = rproc->priv; 473 int err, dummy_data, idx; 474 475 /* request shutdown of the remote processor */ 476 if (rproc->state != RPROC_OFFLINE) { 477 idx = stm32_rproc_mbox_idx(rproc, STM32_MBX_SHUTDOWN); 478 if (idx >= 0 && ddata->mb[idx].chan) { 479 /* a dummy data is sent to allow to block on transmit */ 480 err = mbox_send_message(ddata->mb[idx].chan, 481 &dummy_data); 482 if (err < 0) 483 dev_warn(&rproc->dev, "warning: remote FW shutdown without ack\n"); 484 } 485 } 486 487 err = stm32_rproc_set_hold_boot(rproc, true); 488 if (err) 489 return err; 490 491 err = reset_control_assert(ddata->rst); 492 if (err) { 493 dev_err(&rproc->dev, "failed to assert the reset\n"); 494 return err; 495 } 496 497 /* to allow platform Standby power mode, set remote proc Deep Sleep */ 498 if (ddata->pdds.map) { 499 err = regmap_update_bits(ddata->pdds.map, ddata->pdds.reg, 500 ddata->pdds.mask, 1); 501 if (err) { 502 dev_err(&rproc->dev, "failed to set pdds\n"); 503 return err; 504 } 505 } 506 507 /* update coprocessor state to OFF if available */ 508 if (ddata->m4_state.map) { 509 err = regmap_update_bits(ddata->m4_state.map, 510 ddata->m4_state.reg, 511 ddata->m4_state.mask, 512 M4_STATE_OFF); 513 if (err) { 514 dev_err(&rproc->dev, "failed to set copro state\n"); 515 return err; 516 } 517 } 518 519 return 0; 520 } 521 522 static void stm32_rproc_kick(struct rproc *rproc, int vqid) 523 { 524 struct stm32_rproc *ddata = rproc->priv; 525 unsigned int i; 526 int err; 527 528 if (WARN_ON(vqid >= MBOX_NB_VQ)) 529 return; 530 531 for (i = 0; i < MBOX_NB_MBX; i++) { 532 if (vqid != ddata->mb[i].vq_id) 533 continue; 534 if (!ddata->mb[i].chan) 535 return; 536 err = mbox_send_message(ddata->mb[i].chan, (void *)(long)vqid); 537 if (err < 0) 538 dev_err(&rproc->dev, "%s: failed (%s, err:%d)\n", 539 __func__, ddata->mb[i].name, err); 540 return; 541 } 542 } 543 544 static struct rproc_ops st_rproc_ops = { 545 .start = stm32_rproc_start, 546 .stop = stm32_rproc_stop, 547 .attach = stm32_rproc_attach, 548 .kick = stm32_rproc_kick, 549 .load = rproc_elf_load_segments, 550 .parse_fw = stm32_rproc_parse_fw, 551 .find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table, 552 .sanity_check = rproc_elf_sanity_check, 553 .get_boot_addr = rproc_elf_get_boot_addr, 554 }; 555 556 static const struct of_device_id stm32_rproc_match[] = { 557 { .compatible = "st,stm32mp1-m4" }, 558 {}, 559 }; 560 MODULE_DEVICE_TABLE(of, stm32_rproc_match); 561 562 static int stm32_rproc_get_syscon(struct device_node *np, const char *prop, 563 struct stm32_syscon *syscon) 564 { 565 int err = 0; 566 567 syscon->map = syscon_regmap_lookup_by_phandle(np, prop); 568 if (IS_ERR(syscon->map)) { 569 err = PTR_ERR(syscon->map); 570 syscon->map = NULL; 571 goto out; 572 } 573 574 err = of_property_read_u32_index(np, prop, 1, &syscon->reg); 575 if (err) 576 goto out; 577 578 err = of_property_read_u32_index(np, prop, 2, &syscon->mask); 579 580 out: 581 return err; 582 } 583 584 static int stm32_rproc_parse_dt(struct platform_device *pdev, 585 struct stm32_rproc *ddata, bool *auto_boot) 586 { 587 struct device *dev = &pdev->dev; 588 struct device_node *np = dev->of_node; 589 struct stm32_syscon tz; 590 unsigned int tzen; 591 int err, irq; 592 593 irq = platform_get_irq(pdev, 0); 594 if (irq == -EPROBE_DEFER) 595 return -EPROBE_DEFER; 596 597 if (irq > 0) { 598 err = devm_request_irq(dev, irq, stm32_rproc_wdg, 0, 599 dev_name(dev), pdev); 600 if (err) { 601 dev_err(dev, "failed to request wdg irq\n"); 602 return err; 603 } 604 605 ddata->wdg_irq = irq; 606 607 if (of_property_read_bool(np, "wakeup-source")) { 608 device_init_wakeup(dev, true); 609 dev_pm_set_wake_irq(dev, irq); 610 } 611 612 dev_info(dev, "wdg irq registered\n"); 613 } 614 615 ddata->rst = devm_reset_control_get_by_index(dev, 0); 616 if (IS_ERR(ddata->rst)) { 617 dev_err(dev, "failed to get mcu reset\n"); 618 return PTR_ERR(ddata->rst); 619 } 620 621 /* 622 * if platform is secured the hold boot bit must be written by 623 * smc call and read normally. 624 * if not secure the hold boot bit could be read/write normally 625 */ 626 err = stm32_rproc_get_syscon(np, "st,syscfg-tz", &tz); 627 if (err) { 628 dev_err(dev, "failed to get tz syscfg\n"); 629 return err; 630 } 631 632 err = regmap_read(tz.map, tz.reg, &tzen); 633 if (err) { 634 dev_err(dev, "failed to read tzen\n"); 635 return err; 636 } 637 ddata->secured_soc = tzen & tz.mask; 638 639 err = stm32_rproc_get_syscon(np, "st,syscfg-holdboot", 640 &ddata->hold_boot); 641 if (err) { 642 dev_err(dev, "failed to get hold boot\n"); 643 return err; 644 } 645 646 err = stm32_rproc_get_syscon(np, "st,syscfg-pdds", &ddata->pdds); 647 if (err) 648 dev_info(dev, "failed to get pdds\n"); 649 650 *auto_boot = of_property_read_bool(np, "st,auto-boot"); 651 652 /* 653 * See if we can check the M4 status, i.e if it was started 654 * from the boot loader or not. 655 */ 656 err = stm32_rproc_get_syscon(np, "st,syscfg-m4-state", 657 &ddata->m4_state); 658 if (err) { 659 /* remember this */ 660 ddata->m4_state.map = NULL; 661 /* no coprocessor state syscon (optional) */ 662 dev_warn(dev, "m4 state not supported\n"); 663 664 /* no need to go further */ 665 return 0; 666 } 667 668 /* See if we can get the resource table */ 669 err = stm32_rproc_get_syscon(np, "st,syscfg-rsc-tbl", 670 &ddata->rsctbl); 671 if (err) { 672 /* no rsc table syscon (optional) */ 673 dev_warn(dev, "rsc tbl syscon not supported\n"); 674 } 675 676 return 0; 677 } 678 679 static int stm32_rproc_get_m4_status(struct stm32_rproc *ddata, 680 unsigned int *state) 681 { 682 /* See stm32_rproc_parse_dt() */ 683 if (!ddata->m4_state.map) { 684 /* 685 * We couldn't get the coprocessor's state, assume 686 * it is not running. 687 */ 688 *state = M4_STATE_OFF; 689 return 0; 690 } 691 692 return regmap_read(ddata->m4_state.map, ddata->m4_state.reg, state); 693 } 694 695 static int stm32_rproc_da_to_pa(struct platform_device *pdev, 696 struct stm32_rproc *ddata, 697 u64 da, phys_addr_t *pa) 698 { 699 struct device *dev = &pdev->dev; 700 struct stm32_rproc_mem *p_mem; 701 unsigned int i; 702 703 for (i = 0; i < ddata->nb_rmems; i++) { 704 p_mem = &ddata->rmems[i]; 705 706 if (da < p_mem->dev_addr || 707 da >= p_mem->dev_addr + p_mem->size) 708 continue; 709 710 *pa = da - p_mem->dev_addr + p_mem->bus_addr; 711 dev_dbg(dev, "da %llx to pa %#x\n", da, *pa); 712 713 return 0; 714 } 715 716 dev_err(dev, "can't translate da %llx\n", da); 717 718 return -EINVAL; 719 } 720 721 static int stm32_rproc_get_loaded_rsc_table(struct platform_device *pdev, 722 struct rproc *rproc, 723 struct stm32_rproc *ddata) 724 { 725 struct device *dev = &pdev->dev; 726 phys_addr_t rsc_pa; 727 u32 rsc_da; 728 int err; 729 730 err = regmap_read(ddata->rsctbl.map, ddata->rsctbl.reg, &rsc_da); 731 if (err) { 732 dev_err(dev, "failed to read rsc tbl addr\n"); 733 return err; 734 } 735 736 if (!rsc_da) 737 /* no rsc table */ 738 return 0; 739 740 err = stm32_rproc_da_to_pa(pdev, ddata, rsc_da, &rsc_pa); 741 if (err) 742 return err; 743 744 ddata->rsc_va = devm_ioremap_wc(dev, rsc_pa, RSC_TBL_SIZE); 745 if (IS_ERR_OR_NULL(ddata->rsc_va)) { 746 dev_err(dev, "Unable to map memory region: %pa+%zx\n", 747 &rsc_pa, RSC_TBL_SIZE); 748 ddata->rsc_va = NULL; 749 return -ENOMEM; 750 } 751 752 /* 753 * The resource table is already loaded in device memory, no need 754 * to work with a cached table. 755 */ 756 rproc->cached_table = NULL; 757 /* Assuming the resource table fits in 1kB is fair */ 758 rproc->table_sz = RSC_TBL_SIZE; 759 rproc->table_ptr = (struct resource_table *)ddata->rsc_va; 760 761 return 0; 762 } 763 764 static int stm32_rproc_probe(struct platform_device *pdev) 765 { 766 struct device *dev = &pdev->dev; 767 struct stm32_rproc *ddata; 768 struct device_node *np = dev->of_node; 769 struct rproc *rproc; 770 unsigned int state; 771 int ret; 772 773 ret = dma_coerce_mask_and_coherent(dev, DMA_BIT_MASK(32)); 774 if (ret) 775 return ret; 776 777 rproc = rproc_alloc(dev, np->name, &st_rproc_ops, NULL, sizeof(*ddata)); 778 if (!rproc) 779 return -ENOMEM; 780 781 ddata = rproc->priv; 782 783 rproc_coredump_set_elf_info(rproc, ELFCLASS32, EM_NONE); 784 785 ret = stm32_rproc_parse_dt(pdev, ddata, &rproc->auto_boot); 786 if (ret) 787 goto free_rproc; 788 789 ret = stm32_rproc_of_memory_translations(pdev, ddata); 790 if (ret) 791 goto free_rproc; 792 793 ret = stm32_rproc_get_m4_status(ddata, &state); 794 if (ret) 795 goto free_rproc; 796 797 if (state == M4_STATE_CRUN) { 798 rproc->state = RPROC_DETACHED; 799 800 ret = stm32_rproc_parse_memory_regions(rproc); 801 if (ret) 802 goto free_resources; 803 804 ret = stm32_rproc_get_loaded_rsc_table(pdev, rproc, ddata); 805 if (ret) 806 goto free_resources; 807 } 808 809 rproc->has_iommu = false; 810 ddata->workqueue = create_workqueue(dev_name(dev)); 811 if (!ddata->workqueue) { 812 dev_err(dev, "cannot create workqueue\n"); 813 ret = -ENOMEM; 814 goto free_resources; 815 } 816 817 platform_set_drvdata(pdev, rproc); 818 819 ret = stm32_rproc_request_mbox(rproc); 820 if (ret) 821 goto free_wkq; 822 823 ret = rproc_add(rproc); 824 if (ret) 825 goto free_mb; 826 827 return 0; 828 829 free_mb: 830 stm32_rproc_free_mbox(rproc); 831 free_wkq: 832 destroy_workqueue(ddata->workqueue); 833 free_resources: 834 rproc_resource_cleanup(rproc); 835 free_rproc: 836 if (device_may_wakeup(dev)) { 837 dev_pm_clear_wake_irq(dev); 838 device_init_wakeup(dev, false); 839 } 840 rproc_free(rproc); 841 return ret; 842 } 843 844 static int stm32_rproc_remove(struct platform_device *pdev) 845 { 846 struct rproc *rproc = platform_get_drvdata(pdev); 847 struct stm32_rproc *ddata = rproc->priv; 848 struct device *dev = &pdev->dev; 849 850 if (atomic_read(&rproc->power) > 0) 851 rproc_shutdown(rproc); 852 853 rproc_del(rproc); 854 stm32_rproc_free_mbox(rproc); 855 destroy_workqueue(ddata->workqueue); 856 857 if (device_may_wakeup(dev)) { 858 dev_pm_clear_wake_irq(dev); 859 device_init_wakeup(dev, false); 860 } 861 rproc_free(rproc); 862 863 return 0; 864 } 865 866 static int __maybe_unused stm32_rproc_suspend(struct device *dev) 867 { 868 struct rproc *rproc = dev_get_drvdata(dev); 869 struct stm32_rproc *ddata = rproc->priv; 870 871 if (device_may_wakeup(dev)) 872 return enable_irq_wake(ddata->wdg_irq); 873 874 return 0; 875 } 876 877 static int __maybe_unused stm32_rproc_resume(struct device *dev) 878 { 879 struct rproc *rproc = dev_get_drvdata(dev); 880 struct stm32_rproc *ddata = rproc->priv; 881 882 if (device_may_wakeup(dev)) 883 return disable_irq_wake(ddata->wdg_irq); 884 885 return 0; 886 } 887 888 static SIMPLE_DEV_PM_OPS(stm32_rproc_pm_ops, 889 stm32_rproc_suspend, stm32_rproc_resume); 890 891 static struct platform_driver stm32_rproc_driver = { 892 .probe = stm32_rproc_probe, 893 .remove = stm32_rproc_remove, 894 .driver = { 895 .name = "stm32-rproc", 896 .pm = &stm32_rproc_pm_ops, 897 .of_match_table = of_match_ptr(stm32_rproc_match), 898 }, 899 }; 900 module_platform_driver(stm32_rproc_driver); 901 902 MODULE_DESCRIPTION("STM32 Remote Processor Control Driver"); 903 MODULE_AUTHOR("Ludovic Barre <ludovic.barre@st.com>"); 904 MODULE_AUTHOR("Fabien Dessenne <fabien.dessenne@st.com>"); 905 MODULE_LICENSE("GPL v2"); 906 907