1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Driver for Realtek PCI-Express card reader
4 *
5 * Copyright(c) 2009-2013 Realtek Semiconductor Corp. All rights reserved.
6 *
7 * Author:
8 * Wei WANG (wei_wang@realsil.com.cn)
9 * Micky Ching (micky_ching@realsil.com.cn)
10 */
11
12 #include <linux/blkdev.h>
13 #include <linux/kthread.h>
14 #include <linux/sched.h>
15 #include <linux/workqueue.h>
16
17 #include "rtsx.h"
18 #include "ms.h"
19 #include "sd.h"
20 #include "xd.h"
21
22 MODULE_DESCRIPTION("Realtek PCI-Express card reader rts5208/rts5288 driver");
23 MODULE_LICENSE("GPL");
24
25 static unsigned int delay_use = 1;
26 module_param(delay_use, uint, 0644);
27 MODULE_PARM_DESC(delay_use, "seconds to delay before using a new device");
28
29 static int ss_en;
30 module_param(ss_en, int, 0644);
31 MODULE_PARM_DESC(ss_en, "enable selective suspend");
32
33 static int ss_interval = 50;
34 module_param(ss_interval, int, 0644);
35 MODULE_PARM_DESC(ss_interval, "Interval to enter ss state in seconds");
36
37 static int auto_delink_en;
38 module_param(auto_delink_en, int, 0644);
39 MODULE_PARM_DESC(auto_delink_en, "enable auto delink");
40
41 static unsigned char aspm_l0s_l1_en;
42 module_param(aspm_l0s_l1_en, byte, 0644);
43 MODULE_PARM_DESC(aspm_l0s_l1_en, "enable device aspm");
44
45 static int msi_en;
46 module_param(msi_en, int, 0644);
47 MODULE_PARM_DESC(msi_en, "enable msi");
48
49 static irqreturn_t rtsx_interrupt(int irq, void *dev_id);
50
51 /***********************************************************************
52 * Host functions
53 ***********************************************************************/
54
host_info(struct Scsi_Host * host)55 static const char *host_info(struct Scsi_Host *host)
56 {
57 return "SCSI emulation for PCI-Express Mass Storage devices";
58 }
59
slave_alloc(struct scsi_device * sdev)60 static int slave_alloc(struct scsi_device *sdev)
61 {
62 /*
63 * Set the INQUIRY transfer length to 36. We don't use any of
64 * the extra data and many devices choke if asked for more or
65 * less than 36 bytes.
66 */
67 sdev->inquiry_len = 36;
68 return 0;
69 }
70
slave_configure(struct scsi_device * sdev)71 static int slave_configure(struct scsi_device *sdev)
72 {
73 /* Set the SCSI level to at least 2. We'll leave it at 3 if that's
74 * what is originally reported. We need this to avoid confusing
75 * the SCSI layer with devices that report 0 or 1, but need 10-byte
76 * commands (ala ATAPI devices behind certain bridges, or devices
77 * which simply have broken INQUIRY data).
78 *
79 * NOTE: This means /dev/sg programs (ala cdrecord) will get the
80 * actual information. This seems to be the preference for
81 * programs like that.
82 *
83 * NOTE: This also means that /proc/scsi/scsi and sysfs may report
84 * the actual value or the modified one, depending on where the
85 * data comes from.
86 */
87 if (sdev->scsi_level < SCSI_2) {
88 sdev->scsi_level = SCSI_2;
89 sdev->sdev_target->scsi_level = SCSI_2;
90 }
91
92 return 0;
93 }
94
95 /***********************************************************************
96 * /proc/scsi/ functions
97 ***********************************************************************/
98
99 /* we use this macro to help us write into the buffer */
100 #undef SPRINTF
101 #define SPRINTF(args...) \
102 do { \
103 if (pos < buffer + length) \
104 pos += sprintf(pos, ## args); \
105 } while (0)
106
107 /* queue a command */
108 /* This is always called with spin_lock_irq(host->host_lock) held */
queuecommand_lck(struct scsi_cmnd * srb)109 static int queuecommand_lck(struct scsi_cmnd *srb)
110 {
111 void (*done)(struct scsi_cmnd *) = scsi_done;
112 struct rtsx_dev *dev = host_to_rtsx(srb->device->host);
113 struct rtsx_chip *chip = dev->chip;
114
115 /* check for state-transition errors */
116 if (chip->srb) {
117 dev_err(&dev->pci->dev, "Error: chip->srb = %p\n",
118 chip->srb);
119 return SCSI_MLQUEUE_HOST_BUSY;
120 }
121
122 /* fail the command if we are disconnecting */
123 if (rtsx_chk_stat(chip, RTSX_STAT_DISCONNECT)) {
124 dev_info(&dev->pci->dev, "Fail command during disconnect\n");
125 srb->result = DID_NO_CONNECT << 16;
126 done(srb);
127 return 0;
128 }
129
130 /* enqueue the command and wake up the control thread */
131 chip->srb = srb;
132 complete(&dev->cmnd_ready);
133
134 return 0;
135 }
136
DEF_SCSI_QCMD(queuecommand)137 static DEF_SCSI_QCMD(queuecommand)
138
139 /***********************************************************************
140 * Error handling functions
141 ***********************************************************************/
142
143 /* Command timeout and abort */
144 static int command_abort(struct scsi_cmnd *srb)
145 {
146 struct Scsi_Host *host = srb->device->host;
147 struct rtsx_dev *dev = host_to_rtsx(host);
148 struct rtsx_chip *chip = dev->chip;
149
150 spin_lock_irq(host->host_lock);
151
152 /* Is this command still active? */
153 if (chip->srb != srb) {
154 spin_unlock_irq(host->host_lock);
155 dev_info(&dev->pci->dev, "-- nothing to abort\n");
156 return FAILED;
157 }
158
159 rtsx_set_stat(chip, RTSX_STAT_ABORT);
160
161 spin_unlock_irq(host->host_lock);
162
163 /* Wait for the aborted command to finish */
164 wait_for_completion(&dev->notify);
165
166 return SUCCESS;
167 }
168
169 /*
170 * This invokes the transport reset mechanism to reset the state of the
171 * device
172 */
device_reset(struct scsi_cmnd * srb)173 static int device_reset(struct scsi_cmnd *srb)
174 {
175 return SUCCESS;
176 }
177
178 /*
179 * this defines our host template, with which we'll allocate hosts
180 */
181
182 static const struct scsi_host_template rtsx_host_template = {
183 /* basic userland interface stuff */
184 .name = CR_DRIVER_NAME,
185 .proc_name = CR_DRIVER_NAME,
186 .info = host_info,
187
188 /* command interface -- queued only */
189 .queuecommand = queuecommand,
190
191 /* error and abort handlers */
192 .eh_abort_handler = command_abort,
193 .eh_device_reset_handler = device_reset,
194
195 /* queue commands only, only one command per LUN */
196 .can_queue = 1,
197
198 /* unknown initiator id */
199 .this_id = -1,
200
201 .slave_alloc = slave_alloc,
202 .slave_configure = slave_configure,
203
204 /* lots of sg segments can be handled */
205 .sg_tablesize = SG_ALL,
206
207 /* limit the total size of a transfer to 120 KB */
208 .max_sectors = 240,
209
210 /*
211 * Scatter-gather buffers (all but the last) must have a length
212 * divisible by the bulk maxpacket size. Otherwise a data packet
213 * would end up being short, causing a premature end to the data
214 * transfer. Since high-speed bulk pipes have a maxpacket size
215 * of 512, we'll use that as the scsi device queue's DMA alignment
216 * mask. Guaranteeing proper alignment of the first buffer will
217 * have the desired effect because, except at the beginning and
218 * the end, scatter-gather buffers follow page boundaries.
219 */
220 .dma_alignment = 511,
221
222 /* emulated HBA */
223 .emulated = 1,
224
225 /* we do our own delay after a device or bus reset */
226 .skip_settle_delay = 1,
227
228 /* module management */
229 .module = THIS_MODULE
230 };
231
rtsx_acquire_irq(struct rtsx_dev * dev)232 static int rtsx_acquire_irq(struct rtsx_dev *dev)
233 {
234 struct rtsx_chip *chip = dev->chip;
235
236 dev_info(&dev->pci->dev, "%s: chip->msi_en = %d, pci->irq = %d\n",
237 __func__, chip->msi_en, dev->pci->irq);
238
239 if (request_irq(dev->pci->irq, rtsx_interrupt,
240 chip->msi_en ? 0 : IRQF_SHARED,
241 CR_DRIVER_NAME, dev)) {
242 dev_err(&dev->pci->dev,
243 "rtsx: unable to grab IRQ %d, disabling device\n",
244 dev->pci->irq);
245 return -1;
246 }
247
248 dev->irq = dev->pci->irq;
249 pci_intx(dev->pci, !chip->msi_en);
250
251 return 0;
252 }
253
254 /*
255 * power management
256 */
rtsx_suspend(struct device * dev_d)257 static int __maybe_unused rtsx_suspend(struct device *dev_d)
258 {
259 struct pci_dev *pci = to_pci_dev(dev_d);
260 struct rtsx_dev *dev = pci_get_drvdata(pci);
261 struct rtsx_chip *chip;
262
263 if (!dev)
264 return 0;
265
266 /* lock the device pointers */
267 mutex_lock(&dev->dev_mutex);
268
269 chip = dev->chip;
270
271 rtsx_do_before_power_down(chip, PM_S3);
272
273 if (dev->irq >= 0) {
274 free_irq(dev->irq, (void *)dev);
275 dev->irq = -1;
276 }
277
278 if (chip->msi_en)
279 pci_free_irq_vectors(pci);
280
281 device_wakeup_enable(dev_d);
282
283 /* unlock the device pointers */
284 mutex_unlock(&dev->dev_mutex);
285
286 return 0;
287 }
288
rtsx_resume(struct device * dev_d)289 static int __maybe_unused rtsx_resume(struct device *dev_d)
290 {
291 struct pci_dev *pci = to_pci_dev(dev_d);
292 struct rtsx_dev *dev = pci_get_drvdata(pci);
293 struct rtsx_chip *chip;
294
295 if (!dev)
296 return 0;
297
298 chip = dev->chip;
299
300 /* lock the device pointers */
301 mutex_lock(&dev->dev_mutex);
302
303 pci_set_master(pci);
304
305 if (chip->msi_en) {
306 if (pci_alloc_irq_vectors(pci, 1, 1, PCI_IRQ_MSI) < 0)
307 chip->msi_en = 0;
308 }
309
310 if (rtsx_acquire_irq(dev) < 0) {
311 /* unlock the device pointers */
312 mutex_unlock(&dev->dev_mutex);
313 return -EIO;
314 }
315
316 rtsx_write_register(chip, HOST_SLEEP_STATE, 0x03, 0x00);
317 rtsx_init_chip(chip);
318
319 /* unlock the device pointers */
320 mutex_unlock(&dev->dev_mutex);
321
322 return 0;
323 }
324
rtsx_shutdown(struct pci_dev * pci)325 static void rtsx_shutdown(struct pci_dev *pci)
326 {
327 struct rtsx_dev *dev = pci_get_drvdata(pci);
328 struct rtsx_chip *chip;
329
330 if (!dev)
331 return;
332
333 chip = dev->chip;
334
335 rtsx_do_before_power_down(chip, PM_S1);
336
337 if (dev->irq >= 0) {
338 free_irq(dev->irq, (void *)dev);
339 dev->irq = -1;
340 }
341
342 if (chip->msi_en)
343 pci_free_irq_vectors(pci);
344
345 pci_disable_device(pci);
346 }
347
rtsx_control_thread(void * __dev)348 static int rtsx_control_thread(void *__dev)
349 {
350 struct rtsx_dev *dev = __dev;
351 struct rtsx_chip *chip = dev->chip;
352 struct Scsi_Host *host = rtsx_to_host(dev);
353
354 for (;;) {
355 if (wait_for_completion_interruptible(&dev->cmnd_ready))
356 break;
357
358 /* lock the device pointers */
359 mutex_lock(&dev->dev_mutex);
360
361 /* if the device has disconnected, we are free to exit */
362 if (rtsx_chk_stat(chip, RTSX_STAT_DISCONNECT)) {
363 dev_info(&dev->pci->dev, "-- rtsx-control exiting\n");
364 mutex_unlock(&dev->dev_mutex);
365 break;
366 }
367
368 /* lock access to the state */
369 spin_lock_irq(host->host_lock);
370
371 /* has the command aborted ? */
372 if (rtsx_chk_stat(chip, RTSX_STAT_ABORT)) {
373 chip->srb->result = DID_ABORT << 16;
374 goto skip_for_abort;
375 }
376
377 spin_unlock_irq(host->host_lock);
378
379 /* reject the command if the direction indicator
380 * is UNKNOWN
381 */
382 if (chip->srb->sc_data_direction == DMA_BIDIRECTIONAL) {
383 dev_err(&dev->pci->dev, "UNKNOWN data direction\n");
384 chip->srb->result = DID_ERROR << 16;
385 } else if (chip->srb->device->id) {
386 /* reject if target != 0 or if LUN is higher than
387 * the maximum known LUN
388 */
389 dev_err(&dev->pci->dev, "Bad target number (%d:%d)\n",
390 chip->srb->device->id,
391 (u8)chip->srb->device->lun);
392 chip->srb->result = DID_BAD_TARGET << 16;
393 } else if (chip->srb->device->lun > chip->max_lun) {
394 dev_err(&dev->pci->dev, "Bad LUN (%d:%d)\n",
395 chip->srb->device->id,
396 (u8)chip->srb->device->lun);
397 chip->srb->result = DID_BAD_TARGET << 16;
398 } else {
399 /* we've got a command, let's do it! */
400 scsi_show_command(chip);
401 rtsx_invoke_transport(chip->srb, chip);
402 }
403
404 /* lock access to the state */
405 spin_lock_irq(host->host_lock);
406
407 /* did the command already complete because of a disconnect? */
408 if (!chip->srb)
409 ; /* nothing to do */
410
411 /* indicate that the command is done */
412 else if (chip->srb->result != DID_ABORT << 16) {
413 scsi_done(chip->srb);
414 } else {
415 skip_for_abort:
416 dev_err(&dev->pci->dev, "scsi command aborted\n");
417 }
418
419 if (rtsx_chk_stat(chip, RTSX_STAT_ABORT)) {
420 complete(&dev->notify);
421
422 rtsx_set_stat(chip, RTSX_STAT_IDLE);
423 }
424
425 /* finished working on this command */
426 chip->srb = NULL;
427 spin_unlock_irq(host->host_lock);
428
429 /* unlock the device pointers */
430 mutex_unlock(&dev->dev_mutex);
431 } /* for (;;) */
432
433 /* notify the exit routine that we're actually exiting now
434 *
435 * complete()/wait_for_completion() is similar to up()/down(),
436 * except that complete() is safe in the case where the structure
437 * is getting deleted in a parallel mode of execution (i.e. just
438 * after the down() -- that's necessary for the thread-shutdown
439 * case.
440 *
441 * kthread_complete_and_exit() goes even further than this --
442 * it is safe in the case that the thread of the caller is going away
443 * (not just the structure) -- this is necessary for the module-remove
444 * case. This is important in preemption kernels, which transfer the
445 * flow of execution immediately upon a complete().
446 */
447 kthread_complete_and_exit(&dev->control_exit, 0);
448 }
449
rtsx_polling_thread(void * __dev)450 static int rtsx_polling_thread(void *__dev)
451 {
452 struct rtsx_dev *dev = __dev;
453 struct rtsx_chip *chip = dev->chip;
454 struct sd_info *sd_card = &chip->sd_card;
455 struct xd_info *xd_card = &chip->xd_card;
456 struct ms_info *ms_card = &chip->ms_card;
457
458 sd_card->cleanup_counter = 0;
459 xd_card->cleanup_counter = 0;
460 ms_card->cleanup_counter = 0;
461
462 /* Wait until SCSI scan finished */
463 wait_timeout((delay_use + 5) * 1000);
464
465 for (;;) {
466 set_current_state(TASK_INTERRUPTIBLE);
467 schedule_timeout(msecs_to_jiffies(POLLING_INTERVAL));
468
469 /* lock the device pointers */
470 mutex_lock(&dev->dev_mutex);
471
472 /* if the device has disconnected, we are free to exit */
473 if (rtsx_chk_stat(chip, RTSX_STAT_DISCONNECT)) {
474 dev_info(&dev->pci->dev, "-- rtsx-polling exiting\n");
475 mutex_unlock(&dev->dev_mutex);
476 break;
477 }
478
479 mutex_unlock(&dev->dev_mutex);
480
481 mspro_polling_format_status(chip);
482
483 /* lock the device pointers */
484 mutex_lock(&dev->dev_mutex);
485
486 rtsx_polling_func(chip);
487
488 /* unlock the device pointers */
489 mutex_unlock(&dev->dev_mutex);
490 }
491
492 kthread_complete_and_exit(&dev->polling_exit, 0);
493 }
494
495 /*
496 * interrupt handler
497 */
rtsx_interrupt(int irq,void * dev_id)498 static irqreturn_t rtsx_interrupt(int irq, void *dev_id)
499 {
500 struct rtsx_dev *dev = dev_id;
501 struct rtsx_chip *chip;
502 int retval;
503 u32 status;
504
505 if (dev)
506 chip = dev->chip;
507 else
508 return IRQ_NONE;
509
510 if (!chip)
511 return IRQ_NONE;
512
513 spin_lock(&dev->reg_lock);
514
515 retval = rtsx_pre_handle_interrupt(chip);
516 if (retval == STATUS_FAIL) {
517 spin_unlock(&dev->reg_lock);
518 if (chip->int_reg == 0xFFFFFFFF)
519 return IRQ_HANDLED;
520 return IRQ_NONE;
521 }
522
523 status = chip->int_reg;
524
525 if (dev->check_card_cd) {
526 if (!(dev->check_card_cd & status)) {
527 /* card not exist, return TRANS_RESULT_FAIL */
528 dev->trans_result = TRANS_RESULT_FAIL;
529 if (dev->done)
530 complete(dev->done);
531 goto exit;
532 }
533 }
534
535 if (status & (NEED_COMPLETE_INT | DELINK_INT)) {
536 if (status & (TRANS_FAIL_INT | DELINK_INT)) {
537 if (status & DELINK_INT)
538 RTSX_SET_DELINK(chip);
539 dev->trans_result = TRANS_RESULT_FAIL;
540 if (dev->done)
541 complete(dev->done);
542 } else if (status & TRANS_OK_INT) {
543 dev->trans_result = TRANS_RESULT_OK;
544 if (dev->done)
545 complete(dev->done);
546 } else if (status & DATA_DONE_INT) {
547 dev->trans_result = TRANS_NOT_READY;
548 if (dev->done && dev->trans_state == STATE_TRANS_SG)
549 complete(dev->done);
550 }
551 }
552
553 exit:
554 spin_unlock(&dev->reg_lock);
555 return IRQ_HANDLED;
556 }
557
558 /* Release all our dynamic resources */
rtsx_release_resources(struct rtsx_dev * dev)559 static void rtsx_release_resources(struct rtsx_dev *dev)
560 {
561 dev_info(&dev->pci->dev, "-- %s\n", __func__);
562
563 /* Tell the control thread to exit. The SCSI host must
564 * already have been removed so it won't try to queue
565 * any more commands.
566 */
567 dev_info(&dev->pci->dev, "-- sending exit command to thread\n");
568 complete(&dev->cmnd_ready);
569 if (dev->ctl_thread)
570 wait_for_completion(&dev->control_exit);
571 if (dev->polling_thread)
572 wait_for_completion(&dev->polling_exit);
573
574 wait_timeout(200);
575
576 if (dev->rtsx_resv_buf) {
577 dev->chip->host_cmds_ptr = NULL;
578 dev->chip->host_sg_tbl_ptr = NULL;
579 }
580
581 if (dev->irq > 0)
582 free_irq(dev->irq, (void *)dev);
583 if (dev->chip->msi_en)
584 pci_free_irq_vectors(dev->pci);
585 if (dev->remap_addr)
586 iounmap(dev->remap_addr);
587
588 rtsx_release_chip(dev->chip);
589 kfree(dev->chip);
590 }
591
592 /*
593 * First stage of disconnect processing: stop all commands and remove
594 * the host
595 */
quiesce_and_remove_host(struct rtsx_dev * dev)596 static void quiesce_and_remove_host(struct rtsx_dev *dev)
597 {
598 struct Scsi_Host *host = rtsx_to_host(dev);
599 struct rtsx_chip *chip = dev->chip;
600
601 /*
602 * Prevent new transfers, stop the current command, and
603 * interrupt a SCSI-scan or device-reset delay
604 */
605 mutex_lock(&dev->dev_mutex);
606 spin_lock_irq(host->host_lock);
607 rtsx_set_stat(chip, RTSX_STAT_DISCONNECT);
608 spin_unlock_irq(host->host_lock);
609 mutex_unlock(&dev->dev_mutex);
610 wake_up(&dev->delay_wait);
611 wait_for_completion(&dev->scanning_done);
612
613 /* Wait some time to let other threads exist */
614 wait_timeout(100);
615
616 /*
617 * queuecommand won't accept any new commands and the control
618 * thread won't execute a previously-queued command. If there
619 * is such a command pending, complete it with an error.
620 */
621 mutex_lock(&dev->dev_mutex);
622 if (chip->srb) {
623 chip->srb->result = DID_NO_CONNECT << 16;
624 spin_lock_irq(host->host_lock);
625 scsi_done(dev->chip->srb);
626 chip->srb = NULL;
627 spin_unlock_irq(host->host_lock);
628 }
629 mutex_unlock(&dev->dev_mutex);
630
631 /* Now we own no commands so it's safe to remove the SCSI host */
632 scsi_remove_host(host);
633 }
634
635 /* Second stage of disconnect processing: deallocate all resources */
release_everything(struct rtsx_dev * dev)636 static void release_everything(struct rtsx_dev *dev)
637 {
638 rtsx_release_resources(dev);
639
640 /*
641 * Drop our reference to the host; the SCSI core will free it
642 * when the refcount becomes 0.
643 */
644 scsi_host_put(rtsx_to_host(dev));
645 }
646
647 /* Thread to carry out delayed SCSI-device scanning */
rtsx_scan_thread(void * __dev)648 static int rtsx_scan_thread(void *__dev)
649 {
650 struct rtsx_dev *dev = __dev;
651 struct rtsx_chip *chip = dev->chip;
652
653 /* Wait for the timeout to expire or for a disconnect */
654 if (delay_use > 0) {
655 dev_info(&dev->pci->dev,
656 "%s: waiting for device to settle before scanning\n",
657 CR_DRIVER_NAME);
658 wait_event_interruptible_timeout
659 (dev->delay_wait,
660 rtsx_chk_stat(chip, RTSX_STAT_DISCONNECT),
661 delay_use * HZ);
662 }
663
664 /* If the device is still connected, perform the scanning */
665 if (!rtsx_chk_stat(chip, RTSX_STAT_DISCONNECT)) {
666 scsi_scan_host(rtsx_to_host(dev));
667 dev_info(&dev->pci->dev, "%s: device scan complete\n",
668 CR_DRIVER_NAME);
669
670 /* Should we unbind if no devices were detected? */
671 }
672
673 kthread_complete_and_exit(&dev->scanning_done, 0);
674 }
675
rtsx_init_options(struct rtsx_chip * chip)676 static void rtsx_init_options(struct rtsx_chip *chip)
677 {
678 chip->vendor_id = chip->rtsx->pci->vendor;
679 chip->product_id = chip->rtsx->pci->device;
680 chip->adma_mode = 1;
681 chip->lun_mc = 0;
682 chip->driver_first_load = 1;
683 #ifdef HW_AUTO_SWITCH_SD_BUS
684 chip->sdio_in_charge = 0;
685 #endif
686
687 chip->mspro_formatter_enable = 1;
688 chip->ignore_sd = 0;
689 chip->use_hw_setting = 0;
690 chip->lun_mode = DEFAULT_SINGLE;
691 chip->auto_delink_en = auto_delink_en;
692 chip->ss_en = ss_en;
693 chip->ss_idle_period = ss_interval * 1000;
694 chip->remote_wakeup_en = 0;
695 chip->aspm_l0s_l1_en = aspm_l0s_l1_en;
696 chip->dynamic_aspm = 1;
697 chip->fpga_sd_sdr104_clk = CLK_200;
698 chip->fpga_sd_ddr50_clk = CLK_100;
699 chip->fpga_sd_sdr50_clk = CLK_100;
700 chip->fpga_sd_hs_clk = CLK_100;
701 chip->fpga_mmc_52m_clk = CLK_80;
702 chip->fpga_ms_hg_clk = CLK_80;
703 chip->fpga_ms_4bit_clk = CLK_80;
704 chip->fpga_ms_1bit_clk = CLK_40;
705 chip->asic_sd_sdr104_clk = 203;
706 chip->asic_sd_sdr50_clk = 98;
707 chip->asic_sd_ddr50_clk = 98;
708 chip->asic_sd_hs_clk = 98;
709 chip->asic_mmc_52m_clk = 98;
710 chip->asic_ms_hg_clk = 117;
711 chip->asic_ms_4bit_clk = 78;
712 chip->asic_ms_1bit_clk = 39;
713 chip->ssc_depth_sd_sdr104 = SSC_DEPTH_2M;
714 chip->ssc_depth_sd_sdr50 = SSC_DEPTH_2M;
715 chip->ssc_depth_sd_ddr50 = SSC_DEPTH_1M;
716 chip->ssc_depth_sd_hs = SSC_DEPTH_1M;
717 chip->ssc_depth_mmc_52m = SSC_DEPTH_1M;
718 chip->ssc_depth_ms_hg = SSC_DEPTH_1M;
719 chip->ssc_depth_ms_4bit = SSC_DEPTH_512K;
720 chip->ssc_depth_low_speed = SSC_DEPTH_512K;
721 chip->ssc_en = 1;
722 chip->sd_speed_prior = 0x01040203;
723 chip->sd_current_prior = 0x00010203;
724 chip->sd_ctl = SD_PUSH_POINT_AUTO |
725 SD_SAMPLE_POINT_AUTO |
726 SUPPORT_MMC_DDR_MODE;
727 chip->sd_ddr_tx_phase = 0;
728 chip->mmc_ddr_tx_phase = 1;
729 chip->sd_default_tx_phase = 15;
730 chip->sd_default_rx_phase = 15;
731 chip->pmos_pwr_on_interval = 200;
732 chip->sd_voltage_switch_delay = 1000;
733 chip->ms_power_class_en = 3;
734
735 chip->sd_400mA_ocp_thd = 1;
736 chip->sd_800mA_ocp_thd = 5;
737 chip->ms_ocp_thd = 2;
738
739 chip->card_drive_sel = 0x55;
740 chip->sd30_drive_sel_1v8 = 0x03;
741 chip->sd30_drive_sel_3v3 = 0x01;
742
743 chip->do_delink_before_power_down = 1;
744 chip->auto_power_down = 1;
745 chip->polling_config = 0;
746
747 chip->force_clkreq_0 = 1;
748 chip->ft2_fast_mode = 0;
749
750 chip->sdio_retry_cnt = 1;
751
752 chip->xd_timeout = 2000;
753 chip->sd_timeout = 10000;
754 chip->ms_timeout = 2000;
755 chip->mspro_timeout = 15000;
756
757 chip->power_down_in_ss = 1;
758
759 chip->sdr104_en = 1;
760 chip->sdr50_en = 1;
761 chip->ddr50_en = 1;
762
763 chip->delink_stage1_step = 100;
764 chip->delink_stage2_step = 40;
765 chip->delink_stage3_step = 20;
766
767 chip->auto_delink_in_L1 = 1;
768 chip->blink_led = 1;
769 chip->msi_en = msi_en;
770 chip->hp_watch_bios_hotplug = 0;
771 chip->max_payload = 0;
772 chip->phy_voltage = 0;
773
774 chip->support_ms_8bit = 1;
775 chip->s3_pwr_off_delay = 1000;
776 }
777
rtsx_probe(struct pci_dev * pci,const struct pci_device_id * pci_id)778 static int rtsx_probe(struct pci_dev *pci,
779 const struct pci_device_id *pci_id)
780 {
781 struct Scsi_Host *host;
782 struct rtsx_dev *dev;
783 int err = 0;
784 struct task_struct *th;
785
786 dev_dbg(&pci->dev, "Realtek PCI-E card reader detected\n");
787
788 err = pcim_enable_device(pci);
789 if (err < 0) {
790 dev_err(&pci->dev, "PCI enable device failed!\n");
791 return err;
792 }
793
794 err = pci_request_regions(pci, CR_DRIVER_NAME);
795 if (err < 0) {
796 dev_err(&pci->dev, "PCI request regions for %s failed!\n",
797 CR_DRIVER_NAME);
798 return err;
799 }
800
801 /*
802 * Ask the SCSI layer to allocate a host structure, with extra
803 * space at the end for our private rtsx_dev structure.
804 */
805 host = scsi_host_alloc(&rtsx_host_template, sizeof(*dev));
806 if (!host) {
807 dev_err(&pci->dev, "Unable to allocate the scsi host\n");
808 err = -ENOMEM;
809 goto scsi_host_alloc_fail;
810 }
811
812 dev = host_to_rtsx(host);
813 memset(dev, 0, sizeof(struct rtsx_dev));
814
815 dev->chip = kzalloc(sizeof(*dev->chip), GFP_KERNEL);
816 if (!dev->chip) {
817 err = -ENOMEM;
818 goto chip_alloc_fail;
819 }
820
821 spin_lock_init(&dev->reg_lock);
822 mutex_init(&dev->dev_mutex);
823 init_completion(&dev->cmnd_ready);
824 init_completion(&dev->control_exit);
825 init_completion(&dev->polling_exit);
826 init_completion(&dev->notify);
827 init_completion(&dev->scanning_done);
828 init_waitqueue_head(&dev->delay_wait);
829
830 dev->pci = pci;
831 dev->irq = -1;
832
833 dev_info(&pci->dev, "Resource length: 0x%x\n",
834 (unsigned int)pci_resource_len(pci, 0));
835 dev->addr = pci_resource_start(pci, 0);
836 dev->remap_addr = ioremap(dev->addr, pci_resource_len(pci, 0));
837 if (!dev->remap_addr) {
838 dev_err(&pci->dev, "ioremap error\n");
839 err = -ENXIO;
840 goto ioremap_fail;
841 }
842
843 /*
844 * Using "unsigned long" cast here to eliminate gcc warning in
845 * 64-bit system
846 */
847 dev_info(&pci->dev, "Original address: 0x%lx, remapped address: 0x%lx\n",
848 (unsigned long)(dev->addr), (unsigned long)(dev->remap_addr));
849
850 dev->rtsx_resv_buf = dmam_alloc_coherent(&pci->dev, RTSX_RESV_BUF_LEN,
851 &dev->rtsx_resv_buf_addr,
852 GFP_KERNEL);
853 if (!dev->rtsx_resv_buf) {
854 dev_err(&pci->dev, "alloc dma buffer fail\n");
855 err = -ENXIO;
856 goto dma_alloc_fail;
857 }
858 dev->chip->host_cmds_ptr = dev->rtsx_resv_buf;
859 dev->chip->host_cmds_addr = dev->rtsx_resv_buf_addr;
860 dev->chip->host_sg_tbl_ptr = dev->rtsx_resv_buf + HOST_CMDS_BUF_LEN;
861 dev->chip->host_sg_tbl_addr = dev->rtsx_resv_buf_addr +
862 HOST_CMDS_BUF_LEN;
863
864 dev->chip->rtsx = dev;
865
866 rtsx_init_options(dev->chip);
867
868 dev_info(&pci->dev, "pci->irq = %d\n", pci->irq);
869
870 if (dev->chip->msi_en) {
871 if (pci_alloc_irq_vectors(pci, 1, 1, PCI_IRQ_MSI) < 0)
872 dev->chip->msi_en = 0;
873 }
874
875 if (rtsx_acquire_irq(dev) < 0) {
876 err = -EBUSY;
877 goto irq_acquire_fail;
878 }
879
880 pci_set_master(pci);
881 synchronize_irq(dev->irq);
882
883 rtsx_init_chip(dev->chip);
884
885 /*
886 * set the supported max_lun and max_id for the scsi host
887 * NOTE: the minimal value of max_id is 1
888 */
889 host->max_id = 1;
890 host->max_lun = dev->chip->max_lun;
891
892 /* Start up our control thread */
893 th = kthread_run(rtsx_control_thread, dev, CR_DRIVER_NAME);
894 if (IS_ERR(th)) {
895 dev_err(&pci->dev, "Unable to start control thread\n");
896 err = PTR_ERR(th);
897 goto control_thread_fail;
898 }
899 dev->ctl_thread = th;
900
901 err = scsi_add_host(host, &pci->dev);
902 if (err) {
903 dev_err(&pci->dev, "Unable to add the scsi host\n");
904 goto scsi_add_host_fail;
905 }
906
907 /* Start up the thread for delayed SCSI-device scanning */
908 th = kthread_run(rtsx_scan_thread, dev, "rtsx-scan");
909 if (IS_ERR(th)) {
910 dev_err(&pci->dev, "Unable to start the device-scanning thread\n");
911 complete(&dev->scanning_done);
912 err = PTR_ERR(th);
913 goto scan_thread_fail;
914 }
915
916 /* Start up the thread for polling thread */
917 th = kthread_run(rtsx_polling_thread, dev, "rtsx-polling");
918 if (IS_ERR(th)) {
919 dev_err(&pci->dev, "Unable to start the device-polling thread\n");
920 err = PTR_ERR(th);
921 goto scan_thread_fail;
922 }
923 dev->polling_thread = th;
924
925 pci_set_drvdata(pci, dev);
926
927 return 0;
928
929 /* We come here if there are any problems */
930 scan_thread_fail:
931 quiesce_and_remove_host(dev);
932 scsi_add_host_fail:
933 complete(&dev->cmnd_ready);
934 wait_for_completion(&dev->control_exit);
935 control_thread_fail:
936 free_irq(dev->irq, (void *)dev);
937 rtsx_release_chip(dev->chip);
938 irq_acquire_fail:
939 dev->chip->host_cmds_ptr = NULL;
940 dev->chip->host_sg_tbl_ptr = NULL;
941 if (dev->chip->msi_en)
942 pci_free_irq_vectors(dev->pci);
943 dma_alloc_fail:
944 iounmap(dev->remap_addr);
945 ioremap_fail:
946 kfree(dev->chip);
947 chip_alloc_fail:
948 dev_err(&pci->dev, "%s failed\n", __func__);
949 scsi_host_put(host);
950 scsi_host_alloc_fail:
951 pci_release_regions(pci);
952 return err;
953 }
954
rtsx_remove(struct pci_dev * pci)955 static void rtsx_remove(struct pci_dev *pci)
956 {
957 struct rtsx_dev *dev = pci_get_drvdata(pci);
958
959 quiesce_and_remove_host(dev);
960 release_everything(dev);
961 pci_release_regions(pci);
962 }
963
964 /* PCI IDs */
965 static const struct pci_device_id rtsx_ids[] = {
966 { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0x5208),
967 PCI_CLASS_OTHERS << 16, 0xFF0000 },
968 { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0x5288),
969 PCI_CLASS_OTHERS << 16, 0xFF0000 },
970 { 0, },
971 };
972
973 MODULE_DEVICE_TABLE(pci, rtsx_ids);
974
975 static SIMPLE_DEV_PM_OPS(rtsx_pm_ops, rtsx_suspend, rtsx_resume);
976
977 /* pci_driver definition */
978 static struct pci_driver rtsx_driver = {
979 .name = CR_DRIVER_NAME,
980 .id_table = rtsx_ids,
981 .probe = rtsx_probe,
982 .remove = rtsx_remove,
983 .driver.pm = &rtsx_pm_ops,
984 .shutdown = rtsx_shutdown,
985 };
986
987 module_pci_driver(rtsx_driver);
988