1 // SPDX-License-Identifier: GPL-2.0
3 * CDX host controller driver for AMD versal-net platform.
5 * Copyright (C) 2022-2023, Advanced Micro Devices, Inc.
8 #include <linux/mod_devicetable.h>
9 #include <linux/platform_device.h>
10 #include <linux/slab.h>
11 #include <linux/cdx/cdx_bus.h>
13 #include "cdx_controller.h"
15 #include "mcdi_functions.h"
18 static unsigned int cdx_mcdi_rpc_timeout(struct cdx_mcdi *cdx, unsigned int cmd)
20 return MCDI_RPC_TIMEOUT;
23 static void cdx_mcdi_request(struct cdx_mcdi *cdx,
24 const struct cdx_dword *hdr, size_t hdr_len,
25 const struct cdx_dword *sdu, size_t sdu_len)
27 if (cdx_rpmsg_send(cdx, hdr, hdr_len, sdu, sdu_len))
28 dev_err(&cdx->rpdev->dev, "Failed to send rpmsg data\n");
31 static const struct cdx_mcdi_ops mcdi_ops = {
32 .mcdi_rpc_timeout = cdx_mcdi_rpc_timeout,
33 .mcdi_request = cdx_mcdi_request,
36 static int cdx_bus_enable(struct cdx_controller *cdx, u8 bus_num)
38 return cdx_mcdi_bus_enable(cdx->priv, bus_num);
41 static int cdx_bus_disable(struct cdx_controller *cdx, u8 bus_num)
43 return cdx_mcdi_bus_disable(cdx->priv, bus_num);
46 void cdx_rpmsg_post_probe(struct cdx_controller *cdx)
48 /* Register CDX controller with CDX bus driver */
49 if (cdx_register_controller(cdx))
50 dev_err(cdx->dev, "Failed to register CDX controller\n");
53 void cdx_rpmsg_pre_remove(struct cdx_controller *cdx)
55 cdx_unregister_controller(cdx);
56 cdx_mcdi_wait_for_quiescence(cdx->priv, MCDI_RPC_TIMEOUT);
59 static int cdx_configure_device(struct cdx_controller *cdx,
60 u8 bus_num, u8 dev_num,
61 struct cdx_device_config *dev_config)
65 switch (dev_config->type) {
66 case CDX_DEV_RESET_CONF:
67 ret = cdx_mcdi_reset_device(cdx->priv, bus_num, dev_num);
69 case CDX_DEV_BUS_MASTER_CONF:
70 ret = cdx_mcdi_bus_master_enable(cdx->priv, bus_num, dev_num,
71 dev_config->bus_master_enable);
80 static int cdx_scan_devices(struct cdx_controller *cdx)
82 struct cdx_mcdi *cdx_mcdi = cdx->priv;
83 u8 bus_num, dev_num, num_cdx_bus;
86 /* MCDI FW Read: Fetch the number of CDX buses on this controller */
87 ret = cdx_mcdi_get_num_buses(cdx_mcdi);
90 "Get number of CDX buses failed: %d\n", ret);
93 num_cdx_bus = (u8)ret;
95 for (bus_num = 0; bus_num < num_cdx_bus; bus_num++) {
96 struct device *bus_dev;
99 /* Add the bus on cdx subsystem */
100 bus_dev = cdx_bus_add(cdx, bus_num);
104 /* MCDI FW Read: Fetch the number of devices present */
105 ret = cdx_mcdi_get_num_devs(cdx_mcdi, bus_num);
108 "Get devices on CDX bus %d failed: %d\n", bus_num, ret);
111 num_cdx_dev = (u8)ret;
113 for (dev_num = 0; dev_num < num_cdx_dev; dev_num++) {
114 struct cdx_dev_params dev_params;
116 /* MCDI FW: Get the device config */
117 ret = cdx_mcdi_get_dev_config(cdx_mcdi, bus_num,
118 dev_num, &dev_params);
121 "CDX device config get failed for %d(bus):%d(dev), %d\n",
122 bus_num, dev_num, ret);
125 dev_params.cdx = cdx;
126 dev_params.parent = bus_dev;
128 /* Add the device to the cdx bus */
129 ret = cdx_device_add(&dev_params);
131 dev_err(cdx->dev, "registering cdx dev: %d failed: %d\n",
136 dev_dbg(cdx->dev, "CDX dev: %d on cdx bus: %d created\n",
144 static struct cdx_ops cdx_ops = {
145 .bus_enable = cdx_bus_enable,
146 .bus_disable = cdx_bus_disable,
147 .scan = cdx_scan_devices,
148 .dev_configure = cdx_configure_device,
151 static int xlnx_cdx_probe(struct platform_device *pdev)
153 struct cdx_controller *cdx;
154 struct cdx_mcdi *cdx_mcdi;
157 cdx_mcdi = kzalloc(sizeof(*cdx_mcdi), GFP_KERNEL);
161 /* Store the MCDI ops */
162 cdx_mcdi->mcdi_ops = &mcdi_ops;
163 /* MCDI FW: Initialize the FW path */
164 ret = cdx_mcdi_init(cdx_mcdi);
166 dev_err_probe(&pdev->dev, ret, "MCDI Initialization failed\n");
170 cdx = kzalloc(sizeof(*cdx), GFP_KERNEL);
175 platform_set_drvdata(pdev, cdx);
177 cdx->dev = &pdev->dev;
178 cdx->priv = cdx_mcdi;
181 ret = cdx_setup_rpmsg(pdev);
183 if (ret != -EPROBE_DEFER)
184 dev_err(&pdev->dev, "Failed to register CDX RPMsg transport\n");
188 dev_info(&pdev->dev, "Successfully registered CDX controller with RPMsg as transport\n");
194 cdx_mcdi_finish(cdx_mcdi);
201 static int xlnx_cdx_remove(struct platform_device *pdev)
203 struct cdx_controller *cdx = platform_get_drvdata(pdev);
204 struct cdx_mcdi *cdx_mcdi = cdx->priv;
206 cdx_destroy_rpmsg(pdev);
210 cdx_mcdi_finish(cdx_mcdi);
216 static const struct of_device_id cdx_match_table[] = {
217 {.compatible = "xlnx,versal-net-cdx",},
221 MODULE_DEVICE_TABLE(of, cdx_match_table);
223 static struct platform_driver cdx_pdriver = {
225 .name = "cdx-controller",
227 .of_match_table = cdx_match_table,
229 .probe = xlnx_cdx_probe,
230 .remove = xlnx_cdx_remove,
233 static int __init cdx_controller_init(void)
237 ret = platform_driver_register(&cdx_pdriver);
239 pr_err("platform_driver_register() failed: %d\n", ret);
244 static void __exit cdx_controller_exit(void)
246 platform_driver_unregister(&cdx_pdriver);
249 module_init(cdx_controller_init);
250 module_exit(cdx_controller_exit);
252 MODULE_AUTHOR("AMD Inc.");
253 MODULE_DESCRIPTION("CDX controller for AMD devices");
254 MODULE_LICENSE("GPL");
255 MODULE_IMPORT_NS(CDX_BUS_CONTROLLER);