1 // SPDX-License-Identifier: GPL-2.0
14 #include <linux/remoteproc/qcom_rproc.h>
72  * sysmon_send_event() - send notification of other remote's SSR event
83 	len = snprintf(req, sizeof(req), "ssr:%s:%s", event->subsys_name,  in sysmon_send_event()
84 		       sysmon_state_string[event->ssr_event]);  in sysmon_send_event()
88 	mutex_lock(&sysmon->lock);  in sysmon_send_event()
89 	reinit_completion(&sysmon->comp);  in sysmon_send_event()
90 	sysmon->ssr_ack = false;  in sysmon_send_event()
92 	ret = rpmsg_send(sysmon->ept, req, len);  in sysmon_send_event()
94 		dev_err(sysmon->dev, "failed to send sysmon event\n");  in sysmon_send_event()
98 	ret = wait_for_completion_timeout(&sysmon->comp,  in sysmon_send_event()
101 		dev_err(sysmon->dev, "timeout waiting for sysmon ack\n");  in sysmon_send_event()
105 	if (!sysmon->ssr_ack)  in sysmon_send_event()
106 		dev_err(sysmon->dev, "unexpected response to sysmon event\n");  in sysmon_send_event()
109 	mutex_unlock(&sysmon->lock);  in sysmon_send_event()
113  * sysmon_request_shutdown() - request graceful shutdown of remote
121 	mutex_lock(&sysmon->lock);  in sysmon_request_shutdown()
122 	reinit_completion(&sysmon->comp);  in sysmon_request_shutdown()
123 	sysmon->ssr_ack = false;  in sysmon_request_shutdown()
125 	ret = rpmsg_send(sysmon->ept, req, strlen(req) + 1);  in sysmon_request_shutdown()
127 		dev_err(sysmon->dev, "send sysmon shutdown request failed\n");  in sysmon_request_shutdown()
131 	ret = wait_for_completion_timeout(&sysmon->comp,  in sysmon_request_shutdown()
134 		dev_err(sysmon->dev, "timeout waiting for sysmon ack\n");  in sysmon_request_shutdown()
138 	if (!sysmon->ssr_ack)  in sysmon_request_shutdown()
139 		dev_err(sysmon->dev,  in sysmon_request_shutdown()
143 	mutex_unlock(&sysmon->lock);  in sysmon_request_shutdown()
154 		return -EINVAL;  in sysmon_callback()
157 		sysmon->ssr_ack = true;  in sysmon_callback()
159 	complete(&sysmon->comp);  in sysmon_callback()
283 	complete(&sysmon->ind_comp);  in sysmon_ind_cb()
298  * ssctl_request_shutdown() - request shutdown via SSCTL QMI service
307 	reinit_completion(&sysmon->ind_comp);  in ssctl_request_shutdown()
308 	reinit_completion(&sysmon->shutdown_comp);  in ssctl_request_shutdown()
309 	ret = qmi_txn_init(&sysmon->qmi, &txn, ssctl_shutdown_resp_ei, &resp);  in ssctl_request_shutdown()
311 		dev_err(sysmon->dev, "failed to allocate QMI txn\n");  in ssctl_request_shutdown()
315 	ret = qmi_send_request(&sysmon->qmi, &sysmon->ssctl, &txn,  in ssctl_request_shutdown()
318 		dev_err(sysmon->dev, "failed to send shutdown request\n");  in ssctl_request_shutdown()
325 		dev_err(sysmon->dev, "failed receiving QMI response\n");  in ssctl_request_shutdown()
327 		dev_err(sysmon->dev, "shutdown request failed\n");  in ssctl_request_shutdown()
329 		dev_dbg(sysmon->dev, "shutdown request completed\n");  in ssctl_request_shutdown()
331 	if (sysmon->shutdown_irq > 0) {  in ssctl_request_shutdown()
332 		ret = wait_for_completion_timeout(&sysmon->shutdown_comp,  in ssctl_request_shutdown()
335 			ret = try_wait_for_completion(&sysmon->ind_comp);  in ssctl_request_shutdown()
337 				dev_err(sysmon->dev,  in ssctl_request_shutdown()
344  * ssctl_send_event() - send notification of other remote's SSR event
357 	ret = qmi_txn_init(&sysmon->qmi, &txn, ssctl_subsys_event_resp_ei, &resp);  in ssctl_send_event()
359 		dev_err(sysmon->dev, "failed to allocate QMI txn\n");  in ssctl_send_event()
364 	strlcpy(req.subsys_name, event->subsys_name, sizeof(req.subsys_name));  in ssctl_send_event()
366 	req.event = event->ssr_event;  in ssctl_send_event()
370 	ret = qmi_send_request(&sysmon->qmi, &sysmon->ssctl, &txn,  in ssctl_send_event()
374 		dev_err(sysmon->dev, "failed to send shutdown request\n");  in ssctl_send_event()
381 		dev_err(sysmon->dev, "failed receiving QMI response\n");  in ssctl_send_event()
383 		dev_err(sysmon->dev, "ssr event send failed\n");  in ssctl_send_event()
385 		dev_dbg(sysmon->dev, "ssr event send completed\n");  in ssctl_send_event()
389  * ssctl_new_server() - QMI callback indicating a new service
393  * Return: 0 if we're interested in this service, -EINVAL otherwise.
399 	switch (svc->version) {  in ssctl_new_server()
401 		if (svc->instance != 0)  in ssctl_new_server()
402 			return -EINVAL;  in ssctl_new_server()
403 		if (strcmp(sysmon->name, "modem"))  in ssctl_new_server()
404 			return -EINVAL;  in ssctl_new_server()
407 		if (svc->instance != sysmon->ssctl_instance)  in ssctl_new_server()
408 			return -EINVAL;  in ssctl_new_server()
411 		return -EINVAL;  in ssctl_new_server()
414 	sysmon->ssctl_version = svc->version;  in ssctl_new_server()
416 	sysmon->ssctl.sq_family = AF_QIPCRTR;  in ssctl_new_server()
417 	sysmon->ssctl.sq_node = svc->node;  in ssctl_new_server()
418 	sysmon->ssctl.sq_port = svc->port;  in ssctl_new_server()
420 	svc->priv = sysmon;  in ssctl_new_server()
426  * ssctl_del_server() - QMI callback indicating that @svc is removed
432 	struct qcom_sysmon *sysmon = svc->priv;  in ssctl_del_server()
434 	sysmon->ssctl_version = 0;  in ssctl_del_server()
447 		.subsys_name = sysmon->name,  in sysmon_prepare()
457  * sysmon_start() - start callback for the sysmon remoteproc subdevice
471 		.subsys_name = sysmon->name,  in sysmon_start()
480 		    target->rproc->state != RPROC_RUNNING)  in sysmon_start()
483 		event.subsys_name = target->name;  in sysmon_start()
485 		if (sysmon->ssctl_version == 2)  in sysmon_start()
487 		else if (sysmon->ept)  in sysmon_start()
499 		.subsys_name = sysmon->name,  in sysmon_stop()
509 	if (sysmon->ssctl_version)  in sysmon_stop()
511 	else if (sysmon->ept)  in sysmon_stop()
520 		.subsys_name = sysmon->name,  in sysmon_unprepare()
528  * sysmon_notify() - notify sysmon target of another's SSR
537 	struct rproc *rproc = sysmon->rproc;  in sysmon_notify()
540 	/* Skip non-running rprocs and the originating instance */  in sysmon_notify()
541 	if (rproc->state != RPROC_RUNNING ||  in sysmon_notify()
542 	    !strcmp(sysmon_event->subsys_name, sysmon->name)) {  in sysmon_notify()
543 		dev_dbg(sysmon->dev, "not notifying %s\n", sysmon->name);  in sysmon_notify()
548 	if (sysmon->ssctl_version == 2)  in sysmon_notify()
550 	else if (sysmon->ept)  in sysmon_notify()
560 	complete(&sysmon->shutdown_comp);  in sysmon_shutdown_interrupt()
566  * qcom_add_sysmon_subdev() - create a sysmon subdev for the given remoteproc
582 		return ERR_PTR(-ENOMEM);  in qcom_add_sysmon_subdev()
584 	sysmon->dev = rproc->dev.parent;  in qcom_add_sysmon_subdev()
585 	sysmon->rproc = rproc;  in qcom_add_sysmon_subdev()
587 	sysmon->name = name;  in qcom_add_sysmon_subdev()
588 	sysmon->ssctl_instance = ssctl_instance;  in qcom_add_sysmon_subdev()
590 	init_completion(&sysmon->comp);  in qcom_add_sysmon_subdev()
591 	init_completion(&sysmon->ind_comp);  in qcom_add_sysmon_subdev()
592 	init_completion(&sysmon->shutdown_comp);  in qcom_add_sysmon_subdev()
593 	mutex_init(&sysmon->lock);  in qcom_add_sysmon_subdev()
595 	sysmon->shutdown_irq = of_irq_get_byname(sysmon->dev->of_node,  in qcom_add_sysmon_subdev()
596 						 "shutdown-ack");  in qcom_add_sysmon_subdev()
597 	if (sysmon->shutdown_irq < 0) {  in qcom_add_sysmon_subdev()
598 		if (sysmon->shutdown_irq != -ENODATA) {  in qcom_add_sysmon_subdev()
599 			dev_err(sysmon->dev,  in qcom_add_sysmon_subdev()
600 				"failed to retrieve shutdown-ack IRQ\n");  in qcom_add_sysmon_subdev()
601 			return ERR_PTR(sysmon->shutdown_irq);  in qcom_add_sysmon_subdev()
604 		ret = devm_request_threaded_irq(sysmon->dev,  in qcom_add_sysmon_subdev()
605 						sysmon->shutdown_irq,  in qcom_add_sysmon_subdev()
608 						"q6v5 shutdown-ack", sysmon);  in qcom_add_sysmon_subdev()
610 			dev_err(sysmon->dev,  in qcom_add_sysmon_subdev()
611 				"failed to acquire shutdown-ack IRQ\n");  in qcom_add_sysmon_subdev()
616 	ret = qmi_handle_init(&sysmon->qmi, SSCTL_MAX_MSG_LEN, &ssctl_ops,  in qcom_add_sysmon_subdev()
619 		dev_err(sysmon->dev, "failed to initialize qmi handle\n");  in qcom_add_sysmon_subdev()
624 	qmi_add_lookup(&sysmon->qmi, 43, 0, 0);  in qcom_add_sysmon_subdev()
626 	sysmon->subdev.prepare = sysmon_prepare;  in qcom_add_sysmon_subdev()
627 	sysmon->subdev.start = sysmon_start;  in qcom_add_sysmon_subdev()
628 	sysmon->subdev.stop = sysmon_stop;  in qcom_add_sysmon_subdev()
629 	sysmon->subdev.unprepare = sysmon_unprepare;  in qcom_add_sysmon_subdev()
631 	rproc_add_subdev(rproc, &sysmon->subdev);  in qcom_add_sysmon_subdev()
633 	sysmon->nb.notifier_call = sysmon_notify;  in qcom_add_sysmon_subdev()
634 	blocking_notifier_chain_register(&sysmon_notifiers, &sysmon->nb);  in qcom_add_sysmon_subdev()
637 	list_add(&sysmon->node, &sysmon_list);  in qcom_add_sysmon_subdev()
645  * qcom_remove_sysmon_subdev() - release a qcom_sysmon
654 	list_del(&sysmon->node);  in qcom_remove_sysmon_subdev()
657 	blocking_notifier_chain_unregister(&sysmon_notifiers, &sysmon->nb);  in qcom_remove_sysmon_subdev()
659 	rproc_remove_subdev(sysmon->rproc, &sysmon->subdev);  in qcom_remove_sysmon_subdev()
661 	qmi_handle_release(&sysmon->qmi);  in qcom_remove_sysmon_subdev()
668  * sysmon_probe() - probe sys_mon channel
671  * Find the sysmon context associated with the ancestor remoteproc and assign
681 	rproc = rproc_get_by_child(&rpdev->dev);  in sysmon_probe()
683 		dev_err(&rpdev->dev, "sysmon device not child of rproc\n");  in sysmon_probe()
684 		return -EINVAL;  in sysmon_probe()
689 		if (sysmon->rproc == rproc)  in sysmon_probe()
694 	dev_err(&rpdev->dev, "no sysmon associated with parent rproc\n");  in sysmon_probe()
696 	return -EINVAL;  in sysmon_probe()
701 	rpdev->ept->priv = sysmon;  in sysmon_probe()
702 	sysmon->ept = rpdev->ept;  in sysmon_probe()
708  * sysmon_remove() - sys_mon channel remove handler
715 	struct qcom_sysmon *sysmon = rpdev->ept->priv;  in sysmon_remove()
717 	sysmon->ept = NULL;  in sysmon_remove()