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 | |
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 | |
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(rpm: icc_smd_rpm, state: ctx, resource_type: rsc_type, resource_id: id, buf: &req, |
42 | count: sizeof(req)); |
43 | } |
44 | EXPORT_SYMBOL_GPL(qcom_icc_rpm_smd_send); |
45 | |
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(rpm: icc_smd_rpm, |
59 | state: ctx, |
60 | resource_type: clk->resource_type, |
61 | resource_id: clk->clock_id, |
62 | buf: &req, count: sizeof(req)); |
63 | } |
64 | EXPORT_SYMBOL_GPL(qcom_icc_rpm_set_bus_rate); |
65 | |
66 | static void qcom_icc_rpm_smd_remove(struct platform_device *pdev) |
67 | { |
68 | icc_smd_rpm = NULL; |
69 | } |
70 | |
71 | static int qcom_icc_rpm_smd_probe(struct platform_device *pdev) |
72 | { |
73 | icc_smd_rpm = dev_get_drvdata(dev: 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 | |