Something went wrong. Try again.
Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
Something went wrong. Try again.
4.6 kB · 202 lines
C
at master
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203// SPDX-License-Identifier: GPL-2.0/* * Platform driver for CDX bus. * * Copyright (C) 2022-2023, Advanced Micro Devices, Inc. */
#include <linux/rpmsg.h>#include <linux/remoteproc.h>#include <linux/of.h>#include <linux/platform_device.h>#include <linux/cdx/cdx_bus.h>#include <linux/module.h>
#include "../cdx.h"#include "cdx_controller.h"#include "mcdi_functions.h"#include "mcdid.h"
static struct rpmsg_device_id cdx_rpmsg_id_table[] = { { .name = "mcdi_ipc" }, { },};MODULE_DEVICE_TABLE(rpmsg, cdx_rpmsg_id_table);
int cdx_rpmsg_send(struct cdx_mcdi *cdx_mcdi, const struct cdx_dword *hdr, size_t hdr_len, const struct cdx_dword *sdu, size_t sdu_len){ unsigned char *send_buf; int ret;
send_buf = kzalloc(hdr_len + sdu_len, GFP_KERNEL); if (!send_buf) return -ENOMEM;
memcpy(send_buf, hdr, hdr_len); memcpy(send_buf + hdr_len, sdu, sdu_len);
ret = rpmsg_send(cdx_mcdi->ept, send_buf, hdr_len + sdu_len); kfree(send_buf);
return ret;}
static int cdx_attach_to_rproc(struct platform_device *pdev){ struct device_node *r5_core_node; struct cdx_controller *cdx_c; struct cdx_mcdi *cdx_mcdi; struct device *dev; struct rproc *rp; int ret;
dev = &pdev->dev; cdx_c = platform_get_drvdata(pdev); cdx_mcdi = cdx_c->priv;
r5_core_node = of_parse_phandle(dev->of_node, "xlnx,rproc", 0); if (!r5_core_node) { dev_err(&pdev->dev, "xlnx,rproc: invalid phandle\n"); return -EINVAL; }
rp = rproc_get_by_phandle(r5_core_node->phandle); if (!rp) { ret = -EPROBE_DEFER; goto pdev_err; }
/* Attach to remote processor */ ret = rproc_boot(rp); if (ret) { dev_err(&pdev->dev, "Failed to attach to remote processor\n"); rproc_put(rp); goto pdev_err; }
cdx_mcdi->r5_rproc = rp;pdev_err: of_node_put(r5_core_node); return ret;}
static void cdx_detach_to_r5(struct platform_device *pdev){ struct cdx_controller *cdx_c; struct cdx_mcdi *cdx_mcdi;
cdx_c = platform_get_drvdata(pdev); cdx_mcdi = cdx_c->priv;
rproc_detach(cdx_mcdi->r5_rproc); rproc_put(cdx_mcdi->r5_rproc);}
static int cdx_rpmsg_cb(struct rpmsg_device *rpdev, void *data, int len, void *priv, u32 src){ struct cdx_controller *cdx_c = dev_get_drvdata(&rpdev->dev); struct cdx_mcdi *cdx_mcdi = cdx_c->priv;
if (len > MCDI_BUF_LEN) return -EINVAL;
cdx_mcdi_process_cmd(cdx_mcdi, (struct cdx_dword *)data, len);
return 0;}
static void cdx_rpmsg_post_probe_work(struct work_struct *work){ struct cdx_controller *cdx_c; struct cdx_mcdi *cdx_mcdi;
cdx_mcdi = container_of(work, struct cdx_mcdi, work); cdx_c = dev_get_drvdata(&cdx_mcdi->rpdev->dev); cdx_rpmsg_post_probe(cdx_c);}
static int cdx_rpmsg_probe(struct rpmsg_device *rpdev){ struct rpmsg_channel_info chinfo = {0}; struct cdx_controller *cdx_c; struct cdx_mcdi *cdx_mcdi;
cdx_c = (struct cdx_controller *)cdx_rpmsg_id_table[0].driver_data; cdx_mcdi = cdx_c->priv;
chinfo.src = RPMSG_ADDR_ANY; chinfo.dst = rpdev->dst; strscpy(chinfo.name, cdx_rpmsg_id_table[0].name, sizeof(chinfo.name));
cdx_mcdi->ept = rpmsg_create_ept(rpdev, cdx_rpmsg_cb, NULL, chinfo); if (!cdx_mcdi->ept) { dev_err_probe(&rpdev->dev, -ENXIO, "Failed to create ept for channel %s\n", chinfo.name); return -EINVAL; }
cdx_mcdi->rpdev = rpdev; dev_set_drvdata(&rpdev->dev, cdx_c);
schedule_work(&cdx_mcdi->work); return 0;}
static void cdx_rpmsg_remove(struct rpmsg_device *rpdev){ struct cdx_controller *cdx_c = dev_get_drvdata(&rpdev->dev); struct cdx_mcdi *cdx_mcdi = cdx_c->priv;
flush_work(&cdx_mcdi->work); cdx_rpmsg_pre_remove(cdx_c);
rpmsg_destroy_ept(cdx_mcdi->ept); dev_set_drvdata(&rpdev->dev, NULL);}
static struct rpmsg_driver cdx_rpmsg_driver = { .drv.name = KBUILD_MODNAME, .id_table = cdx_rpmsg_id_table, .probe = cdx_rpmsg_probe, .remove = cdx_rpmsg_remove, .callback = cdx_rpmsg_cb,};
int cdx_setup_rpmsg(struct platform_device *pdev){ struct cdx_controller *cdx_c; struct cdx_mcdi *cdx_mcdi; int ret;
/* Attach to remote processor */ ret = cdx_attach_to_rproc(pdev); if (ret) return ret;
cdx_c = platform_get_drvdata(pdev); cdx_mcdi = cdx_c->priv;
/* Register RPMsg driver */ cdx_rpmsg_id_table[0].driver_data = (kernel_ulong_t)cdx_c;
INIT_WORK(&cdx_mcdi->work, cdx_rpmsg_post_probe_work); ret = register_rpmsg_driver(&cdx_rpmsg_driver); if (ret) { dev_err(&pdev->dev, "Failed to register cdx RPMsg driver: %d\n", ret); cdx_detach_to_r5(pdev); }
return ret;}
void cdx_destroy_rpmsg(struct platform_device *pdev){ unregister_rpmsg_driver(&cdx_rpmsg_driver);
cdx_detach_to_r5(pdev);}