Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * RPM over SMD communication wrapper for interconnects
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * Copyright (C) 2019 Linaro Ltd
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  * Author: Georgi Djakov <georgi.djakov@linaro.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #include <linux/interconnect-provider.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/of_platform.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/soc/qcom/smd-rpm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include "smd-rpm.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #define RPM_KEY_BW		0x00007762
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) static struct qcom_smd_rpm *icc_smd_rpm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) struct icc_rpm_smd_req {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	__le32 key;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	__le32 nbytes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 	__le32 value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) bool qcom_icc_rpm_smd_available(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	return !!icc_smd_rpm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) EXPORT_SYMBOL_GPL(qcom_icc_rpm_smd_available);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) int qcom_icc_rpm_smd_send(int ctx, int rsc_type, int id, u32 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	struct icc_rpm_smd_req req = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 		.key = cpu_to_le32(RPM_KEY_BW),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 		.nbytes = cpu_to_le32(sizeof(u32)),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 		.value = cpu_to_le32(val),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	return qcom_rpm_smd_write(icc_smd_rpm, ctx, rsc_type, id, &req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 				  sizeof(req));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) EXPORT_SYMBOL_GPL(qcom_icc_rpm_smd_send);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) static int qcom_icc_rpm_smd_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	icc_smd_rpm = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static int qcom_icc_rpm_smd_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 	icc_smd_rpm = dev_get_drvdata(pdev->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 	if (!icc_smd_rpm) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 		dev_err(&pdev->dev, "unable to retrieve handle to RPM\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) static struct platform_driver qcom_interconnect_rpm_smd_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 		.name		= "icc_smd_rpm",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 	.probe = qcom_icc_rpm_smd_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 	.remove = qcom_icc_rpm_smd_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) module_platform_driver(qcom_interconnect_rpm_smd_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) MODULE_AUTHOR("Georgi Djakov <georgi.djakov@linaro.org>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) MODULE_DESCRIPTION("Qualcomm SMD RPM interconnect proxy driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) MODULE_ALIAS("platform:icc_smd_rpm");