1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * RPM over SMD communication wrapper for interconnects
4 *
5 * Copyright (C) 2019 Linaro Ltd
6 * Author: Georgi Djakov <georgi.djakov@linaro.org>
7 */
8
9 #include <linux/interconnect-provider.h>
10 #include <linux/module.h>
11 #include <linux/platform_device.h>
12 #include <linux/soc/qcom/smd-rpm.h>
13
14 #include "icc-rpm.h"
15
16 #define RPM_KEY_BW 0x00007762
17 #define QCOM_RPM_SMD_KEY_RATE 0x007a484b
18
19 static struct qcom_smd_rpm *icc_smd_rpm;
20
21 struct icc_rpm_smd_req {
22 __le32 key;
23 __le32 nbytes;
24 __le32 value;
25 };
26
qcom_icc_rpm_smd_available(void)27 bool qcom_icc_rpm_smd_available(void)
28 {
29 return !!icc_smd_rpm;
30 }
31 EXPORT_SYMBOL_GPL(qcom_icc_rpm_smd_available);
32
qcom_icc_rpm_smd_send(int ctx,int rsc_type,int id,u32 val)33 int qcom_icc_rpm_smd_send(int ctx, int rsc_type, int id, u32 val)
34 {
35 struct icc_rpm_smd_req req = {
36 .key = cpu_to_le32(RPM_KEY_BW),
37 .nbytes = cpu_to_le32(sizeof(u32)),
38 .value = cpu_to_le32(val),
39 };
40
41 return qcom_rpm_smd_write(icc_smd_rpm, ctx, rsc_type, id, &req,
42 sizeof(req));
43 }
44 EXPORT_SYMBOL_GPL(qcom_icc_rpm_smd_send);
45
qcom_icc_rpm_set_bus_rate(const struct rpm_clk_resource * clk,int ctx,u32 rate)46 int qcom_icc_rpm_set_bus_rate(const struct rpm_clk_resource *clk, int ctx, u32 rate)
47 {
48 struct clk_smd_rpm_req req = {
49 .key = cpu_to_le32(QCOM_RPM_SMD_KEY_RATE),
50 .nbytes = cpu_to_le32(sizeof(u32)),
51 };
52
53 /* Branch clocks are only on/off */
54 if (clk->branch)
55 rate = !!rate;
56
57 req.value = cpu_to_le32(rate);
58 return qcom_rpm_smd_write(icc_smd_rpm,
59 ctx,
60 clk->resource_type,
61 clk->clock_id,
62 &req, sizeof(req));
63 }
64 EXPORT_SYMBOL_GPL(qcom_icc_rpm_set_bus_rate);
65
qcom_icc_rpm_smd_remove(struct platform_device * pdev)66 static void qcom_icc_rpm_smd_remove(struct platform_device *pdev)
67 {
68 icc_smd_rpm = NULL;
69 }
70
qcom_icc_rpm_smd_probe(struct platform_device * pdev)71 static int qcom_icc_rpm_smd_probe(struct platform_device *pdev)
72 {
73 icc_smd_rpm = dev_get_drvdata(pdev->dev.parent);
74
75 if (!icc_smd_rpm) {
76 dev_err(&pdev->dev, "unable to retrieve handle to RPM\n");
77 return -ENODEV;
78 }
79
80 return 0;
81 }
82
83 static struct platform_driver qcom_interconnect_rpm_smd_driver = {
84 .driver = {
85 .name = "icc_smd_rpm",
86 },
87 .probe = qcom_icc_rpm_smd_probe,
88 .remove_new = qcom_icc_rpm_smd_remove,
89 };
90 module_platform_driver(qcom_interconnect_rpm_smd_driver);
91 MODULE_AUTHOR("Georgi Djakov <georgi.djakov@linaro.org>");
92 MODULE_DESCRIPTION("Qualcomm SMD RPM interconnect proxy driver");
93 MODULE_LICENSE("GPL v2");
94 MODULE_ALIAS("platform:icc_smd_rpm");
95