Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 | // SPDX-License-Identifier: GPL-2.0 /* * PCI Specific M_CAN Glue * * Copyright (C) 2018-2020 Intel Corporation * Author: Felipe Balbi (Intel) * Author: Jarkko Nikula <jarkko.nikula@linux.intel.com> * Author: Raymond Tan <raymond.tan@intel.com> */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/netdevice.h> #include <linux/pci.h> #include <linux/pm_runtime.h> #include "m_can.h" #define M_CAN_PCI_MMIO_BAR 0 #define M_CAN_CLOCK_FREQ_EHL 200000000 #define CTL_CSR_INT_CTL_OFFSET 0x508 struct m_can_pci_priv { struct m_can_classdev cdev; void __iomem *base; }; static inline struct m_can_pci_priv *cdev_to_priv(struct m_can_classdev *cdev) { return container_of(cdev, struct m_can_pci_priv, cdev); } static u32 iomap_read_reg(struct m_can_classdev *cdev, int reg) { struct m_can_pci_priv *priv = cdev_to_priv(cdev); return readl(priv->base + reg); } static int iomap_read_fifo(struct m_can_classdev *cdev, int offset, void *val, size_t val_count) { struct m_can_pci_priv *priv = cdev_to_priv(cdev); void __iomem *src = priv->base + offset; while (val_count--) { *(unsigned int *)val = ioread32(src); val += 4; src += 4; } return 0; } static int iomap_write_reg(struct m_can_classdev *cdev, int reg, int val) { struct m_can_pci_priv *priv = cdev_to_priv(cdev); writel(val, priv->base + reg); return 0; } static int iomap_write_fifo(struct m_can_classdev *cdev, int offset, const void *val, size_t val_count) { struct m_can_pci_priv *priv = cdev_to_priv(cdev); void __iomem *dst = priv->base + offset; while (val_count--) { iowrite32(*(unsigned int *)val, dst); val += 4; dst += 4; } return 0; } static struct m_can_ops m_can_pci_ops = { .read_reg = iomap_read_reg, .write_reg = iomap_write_reg, .write_fifo = iomap_write_fifo, .read_fifo = iomap_read_fifo, }; static int m_can_pci_probe(struct pci_dev *pci, const struct pci_device_id *id) { struct device *dev = &pci->dev; struct m_can_classdev *mcan_class; struct m_can_pci_priv *priv; void __iomem *base; int ret; ret = pcim_enable_device(pci); if (ret) return ret; pci_set_master(pci); ret = pcim_iomap_regions(pci, BIT(M_CAN_PCI_MMIO_BAR), pci_name(pci)); if (ret) return ret; base = pcim_iomap_table(pci)[M_CAN_PCI_MMIO_BAR]; if (!base) { dev_err(dev, "failed to map BARs\n"); return -ENOMEM; } mcan_class = m_can_class_allocate_dev(&pci->dev, sizeof(struct m_can_pci_priv)); if (!mcan_class) return -ENOMEM; priv = cdev_to_priv(mcan_class); priv->base = base; ret = pci_alloc_irq_vectors(pci, 1, 1, PCI_IRQ_ALL_TYPES); if (ret < 0) goto err_free_dev; mcan_class->dev = &pci->dev; mcan_class->net->irq = pci_irq_vector(pci, 0); mcan_class->pm_clock_support = 1; mcan_class->can.clock.freq = id->driver_data; mcan_class->ops = &m_can_pci_ops; pci_set_drvdata(pci, mcan_class); ret = m_can_class_register(mcan_class); if (ret) goto err_free_irq; /* Enable interrupt control at CAN wrapper IP */ writel(0x1, base + CTL_CSR_INT_CTL_OFFSET); pm_runtime_set_autosuspend_delay(dev, 1000); pm_runtime_use_autosuspend(dev); pm_runtime_put_noidle(dev); pm_runtime_allow(dev); return 0; err_free_irq: pci_free_irq_vectors(pci); err_free_dev: m_can_class_free_dev(mcan_class->net); return ret; } static void m_can_pci_remove(struct pci_dev *pci) { struct m_can_classdev *mcan_class = pci_get_drvdata(pci); struct m_can_pci_priv *priv = cdev_to_priv(mcan_class); pm_runtime_forbid(&pci->dev); pm_runtime_get_noresume(&pci->dev); /* Disable interrupt control at CAN wrapper IP */ writel(0x0, priv->base + CTL_CSR_INT_CTL_OFFSET); m_can_class_unregister(mcan_class); m_can_class_free_dev(mcan_class->net); pci_free_irq_vectors(pci); } static __maybe_unused int m_can_pci_suspend(struct device *dev) { return m_can_class_suspend(dev); } static __maybe_unused int m_can_pci_resume(struct device *dev) { return m_can_class_resume(dev); } static SIMPLE_DEV_PM_OPS(m_can_pci_pm_ops, m_can_pci_suspend, m_can_pci_resume); static const struct pci_device_id m_can_pci_id_table[] = { { PCI_VDEVICE(INTEL, 0x4bc1), M_CAN_CLOCK_FREQ_EHL, }, { PCI_VDEVICE(INTEL, 0x4bc2), M_CAN_CLOCK_FREQ_EHL, }, { } /* Terminating Entry */ }; MODULE_DEVICE_TABLE(pci, m_can_pci_id_table); static struct pci_driver m_can_pci_driver = { .name = "m_can_pci", .probe = m_can_pci_probe, .remove = m_can_pci_remove, .id_table = m_can_pci_id_table, .driver = { .pm = &m_can_pci_pm_ops, }, }; module_pci_driver(m_can_pci_driver); MODULE_AUTHOR("Felipe Balbi (Intel)"); MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@linux.intel.com>"); MODULE_AUTHOR("Raymond Tan <raymond.tan@intel.com>"); MODULE_LICENSE("GPL"); MODULE_DESCRIPTION("CAN bus driver for Bosch M_CAN controller on PCI bus"); |