// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (c) 2015, Sony Mobile Communications AB.
 * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
 */

#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/of_platform.h>
#include <linux/io.h>
#include <linux/interrupt.h>
#include <linux/slab.h>

#include <linux/rpmsg.h>
#include <linux/soc/qcom/smd-rpm.h>

#define RPM_REQUEST_TIMEOUT     (5 * HZ)

/**
 * struct qcom_smd_rpm - state of the rpm device driver
 * @rpm_channel:        reference to the smd channel
 * @icc:                interconnect proxy device
 * @dev:                rpm device
 * @ack:                completion for acks
 * @lock:               mutual exclusion around the send/complete pair
 * @ack_status:         result of the rpm request
 */
struct qcom_smd_rpm {
        struct rpmsg_endpoint *rpm_channel;
        struct platform_device *icc;
        struct device *dev;

        struct completion ack;
        struct mutex lock;
        int ack_status;
};

/**
 * struct qcom_rpm_header - header for all rpm requests and responses
 * @service_type:       identifier of the service
 * @length:             length of the payload
 */
struct qcom_rpm_header {
        __le32 service_type;
        __le32 length;
};

/**
 * struct qcom_rpm_request - request message to the rpm
 * @msg_id:     identifier of the outgoing message
 * @flags:      active/sleep state flags
 * @type:       resource type
 * @id:         resource id
 * @data_len:   length of the payload following this header
 */
struct qcom_rpm_request {
        __le32 msg_id;
        __le32 flags;
        __le32 type;
        __le32 id;
        __le32 data_len;
};

/**
 * struct qcom_rpm_message - response message from the rpm
 * @msg_type:   indicator of the type of message
 * @length:     the size of this message, including the message header
 * @msg_id:     message id
 * @message:    textual message from the rpm
 *
 * Multiple of these messages can be stacked in an rpm message.
 */
struct qcom_rpm_message {
        __le32 msg_type;
        __le32 length;
        union {
                __le32 msg_id;
                u8 message[0];
        };
};

#define RPM_SERVICE_TYPE_REQUEST        0x00716572 /* "req\0" */

#define RPM_MSG_TYPE_ERR                0x00727265 /* "err\0" */
#define RPM_MSG_TYPE_MSG_ID             0x2367736d /* "msg#" */

/**
 * qcom_rpm_smd_write - write @buf to @type:@id
 * @rpm:        rpm handle
 * @state:      active/sleep state flags
 * @type:       resource type
 * @id:         resource identifier
 * @buf:        the data to be written
 * @count:      number of bytes in @buf
 */
int qcom_rpm_smd_write(struct qcom_smd_rpm *rpm,
                       int state,
                       u32 type, u32 id,
                       void *buf,
                       size_t count)
{
        static unsigned msg_id = 1;
        int left;
        int ret;
        struct {
                struct qcom_rpm_header hdr;
                struct qcom_rpm_request req;
                u8 payload[];
        } *pkt;
        size_t size = sizeof(*pkt) + count;

        /* SMD packets to the RPM may not exceed 256 bytes */
        if (WARN_ON(size >= 256))
                return -EINVAL;

        pkt = kmalloc(size, GFP_KERNEL);
        if (!pkt)
                return -ENOMEM;

        mutex_lock(&rpm->lock);

        pkt->hdr.service_type = cpu_to_le32(RPM_SERVICE_TYPE_REQUEST);
        pkt->hdr.length = cpu_to_le32(sizeof(struct qcom_rpm_request) + count);

        pkt->req.msg_id = cpu_to_le32(msg_id++);
        pkt->req.flags = cpu_to_le32(state);
        pkt->req.type = cpu_to_le32(type);
        pkt->req.id = cpu_to_le32(id);
        pkt->req.data_len = cpu_to_le32(count);
        memcpy(pkt->payload, buf, count);

        ret = rpmsg_send(rpm->rpm_channel, pkt, size);
        if (ret)
                goto out;

        left = wait_for_completion_timeout(&rpm->ack, RPM_REQUEST_TIMEOUT);
        if (!left)
                ret = -ETIMEDOUT;
        else
                ret = rpm->ack_status;

out:
        kfree(pkt);
        mutex_unlock(&rpm->lock);
        return ret;
}
EXPORT_SYMBOL(qcom_rpm_smd_write);

static int qcom_smd_rpm_callback(struct rpmsg_device *rpdev,
                                 void *data,
                                 int count,
                                 void *priv,
                                 u32 addr)
{
        const struct qcom_rpm_header *hdr = data;
        size_t hdr_length = le32_to_cpu(hdr->length);
        const struct qcom_rpm_message *msg;
        struct qcom_smd_rpm *rpm = dev_get_drvdata(&rpdev->dev);
        const u8 *buf = data + sizeof(struct qcom_rpm_header);
        const u8 *end = buf + hdr_length;
        char msgbuf[32];
        int status = 0;
        u32 len, msg_length;

        if (le32_to_cpu(hdr->service_type) != RPM_SERVICE_TYPE_REQUEST ||
            hdr_length < sizeof(struct qcom_rpm_message)) {
                dev_err(rpm->dev, "invalid request\n");
                return 0;
        }

        while (buf < end) {
                msg = (struct qcom_rpm_message *)buf;
                msg_length = le32_to_cpu(msg->length);
                switch (le32_to_cpu(msg->msg_type)) {
                case RPM_MSG_TYPE_MSG_ID:
                        break;
                case RPM_MSG_TYPE_ERR:
                        len = min_t(u32, ALIGN(msg_length, 4), sizeof(msgbuf));
                        memcpy_fromio(msgbuf, msg->message, len);
                        msgbuf[len - 1] = 0;

                        if (!strcmp(msgbuf, "resource does not exist"))
                                status = -ENXIO;
                        else
                                status = -EINVAL;
                        break;
                }

                buf = PTR_ALIGN(buf + 2 * sizeof(u32) + msg_length, 4);
        }

        rpm->ack_status = status;
        complete(&rpm->ack);
        return 0;
}

static int qcom_smd_rpm_probe(struct rpmsg_device *rpdev)
{
        struct qcom_smd_rpm *rpm;
        int ret;

        rpm = devm_kzalloc(&rpdev->dev, sizeof(*rpm), GFP_KERNEL);
        if (!rpm)
                return -ENOMEM;

        mutex_init(&rpm->lock);
        init_completion(&rpm->ack);

        rpm->dev = &rpdev->dev;
        rpm->rpm_channel = rpdev->ept;
        dev_set_drvdata(&rpdev->dev, rpm);

        rpm->icc = platform_device_register_data(&rpdev->dev, "icc_smd_rpm", -1,
                                                 NULL, 0);
        if (IS_ERR(rpm->icc))
                return PTR_ERR(rpm->icc);

        ret = of_platform_populate(rpdev->dev.of_node, NULL, NULL, &rpdev->dev);
        if (ret)
                platform_device_unregister(rpm->icc);

        return ret;
}

static void qcom_smd_rpm_remove(struct rpmsg_device *rpdev)
{
        struct qcom_smd_rpm *rpm = dev_get_drvdata(&rpdev->dev);

        platform_device_unregister(rpm->icc);
        of_platform_depopulate(&rpdev->dev);
}

static const struct of_device_id qcom_smd_rpm_of_match[] = {
        { .compatible = "qcom,rpm-apq8084" },
        { .compatible = "qcom,rpm-ipq6018" },
        { .compatible = "qcom,rpm-msm8226" },
        { .compatible = "qcom,rpm-msm8916" },
        { .compatible = "qcom,rpm-msm8936" },
        { .compatible = "qcom,rpm-msm8974" },
        { .compatible = "qcom,rpm-msm8976" },
        { .compatible = "qcom,rpm-msm8994" },
        { .compatible = "qcom,rpm-msm8996" },
        { .compatible = "qcom,rpm-msm8998" },
        { .compatible = "qcom,rpm-sdm660" },
        { .compatible = "qcom,rpm-sm6115" },
        { .compatible = "qcom,rpm-sm6125" },
        { .compatible = "qcom,rpm-qcs404" },
        {}
};
MODULE_DEVICE_TABLE(of, qcom_smd_rpm_of_match);

static struct rpmsg_driver qcom_smd_rpm_driver = {
        .probe = qcom_smd_rpm_probe,
        .remove = qcom_smd_rpm_remove,
        .callback = qcom_smd_rpm_callback,
        .drv  = {
                .name  = "qcom_smd_rpm",
                .of_match_table = qcom_smd_rpm_of_match,
        },
};

static int __init qcom_smd_rpm_init(void)
{
        return register_rpmsg_driver(&qcom_smd_rpm_driver);
}
arch_initcall(qcom_smd_rpm_init);

static void __exit qcom_smd_rpm_exit(void)
{
        unregister_rpmsg_driver(&qcom_smd_rpm_driver);
}
module_exit(qcom_smd_rpm_exit);

MODULE_AUTHOR("Bjorn Andersson <bjorn.andersson@sonymobile.com>");
MODULE_DESCRIPTION("Qualcomm SMD backed RPM driver");
MODULE_LICENSE("GPL v2");