1 // SPDX-License-Identifier: GPL-2.0-only
7  * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
16 #include <linux/rpmsg/qcom_glink.h>
17 #include <linux/rpmsg/qcom_smd.h>
29 	const char *name;  member
41 	glink->edge = qcom_glink_smem_register(glink->dev, glink->node);  in glink_subdev_start()
43 	return PTR_ERR_OR_ZERO(glink->edge);  in glink_subdev_start()
50 	qcom_glink_smem_unregister(glink->edge);  in glink_subdev_stop()
51 	glink->edge = NULL;  in glink_subdev_stop()
58 	qcom_glink_ssr_notify(glink->ssr_name);  in glink_subdev_unprepare()
62  * qcom_add_glink_subdev() - try to add a GLINK subdevice to rproc
70 	struct device *dev = &rproc->dev;  in qcom_add_glink_subdev()
72 	glink->node = of_get_child_by_name(dev->parent->of_node, "glink-edge");  in qcom_add_glink_subdev()
73 	if (!glink->node)  in qcom_add_glink_subdev()
76 	glink->ssr_name = kstrdup_const(ssr_name, GFP_KERNEL);  in qcom_add_glink_subdev()
77 	if (!glink->ssr_name)  in qcom_add_glink_subdev()
80 	glink->dev = dev;  in qcom_add_glink_subdev()
81 	glink->subdev.start = glink_subdev_start;  in qcom_add_glink_subdev()
82 	glink->subdev.stop = glink_subdev_stop;  in qcom_add_glink_subdev()
83 	glink->subdev.unprepare = glink_subdev_unprepare;  in qcom_add_glink_subdev()
85 	rproc_add_subdev(rproc, &glink->subdev);  in qcom_add_glink_subdev()
90  * qcom_remove_glink_subdev() - remove a GLINK subdevice from rproc
96 	if (!glink->node)  in qcom_remove_glink_subdev()
99 	rproc_remove_subdev(rproc, &glink->subdev);  in qcom_remove_glink_subdev()
100 	kfree_const(glink->ssr_name);  in qcom_remove_glink_subdev()
101 	of_node_put(glink->node);  in qcom_remove_glink_subdev()
106  * qcom_register_dump_segments() - register segments for coredump
123 	ehdr = (struct elf32_hdr *)fw->data;  in qcom_register_dump_segments()
126 	for (i = 0; i < ehdr->e_phnum; i++) {  in qcom_register_dump_segments()
129 		if (phdr->p_type != PT_LOAD)  in qcom_register_dump_segments()
132 		if ((phdr->p_flags & QCOM_MDT_TYPE_MASK) == QCOM_MDT_TYPE_HASH)  in qcom_register_dump_segments()
135 		if (!phdr->p_memsz)  in qcom_register_dump_segments()
138 		ret = rproc_coredump_add_segment(rproc, phdr->p_paddr,  in qcom_register_dump_segments()
139 						 phdr->p_memsz);  in qcom_register_dump_segments()
152 	smd->edge = qcom_smd_register_edge(smd->dev, smd->node);  in smd_subdev_start()
154 	return PTR_ERR_OR_ZERO(smd->edge);  in smd_subdev_start()
161 	qcom_smd_unregister_edge(smd->edge);  in smd_subdev_stop()
162 	smd->edge = NULL;  in smd_subdev_stop()
166  * qcom_add_smd_subdev() - try to add a SMD subdevice to rproc
172 	struct device *dev = &rproc->dev;  in qcom_add_smd_subdev()
174 	smd->node = of_get_child_by_name(dev->parent->of_node, "smd-edge");  in qcom_add_smd_subdev()
175 	if (!smd->node)  in qcom_add_smd_subdev()
178 	smd->dev = dev;  in qcom_add_smd_subdev()
179 	smd->subdev.start = smd_subdev_start;  in qcom_add_smd_subdev()
180 	smd->subdev.stop = smd_subdev_stop;  in qcom_add_smd_subdev()
182 	rproc_add_subdev(rproc, &smd->subdev);  in qcom_add_smd_subdev()
187  * qcom_remove_smd_subdev() - remove the smd subdevice from rproc
193 	if (!smd->node)  in qcom_remove_smd_subdev()
196 	rproc_remove_subdev(rproc, &smd->subdev);  in qcom_remove_smd_subdev()
197 	of_node_put(smd->node);  in qcom_remove_smd_subdev()
201 static struct qcom_ssr_subsystem *qcom_ssr_get_subsys(const char *name)  in qcom_ssr_get_subsys()  argument
206 	/* Match in the global qcom_ssr_subsystem_list with name */  in qcom_ssr_get_subsys()
208 		if (!strcmp(info->name, name))  in qcom_ssr_get_subsys()
213 		info = ERR_PTR(-ENOMEM);  in qcom_ssr_get_subsys()
216 	info->name = kstrdup_const(name, GFP_KERNEL);  in qcom_ssr_get_subsys()
217 	srcu_init_notifier_head(&info->notifier_list);  in qcom_ssr_get_subsys()
220 	list_add_tail(&info->list, &qcom_ssr_subsystem_list);  in qcom_ssr_get_subsys()
228  * qcom_register_ssr_notifier() - register SSR notification handler
229  * @name:	Subsystem's SSR name
233  * remoteproc associated with @name. The notifier block's callback
239 void *qcom_register_ssr_notifier(const char *name, struct notifier_block *nb)  in qcom_register_ssr_notifier()  argument
243 	info = qcom_ssr_get_subsys(name);  in qcom_register_ssr_notifier()
247 	srcu_notifier_chain_register(&info->notifier_list, nb);  in qcom_register_ssr_notifier()
249 	return &info->notifier_list;  in qcom_register_ssr_notifier()
254  * qcom_unregister_ssr_notifier() - unregister SSR notification handler
273 		.name = ssr->info->name,  in ssr_notify_prepare()
277 	srcu_notifier_call_chain(&ssr->info->notifier_list,  in ssr_notify_prepare()
286 		.name = ssr->info->name,  in ssr_notify_start()
290 	srcu_notifier_call_chain(&ssr->info->notifier_list,  in ssr_notify_start()
299 		.name = ssr->info->name,  in ssr_notify_stop()
303 	srcu_notifier_call_chain(&ssr->info->notifier_list,  in ssr_notify_stop()
311 		.name = ssr->info->name,  in ssr_notify_unprepare()
315 	srcu_notifier_call_chain(&ssr->info->notifier_list,  in ssr_notify_unprepare()
320  * qcom_add_ssr_subdev() - register subdevice as restart notification source
336 		dev_err(&rproc->dev, "Failed to add ssr subdevice\n");  in qcom_add_ssr_subdev()
340 	ssr->info = info;  in qcom_add_ssr_subdev()
341 	ssr->subdev.prepare = ssr_notify_prepare;  in qcom_add_ssr_subdev()
342 	ssr->subdev.start = ssr_notify_start;  in qcom_add_ssr_subdev()
343 	ssr->subdev.stop = ssr_notify_stop;  in qcom_add_ssr_subdev()
344 	ssr->subdev.unprepare = ssr_notify_unprepare;  in qcom_add_ssr_subdev()
346 	rproc_add_subdev(rproc, &ssr->subdev);  in qcom_add_ssr_subdev()
351  * qcom_remove_ssr_subdev() - remove subdevice as restart notification source
357 	rproc_remove_subdev(rproc, &ssr->subdev);  in qcom_remove_ssr_subdev()
358 	ssr->info = NULL;  in qcom_remove_ssr_subdev()