127 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*******************************************************************************3 *4 * CTU CAN FD IP Core5 *6 * Copyright (C) 2015-2018 Ondrej Ille <ondrej.ille@gmail.com> FEE CTU7 * Copyright (C) 2018-2021 Ondrej Ille <ondrej.ille@gmail.com> self-funded8 * Copyright (C) 2018-2019 Martin Jerabek <martin.jerabek01@gmail.com> FEE CTU9 * Copyright (C) 2018-2022 Pavel Pisa <pisa@cmp.felk.cvut.cz> FEE CTU/self-funded10 *11 * Project advisors:12 * Jiri Novak <jnovak@fel.cvut.cz>13 * Pavel Pisa <pisa@cmp.felk.cvut.cz>14 *15 * Department of Measurement (http://meas.fel.cvut.cz/)16 * Faculty of Electrical Engineering (http://www.fel.cvut.cz)17 * Czech Technical University (http://www.cvut.cz/)18 ******************************************************************************/19 20#include <linux/module.h>21#include <linux/netdevice.h>22#include <linux/of.h>23#include <linux/platform_device.h>24#include <linux/pm_runtime.h>25 26#include "ctucanfd.h"27 28#define DRV_NAME "ctucanfd"29 30static void ctucan_platform_set_drvdata(struct device *dev,31 struct net_device *ndev)32{33 struct platform_device *pdev = container_of(dev, struct platform_device,34 dev);35 36 platform_set_drvdata(pdev, ndev);37}38 39/**40 * ctucan_platform_probe - Platform registration call41 * @pdev: Handle to the platform device structure42 *43 * This function does all the memory allocation and registration for the CAN44 * device.45 *46 * Return: 0 on success and failure value on error47 */48static int ctucan_platform_probe(struct platform_device *pdev)49{50 struct device *dev = &pdev->dev;51 void __iomem *addr;52 int ret;53 unsigned int ntxbufs;54 int irq;55 56 /* Get the virtual base address for the device */57 addr = devm_platform_ioremap_resource(pdev, 0);58 if (IS_ERR(addr)) {59 ret = PTR_ERR(addr);60 goto err;61 }62 irq = platform_get_irq(pdev, 0);63 if (irq < 0) {64 ret = irq;65 goto err;66 }67 68 /* Number of tx bufs might be change in HW for future. If so,69 * it will be passed as property via device tree70 */71 ntxbufs = 4;72 ret = ctucan_probe_common(dev, addr, irq, ntxbufs, 0,73 1, ctucan_platform_set_drvdata);74 75 if (ret < 0)76 platform_set_drvdata(pdev, NULL);77 78err:79 return ret;80}81 82/**83 * ctucan_platform_remove - Unregister the device after releasing the resources84 * @pdev: Handle to the platform device structure85 *86 * This function frees all the resources allocated to the device.87 * Return: 0 always88 */89static void ctucan_platform_remove(struct platform_device *pdev)90{91 struct net_device *ndev = platform_get_drvdata(pdev);92 struct ctucan_priv *priv = netdev_priv(ndev);93 94 netdev_dbg(ndev, "ctucan_remove");95 96 unregister_candev(ndev);97 pm_runtime_disable(&pdev->dev);98 netif_napi_del(&priv->napi);99 free_candev(ndev);100}101 102static SIMPLE_DEV_PM_OPS(ctucan_platform_pm_ops, ctucan_suspend, ctucan_resume);103 104/* Match table for OF platform binding */105static const struct of_device_id ctucan_of_match[] = {106 { .compatible = "ctu,ctucanfd-2", },107 { .compatible = "ctu,ctucanfd", },108 { /* end of list */ },109};110MODULE_DEVICE_TABLE(of, ctucan_of_match);111 112static struct platform_driver ctucanfd_driver = {113 .probe = ctucan_platform_probe,114 .remove = ctucan_platform_remove,115 .driver = {116 .name = DRV_NAME,117 .pm = &ctucan_platform_pm_ops,118 .of_match_table = ctucan_of_match,119 },120};121 122module_platform_driver(ctucanfd_driver);123 124MODULE_LICENSE("GPL");125MODULE_AUTHOR("Martin Jerabek");126MODULE_DESCRIPTION("CTU CAN FD for platform");127