Hello Xiang
On 2/16/19 8:37 PM, Xiang Xiao wrote:
> From: Yanlin Zhu <zhuyanlin@xxxxxxxxxxxx>
>
> which could redirect clk API from remote to the kernel
>
> Signed-off-by: Yanlin Zhu <zhuyanlin@xxxxxxxxxxxx>
> ---
> drivers/rpmsg/Kconfig | 10 ++
> drivers/rpmsg/Makefile | 1 +
> drivers/rpmsg/rpmsg_clk.c | 284 ++++++++++++++++++++++++++++++++++++++++++++++
> 3 files changed, 295 insertions(+)
> create mode 100644 drivers/rpmsg/rpmsg_clk.c
>
> diff --git a/drivers/rpmsg/Kconfig b/drivers/rpmsg/Kconfig
> index 13ead55..ed04cb9 100644
> --- a/drivers/rpmsg/Kconfig
> +++ b/drivers/rpmsg/Kconfig
> @@ -15,6 +15,16 @@ config RPMSG_CHAR
> in /dev. They make it possible for user-space programs to send and
> receive rpmsg packets.
>
> +config RPMSG_CLK
> + tristate "RPMSG clock API redirection"
> + depends on COMMON_CLK
> + depends on RPMSG
> + help
> + Say Y here to redirect clock API from the remote processor.
> + With this driver, the remote processor could:
> + 1.Reuse the clock driver in the kernel side, or
> + 2.Form a hybrid(kernel plus RTOS) clock tree.
> +
> config RPMSG_SYSLOG
> tristate "RPMSG syslog redirection"
> depends on RPMSG
> diff --git a/drivers/rpmsg/Makefile b/drivers/rpmsg/Makefile
> index bfd22df..0d777b1 100644
> --- a/drivers/rpmsg/Makefile
> +++ b/drivers/rpmsg/Makefile
> @@ -1,6 +1,7 @@
> # SPDX-License-Identifier: GPL-2.0
> obj-$(CONFIG_RPMSG) += rpmsg_core.o
> obj-$(CONFIG_RPMSG_CHAR) += rpmsg_char.o
> +obj-$(CONFIG_RPMSG_CLK) += rpmsg_clk.o
> obj-$(CONFIG_RPMSG_SYSLOG) += rpmsg_syslog.o
> obj-$(CONFIG_RPMSG_QCOM_GLINK_RPM) += qcom_glink_rpm.o
> obj-$(CONFIG_RPMSG_QCOM_GLINK_NATIVE) += qcom_glink_native.o
> diff --git a/drivers/rpmsg/rpmsg_clk.c b/drivers/rpmsg/rpmsg_clk.c
> new file mode 100644
> index 0000000..0ec0241
> --- /dev/null
> +++ b/drivers/rpmsg/rpmsg_clk.c
> @@ -0,0 +1,284 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright (C) 2016 Pinecone Inc.
> + *
> + * redirect clk API from remote to the kernel.
> + */
> +
> +#include <linux/clk.h>
> +#include <linux/clk-provider.h>
> +#include <linux/module.h>
> +#include <linux/rpmsg.h>
> +
> +#define RPMSG_CLK_ENABLE 0
> +#define RPMSG_CLK_DISABLE 1
> +#define RPMSG_CLK_SETRATE 2
> +#define RPMSG_CLK_SETPHASE 3
> +#define RPMSG_CLK_GETPHASE 4
> +#define RPMSG_CLK_GETRATE 5
> +#define RPMSG_CLK_ROUNDRATE 6
> +#define RPMSG_CLK_ISENABLED 7
> +
> +struct rpmsg_clk_header {
> + u32 command;
> + u32 response;
> + s64 result;
> + u64 cookie;
> +} __packed;
> +
> +struct rpmsg_clk_enable {
> + struct rpmsg_clk_header header;
> + char name[0];
> +} __packed;
> +
> +#define rpmsg_clk_disable rpmsg_clk_enable
> +#define rpmsg_clk_isenabled rpmsg_clk_enable
> +
> +struct rpmsg_clk_setrate {
> + struct rpmsg_clk_header header;
> + u64 rate;
> + char name[0];
> +} __packed;
> +
> +#define rpmsg_clk_getrate rpmsg_clk_enable
> +#define rpmsg_clk_roundrate rpmsg_clk_setrate
> +
> +struct rpmsg_clk_setphase {
> + struct rpmsg_clk_header header;
> + u32 degrees;
> + char name[0];
> +} __packed;
> +
> +#define rpmsg_clk_getphase rpmsg_clk_enable
> +
> +struct rpmsg_clk_res {
> + struct clk *clk;
> + atomic_t count;
> +};
> +
> +static void rpmsg_clk_release(struct device *dev, void *res)
> +{
> + struct rpmsg_clk_res *clkres = res;
> + int count = atomic_read(&clkres->count);
> +
> + while (count-- > 0)
> + clk_disable_unprepare(clkres->clk);
> +
> + clk_put(clkres->clk);
> +}
> +
> +static int rpmsg_clk_match(struct device *dev, void *res, void *data)
> +{
> + struct rpmsg_clk_res *clkres = res;
> +
> + return !strcmp(__clk_get_name(clkres->clk), data);
> +}
> +
> +static struct rpmsg_clk_res *
> +rpmsg_clk_get_res(struct rpmsg_device *rpdev, const char *name)
> +{
> + struct rpmsg_clk_res *clkres;
> + struct clk *clk;
> +
> + clkres = devres_find(&rpdev->dev, rpmsg_clk_release,
> + rpmsg_clk_match, (void *)name);
> + if (clkres)
> + return clkres;
> +
> + clkres = devres_alloc(rpmsg_clk_release, sizeof(*clkres), GFP_KERNEL);
> + if (!clkres)
> + return ERR_PTR(-ENOMEM);
> +
> + clk = clk_get(&rpdev->dev, name);
> + if (IS_ERR(clk)) {
> + devres_free(clkres);
> + return ERR_CAST(clk);
> + }
> +
> + clkres->clk = clk;
> + devres_add(&rpdev->dev, clkres);
> +
> + return clkres;
> +}
> +
> +static int rpmsg_clk_enable_handler(struct rpmsg_device *rpdev,
> + void *data, int len, void *priv, u32 src)
> +{
> + struct rpmsg_clk_enable *msg = data;
> + struct rpmsg_clk_res *clkres = rpmsg_clk_get_res(rpdev, msg->name);
> +
> + if (!IS_ERR(clkres)) {
> + msg->header.result = clk_prepare_enable(clkres->clk);
> + if (msg->header.result >= 0)
> + atomic_inc(&clkres->count);
> + } else {
> + msg->header.result = PTR_ERR(clkres);
> + }
> +
> + return rpmsg_send(rpdev->ept, msg, sizeof(*msg));
> +}
> +
> +static int rpmsg_clk_disable_handler(struct rpmsg_device *rpdev,
> + void *data, int len, void *priv, u32 src)
> +{
> + struct rpmsg_clk_disable *msg = data;
> + struct rpmsg_clk_res *clkres = rpmsg_clk_get_res(rpdev, msg->name);
> +
> + if (!IS_ERR(clkres)) {
> + msg->header.result = 0;
> + if (atomic_dec_return(&clkres->count) >= 0)
> + clk_disable_unprepare(clkres->clk);
> + else
> + atomic_inc(&clkres->count);
> + } else {
> + msg->header.result = PTR_ERR(clkres);
> + }
> +
> + return rpmsg_send(rpdev->ept, msg, sizeof(*msg));
> +}
> +
> +static int rpmsg_clk_getrate_handler(struct rpmsg_device *rpdev,
> + void *data, int len, void *priv, u32 src)
> +{
> + struct rpmsg_clk_getrate *msg = data;
> + struct rpmsg_clk_res *clkres = rpmsg_clk_get_res(rpdev, msg->name);
> +
> + if (!IS_ERR(clkres))
> + msg->header.result = clk_get_rate(clkres->clk);
> + else
> + msg->header.result = PTR_ERR(clkres);
> +
> + return rpmsg_send(rpdev->ept, msg, sizeof(*msg));
> +}
> +
> +static int rpmsg_clk_roundrate_handler(struct rpmsg_device *rpdev,
> + void *data, int len, void *priv, u32 src)
> +{
> + struct rpmsg_clk_roundrate *msg = data;
> + struct rpmsg_clk_res *clkres = rpmsg_clk_get_res(rpdev, msg->name);
> +
> + if (!IS_ERR(clkres))
> + msg->header.result = clk_round_rate(clkres->clk, msg->rate);
> + else
> + msg->header.result = PTR_ERR(clkres);
> +
> + return rpmsg_send(rpdev->ept, msg, sizeof(*msg));
> +}
> +
> +static int rpmsg_clk_setrate_handler(struct rpmsg_device *rpdev,
> + void *data, int len, void *priv, u32 src)
> +{
> + struct rpmsg_clk_setrate *msg = data;
> + struct rpmsg_clk_res *clkres = rpmsg_clk_get_res(rpdev, msg->name);
> +
> + if (!IS_ERR(clkres))
> + msg->header.result = clk_set_rate(clkres->clk, msg->rate);
> + else
> + msg->header.result = PTR_ERR(clkres);
> +
> + return rpmsg_send(rpdev->ept, msg, sizeof(*msg));
> +}
> +
> +static int rpmsg_clk_setphase_handler(struct rpmsg_device *rpdev,
> + void *data, int len, void *priv, u32 src)
> +{
> + struct rpmsg_clk_setphase *msg = data;
> + struct rpmsg_clk_res *clkres = rpmsg_clk_get_res(rpdev, msg->name);
> +
> + if (!IS_ERR(clkres))
> + msg->header.result = clk_set_phase(clkres->clk, msg->degrees);
> + else
> + msg->header.result = PTR_ERR(clkres);
> +
> + return rpmsg_send(rpdev->ept, msg, sizeof(*msg));
> +}
> +
> +static int rpmsg_clk_getphase_handler(struct rpmsg_device *rpdev,
> + void *data, int len, void *priv, u32 src)
> +{
> + struct rpmsg_clk_getphase *msg = data;
> + struct rpmsg_clk_res *clkres = rpmsg_clk_get_res(rpdev, msg->name);
> +
> + if (!IS_ERR(clkres))
> + msg->header.result = clk_get_phase(clkres->clk);
> + else
> + msg->header.result = PTR_ERR(clkres);
> +
> + return rpmsg_send(rpdev->ept, msg, sizeof(*msg));
> +}
> +
> +static int rpmsg_clk_isenabled_handler(struct rpmsg_device *rpdev,
> + void *data, int len, void *priv, u32 src)
> +{
> + struct rpmsg_clk_isenabled *msg = data;
> + struct rpmsg_clk_res *clkres = rpmsg_clk_get_res(rpdev, msg->name);
> +
> + if (!IS_ERR(clkres))
> + msg->header.result = __clk_is_enabled(clkres->clk);
> + else
> + msg->header.result = PTR_ERR(clkres);
> +
> + return rpmsg_send(rpdev->ept, msg, sizeof(*msg));
> +}
> +
> +static const rpmsg_rx_cb_t rpmsg_clk_handler[] = {
> + [RPMSG_CLK_ENABLE] = rpmsg_clk_enable_handler,
> + [RPMSG_CLK_DISABLE] = rpmsg_clk_disable_handler,
> + [RPMSG_CLK_SETRATE] = rpmsg_clk_setrate_handler,
> + [RPMSG_CLK_SETPHASE] = rpmsg_clk_setphase_handler,
> + [RPMSG_CLK_GETPHASE] = rpmsg_clk_getphase_handler,
> + [RPMSG_CLK_GETRATE] = rpmsg_clk_getrate_handler,
> + [RPMSG_CLK_ROUNDRATE] = rpmsg_clk_roundrate_handler,
> + [RPMSG_CLK_ISENABLED] = rpmsg_clk_isenabled_handler,
> +};
> +
> +static int rpmsg_clk_callback(struct rpmsg_device *rpdev,
> + void *data, int len, void *priv, u32 src)
> +{
> + struct rpmsg_clk_header *hdr = data;
> + u32 cmd = hdr->command;
> + int ret = -EINVAL;
> +
> + if (cmd < ARRAY_SIZE(rpmsg_clk_handler)) {
> + hdr->response = 1;
> + ret = rpmsg_clk_handler[cmd](rpdev, data, len, priv, src);
> + } else {
> + dev_err(&rpdev->dev, "invalid command %u\n", cmd);
> + }
> +
> + return ret;
> +}
> +
> +static int rpmsg_clk_probe(struct rpmsg_device *rpdev)
> +{
> + return 0;
> +}
> +
> +static void rpmsg_clk_remove(struct rpmsg_device *rpdev)
> +{
> +}
> +
> +static const struct rpmsg_device_id rpmsg_clk_id_table[] = {
> + { .name = "rpmsg-clk" },
> + { }
> +};
> +MODULE_DEVICE_TABLE(rpmsg, rpmsg_clk_id_table);
> +
> +static struct rpmsg_driver rpmsg_clk_driver = {
> + .drv = {
> + .name = "rpmsg_clk",
> + .owner = THIS_MODULE,
> + },
> +
> + .id_table = rpmsg_clk_id_table,
> + .probe = rpmsg_clk_probe,
> + .callback = rpmsg_clk_callback,
> + .remove = rpmsg_clk_remove,
> +};
> +
> +module_rpmsg_driver(rpmsg_clk_driver);
> +
> +MODULE_ALIAS("rpmsg:rpmsg_clk");
> +MODULE_AUTHOR("Yanlin Zhu <zhuyanlin@xxxxxxxxxx>");
> +MODULE_DESCRIPTION("rpmsg clock API redirection driver");
> +MODULE_LICENSE("GPL v2");
>
This is similar to the resource manager we proposed several months ago.
we proposed a generic solution for the clock but also the other
resources managed by Linux for the remote processor (regulators, GPIO,...)
Please have a look here
patch:
https://patchwork.kernel.org/project/linux-remoteproc/list/?submitter=92421
overview document:
http://openamp.github.io/docs/mca/remoteproc-resource-manager-overview.pdf
Regards
Arnaud
