Merge tag 'for-linus-iommufd' of git://git.kernel.org/pub/scm/linux/kernel/git/jgg...
[linux-block.git] / drivers / mmc / host / via-sdmmc.c
CommitLineData
2874c5fd 1// SPDX-License-Identifier: GPL-2.0-or-later
f0bf7f61
HW
2/*
3 * drivers/mmc/host/via-sdmmc.c - VIA SD/MMC Card Reader driver
4 * Copyright (c) 2008, VIA Technologies Inc. All Rights Reserved.
f0bf7f61
HW
5 */
6
7#include <linux/pci.h>
88b47679 8#include <linux/module.h>
f0bf7f61
HW
9#include <linux/dma-mapping.h>
10#include <linux/highmem.h>
11#include <linux/delay.h>
b8789ec4 12#include <linux/interrupt.h>
f0bf7f61
HW
13
14#include <linux/mmc/host.h>
921c87ba 15#include <linux/workqueue.h>
f0bf7f61
HW
16
17#define DRV_NAME "via_sdmmc"
18
19#define PCI_DEVICE_ID_VIA_9530 0x9530
20
21#define VIA_CRDR_SDC_OFF 0x200
22#define VIA_CRDR_DDMA_OFF 0x400
23#define VIA_CRDR_PCICTRL_OFF 0x600
24
25#define VIA_CRDR_MIN_CLOCK 375000
26#define VIA_CRDR_MAX_CLOCK 48000000
27
28/*
29 * PCI registers
30 */
31
32#define VIA_CRDR_PCI_WORK_MODE 0x40
33#define VIA_CRDR_PCI_DBG_MODE 0x41
34
35/*
36 * SDC MMIO Registers
37 */
38
39#define VIA_CRDR_SDCTRL 0x0
40#define VIA_CRDR_SDCTRL_START 0x01
41#define VIA_CRDR_SDCTRL_WRITE 0x04
42#define VIA_CRDR_SDCTRL_SINGLE_WR 0x10
43#define VIA_CRDR_SDCTRL_SINGLE_RD 0x20
44#define VIA_CRDR_SDCTRL_MULTI_WR 0x30
45#define VIA_CRDR_SDCTRL_MULTI_RD 0x40
46#define VIA_CRDR_SDCTRL_STOP 0x70
47
48#define VIA_CRDR_SDCTRL_RSP_NONE 0x0
49#define VIA_CRDR_SDCTRL_RSP_R1 0x10000
50#define VIA_CRDR_SDCTRL_RSP_R2 0x20000
51#define VIA_CRDR_SDCTRL_RSP_R3 0x30000
52#define VIA_CRDR_SDCTRL_RSP_R1B 0x90000
53
54#define VIA_CRDR_SDCARG 0x4
55
56#define VIA_CRDR_SDBUSMODE 0x8
57#define VIA_CRDR_SDMODE_4BIT 0x02
58#define VIA_CRDR_SDMODE_CLK_ON 0x40
59
60#define VIA_CRDR_SDBLKLEN 0xc
61/*
62 * Bit 0 -Bit 10 : Block length. So, the maximum block length should be 2048.
63 * Bit 11 - Bit 13 : Reserved.
64 * GPIDET : Select GPI pin to detect card, GPI means CR_CD# in top design.
65 * INTEN : Enable SD host interrupt.
66 * Bit 16 - Bit 31 : Block count. So, the maximun block count should be 65536.
67 */
68#define VIA_CRDR_SDBLKLEN_GPIDET 0x2000
69#define VIA_CRDR_SDBLKLEN_INTEN 0x8000
70#define VIA_CRDR_MAX_BLOCK_COUNT 65536
71#define VIA_CRDR_MAX_BLOCK_LENGTH 2048
72
73#define VIA_CRDR_SDRESP0 0x10
74#define VIA_CRDR_SDRESP1 0x14
75#define VIA_CRDR_SDRESP2 0x18
76#define VIA_CRDR_SDRESP3 0x1c
77
78#define VIA_CRDR_SDCURBLKCNT 0x20
79
80#define VIA_CRDR_SDINTMASK 0x24
81/*
82 * MBDIE : Multiple Blocks transfer Done Interrupt Enable
83 * BDDIE : Block Data transfer Done Interrupt Enable
84 * CIRIE : Card Insertion or Removal Interrupt Enable
85 * CRDIE : Command-Response transfer Done Interrupt Enable
86 * CRTOIE : Command-Response response TimeOut Interrupt Enable
87 * ASCRDIE : Auto Stop Command-Response transfer Done Interrupt Enable
88 * DTIE : Data access Timeout Interrupt Enable
89 * SCIE : reSponse CRC error Interrupt Enable
90 * RCIE : Read data CRC error Interrupt Enable
91 * WCIE : Write data CRC error Interrupt Enable
92 */
93#define VIA_CRDR_SDINTMASK_MBDIE 0x10
94#define VIA_CRDR_SDINTMASK_BDDIE 0x20
95#define VIA_CRDR_SDINTMASK_CIRIE 0x80
96#define VIA_CRDR_SDINTMASK_CRDIE 0x200
97#define VIA_CRDR_SDINTMASK_CRTOIE 0x400
98#define VIA_CRDR_SDINTMASK_ASCRDIE 0x800
99#define VIA_CRDR_SDINTMASK_DTIE 0x1000
100#define VIA_CRDR_SDINTMASK_SCIE 0x2000
101#define VIA_CRDR_SDINTMASK_RCIE 0x4000
102#define VIA_CRDR_SDINTMASK_WCIE 0x8000
103
104#define VIA_CRDR_SDACTIVE_INTMASK \
105 (VIA_CRDR_SDINTMASK_MBDIE | VIA_CRDR_SDINTMASK_CIRIE \
106 | VIA_CRDR_SDINTMASK_CRDIE | VIA_CRDR_SDINTMASK_CRTOIE \
107 | VIA_CRDR_SDINTMASK_DTIE | VIA_CRDR_SDINTMASK_SCIE \
108 | VIA_CRDR_SDINTMASK_RCIE | VIA_CRDR_SDINTMASK_WCIE)
109
110#define VIA_CRDR_SDSTATUS 0x28
111/*
112 * CECC : Reserved
113 * WP : SD card Write Protect status
114 * SLOTD : Reserved
115 * SLOTG : SD SLOT status(Gpi pin status)
116 * MBD : Multiple Blocks transfer Done interrupt status
117 * BDD : Block Data transfer Done interrupt status
118 * CD : Reserved
119 * CIR : Card Insertion or Removal interrupt detected on GPI pin
120 * IO : Reserved
121 * CRD : Command-Response transfer Done interrupt status
122 * CRTO : Command-Response response TimeOut interrupt status
123 * ASCRDIE : Auto Stop Command-Response transfer Done interrupt status
124 * DT : Data access Timeout interrupt status
125 * SC : reSponse CRC error interrupt status
126 * RC : Read data CRC error interrupt status
127 * WC : Write data CRC error interrupt status
128 */
129#define VIA_CRDR_SDSTS_CECC 0x01
130#define VIA_CRDR_SDSTS_WP 0x02
131#define VIA_CRDR_SDSTS_SLOTD 0x04
132#define VIA_CRDR_SDSTS_SLOTG 0x08
133#define VIA_CRDR_SDSTS_MBD 0x10
134#define VIA_CRDR_SDSTS_BDD 0x20
135#define VIA_CRDR_SDSTS_CD 0x40
136#define VIA_CRDR_SDSTS_CIR 0x80
137#define VIA_CRDR_SDSTS_IO 0x100
138#define VIA_CRDR_SDSTS_CRD 0x200
139#define VIA_CRDR_SDSTS_CRTO 0x400
140#define VIA_CRDR_SDSTS_ASCRDIE 0x800
141#define VIA_CRDR_SDSTS_DT 0x1000
142#define VIA_CRDR_SDSTS_SC 0x2000
143#define VIA_CRDR_SDSTS_RC 0x4000
144#define VIA_CRDR_SDSTS_WC 0x8000
145
146#define VIA_CRDR_SDSTS_IGN_MASK\
147 (VIA_CRDR_SDSTS_BDD | VIA_CRDR_SDSTS_ASCRDIE | VIA_CRDR_SDSTS_IO)
148#define VIA_CRDR_SDSTS_INT_MASK \
149 (VIA_CRDR_SDSTS_MBD | VIA_CRDR_SDSTS_BDD | VIA_CRDR_SDSTS_CD \
150 | VIA_CRDR_SDSTS_CIR | VIA_CRDR_SDSTS_IO | VIA_CRDR_SDSTS_CRD \
151 | VIA_CRDR_SDSTS_CRTO | VIA_CRDR_SDSTS_ASCRDIE | VIA_CRDR_SDSTS_DT \
152 | VIA_CRDR_SDSTS_SC | VIA_CRDR_SDSTS_RC | VIA_CRDR_SDSTS_WC)
153#define VIA_CRDR_SDSTS_W1C_MASK \
154 (VIA_CRDR_SDSTS_CECC | VIA_CRDR_SDSTS_MBD | VIA_CRDR_SDSTS_BDD \
155 | VIA_CRDR_SDSTS_CD | VIA_CRDR_SDSTS_CIR | VIA_CRDR_SDSTS_CRD \
156 | VIA_CRDR_SDSTS_CRTO | VIA_CRDR_SDSTS_ASCRDIE | VIA_CRDR_SDSTS_DT \
157 | VIA_CRDR_SDSTS_SC | VIA_CRDR_SDSTS_RC | VIA_CRDR_SDSTS_WC)
158#define VIA_CRDR_SDSTS_CMD_MASK \
159 (VIA_CRDR_SDSTS_CRD | VIA_CRDR_SDSTS_CRTO | VIA_CRDR_SDSTS_SC)
160#define VIA_CRDR_SDSTS_DATA_MASK\
161 (VIA_CRDR_SDSTS_MBD | VIA_CRDR_SDSTS_DT \
162 | VIA_CRDR_SDSTS_RC | VIA_CRDR_SDSTS_WC)
163
164#define VIA_CRDR_SDSTATUS2 0x2a
165/*
166 * CFE : Enable SD host automatic Clock FReezing
167 */
168#define VIA_CRDR_SDSTS_CFE 0x80
169
170#define VIA_CRDR_SDRSPTMO 0x2C
171
172#define VIA_CRDR_SDCLKSEL 0x30
173
174#define VIA_CRDR_SDEXTCTRL 0x34
175#define VIS_CRDR_SDEXTCTRL_AUTOSTOP_SD 0x01
176#define VIS_CRDR_SDEXTCTRL_SHIFT_9 0x02
177#define VIS_CRDR_SDEXTCTRL_MMC_8BIT 0x04
178#define VIS_CRDR_SDEXTCTRL_RELD_BLK 0x08
179#define VIS_CRDR_SDEXTCTRL_BAD_CMDA 0x10
180#define VIS_CRDR_SDEXTCTRL_BAD_DATA 0x20
181#define VIS_CRDR_SDEXTCTRL_AUTOSTOP_SPI 0x40
182#define VIA_CRDR_SDEXTCTRL_HISPD 0x80
183/* 0x38-0xFF reserved */
184
185/*
186 * Data DMA Control Registers
187 */
188
189#define VIA_CRDR_DMABASEADD 0x0
190#define VIA_CRDR_DMACOUNTER 0x4
191
192#define VIA_CRDR_DMACTRL 0x8
193/*
194 * DIR :Transaction Direction
195 * 0 : From card to memory
196 * 1 : From memory to card
197 */
198#define VIA_CRDR_DMACTRL_DIR 0x100
199#define VIA_CRDR_DMACTRL_ENIRQ 0x10000
200#define VIA_CRDR_DMACTRL_SFTRST 0x1000000
201
202#define VIA_CRDR_DMASTS 0xc
203
204#define VIA_CRDR_DMASTART 0x10
205/*0x14-0xFF reserved*/
206
207/*
208 * PCI Control Registers
209 */
210
211/*0x0 - 0x1 reserved*/
212#define VIA_CRDR_PCICLKGATT 0x2
213/*
214 * SFTRST :
215 * 0 : Soft reset all the controller and it will be de-asserted automatically
216 * 1 : Soft reset is de-asserted
217 */
218#define VIA_CRDR_PCICLKGATT_SFTRST 0x01
219/*
220 * 3V3 : Pad power select
221 * 0 : 1.8V
222 * 1 : 3.3V
223 * NOTE : No mater what the actual value should be, this bit always
224 * read as 0. This is a hardware bug.
225 */
226#define VIA_CRDR_PCICLKGATT_3V3 0x10
227/*
228 * PAD_PWRON : Pad Power on/off select
229 * 0 : Power off
230 * 1 : Power on
231 * NOTE : No mater what the actual value should be, this bit always
232 * read as 0. This is a hardware bug.
233 */
234#define VIA_CRDR_PCICLKGATT_PAD_PWRON 0x20
235
236#define VIA_CRDR_PCISDCCLK 0x5
237
238#define VIA_CRDR_PCIDMACLK 0x7
239#define VIA_CRDR_PCIDMACLK_SDC 0x2
240
241#define VIA_CRDR_PCIINTCTRL 0x8
242#define VIA_CRDR_PCIINTCTRL_SDCIRQEN 0x04
243
244#define VIA_CRDR_PCIINTSTATUS 0x9
245#define VIA_CRDR_PCIINTSTATUS_SDC 0x04
246
247#define VIA_CRDR_PCITMOCTRL 0xa
248#define VIA_CRDR_PCITMOCTRL_NO 0x0
249#define VIA_CRDR_PCITMOCTRL_32US 0x1
250#define VIA_CRDR_PCITMOCTRL_256US 0x2
251#define VIA_CRDR_PCITMOCTRL_1024US 0x3
252#define VIA_CRDR_PCITMOCTRL_256MS 0x4
253#define VIA_CRDR_PCITMOCTRL_512MS 0x5
254#define VIA_CRDR_PCITMOCTRL_1024MS 0x6
255
256/*0xB-0xFF reserved*/
257
258enum PCI_HOST_CLK_CONTROL {
259 PCI_CLK_375K = 0x03,
260 PCI_CLK_8M = 0x04,
261 PCI_CLK_12M = 0x00,
262 PCI_CLK_16M = 0x05,
263 PCI_CLK_24M = 0x01,
264 PCI_CLK_33M = 0x06,
265 PCI_CLK_48M = 0x02
266};
267
268struct sdhcreg {
269 u32 sdcontrol_reg;
270 u32 sdcmdarg_reg;
271 u32 sdbusmode_reg;
272 u32 sdblklen_reg;
273 u32 sdresp_reg[4];
274 u32 sdcurblkcnt_reg;
275 u32 sdintmask_reg;
276 u32 sdstatus_reg;
277 u32 sdrsptmo_reg;
278 u32 sdclksel_reg;
279 u32 sdextctrl_reg;
280};
281
282struct pcictrlreg {
283 u8 reserve[2];
284 u8 pciclkgat_reg;
285 u8 pcinfcclk_reg;
286 u8 pcimscclk_reg;
287 u8 pcisdclk_reg;
288 u8 pcicaclk_reg;
289 u8 pcidmaclk_reg;
290 u8 pciintctrl_reg;
291 u8 pciintstatus_reg;
292 u8 pcitmoctrl_reg;
293 u8 Resv;
294};
295
296struct via_crdr_mmc_host {
297 struct mmc_host *mmc;
298 struct mmc_request *mrq;
299 struct mmc_command *cmd;
300 struct mmc_data *data;
301
302 void __iomem *mmiobase;
303 void __iomem *sdhc_mmiobase;
304 void __iomem *ddma_mmiobase;
305 void __iomem *pcictrl_mmiobase;
306
307 struct pcictrlreg pm_pcictrl_reg;
308 struct sdhcreg pm_sdhc_reg;
309
310 struct work_struct carddet_work;
921c87ba 311 struct work_struct finish_bh_work;
f0bf7f61
HW
312
313 struct timer_list timer;
314 spinlock_t lock;
315 u8 power;
316 int reject;
317 unsigned int quirks;
318};
319
320/* some devices need a very long delay for power to stabilize */
321#define VIA_CRDR_QUIRK_300MS_PWRDELAY 0x0001
322
966244cc
UH
323#define VIA_CMD_TIMEOUT_MS 1000
324
adb7434a 325static const struct pci_device_id via_ids[] = {
f0bf7f61
HW
326 {PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_9530,
327 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0,},
328 {0,}
329};
330
331MODULE_DEVICE_TABLE(pci, via_ids);
332
333static void via_print_sdchc(struct via_crdr_mmc_host *host)
334{
335 void __iomem *addrbase = host->sdhc_mmiobase;
336
337 pr_debug("SDC MMIO Registers:\n");
338 pr_debug("SDCONTROL=%08x, SDCMDARG=%08x, SDBUSMODE=%08x\n",
339 readl(addrbase + VIA_CRDR_SDCTRL),
340 readl(addrbase + VIA_CRDR_SDCARG),
341 readl(addrbase + VIA_CRDR_SDBUSMODE));
342 pr_debug("SDBLKLEN=%08x, SDCURBLKCNT=%08x, SDINTMASK=%08x\n",
343 readl(addrbase + VIA_CRDR_SDBLKLEN),
344 readl(addrbase + VIA_CRDR_SDCURBLKCNT),
345 readl(addrbase + VIA_CRDR_SDINTMASK));
346 pr_debug("SDSTATUS=%08x, SDCLKSEL=%08x, SDEXTCTRL=%08x\n",
347 readl(addrbase + VIA_CRDR_SDSTATUS),
348 readl(addrbase + VIA_CRDR_SDCLKSEL),
349 readl(addrbase + VIA_CRDR_SDEXTCTRL));
350}
351
352static void via_print_pcictrl(struct via_crdr_mmc_host *host)
353{
354 void __iomem *addrbase = host->pcictrl_mmiobase;
355
356 pr_debug("PCI Control Registers:\n");
357 pr_debug("PCICLKGATT=%02x, PCISDCCLK=%02x, PCIDMACLK=%02x\n",
358 readb(addrbase + VIA_CRDR_PCICLKGATT),
359 readb(addrbase + VIA_CRDR_PCISDCCLK),
360 readb(addrbase + VIA_CRDR_PCIDMACLK));
361 pr_debug("PCIINTCTRL=%02x, PCIINTSTATUS=%02x\n",
362 readb(addrbase + VIA_CRDR_PCIINTCTRL),
363 readb(addrbase + VIA_CRDR_PCIINTSTATUS));
364}
365
366static void via_save_pcictrlreg(struct via_crdr_mmc_host *host)
367{
368 struct pcictrlreg *pm_pcictrl_reg;
369 void __iomem *addrbase;
370
371 pm_pcictrl_reg = &(host->pm_pcictrl_reg);
372 addrbase = host->pcictrl_mmiobase;
373
374 pm_pcictrl_reg->pciclkgat_reg = readb(addrbase + VIA_CRDR_PCICLKGATT);
375 pm_pcictrl_reg->pciclkgat_reg |=
376 VIA_CRDR_PCICLKGATT_3V3 | VIA_CRDR_PCICLKGATT_PAD_PWRON;
377 pm_pcictrl_reg->pcisdclk_reg = readb(addrbase + VIA_CRDR_PCISDCCLK);
378 pm_pcictrl_reg->pcidmaclk_reg = readb(addrbase + VIA_CRDR_PCIDMACLK);
379 pm_pcictrl_reg->pciintctrl_reg = readb(addrbase + VIA_CRDR_PCIINTCTRL);
380 pm_pcictrl_reg->pciintstatus_reg =
381 readb(addrbase + VIA_CRDR_PCIINTSTATUS);
382 pm_pcictrl_reg->pcitmoctrl_reg = readb(addrbase + VIA_CRDR_PCITMOCTRL);
383}
384
385static void via_restore_pcictrlreg(struct via_crdr_mmc_host *host)
386{
387 struct pcictrlreg *pm_pcictrl_reg;
388 void __iomem *addrbase;
389
390 pm_pcictrl_reg = &(host->pm_pcictrl_reg);
391 addrbase = host->pcictrl_mmiobase;
392
393 writeb(pm_pcictrl_reg->pciclkgat_reg, addrbase + VIA_CRDR_PCICLKGATT);
394 writeb(pm_pcictrl_reg->pcisdclk_reg, addrbase + VIA_CRDR_PCISDCCLK);
395 writeb(pm_pcictrl_reg->pcidmaclk_reg, addrbase + VIA_CRDR_PCIDMACLK);
396 writeb(pm_pcictrl_reg->pciintctrl_reg, addrbase + VIA_CRDR_PCIINTCTRL);
397 writeb(pm_pcictrl_reg->pciintstatus_reg,
398 addrbase + VIA_CRDR_PCIINTSTATUS);
399 writeb(pm_pcictrl_reg->pcitmoctrl_reg, addrbase + VIA_CRDR_PCITMOCTRL);
400}
401
402static void via_save_sdcreg(struct via_crdr_mmc_host *host)
403{
404 struct sdhcreg *pm_sdhc_reg;
405 void __iomem *addrbase;
406
407 pm_sdhc_reg = &(host->pm_sdhc_reg);
408 addrbase = host->sdhc_mmiobase;
409
410 pm_sdhc_reg->sdcontrol_reg = readl(addrbase + VIA_CRDR_SDCTRL);
411 pm_sdhc_reg->sdcmdarg_reg = readl(addrbase + VIA_CRDR_SDCARG);
412 pm_sdhc_reg->sdbusmode_reg = readl(addrbase + VIA_CRDR_SDBUSMODE);
413 pm_sdhc_reg->sdblklen_reg = readl(addrbase + VIA_CRDR_SDBLKLEN);
414 pm_sdhc_reg->sdcurblkcnt_reg = readl(addrbase + VIA_CRDR_SDCURBLKCNT);
415 pm_sdhc_reg->sdintmask_reg = readl(addrbase + VIA_CRDR_SDINTMASK);
416 pm_sdhc_reg->sdstatus_reg = readl(addrbase + VIA_CRDR_SDSTATUS);
417 pm_sdhc_reg->sdrsptmo_reg = readl(addrbase + VIA_CRDR_SDRSPTMO);
418 pm_sdhc_reg->sdclksel_reg = readl(addrbase + VIA_CRDR_SDCLKSEL);
419 pm_sdhc_reg->sdextctrl_reg = readl(addrbase + VIA_CRDR_SDEXTCTRL);
420}
421
422static void via_restore_sdcreg(struct via_crdr_mmc_host *host)
423{
424 struct sdhcreg *pm_sdhc_reg;
425 void __iomem *addrbase;
426
427 pm_sdhc_reg = &(host->pm_sdhc_reg);
428 addrbase = host->sdhc_mmiobase;
429
430 writel(pm_sdhc_reg->sdcontrol_reg, addrbase + VIA_CRDR_SDCTRL);
431 writel(pm_sdhc_reg->sdcmdarg_reg, addrbase + VIA_CRDR_SDCARG);
432 writel(pm_sdhc_reg->sdbusmode_reg, addrbase + VIA_CRDR_SDBUSMODE);
433 writel(pm_sdhc_reg->sdblklen_reg, addrbase + VIA_CRDR_SDBLKLEN);
434 writel(pm_sdhc_reg->sdcurblkcnt_reg, addrbase + VIA_CRDR_SDCURBLKCNT);
435 writel(pm_sdhc_reg->sdintmask_reg, addrbase + VIA_CRDR_SDINTMASK);
436 writel(pm_sdhc_reg->sdstatus_reg, addrbase + VIA_CRDR_SDSTATUS);
437 writel(pm_sdhc_reg->sdrsptmo_reg, addrbase + VIA_CRDR_SDRSPTMO);
438 writel(pm_sdhc_reg->sdclksel_reg, addrbase + VIA_CRDR_SDCLKSEL);
439 writel(pm_sdhc_reg->sdextctrl_reg, addrbase + VIA_CRDR_SDEXTCTRL);
440}
441
442static void via_pwron_sleep(struct via_crdr_mmc_host *sdhost)
443{
444 if (sdhost->quirks & VIA_CRDR_QUIRK_300MS_PWRDELAY)
445 msleep(300);
446 else
447 msleep(3);
448}
449
450static void via_set_ddma(struct via_crdr_mmc_host *host,
451 dma_addr_t dmaaddr, u32 count, int dir, int enirq)
452{
453 void __iomem *addrbase;
454 u32 ctrl_data = 0;
455
456 if (enirq)
457 ctrl_data |= VIA_CRDR_DMACTRL_ENIRQ;
458
459 if (dir)
460 ctrl_data |= VIA_CRDR_DMACTRL_DIR;
461
462 addrbase = host->ddma_mmiobase;
463
464 writel(dmaaddr, addrbase + VIA_CRDR_DMABASEADD);
465 writel(count, addrbase + VIA_CRDR_DMACOUNTER);
466 writel(ctrl_data, addrbase + VIA_CRDR_DMACTRL);
467 writel(0x01, addrbase + VIA_CRDR_DMASTART);
468
469 /* It seems that our DMA can not work normally with 375kHz clock */
470 /* FIXME: don't brute-force 8MHz but use PIO at 375kHz !! */
471 addrbase = host->pcictrl_mmiobase;
472 if (readb(addrbase + VIA_CRDR_PCISDCCLK) == PCI_CLK_375K) {
473 dev_info(host->mmc->parent, "forcing card speed to 8MHz\n");
474 writeb(PCI_CLK_8M, addrbase + VIA_CRDR_PCISDCCLK);
475 }
476}
477
478static void via_sdc_preparedata(struct via_crdr_mmc_host *host,
479 struct mmc_data *data)
480{
481 void __iomem *addrbase;
482 u32 blk_reg;
483 int count;
484
485 WARN_ON(host->data);
486
487 /* Sanity checks */
488 BUG_ON(data->blksz > host->mmc->max_blk_size);
489 BUG_ON(data->blocks > host->mmc->max_blk_count);
490
491 host->data = data;
492
493 count = dma_map_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
494 ((data->flags & MMC_DATA_READ) ?
b048457c 495 DMA_FROM_DEVICE : DMA_TO_DEVICE));
f0bf7f61
HW
496 BUG_ON(count != 1);
497
498 via_set_ddma(host, sg_dma_address(data->sg), sg_dma_len(data->sg),
499 (data->flags & MMC_DATA_WRITE) ? 1 : 0, 1);
500
501 addrbase = host->sdhc_mmiobase;
502
503 blk_reg = data->blksz - 1;
504 blk_reg |= VIA_CRDR_SDBLKLEN_GPIDET | VIA_CRDR_SDBLKLEN_INTEN;
505 blk_reg |= (data->blocks) << 16;
506
507 writel(blk_reg, addrbase + VIA_CRDR_SDBLKLEN);
508}
509
510static void via_sdc_get_response(struct via_crdr_mmc_host *host,
511 struct mmc_command *cmd)
512{
513 void __iomem *addrbase = host->sdhc_mmiobase;
514 u32 dwdata0 = readl(addrbase + VIA_CRDR_SDRESP0);
515 u32 dwdata1 = readl(addrbase + VIA_CRDR_SDRESP1);
516 u32 dwdata2 = readl(addrbase + VIA_CRDR_SDRESP2);
517 u32 dwdata3 = readl(addrbase + VIA_CRDR_SDRESP3);
518
519 if (cmd->flags & MMC_RSP_136) {
520 cmd->resp[0] = ((u8) (dwdata1)) |
521 (((u8) (dwdata0 >> 24)) << 8) |
522 (((u8) (dwdata0 >> 16)) << 16) |
523 (((u8) (dwdata0 >> 8)) << 24);
524
525 cmd->resp[1] = ((u8) (dwdata2)) |
526 (((u8) (dwdata1 >> 24)) << 8) |
527 (((u8) (dwdata1 >> 16)) << 16) |
528 (((u8) (dwdata1 >> 8)) << 24);
529
530 cmd->resp[2] = ((u8) (dwdata3)) |
531 (((u8) (dwdata2 >> 24)) << 8) |
532 (((u8) (dwdata2 >> 16)) << 16) |
533 (((u8) (dwdata2 >> 8)) << 24);
534
535 cmd->resp[3] = 0xff |
536 ((((u8) (dwdata3 >> 24))) << 8) |
537 (((u8) (dwdata3 >> 16)) << 16) |
538 (((u8) (dwdata3 >> 8)) << 24);
539 } else {
540 dwdata0 >>= 8;
541 cmd->resp[0] = ((dwdata0 & 0xff) << 24) |
542 (((dwdata0 >> 8) & 0xff) << 16) |
543 (((dwdata0 >> 16) & 0xff) << 8) | (dwdata1 & 0xff);
544
545 dwdata1 >>= 8;
546 cmd->resp[1] = ((dwdata1 & 0xff) << 24) |
547 (((dwdata1 >> 8) & 0xff) << 16) |
548 (((dwdata1 >> 16) & 0xff) << 8);
549 }
550}
551
552static void via_sdc_send_command(struct via_crdr_mmc_host *host,
553 struct mmc_command *cmd)
554{
555 void __iomem *addrbase;
556 struct mmc_data *data;
966244cc 557 unsigned int timeout_ms;
f0bf7f61
HW
558 u32 cmdctrl = 0;
559
560 WARN_ON(host->cmd);
561
562 data = cmd->data;
f0bf7f61
HW
563 host->cmd = cmd;
564
966244cc
UH
565 timeout_ms = cmd->busy_timeout ? cmd->busy_timeout : VIA_CMD_TIMEOUT_MS;
566 mod_timer(&host->timer, jiffies + msecs_to_jiffies(timeout_ms));
567
f0bf7f61
HW
568 /*Command index*/
569 cmdctrl = cmd->opcode << 8;
570
571 /*Response type*/
572 switch (mmc_resp_type(cmd)) {
573 case MMC_RSP_NONE:
574 cmdctrl |= VIA_CRDR_SDCTRL_RSP_NONE;
575 break;
576 case MMC_RSP_R1:
577 cmdctrl |= VIA_CRDR_SDCTRL_RSP_R1;
578 break;
579 case MMC_RSP_R1B:
580 cmdctrl |= VIA_CRDR_SDCTRL_RSP_R1B;
581 break;
582 case MMC_RSP_R2:
583 cmdctrl |= VIA_CRDR_SDCTRL_RSP_R2;
584 break;
585 case MMC_RSP_R3:
586 cmdctrl |= VIA_CRDR_SDCTRL_RSP_R3;
587 break;
588 default:
589 pr_err("%s: cmd->flag is not valid\n", mmc_hostname(host->mmc));
590 break;
591 }
592
593 if (!(cmd->data))
594 goto nodata;
595
596 via_sdc_preparedata(host, data);
597
598 /*Command control*/
599 if (data->blocks > 1) {
600 if (data->flags & MMC_DATA_WRITE) {
601 cmdctrl |= VIA_CRDR_SDCTRL_WRITE;
602 cmdctrl |= VIA_CRDR_SDCTRL_MULTI_WR;
603 } else {
604 cmdctrl |= VIA_CRDR_SDCTRL_MULTI_RD;
605 }
606 } else {
607 if (data->flags & MMC_DATA_WRITE) {
608 cmdctrl |= VIA_CRDR_SDCTRL_WRITE;
609 cmdctrl |= VIA_CRDR_SDCTRL_SINGLE_WR;
610 } else {
611 cmdctrl |= VIA_CRDR_SDCTRL_SINGLE_RD;
612 }
613 }
614
615nodata:
616 if (cmd == host->mrq->stop)
617 cmdctrl |= VIA_CRDR_SDCTRL_STOP;
618
619 cmdctrl |= VIA_CRDR_SDCTRL_START;
620
621 addrbase = host->sdhc_mmiobase;
622 writel(cmd->arg, addrbase + VIA_CRDR_SDCARG);
623 writel(cmdctrl, addrbase + VIA_CRDR_SDCTRL);
624}
625
626static void via_sdc_finish_data(struct via_crdr_mmc_host *host)
627{
628 struct mmc_data *data;
629
630 BUG_ON(!host->data);
631
632 data = host->data;
633 host->data = NULL;
634
635 if (data->error)
636 data->bytes_xfered = 0;
637 else
638 data->bytes_xfered = data->blocks * data->blksz;
639
640 dma_unmap_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
641 ((data->flags & MMC_DATA_READ) ?
b048457c 642 DMA_FROM_DEVICE : DMA_TO_DEVICE));
f0bf7f61
HW
643
644 if (data->stop)
645 via_sdc_send_command(host, data->stop);
646 else
921c87ba 647 queue_work(system_bh_wq, &host->finish_bh_work);
f0bf7f61
HW
648}
649
650static void via_sdc_finish_command(struct via_crdr_mmc_host *host)
651{
652 via_sdc_get_response(host, host->cmd);
653
654 host->cmd->error = 0;
655
656 if (!host->cmd->data)
921c87ba 657 queue_work(system_bh_wq, &host->finish_bh_work);
f0bf7f61
HW
658
659 host->cmd = NULL;
660}
661
662static void via_sdc_request(struct mmc_host *mmc, struct mmc_request *mrq)
663{
664 void __iomem *addrbase;
665 struct via_crdr_mmc_host *host;
666 unsigned long flags;
667 u16 status;
668
669 host = mmc_priv(mmc);
670
671 spin_lock_irqsave(&host->lock, flags);
672
673 addrbase = host->pcictrl_mmiobase;
674 writeb(VIA_CRDR_PCIDMACLK_SDC, addrbase + VIA_CRDR_PCIDMACLK);
675
676 status = readw(host->sdhc_mmiobase + VIA_CRDR_SDSTATUS);
677 status &= VIA_CRDR_SDSTS_W1C_MASK;
678 writew(status, host->sdhc_mmiobase + VIA_CRDR_SDSTATUS);
679
680 WARN_ON(host->mrq != NULL);
681 host->mrq = mrq;
682
683 status = readw(host->sdhc_mmiobase + VIA_CRDR_SDSTATUS);
684 if (!(status & VIA_CRDR_SDSTS_SLOTG) || host->reject) {
685 host->mrq->cmd->error = -ENOMEDIUM;
921c87ba 686 queue_work(system_bh_wq, &host->finish_bh_work);
f0bf7f61
HW
687 } else {
688 via_sdc_send_command(host, mrq->cmd);
689 }
690
f0bf7f61
HW
691 spin_unlock_irqrestore(&host->lock, flags);
692}
693
694static void via_sdc_set_power(struct via_crdr_mmc_host *host,
695 unsigned short power, unsigned int on)
696{
697 unsigned long flags;
698 u8 gatt;
699
700 spin_lock_irqsave(&host->lock, flags);
701
702 host->power = (1 << power);
703
704 gatt = readb(host->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
705 if (host->power == MMC_VDD_165_195)
706 gatt &= ~VIA_CRDR_PCICLKGATT_3V3;
707 else
708 gatt |= VIA_CRDR_PCICLKGATT_3V3;
709 if (on)
710 gatt |= VIA_CRDR_PCICLKGATT_PAD_PWRON;
711 else
712 gatt &= ~VIA_CRDR_PCICLKGATT_PAD_PWRON;
713 writeb(gatt, host->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
714
f0bf7f61
HW
715 spin_unlock_irqrestore(&host->lock, flags);
716
717 via_pwron_sleep(host);
718}
719
720static void via_sdc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
721{
722 struct via_crdr_mmc_host *host;
723 unsigned long flags;
724 void __iomem *addrbase;
725 u32 org_data, sdextctrl;
726 u8 clock;
727
728 host = mmc_priv(mmc);
729
730 spin_lock_irqsave(&host->lock, flags);
731
732 addrbase = host->sdhc_mmiobase;
733 org_data = readl(addrbase + VIA_CRDR_SDBUSMODE);
734 sdextctrl = readl(addrbase + VIA_CRDR_SDEXTCTRL);
735
736 if (ios->bus_width == MMC_BUS_WIDTH_1)
737 org_data &= ~VIA_CRDR_SDMODE_4BIT;
738 else
739 org_data |= VIA_CRDR_SDMODE_4BIT;
740
741 if (ios->power_mode == MMC_POWER_OFF)
742 org_data &= ~VIA_CRDR_SDMODE_CLK_ON;
743 else
744 org_data |= VIA_CRDR_SDMODE_CLK_ON;
745
746 if (ios->timing == MMC_TIMING_SD_HS)
747 sdextctrl |= VIA_CRDR_SDEXTCTRL_HISPD;
748 else
749 sdextctrl &= ~VIA_CRDR_SDEXTCTRL_HISPD;
750
751 writel(org_data, addrbase + VIA_CRDR_SDBUSMODE);
752 writel(sdextctrl, addrbase + VIA_CRDR_SDEXTCTRL);
753
754 if (ios->clock >= 48000000)
755 clock = PCI_CLK_48M;
756 else if (ios->clock >= 33000000)
757 clock = PCI_CLK_33M;
758 else if (ios->clock >= 24000000)
759 clock = PCI_CLK_24M;
760 else if (ios->clock >= 16000000)
761 clock = PCI_CLK_16M;
762 else if (ios->clock >= 12000000)
763 clock = PCI_CLK_12M;
764 else if (ios->clock >= 8000000)
765 clock = PCI_CLK_8M;
766 else
767 clock = PCI_CLK_375K;
768
769 addrbase = host->pcictrl_mmiobase;
770 if (readb(addrbase + VIA_CRDR_PCISDCCLK) != clock)
771 writeb(clock, addrbase + VIA_CRDR_PCISDCCLK);
772
f0bf7f61
HW
773 spin_unlock_irqrestore(&host->lock, flags);
774
775 if (ios->power_mode != MMC_POWER_OFF)
776 via_sdc_set_power(host, ios->vdd, 1);
777 else
778 via_sdc_set_power(host, ios->vdd, 0);
779}
780
781static int via_sdc_get_ro(struct mmc_host *mmc)
782{
783 struct via_crdr_mmc_host *host;
784 unsigned long flags;
785 u16 status;
786
787 host = mmc_priv(mmc);
788
789 spin_lock_irqsave(&host->lock, flags);
790
791 status = readw(host->sdhc_mmiobase + VIA_CRDR_SDSTATUS);
792
793 spin_unlock_irqrestore(&host->lock, flags);
794
795 return !(status & VIA_CRDR_SDSTS_WP);
796}
797
798static const struct mmc_host_ops via_sdc_ops = {
799 .request = via_sdc_request,
800 .set_ios = via_sdc_set_ios,
801 .get_ro = via_sdc_get_ro,
802};
803
804static void via_reset_pcictrl(struct via_crdr_mmc_host *host)
805{
f0bf7f61
HW
806 unsigned long flags;
807 u8 gatt;
808
f0bf7f61
HW
809 spin_lock_irqsave(&host->lock, flags);
810
811 via_save_pcictrlreg(host);
812 via_save_sdcreg(host);
813
814 spin_unlock_irqrestore(&host->lock, flags);
815
816 gatt = VIA_CRDR_PCICLKGATT_PAD_PWRON;
817 if (host->power == MMC_VDD_165_195)
818 gatt &= VIA_CRDR_PCICLKGATT_3V3;
819 else
820 gatt |= VIA_CRDR_PCICLKGATT_3V3;
821 writeb(gatt, host->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
822 via_pwron_sleep(host);
823 gatt |= VIA_CRDR_PCICLKGATT_SFTRST;
824 writeb(gatt, host->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
825 msleep(3);
826
827 spin_lock_irqsave(&host->lock, flags);
828
829 via_restore_pcictrlreg(host);
830 via_restore_sdcreg(host);
831
f0bf7f61
HW
832 spin_unlock_irqrestore(&host->lock, flags);
833}
834
835static void via_sdc_cmd_isr(struct via_crdr_mmc_host *host, u16 intmask)
836{
837 BUG_ON(intmask == 0);
838
839 if (!host->cmd) {
840 pr_err("%s: Got command interrupt 0x%x even "
841 "though no command operation was in progress.\n",
842 mmc_hostname(host->mmc), intmask);
843 return;
844 }
845
846 if (intmask & VIA_CRDR_SDSTS_CRTO)
847 host->cmd->error = -ETIMEDOUT;
848 else if (intmask & VIA_CRDR_SDSTS_SC)
849 host->cmd->error = -EILSEQ;
850
851 if (host->cmd->error)
921c87ba 852 queue_work(system_bh_wq, &host->finish_bh_work);
f0bf7f61
HW
853 else if (intmask & VIA_CRDR_SDSTS_CRD)
854 via_sdc_finish_command(host);
855}
856
857static void via_sdc_data_isr(struct via_crdr_mmc_host *host, u16 intmask)
858{
859 BUG_ON(intmask == 0);
860
45c8ddd0
ZM
861 if (!host->data)
862 return;
863
f0bf7f61
HW
864 if (intmask & VIA_CRDR_SDSTS_DT)
865 host->data->error = -ETIMEDOUT;
866 else if (intmask & (VIA_CRDR_SDSTS_RC | VIA_CRDR_SDSTS_WC))
867 host->data->error = -EILSEQ;
868
869 via_sdc_finish_data(host);
870}
871
872static irqreturn_t via_sdc_isr(int irq, void *dev_id)
873{
874 struct via_crdr_mmc_host *sdhost = dev_id;
875 void __iomem *addrbase;
876 u8 pci_status;
877 u16 sd_status;
878 irqreturn_t result;
879
880 if (!sdhost)
881 return IRQ_NONE;
882
883 spin_lock(&sdhost->lock);
884
885 addrbase = sdhost->pcictrl_mmiobase;
886 pci_status = readb(addrbase + VIA_CRDR_PCIINTSTATUS);
887 if (!(pci_status & VIA_CRDR_PCIINTSTATUS_SDC)) {
888 result = IRQ_NONE;
889 goto out;
890 }
891
892 addrbase = sdhost->sdhc_mmiobase;
893 sd_status = readw(addrbase + VIA_CRDR_SDSTATUS);
894 sd_status &= VIA_CRDR_SDSTS_INT_MASK;
895 sd_status &= ~VIA_CRDR_SDSTS_IGN_MASK;
896 if (!sd_status) {
897 result = IRQ_NONE;
898 goto out;
899 }
900
901 if (sd_status & VIA_CRDR_SDSTS_CIR) {
902 writew(sd_status & VIA_CRDR_SDSTS_CIR,
903 addrbase + VIA_CRDR_SDSTATUS);
904
905 schedule_work(&sdhost->carddet_work);
906 }
907
908 sd_status &= ~VIA_CRDR_SDSTS_CIR;
909 if (sd_status & VIA_CRDR_SDSTS_CMD_MASK) {
910 writew(sd_status & VIA_CRDR_SDSTS_CMD_MASK,
911 addrbase + VIA_CRDR_SDSTATUS);
912 via_sdc_cmd_isr(sdhost, sd_status & VIA_CRDR_SDSTS_CMD_MASK);
913 }
914 if (sd_status & VIA_CRDR_SDSTS_DATA_MASK) {
915 writew(sd_status & VIA_CRDR_SDSTS_DATA_MASK,
916 addrbase + VIA_CRDR_SDSTATUS);
917 via_sdc_data_isr(sdhost, sd_status & VIA_CRDR_SDSTS_DATA_MASK);
918 }
919
920 sd_status &= ~(VIA_CRDR_SDSTS_CMD_MASK | VIA_CRDR_SDSTS_DATA_MASK);
921 if (sd_status) {
922 pr_err("%s: Unexpected interrupt 0x%x\n",
923 mmc_hostname(sdhost->mmc), sd_status);
924 writew(sd_status, addrbase + VIA_CRDR_SDSTATUS);
925 }
926
927 result = IRQ_HANDLED;
928
f0bf7f61
HW
929out:
930 spin_unlock(&sdhost->lock);
931
932 return result;
933}
934
2ee4f620 935static void via_sdc_timeout(struct timer_list *t)
f0bf7f61
HW
936{
937 struct via_crdr_mmc_host *sdhost;
938 unsigned long flags;
939
2ee4f620 940 sdhost = from_timer(sdhost, t, timer);
f0bf7f61
HW
941
942 spin_lock_irqsave(&sdhost->lock, flags);
943
944 if (sdhost->mrq) {
945 pr_err("%s: Timeout waiting for hardware interrupt."
946 "cmd:0x%x\n", mmc_hostname(sdhost->mmc),
947 sdhost->mrq->cmd->opcode);
948
949 if (sdhost->data) {
950 writel(VIA_CRDR_DMACTRL_SFTRST,
951 sdhost->ddma_mmiobase + VIA_CRDR_DMACTRL);
952 sdhost->data->error = -ETIMEDOUT;
953 via_sdc_finish_data(sdhost);
954 } else {
955 if (sdhost->cmd)
956 sdhost->cmd->error = -ETIMEDOUT;
957 else
958 sdhost->mrq->cmd->error = -ETIMEDOUT;
921c87ba 959 queue_work(system_bh_wq, &sdhost->finish_bh_work);
f0bf7f61
HW
960 }
961 }
962
f0bf7f61
HW
963 spin_unlock_irqrestore(&sdhost->lock, flags);
964}
965
921c87ba 966static void via_sdc_finish_bh_work(struct work_struct *t)
f0bf7f61 967{
921c87ba 968 struct via_crdr_mmc_host *host = from_work(host, t, finish_bh_work);
f0bf7f61
HW
969 unsigned long flags;
970 struct mmc_request *mrq;
971
f0bf7f61
HW
972 spin_lock_irqsave(&host->lock, flags);
973
974 del_timer(&host->timer);
975 mrq = host->mrq;
976 host->mrq = NULL;
977 host->cmd = NULL;
978 host->data = NULL;
979
980 spin_unlock_irqrestore(&host->lock, flags);
981
982 mmc_request_done(host->mmc, mrq);
983}
984
985static void via_sdc_card_detect(struct work_struct *work)
986{
987 struct via_crdr_mmc_host *host;
988 void __iomem *addrbase;
989 unsigned long flags;
990 u16 status;
991
992 host = container_of(work, struct via_crdr_mmc_host, carddet_work);
993
994 addrbase = host->ddma_mmiobase;
995 writel(VIA_CRDR_DMACTRL_SFTRST, addrbase + VIA_CRDR_DMACTRL);
996
997 spin_lock_irqsave(&host->lock, flags);
998
999 addrbase = host->pcictrl_mmiobase;
1000 writeb(VIA_CRDR_PCIDMACLK_SDC, addrbase + VIA_CRDR_PCIDMACLK);
1001
1002 addrbase = host->sdhc_mmiobase;
1003 status = readw(addrbase + VIA_CRDR_SDSTATUS);
1004 if (!(status & VIA_CRDR_SDSTS_SLOTG)) {
1005 if (host->mrq) {
1006 pr_err("%s: Card removed during transfer!\n",
1007 mmc_hostname(host->mmc));
1008 host->mrq->cmd->error = -ENOMEDIUM;
921c87ba 1009 queue_work(system_bh_wq, &host->finish_bh_work);
f0bf7f61
HW
1010 }
1011
f0bf7f61
HW
1012 spin_unlock_irqrestore(&host->lock, flags);
1013
1014 via_reset_pcictrl(host);
1015
1016 spin_lock_irqsave(&host->lock, flags);
1017 }
1018
f0bf7f61
HW
1019 spin_unlock_irqrestore(&host->lock, flags);
1020
1021 via_print_pcictrl(host);
1022 via_print_sdchc(host);
1023
1024 mmc_detect_change(host->mmc, msecs_to_jiffies(500));
1025}
1026
1027static void via_init_mmc_host(struct via_crdr_mmc_host *host)
1028{
1029 struct mmc_host *mmc = host->mmc;
1030 void __iomem *addrbase;
1031 u32 lenreg;
1032 u32 status;
1033
2ee4f620 1034 timer_setup(&host->timer, via_sdc_timeout, 0);
f0bf7f61
HW
1035
1036 spin_lock_init(&host->lock);
1037
1038 mmc->f_min = VIA_CRDR_MIN_CLOCK;
1039 mmc->f_max = VIA_CRDR_MAX_CLOCK;
1040 mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195;
1041 mmc->caps = MMC_CAP_4_BIT_DATA | MMC_CAP_SD_HIGHSPEED;
1042 mmc->ops = &via_sdc_ops;
1043
1044 /*Hardware cannot do scatter lists*/
a36274e0 1045 mmc->max_segs = 1;
f0bf7f61
HW
1046
1047 mmc->max_blk_size = VIA_CRDR_MAX_BLOCK_LENGTH;
1048 mmc->max_blk_count = VIA_CRDR_MAX_BLOCK_COUNT;
1049
1050 mmc->max_seg_size = mmc->max_blk_size * mmc->max_blk_count;
1051 mmc->max_req_size = mmc->max_seg_size;
1052
1053 INIT_WORK(&host->carddet_work, via_sdc_card_detect);
1054
921c87ba 1055 INIT_WORK(&host->finish_bh_work, via_sdc_finish_bh_work);
f0bf7f61
HW
1056
1057 addrbase = host->sdhc_mmiobase;
1058 writel(0x0, addrbase + VIA_CRDR_SDINTMASK);
1059 msleep(1);
1060
1061 lenreg = VIA_CRDR_SDBLKLEN_GPIDET | VIA_CRDR_SDBLKLEN_INTEN;
1062 writel(lenreg, addrbase + VIA_CRDR_SDBLKLEN);
1063
1064 status = readw(addrbase + VIA_CRDR_SDSTATUS);
1065 status &= VIA_CRDR_SDSTS_W1C_MASK;
1066 writew(status, addrbase + VIA_CRDR_SDSTATUS);
1067
1068 status = readw(addrbase + VIA_CRDR_SDSTATUS2);
1069 status |= VIA_CRDR_SDSTS_CFE;
1070 writew(status, addrbase + VIA_CRDR_SDSTATUS2);
1071
1072 writeb(0x0, addrbase + VIA_CRDR_SDEXTCTRL);
1073
1074 writel(VIA_CRDR_SDACTIVE_INTMASK, addrbase + VIA_CRDR_SDINTMASK);
1075 msleep(1);
1076}
1077
c3be1efd 1078static int via_sd_probe(struct pci_dev *pcidev,
f0bf7f61
HW
1079 const struct pci_device_id *id)
1080{
1081 struct mmc_host *mmc;
1082 struct via_crdr_mmc_host *sdhost;
1083 u32 base, len;
cf5e23e1 1084 u8 gatt;
f0bf7f61
HW
1085 int ret;
1086
f0bf7f61
HW
1087 pr_info(DRV_NAME
1088 ": VIA SDMMC controller found at %s [%04x:%04x] (rev %x)\n",
1089 pci_name(pcidev), (int)pcidev->vendor, (int)pcidev->device,
cf5e23e1 1090 (int)pcidev->revision);
f0bf7f61
HW
1091
1092 ret = pci_enable_device(pcidev);
1093 if (ret)
1094 return ret;
1095
1096 ret = pci_request_regions(pcidev, DRV_NAME);
1097 if (ret)
1098 goto disable;
1099
1100 pci_write_config_byte(pcidev, VIA_CRDR_PCI_WORK_MODE, 0);
1101 pci_write_config_byte(pcidev, VIA_CRDR_PCI_DBG_MODE, 0);
1102
1103 mmc = mmc_alloc_host(sizeof(struct via_crdr_mmc_host), &pcidev->dev);
1104 if (!mmc) {
1105 ret = -ENOMEM;
1106 goto release;
1107 }
1108
1109 sdhost = mmc_priv(mmc);
1110 sdhost->mmc = mmc;
1111 dev_set_drvdata(&pcidev->dev, sdhost);
1112
1113 len = pci_resource_len(pcidev, 0);
1114 base = pci_resource_start(pcidev, 0);
4bdc0d67 1115 sdhost->mmiobase = ioremap(base, len);
f0bf7f61
HW
1116 if (!sdhost->mmiobase) {
1117 ret = -ENOMEM;
1118 goto free_mmc_host;
1119 }
1120
1121 sdhost->sdhc_mmiobase =
1122 sdhost->mmiobase + VIA_CRDR_SDC_OFF;
1123 sdhost->ddma_mmiobase =
1124 sdhost->mmiobase + VIA_CRDR_DDMA_OFF;
1125 sdhost->pcictrl_mmiobase =
1126 sdhost->mmiobase + VIA_CRDR_PCICTRL_OFF;
1127
1128 sdhost->power = MMC_VDD_165_195;
1129
1130 gatt = VIA_CRDR_PCICLKGATT_3V3 | VIA_CRDR_PCICLKGATT_PAD_PWRON;
1131 writeb(gatt, sdhost->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
1132 via_pwron_sleep(sdhost);
1133 gatt |= VIA_CRDR_PCICLKGATT_SFTRST;
1134 writeb(gatt, sdhost->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
1135 msleep(3);
1136
1137 via_init_mmc_host(sdhost);
1138
1139 ret =
1140 request_irq(pcidev->irq, via_sdc_isr, IRQF_SHARED, DRV_NAME,
1141 sdhost);
1142 if (ret)
1143 goto unmap;
1144
1145 writeb(VIA_CRDR_PCIINTCTRL_SDCIRQEN,
1146 sdhost->pcictrl_mmiobase + VIA_CRDR_PCIINTCTRL);
1147 writeb(VIA_CRDR_PCITMOCTRL_1024MS,
1148 sdhost->pcictrl_mmiobase + VIA_CRDR_PCITMOCTRL);
1149
1150 /* device-specific quirks */
1151 if (pcidev->subsystem_vendor == PCI_VENDOR_ID_LENOVO &&
1152 pcidev->subsystem_device == 0x3891)
1153 sdhost->quirks = VIA_CRDR_QUIRK_300MS_PWRDELAY;
1154
e4e46fb6
YY
1155 ret = mmc_add_host(mmc);
1156 if (ret)
1157 goto unmap;
f0bf7f61
HW
1158
1159 return 0;
1160
1161unmap:
1162 iounmap(sdhost->mmiobase);
1163free_mmc_host:
f0bf7f61
HW
1164 mmc_free_host(mmc);
1165release:
1166 pci_release_regions(pcidev);
1167disable:
1168 pci_disable_device(pcidev);
1169
1170 return ret;
1171}
1172
6e0ee714 1173static void via_sd_remove(struct pci_dev *pcidev)
f0bf7f61
HW
1174{
1175 struct via_crdr_mmc_host *sdhost = pci_get_drvdata(pcidev);
1176 unsigned long flags;
1177 u8 gatt;
1178
1179 spin_lock_irqsave(&sdhost->lock, flags);
1180
1181 /* Ensure we don't accept more commands from mmc layer */
1182 sdhost->reject = 1;
1183
1184 /* Disable generating further interrupts */
1185 writeb(0x0, sdhost->pcictrl_mmiobase + VIA_CRDR_PCIINTCTRL);
f0bf7f61
HW
1186
1187 if (sdhost->mrq) {
a3c76eb9 1188 pr_err("%s: Controller removed during "
f0bf7f61
HW
1189 "transfer\n", mmc_hostname(sdhost->mmc));
1190
1191 /* make sure all DMA is stopped */
1192 writel(VIA_CRDR_DMACTRL_SFTRST,
1193 sdhost->ddma_mmiobase + VIA_CRDR_DMACTRL);
f0bf7f61
HW
1194 sdhost->mrq->cmd->error = -ENOMEDIUM;
1195 if (sdhost->mrq->stop)
1196 sdhost->mrq->stop->error = -ENOMEDIUM;
921c87ba 1197 queue_work(system_bh_wq, &sdhost->finish_bh_work);
f0bf7f61
HW
1198 }
1199 spin_unlock_irqrestore(&sdhost->lock, flags);
1200
1201 mmc_remove_host(sdhost->mmc);
1202
1203 free_irq(pcidev->irq, sdhost);
1204
1205 del_timer_sync(&sdhost->timer);
1206
921c87ba 1207 cancel_work_sync(&sdhost->finish_bh_work);
f0bf7f61
HW
1208
1209 /* switch off power */
1210 gatt = readb(sdhost->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
1211 gatt &= ~VIA_CRDR_PCICLKGATT_PAD_PWRON;
1212 writeb(gatt, sdhost->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
1213
1214 iounmap(sdhost->mmiobase);
f0bf7f61
HW
1215 mmc_free_host(sdhost->mmc);
1216 pci_release_regions(pcidev);
1217 pci_disable_device(pcidev);
1218
1219 pr_info(DRV_NAME
1220 ": VIA SDMMC controller at %s [%04x:%04x] has been removed\n",
1221 pci_name(pcidev), (int)pcidev->vendor, (int)pcidev->device);
1222}
1223
0d776e5b 1224static void __maybe_unused via_init_sdc_pm(struct via_crdr_mmc_host *host)
f0bf7f61
HW
1225{
1226 struct sdhcreg *pm_sdhcreg;
1227 void __iomem *addrbase;
1228 u32 lenreg;
1229 u16 status;
1230
1231 pm_sdhcreg = &(host->pm_sdhc_reg);
1232 addrbase = host->sdhc_mmiobase;
1233
1234 writel(0x0, addrbase + VIA_CRDR_SDINTMASK);
1235
1236 lenreg = VIA_CRDR_SDBLKLEN_GPIDET | VIA_CRDR_SDBLKLEN_INTEN;
1237 writel(lenreg, addrbase + VIA_CRDR_SDBLKLEN);
1238
1239 status = readw(addrbase + VIA_CRDR_SDSTATUS);
1240 status &= VIA_CRDR_SDSTS_W1C_MASK;
1241 writew(status, addrbase + VIA_CRDR_SDSTATUS);
1242
1243 status = readw(addrbase + VIA_CRDR_SDSTATUS2);
1244 status |= VIA_CRDR_SDSTS_CFE;
1245 writew(status, addrbase + VIA_CRDR_SDSTATUS2);
1246
1247 writel(pm_sdhcreg->sdcontrol_reg, addrbase + VIA_CRDR_SDCTRL);
1248 writel(pm_sdhcreg->sdcmdarg_reg, addrbase + VIA_CRDR_SDCARG);
1249 writel(pm_sdhcreg->sdintmask_reg, addrbase + VIA_CRDR_SDINTMASK);
1250 writel(pm_sdhcreg->sdrsptmo_reg, addrbase + VIA_CRDR_SDRSPTMO);
1251 writel(pm_sdhcreg->sdclksel_reg, addrbase + VIA_CRDR_SDCLKSEL);
1252 writel(pm_sdhcreg->sdextctrl_reg, addrbase + VIA_CRDR_SDEXTCTRL);
1253
1254 via_print_pcictrl(host);
1255 via_print_sdchc(host);
1256}
1257
0d776e5b 1258static int __maybe_unused via_sd_suspend(struct device *dev)
f0bf7f61
HW
1259{
1260 struct via_crdr_mmc_host *host;
87d7ad08 1261 unsigned long flags;
f0bf7f61 1262
0d776e5b 1263 host = dev_get_drvdata(dev);
f0bf7f61 1264
87d7ad08 1265 spin_lock_irqsave(&host->lock, flags);
f0bf7f61
HW
1266 via_save_pcictrlreg(host);
1267 via_save_sdcreg(host);
87d7ad08 1268 spin_unlock_irqrestore(&host->lock, flags);
f0bf7f61 1269
0d776e5b 1270 device_wakeup_enable(dev);
f0bf7f61 1271
ccad9b97 1272 return 0;
f0bf7f61
HW
1273}
1274
0d776e5b 1275static int __maybe_unused via_sd_resume(struct device *dev)
f0bf7f61
HW
1276{
1277 struct via_crdr_mmc_host *sdhost;
f0bf7f61
HW
1278 u8 gatt;
1279
0d776e5b 1280 sdhost = dev_get_drvdata(dev);
f0bf7f61
HW
1281
1282 gatt = VIA_CRDR_PCICLKGATT_PAD_PWRON;
1283 if (sdhost->power == MMC_VDD_165_195)
1284 gatt &= ~VIA_CRDR_PCICLKGATT_3V3;
1285 else
1286 gatt |= VIA_CRDR_PCICLKGATT_3V3;
1287 writeb(gatt, sdhost->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
1288 via_pwron_sleep(sdhost);
1289 gatt |= VIA_CRDR_PCICLKGATT_SFTRST;
1290 writeb(gatt, sdhost->pcictrl_mmiobase + VIA_CRDR_PCICLKGATT);
1291 msleep(3);
1292
1293 msleep(100);
1294
f0bf7f61
HW
1295 via_restore_pcictrlreg(sdhost);
1296 via_init_sdc_pm(sdhost);
1297
3a75283a 1298 return 0;
f0bf7f61
HW
1299}
1300
0d776e5b 1301static SIMPLE_DEV_PM_OPS(via_sd_pm_ops, via_sd_suspend, via_sd_resume);
f0bf7f61
HW
1302
1303static struct pci_driver via_sd_driver = {
1304 .name = DRV_NAME,
1305 .id_table = via_ids,
1306 .probe = via_sd_probe,
0433c143 1307 .remove = via_sd_remove,
0d776e5b 1308 .driver.pm = &via_sd_pm_ops,
f0bf7f61
HW
1309};
1310
0d4de8f5 1311module_pci_driver(via_sd_driver);
f0bf7f61
HW
1312
1313MODULE_LICENSE("GPL");
1314MODULE_AUTHOR("VIA Technologies Inc.");
1315MODULE_DESCRIPTION("VIA SD/MMC Card Interface driver");