Lines Matching +full:modem +full:- +full:remoteproc
1 // SPDX-License-Identifier: GPL-2.0
14 #include <linux/remoteproc/qcom_rproc.h>
76 * sysmon_send_event() - send notification of other remote's SSR event
87 len = snprintf(req, sizeof(req), "ssr:%s:%s", event->subsys_name, in sysmon_send_event()
88 sysmon_state_string[event->ssr_event]); in sysmon_send_event()
92 mutex_lock(&sysmon->lock); in sysmon_send_event()
93 reinit_completion(&sysmon->comp); in sysmon_send_event()
94 sysmon->ssr_ack = false; in sysmon_send_event()
96 ret = rpmsg_send(sysmon->ept, req, len); in sysmon_send_event()
98 dev_err(sysmon->dev, "failed to send sysmon event\n"); in sysmon_send_event()
102 ret = wait_for_completion_timeout(&sysmon->comp, in sysmon_send_event()
105 dev_err(sysmon->dev, "timeout waiting for sysmon ack\n"); in sysmon_send_event()
109 if (!sysmon->ssr_ack) in sysmon_send_event()
110 dev_err(sysmon->dev, "unexpected response to sysmon event\n"); in sysmon_send_event()
113 mutex_unlock(&sysmon->lock); in sysmon_send_event()
117 * sysmon_request_shutdown() - request graceful shutdown of remote
125 mutex_lock(&sysmon->lock); in sysmon_request_shutdown()
126 reinit_completion(&sysmon->comp); in sysmon_request_shutdown()
127 sysmon->ssr_ack = false; in sysmon_request_shutdown()
129 ret = rpmsg_send(sysmon->ept, req, strlen(req) + 1); in sysmon_request_shutdown()
131 dev_err(sysmon->dev, "send sysmon shutdown request failed\n"); in sysmon_request_shutdown()
135 ret = wait_for_completion_timeout(&sysmon->comp, in sysmon_request_shutdown()
138 dev_err(sysmon->dev, "timeout waiting for sysmon ack\n"); in sysmon_request_shutdown()
142 if (!sysmon->ssr_ack) in sysmon_request_shutdown()
143 dev_err(sysmon->dev, in sysmon_request_shutdown()
147 mutex_unlock(&sysmon->lock); in sysmon_request_shutdown()
158 return -EINVAL; in sysmon_callback()
161 sysmon->ssr_ack = true; in sysmon_callback()
163 complete(&sysmon->comp); in sysmon_callback()
287 complete(&sysmon->ind_comp); in sysmon_ind_cb()
302 * ssctl_request_shutdown() - request shutdown via SSCTL QMI service
311 reinit_completion(&sysmon->ind_comp); in ssctl_request_shutdown()
312 reinit_completion(&sysmon->shutdown_comp); in ssctl_request_shutdown()
313 ret = qmi_txn_init(&sysmon->qmi, &txn, ssctl_shutdown_resp_ei, &resp); in ssctl_request_shutdown()
315 dev_err(sysmon->dev, "failed to allocate QMI txn\n"); in ssctl_request_shutdown()
319 ret = qmi_send_request(&sysmon->qmi, &sysmon->ssctl, &txn, in ssctl_request_shutdown()
322 dev_err(sysmon->dev, "failed to send shutdown request\n"); in ssctl_request_shutdown()
329 dev_err(sysmon->dev, "failed receiving QMI response\n"); in ssctl_request_shutdown()
331 dev_err(sysmon->dev, "shutdown request failed\n"); in ssctl_request_shutdown()
333 dev_dbg(sysmon->dev, "shutdown request completed\n"); in ssctl_request_shutdown()
335 if (sysmon->shutdown_irq > 0) { in ssctl_request_shutdown()
336 ret = wait_for_completion_timeout(&sysmon->shutdown_comp, in ssctl_request_shutdown()
339 ret = try_wait_for_completion(&sysmon->ind_comp); in ssctl_request_shutdown()
341 dev_err(sysmon->dev, in ssctl_request_shutdown()
348 * ssctl_send_event() - send notification of other remote's SSR event
361 ret = qmi_txn_init(&sysmon->qmi, &txn, ssctl_subsys_event_resp_ei, &resp); in ssctl_send_event()
363 dev_err(sysmon->dev, "failed to allocate QMI txn\n"); in ssctl_send_event()
368 strlcpy(req.subsys_name, event->subsys_name, sizeof(req.subsys_name)); in ssctl_send_event()
370 req.event = event->ssr_event; in ssctl_send_event()
374 ret = qmi_send_request(&sysmon->qmi, &sysmon->ssctl, &txn, in ssctl_send_event()
378 dev_err(sysmon->dev, "failed to send shutdown request\n"); in ssctl_send_event()
385 dev_err(sysmon->dev, "failed receiving QMI response\n"); in ssctl_send_event()
387 dev_err(sysmon->dev, "ssr event send failed\n"); in ssctl_send_event()
389 dev_dbg(sysmon->dev, "ssr event send completed\n"); in ssctl_send_event()
393 * ssctl_new_server() - QMI callback indicating a new service
397 * Return: 0 if we're interested in this service, -EINVAL otherwise.
403 switch (svc->version) { in ssctl_new_server()
405 if (svc->instance != 0) in ssctl_new_server()
406 return -EINVAL; in ssctl_new_server()
407 if (strcmp(sysmon->name, "modem")) in ssctl_new_server()
408 return -EINVAL; in ssctl_new_server()
411 if (svc->instance != sysmon->ssctl_instance) in ssctl_new_server()
412 return -EINVAL; in ssctl_new_server()
415 return -EINVAL; in ssctl_new_server()
418 sysmon->ssctl_version = svc->version; in ssctl_new_server()
420 sysmon->ssctl.sq_family = AF_QIPCRTR; in ssctl_new_server()
421 sysmon->ssctl.sq_node = svc->node; in ssctl_new_server()
422 sysmon->ssctl.sq_port = svc->port; in ssctl_new_server()
424 svc->priv = sysmon; in ssctl_new_server()
426 complete(&sysmon->ssctl_comp); in ssctl_new_server()
432 * ssctl_del_server() - QMI callback indicating that @svc is removed
438 struct qcom_sysmon *sysmon = svc->priv; in ssctl_del_server()
440 sysmon->ssctl_version = 0; in ssctl_del_server()
453 .subsys_name = sysmon->name, in sysmon_prepare()
457 mutex_lock(&sysmon->state_lock); in sysmon_prepare()
458 sysmon->state = SSCTL_SSR_EVENT_BEFORE_POWERUP; in sysmon_prepare()
460 mutex_unlock(&sysmon->state_lock); in sysmon_prepare()
466 * sysmon_start() - start callback for the sysmon remoteproc subdevice
480 .subsys_name = sysmon->name, in sysmon_start()
484 reinit_completion(&sysmon->ssctl_comp); in sysmon_start()
485 mutex_lock(&sysmon->state_lock); in sysmon_start()
486 sysmon->state = SSCTL_SSR_EVENT_AFTER_POWERUP; in sysmon_start()
488 mutex_unlock(&sysmon->state_lock); in sysmon_start()
495 mutex_lock(&target->state_lock); in sysmon_start()
496 event.subsys_name = target->name; in sysmon_start()
497 event.ssr_event = target->state; in sysmon_start()
499 if (sysmon->ssctl_version == 2) in sysmon_start()
501 else if (sysmon->ept) in sysmon_start()
503 mutex_unlock(&target->state_lock); in sysmon_start()
514 .subsys_name = sysmon->name, in sysmon_stop()
518 mutex_lock(&sysmon->state_lock); in sysmon_stop()
519 sysmon->state = SSCTL_SSR_EVENT_BEFORE_SHUTDOWN; in sysmon_stop()
521 mutex_unlock(&sysmon->state_lock); in sysmon_stop()
527 if (sysmon->ssctl_instance) { in sysmon_stop()
528 if (!wait_for_completion_timeout(&sysmon->ssctl_comp, HZ / 2)) in sysmon_stop()
529 dev_err(sysmon->dev, "timeout waiting for ssctl service\n"); in sysmon_stop()
532 if (sysmon->ssctl_version) in sysmon_stop()
534 else if (sysmon->ept) in sysmon_stop()
543 .subsys_name = sysmon->name, in sysmon_unprepare()
547 mutex_lock(&sysmon->state_lock); in sysmon_unprepare()
548 sysmon->state = SSCTL_SSR_EVENT_AFTER_SHUTDOWN; in sysmon_unprepare()
550 mutex_unlock(&sysmon->state_lock); in sysmon_unprepare()
554 * sysmon_notify() - notify sysmon target of another's SSR
565 /* Skip non-running rprocs and the originating instance */ in sysmon_notify()
566 if (sysmon->state != SSCTL_SSR_EVENT_AFTER_POWERUP || in sysmon_notify()
567 !strcmp(sysmon_event->subsys_name, sysmon->name)) { in sysmon_notify()
568 dev_dbg(sysmon->dev, "not notifying %s\n", sysmon->name); in sysmon_notify()
573 if (sysmon->ssctl_version == 2) in sysmon_notify()
575 else if (sysmon->ept) in sysmon_notify()
585 complete(&sysmon->shutdown_comp); in sysmon_shutdown_interrupt()
591 * qcom_add_sysmon_subdev() - create a sysmon subdev for the given remoteproc
607 return ERR_PTR(-ENOMEM); in qcom_add_sysmon_subdev()
609 sysmon->dev = rproc->dev.parent; in qcom_add_sysmon_subdev()
610 sysmon->rproc = rproc; in qcom_add_sysmon_subdev()
612 sysmon->name = name; in qcom_add_sysmon_subdev()
613 sysmon->ssctl_instance = ssctl_instance; in qcom_add_sysmon_subdev()
615 init_completion(&sysmon->comp); in qcom_add_sysmon_subdev()
616 init_completion(&sysmon->ind_comp); in qcom_add_sysmon_subdev()
617 init_completion(&sysmon->shutdown_comp); in qcom_add_sysmon_subdev()
618 init_completion(&sysmon->ssctl_comp); in qcom_add_sysmon_subdev()
619 mutex_init(&sysmon->lock); in qcom_add_sysmon_subdev()
620 mutex_init(&sysmon->state_lock); in qcom_add_sysmon_subdev()
622 sysmon->shutdown_irq = of_irq_get_byname(sysmon->dev->of_node, in qcom_add_sysmon_subdev()
623 "shutdown-ack"); in qcom_add_sysmon_subdev()
624 if (sysmon->shutdown_irq < 0) { in qcom_add_sysmon_subdev()
625 if (sysmon->shutdown_irq != -ENODATA) { in qcom_add_sysmon_subdev()
626 dev_err(sysmon->dev, in qcom_add_sysmon_subdev()
627 "failed to retrieve shutdown-ack IRQ\n"); in qcom_add_sysmon_subdev()
628 return ERR_PTR(sysmon->shutdown_irq); in qcom_add_sysmon_subdev()
631 ret = devm_request_threaded_irq(sysmon->dev, in qcom_add_sysmon_subdev()
632 sysmon->shutdown_irq, in qcom_add_sysmon_subdev()
635 "q6v5 shutdown-ack", sysmon); in qcom_add_sysmon_subdev()
637 dev_err(sysmon->dev, in qcom_add_sysmon_subdev()
638 "failed to acquire shutdown-ack IRQ\n"); in qcom_add_sysmon_subdev()
643 ret = qmi_handle_init(&sysmon->qmi, SSCTL_MAX_MSG_LEN, &ssctl_ops, in qcom_add_sysmon_subdev()
646 dev_err(sysmon->dev, "failed to initialize qmi handle\n"); in qcom_add_sysmon_subdev()
651 qmi_add_lookup(&sysmon->qmi, 43, 0, 0); in qcom_add_sysmon_subdev()
653 sysmon->subdev.prepare = sysmon_prepare; in qcom_add_sysmon_subdev()
654 sysmon->subdev.start = sysmon_start; in qcom_add_sysmon_subdev()
655 sysmon->subdev.stop = sysmon_stop; in qcom_add_sysmon_subdev()
656 sysmon->subdev.unprepare = sysmon_unprepare; in qcom_add_sysmon_subdev()
658 rproc_add_subdev(rproc, &sysmon->subdev); in qcom_add_sysmon_subdev()
660 sysmon->nb.notifier_call = sysmon_notify; in qcom_add_sysmon_subdev()
661 blocking_notifier_chain_register(&sysmon_notifiers, &sysmon->nb); in qcom_add_sysmon_subdev()
664 list_add(&sysmon->node, &sysmon_list); in qcom_add_sysmon_subdev()
672 * qcom_remove_sysmon_subdev() - release a qcom_sysmon
681 list_del(&sysmon->node); in qcom_remove_sysmon_subdev()
684 blocking_notifier_chain_unregister(&sysmon_notifiers, &sysmon->nb); in qcom_remove_sysmon_subdev()
686 rproc_remove_subdev(sysmon->rproc, &sysmon->subdev); in qcom_remove_sysmon_subdev()
688 qmi_handle_release(&sysmon->qmi); in qcom_remove_sysmon_subdev()
695 * sysmon_probe() - probe sys_mon channel
698 * Find the sysmon context associated with the ancestor remoteproc and assign
708 rproc = rproc_get_by_child(&rpdev->dev); in sysmon_probe()
710 dev_err(&rpdev->dev, "sysmon device not child of rproc\n"); in sysmon_probe()
711 return -EINVAL; in sysmon_probe()
716 if (sysmon->rproc == rproc) in sysmon_probe()
721 dev_err(&rpdev->dev, "no sysmon associated with parent rproc\n"); in sysmon_probe()
723 return -EINVAL; in sysmon_probe()
728 rpdev->ept->priv = sysmon; in sysmon_probe()
729 sysmon->ept = rpdev->ept; in sysmon_probe()
735 * sysmon_remove() - sys_mon channel remove handler
742 struct qcom_sysmon *sysmon = rpdev->ept->priv; in sysmon_remove()
744 sysmon->ept = NULL; in sysmon_remove()