root/drivers/interconnect/qcom/smd-rpm.c
// SPDX-License-Identifier: GPL-2.0
/*
 * RPM over SMD communication wrapper for interconnects
 *
 * Copyright (C) 2019 Linaro Ltd
 * Author: Georgi Djakov <georgi.djakov@linaro.org>
 */

#include <linux/interconnect-provider.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/soc/qcom/smd-rpm.h>

#include "icc-rpm.h"

#define RPM_KEY_BW              0x00007762

static struct qcom_smd_rpm *icc_smd_rpm;

struct icc_rpm_smd_req {
        __le32 key;
        __le32 nbytes;
        __le32 value;
};

bool qcom_icc_rpm_smd_available(void)
{
        return !!icc_smd_rpm;
}
EXPORT_SYMBOL_GPL(qcom_icc_rpm_smd_available);

int qcom_icc_rpm_smd_send(int ctx, int rsc_type, int id, u32 val)
{
        struct icc_rpm_smd_req req = {
                .key = cpu_to_le32(RPM_KEY_BW),
                .nbytes = cpu_to_le32(sizeof(u32)),
                .value = cpu_to_le32(val),
        };

        return qcom_rpm_smd_write(icc_smd_rpm, ctx, rsc_type, id, &req,
                                  sizeof(req));
}
EXPORT_SYMBOL_GPL(qcom_icc_rpm_smd_send);

int qcom_icc_rpm_set_bus_rate(const struct rpm_clk_resource *clk, int ctx, u32 rate)
{
        struct clk_smd_rpm_req req = {
                .key = cpu_to_le32(QCOM_RPM_SMD_KEY_RATE),
                .nbytes = cpu_to_le32(sizeof(u32)),
        };

        /* Branch clocks are only on/off */
        if (clk->branch)
                rate = !!rate;

        req.value = cpu_to_le32(rate);
        return qcom_rpm_smd_write(icc_smd_rpm,
                                  ctx,
                                  clk->resource_type,
                                  clk->clock_id,
                                  &req, sizeof(req));
}
EXPORT_SYMBOL_GPL(qcom_icc_rpm_set_bus_rate);

static void qcom_icc_rpm_smd_remove(struct platform_device *pdev)
{
        icc_smd_rpm = NULL;
}

static int qcom_icc_rpm_smd_probe(struct platform_device *pdev)
{
        icc_smd_rpm = dev_get_drvdata(pdev->dev.parent);

        if (!icc_smd_rpm) {
                dev_err(&pdev->dev, "unable to retrieve handle to RPM\n");
                return -ENODEV;
        }

        return 0;
}

static struct platform_driver qcom_interconnect_rpm_smd_driver = {
        .driver = {
                .name           = "icc_smd_rpm",
        },
        .probe = qcom_icc_rpm_smd_probe,
        .remove = qcom_icc_rpm_smd_remove,
};
module_platform_driver(qcom_interconnect_rpm_smd_driver);
MODULE_AUTHOR("Georgi Djakov <georgi.djakov@linaro.org>");
MODULE_DESCRIPTION("Qualcomm SMD RPM interconnect proxy driver");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:icc_smd_rpm");