279 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * CDX host controller driver for AMD versal-net platform.4 *5 * Copyright (C) 2022-2023, Advanced Micro Devices, Inc.6 */7 8#include <linux/mod_devicetable.h>9#include <linux/platform_device.h>10#include <linux/slab.h>11#include <linux/cdx/cdx_bus.h>12#include <linux/irqdomain.h>13 14#include "cdx_controller.h"15#include "../cdx.h"16#include "mcdi_functions.h"17#include "mcdi.h"18 19static unsigned int cdx_mcdi_rpc_timeout(struct cdx_mcdi *cdx, unsigned int cmd)20{21 return MCDI_RPC_TIMEOUT;22}23 24static void cdx_mcdi_request(struct cdx_mcdi *cdx,25 const struct cdx_dword *hdr, size_t hdr_len,26 const struct cdx_dword *sdu, size_t sdu_len)27{28 if (cdx_rpmsg_send(cdx, hdr, hdr_len, sdu, sdu_len))29 dev_err(&cdx->rpdev->dev, "Failed to send rpmsg data\n");30}31 32static const struct cdx_mcdi_ops mcdi_ops = {33 .mcdi_rpc_timeout = cdx_mcdi_rpc_timeout,34 .mcdi_request = cdx_mcdi_request,35};36 37static int cdx_bus_enable(struct cdx_controller *cdx, u8 bus_num)38{39 return cdx_mcdi_bus_enable(cdx->priv, bus_num);40}41 42static int cdx_bus_disable(struct cdx_controller *cdx, u8 bus_num)43{44 return cdx_mcdi_bus_disable(cdx->priv, bus_num);45}46 47void cdx_rpmsg_post_probe(struct cdx_controller *cdx)48{49 /* Register CDX controller with CDX bus driver */50 if (cdx_register_controller(cdx))51 dev_err(cdx->dev, "Failed to register CDX controller\n");52}53 54void cdx_rpmsg_pre_remove(struct cdx_controller *cdx)55{56 cdx_unregister_controller(cdx);57 cdx_mcdi_wait_for_quiescence(cdx->priv, MCDI_RPC_TIMEOUT);58}59 60static int cdx_configure_device(struct cdx_controller *cdx,61 u8 bus_num, u8 dev_num,62 struct cdx_device_config *dev_config)63{64 u16 msi_index;65 int ret = 0;66 u32 data;67 u64 addr;68 69 switch (dev_config->type) {70 case CDX_DEV_MSI_CONF:71 msi_index = dev_config->msi.msi_index;72 data = dev_config->msi.data;73 addr = dev_config->msi.addr;74 75 ret = cdx_mcdi_write_msi(cdx->priv, bus_num, dev_num, msi_index, addr, data);76 break;77 case CDX_DEV_RESET_CONF:78 ret = cdx_mcdi_reset_device(cdx->priv, bus_num, dev_num);79 break;80 case CDX_DEV_BUS_MASTER_CONF:81 ret = cdx_mcdi_bus_master_enable(cdx->priv, bus_num, dev_num,82 dev_config->bus_master_enable);83 break;84 case CDX_DEV_MSI_ENABLE:85 ret = cdx_mcdi_msi_enable(cdx->priv, bus_num, dev_num, dev_config->msi_enable);86 break;87 default:88 ret = -EINVAL;89 }90 91 return ret;92}93 94static int cdx_scan_devices(struct cdx_controller *cdx)95{96 struct cdx_mcdi *cdx_mcdi = cdx->priv;97 u8 bus_num, dev_num, num_cdx_bus;98 int ret;99 100 /* MCDI FW Read: Fetch the number of CDX buses on this controller */101 ret = cdx_mcdi_get_num_buses(cdx_mcdi);102 if (ret < 0) {103 dev_err(cdx->dev,104 "Get number of CDX buses failed: %d\n", ret);105 return ret;106 }107 num_cdx_bus = (u8)ret;108 109 for (bus_num = 0; bus_num < num_cdx_bus; bus_num++) {110 struct device *bus_dev;111 u8 num_cdx_dev;112 113 /* Add the bus on cdx subsystem */114 bus_dev = cdx_bus_add(cdx, bus_num);115 if (!bus_dev)116 continue;117 118 /* MCDI FW Read: Fetch the number of devices present */119 ret = cdx_mcdi_get_num_devs(cdx_mcdi, bus_num);120 if (ret < 0) {121 dev_err(cdx->dev,122 "Get devices on CDX bus %d failed: %d\n", bus_num, ret);123 continue;124 }125 num_cdx_dev = (u8)ret;126 127 for (dev_num = 0; dev_num < num_cdx_dev; dev_num++) {128 struct cdx_dev_params dev_params;129 130 /* MCDI FW: Get the device config */131 ret = cdx_mcdi_get_dev_config(cdx_mcdi, bus_num,132 dev_num, &dev_params);133 if (ret) {134 dev_err(cdx->dev,135 "CDX device config get failed for %d(bus):%d(dev), %d\n",136 bus_num, dev_num, ret);137 continue;138 }139 dev_params.cdx = cdx;140 dev_params.parent = bus_dev;141 142 /* Add the device to the cdx bus */143 ret = cdx_device_add(&dev_params);144 if (ret) {145 dev_err(cdx->dev, "registering cdx dev: %d failed: %d\n",146 dev_num, ret);147 continue;148 }149 150 dev_dbg(cdx->dev, "CDX dev: %d on cdx bus: %d created\n",151 dev_num, bus_num);152 }153 }154 155 return 0;156}157 158static struct cdx_ops cdx_ops = {159 .bus_enable = cdx_bus_enable,160 .bus_disable = cdx_bus_disable,161 .scan = cdx_scan_devices,162 .dev_configure = cdx_configure_device,163};164 165static int xlnx_cdx_probe(struct platform_device *pdev)166{167 struct cdx_controller *cdx;168 struct cdx_mcdi *cdx_mcdi;169 int ret;170 171 cdx_mcdi = kzalloc(sizeof(*cdx_mcdi), GFP_KERNEL);172 if (!cdx_mcdi)173 return -ENOMEM;174 175 /* Store the MCDI ops */176 cdx_mcdi->mcdi_ops = &mcdi_ops;177 /* MCDI FW: Initialize the FW path */178 ret = cdx_mcdi_init(cdx_mcdi);179 if (ret) {180 dev_err_probe(&pdev->dev, ret, "MCDI Initialization failed\n");181 goto mcdi_init_fail;182 }183 184 cdx = kzalloc(sizeof(*cdx), GFP_KERNEL);185 if (!cdx) {186 ret = -ENOMEM;187 goto cdx_alloc_fail;188 }189 platform_set_drvdata(pdev, cdx);190 191 cdx->dev = &pdev->dev;192 cdx->priv = cdx_mcdi;193 cdx->ops = &cdx_ops;194 195 /* Create MSI domain */196 cdx->msi_domain = cdx_msi_domain_init(&pdev->dev);197 if (!cdx->msi_domain) {198 dev_err(&pdev->dev, "cdx_msi_domain_init() failed");199 ret = -ENODEV;200 goto cdx_msi_fail;201 }202 203 ret = cdx_setup_rpmsg(pdev);204 if (ret) {205 if (ret != -EPROBE_DEFER)206 dev_err(&pdev->dev, "Failed to register CDX RPMsg transport\n");207 goto cdx_rpmsg_fail;208 }209 210 dev_info(&pdev->dev, "Successfully registered CDX controller with RPMsg as transport\n");211 return 0;212 213cdx_rpmsg_fail:214 irq_domain_remove(cdx->msi_domain);215cdx_msi_fail:216 kfree(cdx);217cdx_alloc_fail:218 cdx_mcdi_finish(cdx_mcdi);219mcdi_init_fail:220 kfree(cdx_mcdi);221 222 return ret;223}224 225static void xlnx_cdx_remove(struct platform_device *pdev)226{227 struct cdx_controller *cdx = platform_get_drvdata(pdev);228 struct cdx_mcdi *cdx_mcdi = cdx->priv;229 230 cdx_destroy_rpmsg(pdev);231 232 irq_domain_remove(cdx->msi_domain);233 kfree(cdx);234 235 cdx_mcdi_finish(cdx_mcdi);236 kfree(cdx_mcdi);237}238 239static const struct of_device_id cdx_match_table[] = {240 {.compatible = "xlnx,versal-net-cdx",},241 { },242};243 244MODULE_DEVICE_TABLE(of, cdx_match_table);245 246static struct platform_driver cdx_pdriver = {247 .driver = {248 .name = "cdx-controller",249 .pm = NULL,250 .of_match_table = cdx_match_table,251 },252 .probe = xlnx_cdx_probe,253 .remove_new = xlnx_cdx_remove,254};255 256static int __init cdx_controller_init(void)257{258 int ret;259 260 ret = platform_driver_register(&cdx_pdriver);261 if (ret)262 pr_err("platform_driver_register() failed: %d\n", ret);263 264 return ret;265}266 267static void __exit cdx_controller_exit(void)268{269 platform_driver_unregister(&cdx_pdriver);270}271 272module_init(cdx_controller_init);273module_exit(cdx_controller_exit);274 275MODULE_AUTHOR("AMD Inc.");276MODULE_DESCRIPTION("CDX controller for AMD devices");277MODULE_LICENSE("GPL");278MODULE_IMPORT_NS(CDX_BUS_CONTROLLER);279