1
2
3
4
5
6
7
8
9
10#include <linux/device.h>
11#include <linux/dma-mapping.h>
12#include <linux/interrupt.h>
13#include <linux/mmc/mmc.h>
14#include <linux/module.h>
15#include <linux/of.h>
16#include <linux/of_platform.h>
17#include <linux/pci.h>
18#include "cavium.h"
19
20static void thunder_mmc_acquire_bus(struct cvm_mmc_host *host)
21{
22 down(&host->mmc_serializer);
23}
24
25static void thunder_mmc_release_bus(struct cvm_mmc_host *host)
26{
27 up(&host->mmc_serializer);
28}
29
30static void thunder_mmc_int_enable(struct cvm_mmc_host *host, u64 val)
31{
32 writeq(val, host->base + MIO_EMM_INT(host));
33 writeq(val, host->base + MIO_EMM_INT_EN_SET(host));
34}
35
36static int thunder_mmc_register_interrupts(struct cvm_mmc_host *host,
37 struct pci_dev *pdev)
38{
39 int nvec, ret, i;
40
41 nvec = pci_alloc_irq_vectors(pdev, 1, 9, PCI_IRQ_MSIX);
42 if (nvec < 0)
43 return nvec;
44
45
46 for (i = 0; i < nvec; i++) {
47 ret = devm_request_irq(&pdev->dev, pci_irq_vector(pdev, i),
48 cvm_mmc_interrupt,
49 0, cvm_mmc_irq_names[i], host);
50 if (ret)
51 return ret;
52 }
53 return 0;
54}
55
56static int thunder_mmc_probe(struct pci_dev *pdev,
57 const struct pci_device_id *id)
58{
59 struct device_node *node = pdev->dev.of_node;
60 struct device *dev = &pdev->dev;
61 struct device_node *child_node;
62 struct cvm_mmc_host *host;
63 int ret, i = 0;
64
65 host = devm_kzalloc(dev, sizeof(*host), GFP_KERNEL);
66 if (!host)
67 return -ENOMEM;
68
69 pci_set_drvdata(pdev, host);
70 ret = pcim_enable_device(pdev);
71 if (ret)
72 return ret;
73
74 ret = pci_request_regions(pdev, KBUILD_MODNAME);
75 if (ret)
76 return ret;
77
78 host->base = pcim_iomap(pdev, 0, pci_resource_len(pdev, 0));
79 if (!host->base)
80 return -EINVAL;
81
82
83 host->dma_base = host->base;
84
85 host->reg_off = 0x2000;
86 host->reg_off_dma = 0x160;
87
88 host->clk = devm_clk_get(dev, NULL);
89 if (IS_ERR(host->clk))
90 return PTR_ERR(host->clk);
91
92 ret = clk_prepare_enable(host->clk);
93 if (ret)
94 return ret;
95 host->sys_freq = clk_get_rate(host->clk);
96
97 spin_lock_init(&host->irq_handler_lock);
98 sema_init(&host->mmc_serializer, 1);
99
100 host->dev = dev;
101 host->acquire_bus = thunder_mmc_acquire_bus;
102 host->release_bus = thunder_mmc_release_bus;
103 host->int_enable = thunder_mmc_int_enable;
104
105 host->use_sg = true;
106 host->big_dma_addr = true;
107 host->need_irq_handler_lock = true;
108 host->last_slot = -1;
109
110 ret = dma_set_mask(dev, DMA_BIT_MASK(48));
111 if (ret)
112 goto error;
113
114
115
116
117
118 writeq(127, host->base + MIO_EMM_INT_EN(host));
119 writeq(3, host->base + MIO_EMM_DMA_INT_ENA_W1C(host));
120
121 writeq(BIT_ULL(16), host->base + MIO_EMM_DMA_FIFO_CFG(host));
122
123 ret = thunder_mmc_register_interrupts(host, pdev);
124 if (ret)
125 goto error;
126
127 for_each_child_of_node(node, child_node) {
128
129
130
131
132
133
134 if (of_device_is_compatible(child_node, "mmc-slot")) {
135 host->slot_pdev[i] = of_platform_device_create(child_node, NULL,
136 &pdev->dev);
137 if (!host->slot_pdev[i])
138 continue;
139
140 ret = cvm_mmc_of_slot_probe(&host->slot_pdev[i]->dev, host);
141 if (ret)
142 goto error;
143 }
144 i++;
145 }
146 dev_info(dev, "probed\n");
147 return 0;
148
149error:
150 for (i = 0; i < CAVIUM_MAX_MMC; i++) {
151 if (host->slot[i])
152 cvm_mmc_of_slot_remove(host->slot[i]);
153 if (host->slot_pdev[i]) {
154 get_device(&host->slot_pdev[i]->dev);
155 of_platform_device_destroy(&host->slot_pdev[i]->dev, NULL);
156 put_device(&host->slot_pdev[i]->dev);
157 }
158 }
159 clk_disable_unprepare(host->clk);
160 return ret;
161}
162
163static void thunder_mmc_remove(struct pci_dev *pdev)
164{
165 struct cvm_mmc_host *host = pci_get_drvdata(pdev);
166 u64 dma_cfg;
167 int i;
168
169 for (i = 0; i < CAVIUM_MAX_MMC; i++)
170 if (host->slot[i])
171 cvm_mmc_of_slot_remove(host->slot[i]);
172
173 dma_cfg = readq(host->dma_base + MIO_EMM_DMA_CFG(host));
174 dma_cfg &= ~MIO_EMM_DMA_CFG_EN;
175 writeq(dma_cfg, host->dma_base + MIO_EMM_DMA_CFG(host));
176
177 clk_disable_unprepare(host->clk);
178}
179
180static const struct pci_device_id thunder_mmc_id_table[] = {
181 { PCI_DEVICE(PCI_VENDOR_ID_CAVIUM, 0xa010) },
182 { 0, }
183};
184
185static struct pci_driver thunder_mmc_driver = {
186 .name = KBUILD_MODNAME,
187 .id_table = thunder_mmc_id_table,
188 .probe = thunder_mmc_probe,
189 .remove = thunder_mmc_remove,
190};
191
192module_pci_driver(thunder_mmc_driver);
193
194MODULE_AUTHOR("Cavium Inc.");
195MODULE_DESCRIPTION("Cavium ThunderX eMMC Driver");
196MODULE_LICENSE("GPL");
197MODULE_DEVICE_TABLE(pci, thunder_mmc_id_table);
198