1 // SPDX-License-Identifier: GPL-2.0-only
4  * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
14 #include <linux/rpmsg.h>
15 #include <linux/soc/qcom/smd-rpm.h>
20  * struct qcom_smd_rpm - state of the rpm device driver
37  * struct qcom_rpm_header - header for all rpm requests and responses
47  * struct qcom_rpm_request - request message to the rpm
63  * struct qcom_rpm_message - response message from the rpm
86  * qcom_rpm_smd_write - write @buf to @type:@id
112 		return -EINVAL;  in qcom_rpm_smd_write()
116 		return -ENOMEM;  in qcom_rpm_smd_write()
118 	mutex_lock(&rpm->lock);  in qcom_rpm_smd_write()
120 	pkt->hdr.service_type = cpu_to_le32(RPM_SERVICE_TYPE_REQUEST);  in qcom_rpm_smd_write()
121 	pkt->hdr.length = cpu_to_le32(sizeof(struct qcom_rpm_request) + count);  in qcom_rpm_smd_write()
123 	pkt->req.msg_id = cpu_to_le32(msg_id++);  in qcom_rpm_smd_write()
124 	pkt->req.flags = cpu_to_le32(state);  in qcom_rpm_smd_write()
125 	pkt->req.type = cpu_to_le32(type);  in qcom_rpm_smd_write()
126 	pkt->req.id = cpu_to_le32(id);  in qcom_rpm_smd_write()
127 	pkt->req.data_len = cpu_to_le32(count);  in qcom_rpm_smd_write()
128 	memcpy(pkt->payload, buf, count);  in qcom_rpm_smd_write()
130 	ret = rpmsg_send(rpm->rpm_channel, pkt, size);  in qcom_rpm_smd_write()
132 		goto out;  in qcom_rpm_smd_write()
134 	left = wait_for_completion_timeout(&rpm->ack, RPM_REQUEST_TIMEOUT);  in qcom_rpm_smd_write()
136 		ret = -ETIMEDOUT;  in qcom_rpm_smd_write()
138 		ret = rpm->ack_status;  in qcom_rpm_smd_write()
140 out:  in qcom_rpm_smd_write()
142 	mutex_unlock(&rpm->lock);  in qcom_rpm_smd_write()
154 	size_t hdr_length = le32_to_cpu(hdr->length);  in qcom_smd_rpm_callback()
156 	struct qcom_smd_rpm *rpm = dev_get_drvdata(&rpdev->dev);  in qcom_smd_rpm_callback()
163 	if (le32_to_cpu(hdr->service_type) != RPM_SERVICE_TYPE_REQUEST ||  in qcom_smd_rpm_callback()
165 		dev_err(rpm->dev, "invalid request\n");  in qcom_smd_rpm_callback()
171 		msg_length = le32_to_cpu(msg->length);  in qcom_smd_rpm_callback()
172 		switch (le32_to_cpu(msg->msg_type)) {  in qcom_smd_rpm_callback()
177 			memcpy_fromio(msgbuf, msg->message, len);  in qcom_smd_rpm_callback()
178 			msgbuf[len - 1] = 0;  in qcom_smd_rpm_callback()
181 				status = -ENXIO;  in qcom_smd_rpm_callback()
183 				status = -EINVAL;  in qcom_smd_rpm_callback()
190 	rpm->ack_status = status;  in qcom_smd_rpm_callback()
191 	complete(&rpm->ack);  in qcom_smd_rpm_callback()
199 	if (!rpdev->dev.of_node)  in qcom_smd_rpm_probe()
200 		return -EINVAL;  in qcom_smd_rpm_probe()
202 	rpm = devm_kzalloc(&rpdev->dev, sizeof(*rpm), GFP_KERNEL);  in qcom_smd_rpm_probe()
204 		return -ENOMEM;  in qcom_smd_rpm_probe()
206 	mutex_init(&rpm->lock);  in qcom_smd_rpm_probe()
207 	init_completion(&rpm->ack);  in qcom_smd_rpm_probe()
209 	rpm->dev = &rpdev->dev;  in qcom_smd_rpm_probe()
210 	rpm->rpm_channel = rpdev->ept;  in qcom_smd_rpm_probe()
211 	dev_set_drvdata(&rpdev->dev, rpm);  in qcom_smd_rpm_probe()
213 	return of_platform_populate(rpdev->dev.of_node, NULL, NULL, &rpdev->dev);  in qcom_smd_rpm_probe()
218 	of_platform_depopulate(&rpdev->dev);  in qcom_smd_rpm_remove()
225 MODULE_DEVICE_TABLE(rpmsg, qcom_smd_rpm_id_table);