[PATCH 2/3] drivers/misc: Add realtek pci card reader driver

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



From: Wei WANG <wei_wang@xxxxxxxxxxxxxx>

Realtek PCI-E card reader driver adapts requests from upper-level
sdmmc/memstick layer to the real physical card reader.

Signed-off-by: Wei WANG <wei_wang@xxxxxxxxxxxxxx>
---
 drivers/misc/realtek_cr/Kconfig        |    1 +
 drivers/misc/realtek_cr/Makefile       |    1 +
 drivers/misc/realtek_cr/pci/Kconfig    |    7 +
 drivers/misc/realtek_cr/pci/Makefile   |    3 +
 drivers/misc/realtek_cr/pci/rts5209.c  |   69 ++
 drivers/misc/realtek_cr/pci/rts5209.h  |   36 +
 drivers/misc/realtek_cr/pci/rts5229.c  |   96 +++
 drivers/misc/realtek_cr/pci/rts5229.h  |   36 +
 drivers/misc/realtek_cr/pci/rtsx_pci.c | 1472 ++++++++++++++++++++++++++++++++
 drivers/misc/realtek_cr/pci/rtsx_pci.h |  684 +++++++++++++++
 drivers/misc/realtek_cr/pci/sdmmc.c    | 1096 ++++++++++++++++++++++++
 drivers/misc/realtek_cr/pci/sdmmc.h    |   31 +
 12 files changed, 3532 insertions(+)
 create mode 100644 drivers/misc/realtek_cr/pci/Kconfig
 create mode 100644 drivers/misc/realtek_cr/pci/Makefile
 create mode 100644 drivers/misc/realtek_cr/pci/rts5209.c
 create mode 100644 drivers/misc/realtek_cr/pci/rts5209.h
 create mode 100644 drivers/misc/realtek_cr/pci/rts5229.c
 create mode 100644 drivers/misc/realtek_cr/pci/rts5229.h
 create mode 100644 drivers/misc/realtek_cr/pci/rtsx_pci.c
 create mode 100644 drivers/misc/realtek_cr/pci/rtsx_pci.h
 create mode 100644 drivers/misc/realtek_cr/pci/sdmmc.c
 create mode 100644 drivers/misc/realtek_cr/pci/sdmmc.h

diff --git a/drivers/misc/realtek_cr/Kconfig b/drivers/misc/realtek_cr/Kconfig
index 303d98a..27a5431a 100644
--- a/drivers/misc/realtek_cr/Kconfig
+++ b/drivers/misc/realtek_cr/Kconfig
@@ -22,5 +22,6 @@ config REALTEK_CR_DEBUG
 if REALTEK_CR_SUPPORT
 
 source "drivers/misc/realtek_cr/core/Kconfig"
+source "drivers/misc/realtek_cr/pci/Kconfig"
 
 endif
diff --git a/drivers/misc/realtek_cr/Makefile b/drivers/misc/realtek_cr/Makefile
index f4e16ba..faae4d1 100644
--- a/drivers/misc/realtek_cr/Makefile
+++ b/drivers/misc/realtek_cr/Makefile
@@ -5,3 +5,4 @@
 subdir-ccflags-$(CONFIG_REALTEK_CR_DEBUG) := -DDEBUG
 
 obj-$(CONFIG_REALTEK_CR_SUPPORT)	+= core/
+obj-$(CONFIG_REALTEK_CR_SUPPORT)	+= pci/
diff --git a/drivers/misc/realtek_cr/pci/Kconfig b/drivers/misc/realtek_cr/pci/Kconfig
new file mode 100644
index 0000000..188ffc9
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/Kconfig
@@ -0,0 +1,7 @@
+config REALTEK_CR_PCI
+	tristate "Realtek PCI-E Card Reader Adapter Driver"
+	depends on PCI && REALTEK_CR_CORE
+	help
+	  Say Y here to include driver code to support the Realtek
+	  PCI-E card reader.
+
diff --git a/drivers/misc/realtek_cr/pci/Makefile b/drivers/misc/realtek_cr/pci/Makefile
new file mode 100644
index 0000000..667bdac
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/Makefile
@@ -0,0 +1,3 @@
+obj-$(CONFIG_REALTEK_CR_PCI)		+= rtsx_pdev.o
+
+rtsx_pdev-y := rtsx_pci.o sdmmc.o rts5209.o rts5229.o
diff --git a/drivers/misc/realtek_cr/pci/rts5209.c b/drivers/misc/realtek_cr/pci/rts5209.c
new file mode 100644
index 0000000..93a9c28
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/rts5209.c
@@ -0,0 +1,69 @@
+/* Driver for Realtek PCI-Express card reader
+ *
+ * Copyright(c) 2009 Realtek Semiconductor Corp. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2, or (at your option) any
+ * later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, see <http://www.gnu.org/licenses/>.
+ *
+ * Author:
+ *   Wei WANG <wei_wang@xxxxxxxxxxxxxx>
+ *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China
+ */
+
+#include <linux/pci.h>
+#include <linux/module.h>
+#include <linux/dma-mapping.h>
+#include <linux/highmem.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/rtsx_core.h>
+
+#include "rtsx_pci.h"
+#include "rts5209.h"
+
+int rts5209_extra_init_hw(struct rtsx_pdev *pdev)
+{
+	return 0;
+}
+
+int rts5209_optimize_phy(struct rtsx_pdev *pdev)
+{
+	int err;
+
+	err = rtsx_pci_write_phy_register(pdev, 0x00, 0xB966);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+void rts5209_turn_on_led(struct rtsx_pdev *pdev)
+{
+	rtsx_pci_write_register(pdev, 0xFD58, 0x01, 0x00);
+}
+
+void rts5209_turn_off_led(struct rtsx_pdev *pdev)
+{
+	rtsx_pci_write_register(pdev, 0xFD58, 0x01, 0x01);
+}
+
+void rts5209_enable_auto_blink(struct rtsx_pdev *pdev)
+{
+	return;
+}
+
+void rts5209_disable_auto_blink(struct rtsx_pdev *pdev)
+{
+	return;
+}
+
diff --git a/drivers/misc/realtek_cr/pci/rts5209.h b/drivers/misc/realtek_cr/pci/rts5209.h
new file mode 100644
index 0000000..93bc2d4
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/rts5209.h
@@ -0,0 +1,36 @@
+/* Driver for Realtek PCI-Express card reader
+ *
+ * Copyright(c) 2009 Realtek Semiconductor Corp. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2, or (at your option) any
+ * later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, see <http://www.gnu.org/licenses/>.
+ *
+ * Author:
+ *   Wei WANG <wei_wang@xxxxxxxxxxxxxx>
+ *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China
+ */
+
+#ifndef __RTSX_PCI_RTS5209_H
+#define __RTSX_PCI_RTS5209_H
+
+#include <linux/pci.h>
+
+int rts5209_extra_init_hw(struct rtsx_pdev *pdev);
+int rts5209_optimize_phy(struct rtsx_pdev *pdev);
+void rts5209_turn_on_led(struct rtsx_pdev *pdev);
+void rts5209_turn_off_led(struct rtsx_pdev *pdev);
+void rts5209_enable_auto_blink(struct rtsx_pdev *pdev);
+void rts5209_disable_auto_blink(struct rtsx_pdev *pdev);
+
+#endif
+
diff --git a/drivers/misc/realtek_cr/pci/rts5229.c b/drivers/misc/realtek_cr/pci/rts5229.c
new file mode 100644
index 0000000..96892c7
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/rts5229.c
@@ -0,0 +1,96 @@
+/* Driver for Realtek PCI-Express card reader
+ *
+ * Copyright(c) 2009 Realtek Semiconductor Corp. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2, or (at your option) any
+ * later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, see <http://www.gnu.org/licenses/>.
+ *
+ * Author:
+ *   Wei WANG <wei_wang@xxxxxxxxxxxxxx>
+ *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China
+ */
+
+#include <linux/pci.h>
+#include <linux/module.h>
+#include <linux/dma-mapping.h>
+#include <linux/highmem.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/rtsx_core.h>
+
+#include "rtsx_pci.h"
+#include "rts5229.h"
+
+int rts5229_extra_init_hw(struct rtsx_pdev *pdev)
+{
+	int err;
+
+	rtsx_pci_init_cmd(pdev);
+
+	/* Switch LDO3318 source from DV33 to card_3v3 */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, 0xFE78, 0x03, 0x00);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, 0xFE78, 0x03, 0x01);
+	/* LED shine disabled, set initial shine cycle period */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, 0xFC1E, 0x0F, 0x02);
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+int rts5229_optimize_phy(struct rtsx_pdev *pdev)
+{
+	int err;
+
+	err = rtsx_pci_write_phy_register(pdev, 0x00, 0xBA42);
+	if (err < 0)
+		return err;
+
+	err = rtsx_pci_write_phy_register(pdev, 0x03, 0xC56A);
+	if (err < 0)
+		return err;
+
+	err = rtsx_pci_write_phy_register(pdev, 0x19, 0xFE6C);
+	if (err < 0)
+		return err;
+
+	wait_timeout(1);
+	err = rtsx_pci_write_phy_register(pdev, 0x0A, 0x05C0);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+void rts5229_turn_on_led(struct rtsx_pdev *pdev)
+{
+	rtsx_pci_write_register(pdev, 0xFC1F, 0x02, 0x02);
+}
+
+void rts5229_turn_off_led(struct rtsx_pdev *pdev)
+{
+	rtsx_pci_write_register(pdev, 0xFC1F, 0x02, 0x00);
+}
+
+void rts5229_enable_auto_blink(struct rtsx_pdev *pdev)
+{
+	rtsx_pci_write_register(pdev, 0xFC1E, 0x08, 0x08);
+}
+
+void rts5229_disable_auto_blink(struct rtsx_pdev *pdev)
+{
+	rtsx_pci_write_register(pdev, 0xFC1E, 0x08, 0x00);
+}
+
diff --git a/drivers/misc/realtek_cr/pci/rts5229.h b/drivers/misc/realtek_cr/pci/rts5229.h
new file mode 100644
index 0000000..f80219a
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/rts5229.h
@@ -0,0 +1,36 @@
+/* Driver for Realtek PCI-Express card reader
+ *
+ * Copyright(c) 2009 Realtek Semiconductor Corp. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2, or (at your option) any
+ * later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, see <http://www.gnu.org/licenses/>.
+ *
+ * Author:
+ *   Wei WANG <wei_wang@xxxxxxxxxxxxxx>
+ *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China
+ */
+
+#ifndef __RTSX_PCI_RTS5229_H
+#define __RTSX_PCI_RTS5229_H
+
+#include <linux/pci.h>
+
+int rts5229_extra_init_hw(struct rtsx_pdev *pdev);
+int rts5229_optimize_phy(struct rtsx_pdev *pdev);
+void rts5229_turn_on_led(struct rtsx_pdev *pdev);
+void rts5229_turn_off_led(struct rtsx_pdev *pdev);
+void rts5229_enable_auto_blink(struct rtsx_pdev *pdev);
+void rts5229_disable_auto_blink(struct rtsx_pdev *pdev);
+
+#endif
+
diff --git a/drivers/misc/realtek_cr/pci/rtsx_pci.c b/drivers/misc/realtek_cr/pci/rtsx_pci.c
new file mode 100644
index 0000000..5c8a90c
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/rtsx_pci.c
@@ -0,0 +1,1472 @@
+/* Driver for Realtek PCI-Express card reader
+ *
+ * Copyright(c) 2009 Realtek Semiconductor Corp. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2, or (at your option) any
+ * later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, see <http://www.gnu.org/licenses/>.
+ *
+ * Author:
+ *   Wei WANG <wei_wang@xxxxxxxxxxxxxx>
+ *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China
+ */
+
+#include <linux/pci.h>
+#include <linux/module.h>
+#include <linux/dma-mapping.h>
+#include <linux/highmem.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/rtsx_core.h>
+
+#include "rtsx_pci.h"
+#include "sdmmc.h"
+#include "rts5209.h"
+#include "rts5229.h"
+
+static int msi_en = 1;
+module_param(msi_en, int, S_IRUGO | S_IWUSR);
+MODULE_PARM_DESC(msi_en, "Enable MSI");
+
+static int adma_mode = 1;
+module_param(adma_mode, int, S_IRUGO | S_IWUSR);
+MODULE_PARM_DESC(adma_mode, "ADMA Mode");
+
+static DEFINE_PCI_DEVICE_TABLE(rtsx_pci_ids) = {
+	{0x10ec, 0x5209, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0,},
+	{0x10ec, 0x5229, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0,},
+	{0,}
+};
+
+MODULE_DEVICE_TABLE(pci, rtsx_pci_ids);
+
+void rtsx_pci_start_run(struct rtsx_pdev *pdev)
+{
+	/* if pci device removed, don't queue idle work any more */
+	if (pdev->remove_pci)
+		return;
+
+	if (pdev->state != PDEV_STAT_RUN) {
+		pdev->state = PDEV_STAT_RUN;
+		pdev->ops.enable_auto_blink(pdev);
+	}
+
+	cancel_delayed_work(&pdev->idle_work);
+	rtsx_queue_delayed_work(&pdev->idle_work, msecs_to_jiffies(200));
+}
+
+int rtsx_pci_write_register(struct rtsx_pdev *pdev, u16 addr, u8 mask, u8 data)
+{
+	int i;
+	u32 val = 3 << 30;
+
+	val |= (u32)(addr & 0x3FFF) << 16;
+	val |= (u32)mask << 8;
+	val |= (u32)data;
+
+	rtsx_pci_writel(pdev, RTSX_HAIMR, val);
+
+	for (i = 0; i < MAX_RW_REG_CNT; i++) {
+		val = rtsx_pci_readl(pdev, RTSX_HAIMR);
+		if ((val & (1 << 31)) == 0) {
+			if (data != (u8)val)
+				return -EIO;
+			return 0;
+		}
+	}
+
+	return -ETIMEDOUT;
+}
+
+int rtsx_pci_read_register(struct rtsx_pdev *pdev, u16 addr, u8 *data)
+{
+	u32 val = 2 << 30;
+	int i;
+
+	if (data)
+		*data = 0;
+
+	val |= (u32)(addr & 0x3FFF) << 16;
+	rtsx_pci_writel(pdev, RTSX_HAIMR, val);
+
+	for (i = 0; i < MAX_RW_REG_CNT; i++) {
+		val = rtsx_pci_readl(pdev, RTSX_HAIMR);
+		if ((val & (1 << 31)) == 0)
+			break;
+	}
+
+	if (i >= MAX_RW_REG_CNT)
+		return -ETIMEDOUT;
+
+	if (data)
+		*data = (u8)(val & 0xFF);
+
+	return 0;
+}
+
+int rtsx_pci_write_phy_register(struct rtsx_pdev *pdev, u8 addr, u16 val)
+{
+	int err, i, finished = 0;
+	u8 tmp;
+
+	rtsx_pci_init_cmd(pdev);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PHYDATA0, 0xFF, (u8)val);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PHYDATA1, 0xFF, (u8)(val >> 8));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PHYADDR, 0xFF, addr);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PHYRWCTL, 0xFF, 0x81);
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	for (i = 0; i < 100000; i++) {
+		err = rtsx_pci_read_register(pdev, PHYRWCTL, &tmp);
+		if (err < 0)
+			return err;
+
+		if (!(tmp & 0x80)) {
+			finished = 1;
+			break;
+		}
+	}
+
+	if (!finished)
+		return -ETIMEDOUT;
+
+	return 0;
+}
+
+int rtsx_pci_read_phy_register(struct rtsx_pdev *pdev, u8 addr, u16 *val)
+{
+	int err, i, finished = 0;
+	u16 data = 0;
+	u8 *ptr, tmp;
+
+	rtsx_pci_init_cmd(pdev);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PHYADDR, 0xFF, addr);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PHYRWCTL, 0xFF, 0x80);
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	for (i = 0; i < 100000; i++) {
+		err = rtsx_pci_read_register(pdev, PHYRWCTL, &tmp);
+		if (err < 0)
+			return err;
+
+		if (!(tmp & 0x80)) {
+			finished = 1;
+			break;
+		}
+	}
+
+	if (!finished)
+		return -ETIMEDOUT;
+
+	rtsx_pci_init_cmd(pdev);
+
+	rtsx_pci_add_cmd(pdev, READ_REG_CMD, PHYDATA0, 0, 0);
+	rtsx_pci_add_cmd(pdev, READ_REG_CMD, PHYDATA1, 0, 0);
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	ptr = rtsx_pci_get_cmd_data(pdev);
+	data = ((u16)ptr[1] << 8) || ptr[0];
+
+	if (val)
+		*val = data;
+
+	return 0;
+}
+
+void rtsx_pci_stop_cmd(struct rtsx_pdev *pdev)
+{
+	rtsx_pci_writel(pdev, RTSX_HCBCTLR, STOP_CMD);
+	rtsx_pci_writel(pdev, RTSX_HDBCTLR, STOP_DMA);
+
+	rtsx_pci_write_register(pdev, DMACTL, 0x80, 0x80);
+	rtsx_pci_write_register(pdev, RBCTL, 0x80, 0x80);
+}
+
+void rtsx_pci_add_cmd(struct rtsx_pdev *pdev,
+		u8 cmd_type, u16 reg_addr, u8 mask, u8 data)
+{
+	unsigned long flags;
+	u32 *cb = (u32 *)(pdev->host_cmds_ptr);
+	u32 val = 0;
+
+	val |= (u32)(cmd_type & 0x03) << 30;
+	val |= (u32)(reg_addr & 0x3FFF) << 16;
+	val |= (u32)mask << 8;
+	val |= (u32)data;
+
+	spin_lock_irqsave(&pdev->lock, flags);
+	if (pdev->ci < (HOST_CMDS_BUF_LEN / 4))
+		cb[(pdev->ci)++] = cpu_to_le32(val);
+	spin_unlock_irqrestore(&pdev->lock, flags);
+}
+
+void rtsx_pci_send_cmd_no_wait(struct rtsx_pdev *pdev)
+{
+	u32 val = 1 << 31;
+
+	rtsx_pci_writel(pdev, RTSX_HCBAR, pdev->host_cmds_addr);
+
+	val |= (u32)(pdev->ci * 4) & 0x00FFFFFF;
+	/* Hardware Auto Response */
+	val |= 0x40000000;
+	rtsx_pci_writel(pdev, RTSX_HCBCTLR, val);
+}
+
+int rtsx_pci_send_cmd(struct rtsx_pdev *pdev, int timeout)
+{
+	struct completion trans_done;
+	u32 val = 1 << 31;
+	long timeleft;
+	unsigned long flags;
+	int err = 0;
+
+	spin_lock_irqsave(&pdev->lock, flags);
+
+	/* set up data structures for the wakeup system */
+	pdev->done = &trans_done;
+	pdev->trans_result = TRANS_NOT_READY;
+	init_completion(&trans_done);
+	pdev->trans_state = STATE_TRANS_CMD;
+
+	rtsx_pci_writel(pdev, RTSX_HCBAR, pdev->host_cmds_addr);
+
+	val |= (u32)(pdev->ci * 4) & 0x00FFFFFF;
+	/* Hardware Auto Response */
+	val |= 0x40000000;
+	rtsx_pci_writel(pdev, RTSX_HCBCTLR, val);
+
+	spin_unlock_irqrestore(&pdev->lock, flags);
+
+	/* Wait for TRANS_OK_INT */
+	timeleft = wait_for_completion_interruptible_timeout(
+			&trans_done, msecs_to_jiffies(timeout));
+	if (timeleft <= 0) {
+		pr_debug("pdev->int_reg = 0x%x\n", pdev->int_reg);
+		err = -ETIMEDOUT;
+		goto finish_send_cmd;
+	}
+
+	spin_lock_irqsave(&pdev->lock, flags);
+	if (pdev->trans_result == TRANS_RESULT_FAIL)
+		err = -EINVAL;
+	else if (pdev->trans_result == TRANS_RESULT_OK)
+		err = 0;
+	else if (pdev->trans_result == TRANS_NO_DEVICE)
+		err = -ENODEV;
+	spin_unlock_irqrestore(&pdev->lock, flags);
+
+finish_send_cmd:
+	spin_lock_irqsave(&pdev->lock, flags);
+	pdev->done = NULL;
+	pdev->trans_state = STATE_TRANS_NONE;
+	spin_unlock_irqrestore(&pdev->lock, flags);
+
+	if ((err < 0) && (err != -ENODEV))
+		rtsx_pci_stop_cmd(pdev);
+
+	if (pdev->finish_me)
+		complete(pdev->finish_me);
+
+	return err;
+}
+
+/**
+ * rtsx_pci_add_sg_tbl - add a sg entry to sg table.
+ * @pdev: Realtek's card reader pdev
+ * @addr: address of host DMA buffer to transfer data
+ * @len: buffer length in bytes
+ * @option: option
+ *
+ * Add a sg entry to sg table.
+ *
+ * Note: The length field is 20-bit long. So if the buffer length is
+ * longer than 0x80000, this function will divide the buffer into
+ * several small buffers to ensure the length field won't overflow.
+ */
+void rtsx_pci_add_sg_tbl(struct rtsx_pdev *pdev, u32 addr, u32 len, u8 option)
+{
+	u64 *sgb = (u64 *)(pdev->host_sg_tbl_ptr);
+	u64 val = 0;
+	u32 temp_len = 0;
+	u8  temp_opt = 0;
+
+	do {
+		if (len > 0x80000) {
+			temp_len = 0x80000;
+			temp_opt = option & (~SG_END);
+		} else {
+			temp_len = len;
+			temp_opt = option;
+		}
+		val = ((u64)addr << 32) | ((u64)temp_len << 12) | temp_opt;
+
+		if (pdev->sgi < (HOST_SG_TBL_BUF_LEN / 8))
+			sgb[(pdev->sgi)++] = cpu_to_le64(val);
+
+		len -= temp_len;
+		addr += temp_len;
+	} while (len);
+}
+
+/**
+ * rtsx_pci_transfer_sglist_adma - transfer sg list in adma mode
+ * @pdev: Realtek's card reader pdev
+ * @card: this command is relevant to card or not
+ * @sg: scatter-gather list
+ * @num_sg: entry count of sg list
+ * @dma_dir: transfer direction (DMA_FROM_DEVICE or DMA_TO_DEVICE)
+ * @timeout: time out in millisecond
+ *
+ * Transfer data in scatter-gather mode. In this mode,
+ * ADMA option will be turned on.
+ */
+static int rtsx_pci_transfer_sglist_adma(struct rtsx_pdev *pdev,
+		struct scatterlist *sg, int num_sg, int read, int timeout)
+{
+	struct completion trans_done;
+	u8 dir;
+	int buf_cnt, i;
+	int err = 0;
+	long timeleft;
+	unsigned long flags;
+	struct scatterlist *sg_ptr;
+	enum dma_data_direction dma_dir;
+
+	if ((sg == NULL) || (num_sg <= 0))
+		return -EINVAL;
+
+	if (read) {
+		dir = DEVICE_TO_HOST;
+		dma_dir = DMA_FROM_DEVICE;
+	} else {
+		dir = HOST_TO_DEVICE;
+		dma_dir = DMA_TO_DEVICE;
+	}
+
+	spin_lock_irqsave(&pdev->lock, flags);
+
+	/* set up data structures for the wakeup system */
+	pdev->done = &trans_done;
+	pdev->trans_state = STATE_TRANS_SG;
+	pdev->trans_result = TRANS_NOT_READY;
+
+	spin_unlock_irqrestore(&pdev->lock, flags);
+
+	buf_cnt = dma_map_sg(&(pdev->pci->dev), sg, num_sg, dma_dir);
+
+	sg_ptr = sg;
+	for (i = 0; i <= buf_cnt / (HOST_SG_TBL_BUF_LEN / 8); i++) {
+		u32 val = TRIG_DMA;
+		int sg_cnt, j;
+
+		if (i == buf_cnt / (HOST_SG_TBL_BUF_LEN / 8))
+			sg_cnt = buf_cnt % (HOST_SG_TBL_BUF_LEN / 8);
+		else
+			sg_cnt = (HOST_SG_TBL_BUF_LEN / 8);
+
+		pdev->sgi = 0;
+		for (j = 0; j < sg_cnt; j++) {
+			dma_addr_t addr = sg_dma_address(sg_ptr);
+			unsigned int len = sg_dma_len(sg_ptr);
+			u8 option;
+
+			pr_debug("DMA addr: 0x%x, Len: 0x%x\n",
+					(unsigned int)addr, len);
+
+			if (j == (sg_cnt - 1))
+				option = SG_VALID | SG_END | SG_TRANS_DATA;
+			else
+				option = SG_VALID | SG_TRANS_DATA;
+
+			rtsx_pci_add_sg_tbl(pdev, (u32)addr, (u32)len, option);
+			sg_ptr = sg_next(sg_ptr);
+		}
+
+		pr_debug("SG table count = %d\n", pdev->sgi);
+
+		val |= (u32)(dir & 0x01) << 29;
+		val |= ADMA_MODE;
+
+		spin_lock_irqsave(&pdev->lock, flags);
+
+		init_completion(&trans_done);
+
+		rtsx_pci_writel(pdev, RTSX_HDBAR, pdev->host_sg_tbl_addr);
+		rtsx_pci_writel(pdev, RTSX_HDBCTLR, val);
+
+		spin_unlock_irqrestore(&pdev->lock, flags);
+
+		timeleft = wait_for_completion_interruptible_timeout(
+				&trans_done, msecs_to_jiffies(timeout));
+		if (timeleft <= 0) {
+			pr_debug("Timeout (%s %d)\n", __func__, __LINE__);
+			pr_debug("pdev->int_reg = 0x%x\n", pdev->int_reg);
+			err = -ETIMEDOUT;
+			goto out;
+		}
+
+		spin_lock_irqsave(&pdev->lock, flags);
+		if (pdev->trans_result == TRANS_RESULT_FAIL) {
+			err = -EINVAL;
+			spin_unlock_irqrestore(&pdev->lock, flags);
+			goto out;
+		} else if (pdev->trans_result == TRANS_NO_DEVICE) {
+			err = -ENODEV;
+			spin_unlock_irqrestore(&pdev->lock, flags);
+			goto out;
+		}
+		spin_unlock_irqrestore(&pdev->lock, flags);
+
+		sg_ptr += sg_cnt;
+	}
+
+	/* Wait for TRANS_OK_INT */
+	spin_lock_irqsave(&pdev->lock, flags);
+	if (pdev->trans_result == TRANS_NOT_READY) {
+		init_completion(&trans_done);
+		spin_unlock_irqrestore(&pdev->lock, flags);
+		timeleft = wait_for_completion_interruptible_timeout(
+				&trans_done, msecs_to_jiffies(timeout));
+		if (timeleft <= 0) {
+			pr_debug("Timeout (%s %d)\n", __func__, __LINE__);
+			pr_debug("pdev->int_reg = 0x%x\n", pdev->int_reg);
+			err = -ETIMEDOUT;
+			goto out;
+		}
+	} else {
+		spin_unlock_irqrestore(&pdev->lock, flags);
+	}
+
+	spin_lock_irqsave(&pdev->lock, flags);
+	if (pdev->trans_result == TRANS_RESULT_FAIL)
+		err = -EINVAL;
+	else if (pdev->trans_result == TRANS_RESULT_OK)
+		err = 0;
+	else if (pdev->trans_result == TRANS_NO_DEVICE)
+		err = -ENODEV;
+	spin_unlock_irqrestore(&pdev->lock, flags);
+
+out:
+	spin_lock_irqsave(&pdev->lock, flags);
+	pdev->done = NULL;
+	pdev->trans_state = STATE_TRANS_NONE;
+	spin_unlock_irqrestore(&pdev->lock, flags);
+
+	dma_unmap_sg(&(pdev->pci->dev), sg, num_sg, dma_dir);
+
+	if ((err < 0) && (err != -ENODEV))
+		rtsx_pci_stop_cmd(pdev);
+
+	if (pdev->finish_me)
+		complete(pdev->finish_me);
+
+	return err;
+}
+
+/**
+ * rtsx_pci_transfer_buf - transfer data in linear buffer.
+ * @pdev: Realtek's card reader pdev
+ * @card: this command is relevant to card or not
+ * @buf: data buffer
+ * @len: buffer length
+ * @dma_dir: transfer direction (DMA_FROM_DEVICE or DMA_TO_DEVICE)
+ * @timeout: time out in millisecond
+ *
+ * Transfer data in linear buffer.
+ */
+static int rtsx_pci_transfer_buf(struct rtsx_pdev *pdev,
+		void *buf, size_t len, int read, int timeout)
+{
+	struct completion trans_done;
+	dma_addr_t addr;
+	u8 dir;
+	int err = 0;
+	u32 val = (1 << 31);
+	long timeleft;
+	unsigned long flags;
+	enum dma_data_direction dma_dir;
+
+	if ((buf == NULL) || (len <= 0))
+		return -EINVAL;
+
+	if (read) {
+		dir = DEVICE_TO_HOST;
+		dma_dir = DMA_FROM_DEVICE;
+	} else {
+		dir = HOST_TO_DEVICE;
+		dma_dir = DMA_TO_DEVICE;
+	}
+
+	addr = dma_map_single(&(pdev->pci->dev), buf, len, dma_dir);
+	if (!addr)
+		return -EINVAL;
+
+	val |= (u32)(dir & 0x01) << 29;
+	val |= (u32)(len & 0x00FFFFFF);
+
+	spin_lock_irqsave(&pdev->lock, flags);
+
+	/* set up data structures for the wakeup system */
+	pdev->done = &trans_done;
+
+	init_completion(&trans_done);
+
+	pdev->trans_state = STATE_TRANS_BUF;
+	pdev->trans_result = TRANS_NOT_READY;
+
+	rtsx_pci_writel(pdev, RTSX_HDBAR, addr);
+	rtsx_pci_writel(pdev, RTSX_HDBCTLR, val);
+
+	spin_unlock_irqrestore(&pdev->lock, flags);
+
+	/* Wait for TRANS_OK_INT */
+	timeleft = wait_for_completion_interruptible_timeout(&trans_done,
+			msecs_to_jiffies(timeout));
+	if (timeleft <= 0) {
+		pr_debug("Timeout (%s %d)\n", __func__, __LINE__);
+		pr_debug("pdev->int_reg = 0x%x\n", pdev->int_reg);
+		err = -ETIMEDOUT;
+		goto out;
+	}
+
+	spin_lock_irqsave(&pdev->lock, flags);
+	if (pdev->trans_result == TRANS_RESULT_FAIL)
+		err = -EINVAL;
+	else if (pdev->trans_result == TRANS_RESULT_OK)
+		err = 0;
+	else if (pdev->trans_result == TRANS_NO_DEVICE)
+		err = -ENODEV;
+	spin_unlock_irqrestore(&pdev->lock, flags);
+
+out:
+	spin_lock_irqsave(&pdev->lock, flags);
+	pdev->done = NULL;
+	pdev->trans_state = STATE_TRANS_NONE;
+	spin_unlock_irqrestore(&pdev->lock, flags);
+
+	dma_unmap_single(&(pdev->pci->dev), addr, len, dma_dir);
+
+	if ((err < 0) && (err != -ENODEV))
+		rtsx_pci_stop_cmd(pdev);
+
+	if (pdev->finish_me)
+		complete(pdev->finish_me);
+
+	return err;
+}
+
+int rtsx_pci_transfer_data(struct rtsx_pdev *pdev,
+		void *buf, size_t len, int use_sg, int read, int timeout)
+{
+	int err = 0;
+
+	pr_debug("use_sg = %d\n", use_sg);
+
+	/* don't transfer data during abort processing */
+	if (pdev->remove_pci)
+		return -EINVAL;
+
+	if (use_sg) {
+		err = rtsx_pci_transfer_sglist_adma(pdev,
+				(struct scatterlist *)buf, use_sg,
+				read, timeout);
+	} else {
+		err = rtsx_pci_transfer_buf(pdev, buf, len, read, timeout);
+	}
+
+	return err;
+}
+
+int rtsx_pci_read_ppbuf(struct rtsx_pdev *pdev, u8 *buf, int buf_len)
+{
+	int err;
+	int i, j;
+	u16 reg;
+	u8 *ptr;
+
+	BUG_ON(!buf || (buf_len <= 0));
+
+	ptr = buf;
+	reg = PPBUF_BASE2;
+	for (i = 0; i < buf_len / 256; i++) {
+		rtsx_pci_init_cmd(pdev);
+
+		for (j = 0; j < 256; j++)
+			rtsx_pci_add_cmd(pdev, READ_REG_CMD, reg++, 0, 0);
+
+		err = rtsx_pci_send_cmd(pdev, 250);
+		if (err < 0)
+			return err;
+
+		memcpy(ptr, rtsx_pci_get_cmd_data(pdev), 256);
+		ptr += 256;
+	}
+
+	if (buf_len % 256) {
+		rtsx_pci_init_cmd(pdev);
+
+		for (j = 0; j < buf_len % 256; j++)
+			rtsx_pci_add_cmd(pdev, READ_REG_CMD, reg++, 0, 0);
+
+		err = rtsx_pci_send_cmd(pdev, 250);
+		if (err < 0)
+			return err;
+	}
+
+	memcpy(ptr, rtsx_pci_get_cmd_data(pdev), buf_len % 256);
+
+	return 0;
+}
+
+int rtsx_pci_write_ppbuf(struct rtsx_pdev *pdev, u8 *buf, int buf_len)
+{
+	int err;
+	int i, j;
+	u16 reg;
+	u8 *ptr;
+
+	BUG_ON(!buf || (buf_len <= 0));
+
+	ptr = buf;
+	reg = PPBUF_BASE2;
+	for (i = 0; i < buf_len / 256; i++) {
+		rtsx_pci_init_cmd(pdev);
+
+		for (j = 0; j < 256; j++) {
+			rtsx_pci_add_cmd(pdev, WRITE_REG_CMD,
+					reg++, 0xFF, *ptr);
+			ptr++;
+		}
+
+		err = rtsx_pci_send_cmd(pdev, 250);
+		if (err < 0)
+			return err;
+	}
+
+	if (buf_len % 256) {
+		rtsx_pci_init_cmd(pdev);
+
+		for (j = 0; j < buf_len % 256; j++) {
+			rtsx_pci_add_cmd(pdev, WRITE_REG_CMD,
+					reg++, 0xFF, *ptr);
+			ptr++;
+		}
+
+		err = rtsx_pci_send_cmd(pdev, 250);
+		if (err < 0)
+			return err;
+	}
+
+	return 0;
+}
+
+static void rtsx_pci_enable_bus_int(struct rtsx_pdev *pdev)
+{
+	u32 reg = 0;
+
+	reg = TRANS_OK_INT_EN | TRANS_FAIL_INT_EN;
+
+	reg |= SD_INT_EN;
+
+	if (pdev->ic_version >= IC_VER_C)
+		reg |= DELINK_INT_EN;
+
+#ifdef SUPPORT_OCP
+	reg |= SD_OC_INT_EN;
+#endif
+	if (!pdev->adma_mode)
+		reg |= DATA_DONE_INT_EN;
+
+	/* Enable Bus Interrupt */
+	rtsx_pci_writel(pdev, RTSX_BIER, reg);
+
+	pr_debug("RTSX_BIER: 0x%08x\n", reg);
+}
+
+static inline u8 double_depth(u8 depth)
+{
+	return ((depth > 1) ? (depth - 1) : depth);
+}
+
+static u8 revise_ssc_depth(u8 ssc_depth, u8 div)
+{
+	if (div > CLK_DIV_1) {
+		if (ssc_depth > (div - 1))
+			ssc_depth -= (div - 1);
+		else
+			ssc_depth = SSC_DEPTH_4M;
+	}
+
+	return ssc_depth;
+}
+
+static int switch_ssc_clock(struct rtsx_pdev *pdev, unsigned int card_clock,
+		u8 ssc_depth, int double_clk, int vpclk)
+{
+	struct sd_info *sd_card = &(pdev->sd_card);
+	int err, clk;
+	u8 N, min_N, max_N, clk_divider;
+	u8 mcu_cnt, div, max_div;
+	u8 depth[] = {
+		[RTSX_SSC_DEPTH_4M] = SSC_DEPTH_4M,
+		[RTSX_SSC_DEPTH_2M] = SSC_DEPTH_2M,
+		[RTSX_SSC_DEPTH_1M] = SSC_DEPTH_1M,
+		[RTSX_SSC_DEPTH_500K] = SSC_DEPTH_500K,
+		[RTSX_SSC_DEPTH_250K] = SSC_DEPTH_250K,
+	};
+
+	if (card_clock <= 1000000) {
+		/* We use 250k(around) here, in initial stage */
+		clk_divider = SD_CLK_DIVIDE_128;
+		card_clock = 30000000;
+		sd_card->initial_mode = 1;
+	} else {
+		clk_divider = SD_CLK_DIVIDE_0;
+		sd_card->initial_mode = 0;
+	}
+	err = rtsx_pci_write_register(pdev, SD_CFG1,
+			SD_CLK_DIVIDE_MASK, clk_divider);
+	if (err < 0)
+		return err;
+
+	card_clock /= 1000000;
+	pr_debug("Switch card clock to %dMHz\n", card_clock);
+
+	min_N = 80;
+	max_N = 208;
+	max_div = CLK_DIV_8;
+
+	clk = card_clock;
+	if (!sd_card->initial_mode && double_clk)
+		clk = card_clock * 2;
+	pr_debug("Internal SSC clock: %dMHz\n", clk);
+
+	N = (u8)(clk - 2);
+	if ((clk <= 2) || (N > max_N))
+		return -EINVAL;
+
+	mcu_cnt = (u8)(125/clk + 3);
+	if (mcu_cnt > 15)
+		mcu_cnt = 15;
+
+	/* Make sure that the SSC clock div_n is equal or greater than min_N */
+	div = CLK_DIV_1;
+	while ((N < min_N) && (div < max_div)) {
+		N = (N + 2) * 2 - 2;
+		div++;
+	}
+	pr_debug("N = %d, div = %d\n", N, div);
+
+	ssc_depth = depth[ssc_depth];
+	if (double_clk)
+		ssc_depth = double_depth(ssc_depth);
+
+	ssc_depth = revise_ssc_depth(ssc_depth, div);
+	pr_debug("ssc_depth = %d\n", ssc_depth);
+
+	rtsx_pci_init_cmd(pdev);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL,
+			CLK_LOW_FREQ, CLK_LOW_FREQ);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_DIV,
+			0xFF, (div << 4) | mcu_cnt);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SSC_CTL1, SSC_RSTB, 0);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SSC_CTL2,
+			SSC_DEPTH_MASK, ssc_depth);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SSC_DIV_N_0, 0xFF, N);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SSC_CTL1, SSC_RSTB, SSC_RSTB);
+	if (vpclk) {
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_VPCLK0_CTL,
+				PHASE_NOT_RESET, 0);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_VPCLK0_CTL,
+				PHASE_NOT_RESET, PHASE_NOT_RESET);
+	}
+
+	err = rtsx_pci_send_cmd(pdev, 2000);
+	if (err < 0)
+		return err;
+
+	udelay(10);
+	err = rtsx_pci_write_register(pdev, CLK_CTL, CLK_LOW_FREQ, 0);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+static irqreturn_t rtsx_pci_isr(int irq, void *dev_id)
+{
+	struct rtsx_pdev *pdev = dev_id;
+	u32 int_enable, int_reg;
+
+	if (!pdev)
+		return IRQ_NONE;
+
+	spin_lock(&pdev->lock);
+
+	int_enable = rtsx_pci_readl(pdev, RTSX_BIER);
+	int_reg = rtsx_pci_readl(pdev, RTSX_BIPR);
+	/* Clear interrupt flag */
+	rtsx_pci_writel(pdev, RTSX_BIPR, int_reg);
+	if ((int_reg & int_enable) == 0) {
+		spin_unlock(&pdev->lock);
+		return IRQ_NONE;
+	}
+	if (int_reg == 0xFFFFFFFF) {
+		spin_unlock(&pdev->lock);
+		return IRQ_HANDLED;
+	}
+
+	int_reg &= (int_enable | 0x7FFFFF);
+
+	if (int_reg & SD_INT) {
+		if (int_reg & SD_EXIST) {
+			pdev->need_reset |= SD_EXIST;
+		} else {
+			pdev->need_release |= SD_EXIST;
+			pdev->need_reset &= ~SD_EXIST;
+		}
+	}
+
+	if (pdev->need_reset || pdev->need_release)
+		rtsx_queue_delayed_work(&pdev->carddet_work,
+				msecs_to_jiffies(200));
+
+	if (int_reg & (NEED_COMPLETE_INT | DELINK_INT)) {
+		if (int_reg & (TRANS_FAIL_INT | DELINK_INT)) {
+			pdev->trans_result = TRANS_RESULT_FAIL;
+			if (pdev->done)
+				complete(pdev->done);
+		} else if (int_reg & TRANS_OK_INT) {
+			pdev->trans_result = TRANS_RESULT_OK;
+			if (pdev->done)
+				complete(pdev->done);
+		} else if (int_reg & DATA_DONE_INT) {
+			pdev->trans_result = TRANS_NOT_READY;
+			if (pdev->done && (pdev->trans_state == STATE_TRANS_SG))
+				complete(pdev->done);
+		}
+	}
+
+	spin_unlock(&pdev->lock);
+	return IRQ_HANDLED;
+}
+
+static int rtsx_pci_acquire_irq(struct rtsx_pdev *pdev)
+{
+	pr_info("%s: pdev->msi_en = %d, pci->irq = %d\n",
+			__func__, pdev->msi_en, pdev->pci->irq);
+
+	if (request_irq(pdev->pci->irq, rtsx_pci_isr,
+			pdev->msi_en ? 0 : IRQF_SHARED,
+			DRV_NAME, pdev)) {
+		pr_err("rtsx_sdmmc: unable to grab IRQ %d, disabling device\n",
+				pdev->pci->irq);
+		return -1;
+	}
+
+	pdev->irq = pdev->pci->irq;
+	pci_intx(pdev->pci, !pdev->msi_en);
+
+	return 0;
+}
+
+static unsigned char get_card_type(u32 card_status)
+{
+	unsigned char type = 0;
+
+	switch (card_status) {
+	case XD_EXIST:
+		type = RTSX_TYPE_XD;
+		break;
+
+	case MS_EXIST:
+		type = RTSX_TYPE_MS;
+		break;
+
+	case SD_EXIST:
+		type = RTSX_TYPE_SD;
+		break;
+
+	default:
+		type = 0;
+		break;
+	}
+
+	return type;
+}
+
+static u32 get_card_status(unsigned char type)
+{
+	u32 card_status = 0;
+
+	switch (type) {
+	case RTSX_TYPE_XD:
+		card_status = XD_EXIST;
+		break;
+
+	case RTSX_TYPE_MS:
+		card_status = MS_EXIST;
+		break;
+
+	case RTSX_TYPE_SD:
+		card_status = SD_EXIST;
+		break;
+
+	default:
+		card_status = 0;
+		break;
+	}
+
+	return card_status;
+}
+
+static int find_empty_socket(struct rtsx_adapter *adapter)
+{
+	int i;
+	int sock_id = -1;
+
+	for (i = 0; i < adapter->num_sockets; i++) {
+		if (!adapter->sockets[i]) {
+			sock_id = i;
+			break;
+		}
+	}
+
+	return sock_id;
+}
+
+static void rtsx_pci_card_detect(struct work_struct *work)
+{
+	struct delayed_work *dwork;
+	struct rtsx_pdev *pdev;
+	struct rtsx_adapter *adapter;
+	struct rtsx_dev *sock;
+	int err, i;
+	unsigned long flags;
+	u32 irq_status;
+
+	pr_debug("--> %s\n", __func__);
+
+	dwork = to_delayed_work(work);
+	pdev = container_of(dwork, struct rtsx_pdev, carddet_work);
+
+	spin_lock_irqsave(&pdev->lock, flags);
+
+	adapter = pdev->adapter;
+
+	irq_status = rtsx_pci_readl(pdev, RTSX_BIPR);
+	pr_debug("irq_status: 0x%08x\n", irq_status);
+
+	if (pdev->need_release) {
+		/* Card unplugged, unregister device */
+		u32 need_release = pdev->need_release;
+
+		for (i = 0; i < adapter->num_sockets; i++) {
+			u32 card_status;
+
+			sock = adapter->sockets[i];
+			if (!sock)
+				continue;
+
+			card_status = get_card_status(sock->type);
+
+			if (!(need_release & card_status))
+				continue;
+
+			pdev->need_release &= ~card_status;
+
+			if (!(irq_status & card_status)) {
+				adapter->sockets[i] = NULL;
+				spin_unlock_irqrestore(&pdev->lock, flags);
+				device_unregister(&sock->dev);
+				spin_lock_irqsave(&pdev->lock, flags);
+			}
+
+		}
+	}
+
+	if (pdev->need_reset) {
+		/* Card inserted, register device */
+		u32 need_reset;
+		u32 card_status[] = {XD_EXIST, MS_EXIST, SD_EXIST};
+		int id;
+
+		pdev->need_reset &= irq_status;
+		if (pdev->need_reset == 0)
+			goto out;
+		need_reset = pdev->need_reset;
+
+		for (i = 0; i < sizeof(card_status)/sizeof(u32); i++) {
+			if (need_reset & card_status[i]) {
+				id = find_empty_socket(adapter);
+				if (id < 0) {
+					pr_err("No empty socket left!\n");
+					goto out;
+				}
+			} else {
+				continue;
+			}
+
+			pdev->need_reset &= ~card_status[i];
+
+			spin_unlock_irqrestore(&pdev->lock, flags);
+			sock = rtsx_alloc_device(adapter, 0,
+					get_card_type(card_status[i]));
+			if (sock) {
+				err = device_register(&sock->dev);
+				if (!err)
+					adapter->sockets[id] = sock;
+				else
+					rtsx_free_device(&sock->dev);
+			}
+			spin_lock_irqsave(&pdev->lock, flags);
+		}
+	}
+
+out:
+	spin_unlock_irqrestore(&pdev->lock, flags);
+}
+
+static void rtsx_pci_enter_idle(struct work_struct *work)
+{
+	struct delayed_work *dwork;
+	struct rtsx_pdev *pdev;
+
+	pr_debug("--> %s\n", __func__);
+
+	dwork = to_delayed_work(work);
+	pdev = container_of(dwork, struct rtsx_pdev, idle_work);
+
+	mutex_lock(&pdev->pdev_mutex);
+
+	pdev->state = PDEV_STAT_IDLE;
+
+	pdev->ops.disable_auto_blink(pdev);
+	pdev->ops.turn_off_led(pdev);
+
+	mutex_unlock(&pdev->pdev_mutex);
+}
+
+static void rtsx_pci_init_options(struct rtsx_pdev *pdev)
+{
+	pdev->msi_en = msi_en;
+	pdev->adma_mode = adma_mode;
+}
+
+static int rtsx_pci_extra_init_hw(struct rtsx_pdev *pdev)
+{
+	pr_warn("%s\n", __func__);
+	return 0;
+}
+
+static int rtsx_pci_optimize_phy(struct rtsx_pdev *pdev)
+{
+	pr_warn("%s\n", __func__);
+	return 0;
+}
+
+static void rtsx_pci_turn_on_led(struct rtsx_pdev *pdev)
+{
+	pr_warn("%s\n", __func__);
+}
+
+static void rtsx_pci_turn_off_led(struct rtsx_pdev *pdev)
+{
+	pr_warn("%s\n", __func__);
+}
+
+static void rtsx_pci_enable_auto_blink(struct rtsx_pdev *pdev)
+{
+	pr_warn("%s\n", __func__);
+}
+
+static void rtsx_pci_disable_auto_blink(struct rtsx_pdev *pdev)
+{
+	pr_warn("%s\n", __func__);
+}
+
+static void rtsx_pci_init_ops(struct rtsx_pdev *pdev)
+{
+	switch (PCI_PID(pdev)) {
+	case 0x5209:
+		pr_info("Initialize 0x5209\n");
+		pdev->ops.extra_init_hw = rts5209_extra_init_hw;
+		pdev->ops.optimize_phy = rts5209_optimize_phy;
+		pdev->ops.turn_on_led = rts5209_turn_on_led;
+		pdev->ops.turn_off_led = rts5209_turn_off_led;
+		pdev->ops.enable_auto_blink = rts5209_enable_auto_blink;
+		pdev->ops.disable_auto_blink = rts5209_disable_auto_blink;
+		break;
+
+	case 0x5229:
+		pr_info("Initialize 0x5229\n");
+		pdev->ops.extra_init_hw = rts5229_extra_init_hw;
+		pdev->ops.optimize_phy = rts5229_optimize_phy;
+		pdev->ops.turn_on_led = rts5229_turn_on_led;
+		pdev->ops.turn_off_led = rts5229_turn_off_led;
+		pdev->ops.enable_auto_blink = rts5229_enable_auto_blink;
+		pdev->ops.disable_auto_blink = rts5229_disable_auto_blink;
+		break;
+
+	default:
+		pr_warn("Initialize dummy ops\n");
+		pdev->ops.extra_init_hw = rtsx_pci_extra_init_hw;
+		pdev->ops.optimize_phy = rtsx_pci_optimize_phy;
+		pdev->ops.turn_on_led = rtsx_pci_turn_on_led;
+		pdev->ops.turn_off_led = rtsx_pci_turn_off_led;
+		pdev->ops.enable_auto_blink = rtsx_pci_enable_auto_blink;
+		pdev->ops.disable_auto_blink = rtsx_pci_disable_auto_blink;
+	}
+}
+
+static int rtsx_pci_init_hw(struct rtsx_pdev *pdev)
+{
+	int err;
+
+	rtsx_pci_writel(pdev, RTSX_HCBAR, pdev->host_cmds_addr);
+
+	rtsx_pci_enable_bus_int(pdev);
+
+	/* Power on SSC */
+	err = rtsx_pci_write_register(pdev, FPDCTL, SSC_POWER_DOWN, 0);
+	if (err < 0)
+		return err;
+
+	udelay(200);
+
+	err = pdev->ops.optimize_phy(pdev);
+	if (err < 0)
+		return err;
+
+	rtsx_pci_init_cmd(pdev);
+
+	/* Set mcu_cnt to 7 to ensure data can be sampled properly */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_DIV, 0x07, 0x07);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, HOST_SLEEP_STATE, 0x03, 0x00);
+	/* Disable card clock */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_CLK_EN, 0x1E, 0);
+	/* Reset ASPM state to default value */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, ASPM_FORCE_CTL, 0x3F, 0);
+	/* Card driving select */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD,
+			SD30_DRIVE_SEL, 0x07, DRIVER_TYPE_D);
+	/* Enlarge the estimation window of PERST# glitch
+	 * to reduce the chance of invalid card interrupt
+	 */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PERST_GLITCH_WIDTH, 0xFF, 0x80);
+	/* Update RC oscillator to 400k
+	 * bit[0] F_HIGH: for RC oscillator, Rst_value is 1'b1
+	 *                1: 2M  0: 400k
+	 */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, RCCTL, 0x01, 0x00);
+	/* Set interrupt write clear
+	 * bit 1: U_elbi_if_rd_clr_en
+	 *	1: Enable ELBI interrupt[31:22] & [7:0] flag read clear
+	 *	0: ELBI interrupt flag[31:22] & [7:0] only can be write clear
+	 */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, NFTS_TX_CTRL, 0x02, 0);
+	/* Force CLKREQ# PIN to drive 0 to request clock */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PETXCFG, 0x08, 0x08);
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	err = pdev->ops.extra_init_hw(pdev);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+static void rtsx_pci_init_chip(struct rtsx_pdev *pdev)
+{
+	struct rtsx_adapter *adapter = pdev->adapter;
+	u32 irq_status;
+
+	spin_lock_init(&pdev->lock);
+	mutex_init(&pdev->pdev_mutex);
+
+	if (CHK_PCI_PID(pdev, 0x5209)) {
+		adapter->extra_caps = EXTRA_CAPS_SD_SDR50 |
+			EXTRA_CAPS_SD_SDR104 | EXTRA_CAPS_MMC_8BIT;
+	} else if (CHK_PCI_PID(pdev, 0x5229)) {
+		adapter->extra_caps = EXTRA_CAPS_SD_SDR50 |
+			EXTRA_CAPS_SD_SDR104;
+	}
+
+	rtsx_pci_init_ops(pdev);
+
+	rtsx_pci_init_hw(pdev);
+
+	pdev->state = PDEV_STAT_IDLE;
+
+	irq_status = rtsx_pci_readl(pdev, RTSX_BIPR);
+	/* Clear interrupt flag */
+	rtsx_pci_writel(pdev, RTSX_BIPR, irq_status);
+	if (irq_status & SD_EXIST)
+		pdev->need_reset |= SD_EXIST;
+
+	if (pdev->need_reset)
+		rtsx_queue_delayed_work(&pdev->carddet_work, 0);
+}
+
+static int rtsx_pci_switch_clock(struct rtsx_adapter *adapter,
+		unsigned int card_clock, u8 ssc_depth,
+		int double_clk, int vpclk)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int err;
+
+	mutex_lock(&pdev->pdev_mutex);
+	err = switch_ssc_clock(pdev, card_clock, ssc_depth, double_clk, vpclk);
+	mutex_unlock(&pdev->pdev_mutex);
+	return err;
+}
+
+static void rtsx_pci_complete_unfinished_transfer(struct rtsx_adapter *adapter)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	struct completion finish;
+
+	pdev->finish_me = &finish;
+	init_completion(&finish);
+
+	if (pdev->done)
+		complete(pdev->done);
+
+	if (!pdev->remove_pci)
+		rtsx_pci_stop_cmd(pdev);
+
+	wait_for_completion_interruptible_timeout(&finish,
+			msecs_to_jiffies(2));
+	pdev->finish_me = NULL;
+}
+
+static int __devinit rtsx_pci_probe(struct pci_dev *pcidev,
+				    const struct pci_device_id *id)
+{
+	struct rtsx_pdev *pdev;
+	struct rtsx_adapter *adapter;
+	u32 base, len;
+	int ret;
+
+	pr_info(DRV_NAME
+		": Realtek PCI-E Card Reader found at %s [%04x:%04x] (rev %x)\n",
+		pci_name(pcidev), (int)pcidev->vendor, (int)pcidev->device,
+		(int)pcidev->revision);
+
+	ret = pci_enable_device(pcidev);
+	if (ret)
+		return ret;
+
+	ret = pci_request_regions(pcidev, DRV_NAME);
+	if (ret)
+		goto disable;
+
+	pdev = kzalloc(sizeof(struct rtsx_pdev), GFP_KERNEL);
+	if (!pdev) {
+		ret = -ENOMEM;
+		goto release_pci;
+	}
+
+	adapter = rtsx_alloc_adapter(1, &pcidev->dev);
+	if (!adapter) {
+		ret = -ENOMEM;
+		goto release_pdev;
+	}
+
+	pdev->pci = pcidev;
+	dev_set_drvdata(&pcidev->dev, pdev);
+
+	len = pci_resource_len(pcidev, 0);
+	base = pci_resource_start(pcidev, 0);
+	pdev->remap_addr = ioremap_nocache(base, len);
+	if (!pdev->remap_addr) {
+		ret = -ENOMEM;
+		goto free_host;
+	}
+
+	pdev->rtsx_resv_buf = dma_alloc_coherent(&(pcidev->dev),
+			RTSX_RESV_BUF_LEN, &(pdev->rtsx_resv_buf_addr),
+			GFP_KERNEL);
+	if (pdev->rtsx_resv_buf == NULL) {
+		ret = -ENXIO;
+		goto unmap;
+	}
+	pdev->host_cmds_ptr = pdev->rtsx_resv_buf;
+	pdev->host_cmds_addr = pdev->rtsx_resv_buf_addr;
+	pdev->host_sg_tbl_ptr = pdev->rtsx_resv_buf + HOST_CMDS_BUF_LEN;
+	pdev->host_sg_tbl_addr = pdev->rtsx_resv_buf_addr + HOST_CMDS_BUF_LEN;
+	pdev->adapter = adapter;
+
+	rtsx_pci_init_options(pdev);
+
+	adapter->switch_clock = rtsx_pci_switch_clock;
+	adapter->complete_unfinished_transfer =
+		rtsx_pci_complete_unfinished_transfer;
+	rtsx_pci_init_sdmmc_callback(adapter);
+
+	pdev->need_reset = 0;
+	pdev->need_release = 0;
+	INIT_DELAYED_WORK(&pdev->carddet_work, rtsx_pci_card_detect);
+	INIT_DELAYED_WORK(&pdev->idle_work, rtsx_pci_enter_idle);
+
+	if (pdev->msi_en) {
+		ret = pci_enable_msi(pcidev);
+		if (ret < 0)
+			pdev->msi_en = 0;
+	}
+
+	ret = rtsx_pci_acquire_irq(pdev);
+	if (ret < 0) {
+		ret = -EIO;
+		goto free_dma;
+	}
+
+	pci_set_master(pcidev);
+	synchronize_irq(pdev->irq);
+
+	ret = rtsx_add_adapter(adapter);
+	if (ret)
+		goto disable_irq;
+
+	rtsx_pci_init_chip(pdev);
+
+	return 0;
+
+disable_irq:
+	free_irq(pdev->irq, (void *)pdev);
+free_dma:
+	dma_free_coherent(&(pdev->pci->dev), RTSX_RESV_BUF_LEN,
+			pdev->rtsx_resv_buf, pdev->rtsx_resv_buf_addr);
+unmap:
+	iounmap(pdev->remap_addr);
+free_host:
+	dev_set_drvdata(&pcidev->dev, NULL);
+	kfree(adapter);
+release_pdev:
+	kfree(pdev);
+release_pci:
+	pci_release_regions(pcidev);
+disable:
+	pci_disable_device(pcidev);
+
+	return ret;
+}
+
+static void __devexit rtsx_pci_remove(struct pci_dev *pcidev)
+{
+	struct rtsx_pdev *pdev = pci_get_drvdata(pcidev);
+
+	pdev->remove_pci = 1;
+
+	cancel_delayed_work(&pdev->carddet_work);
+	cancel_delayed_work(&pdev->idle_work);
+	rtsx_remove_adapter(pdev->adapter);
+
+	dma_free_coherent(&(pdev->pci->dev), RTSX_RESV_BUF_LEN,
+			pdev->rtsx_resv_buf, pdev->rtsx_resv_buf_addr);
+	free_irq(pdev->irq, (void *)pdev);
+	if (pdev->msi_en)
+		pci_disable_msi(pdev->pci);
+	iounmap(pdev->remap_addr);
+
+	dev_set_drvdata(&pcidev->dev, NULL);
+	pci_release_regions(pcidev);
+	pci_disable_device(pcidev);
+	rtsx_free_adapter(pdev->adapter);
+
+	pr_info(DRV_NAME
+		": Realtek PCI-E Card Reader at %s [%04x:%04x] has been removed\n",
+		pci_name(pcidev), (int)pcidev->vendor, (int)pcidev->device);
+}
+
+#ifdef CONFIG_PM
+
+static int rtsx_pci_suspend(struct pci_dev *pcidev, pm_message_t state)
+{
+	struct rtsx_pdev *pdev;
+	int ret = 0;
+
+	pdev = pci_get_drvdata(pcidev);
+
+	pci_save_state(pcidev);
+	pci_enable_wake(pcidev, pci_choose_state(pcidev, state), 0);
+	pci_disable_device(pcidev);
+	pci_set_power_state(pcidev, pci_choose_state(pcidev, state));
+
+	return ret;
+}
+
+static int rtsx_pci_resume(struct pci_dev *pcidev)
+{
+	struct rtsx_pdev *pdev;
+	int ret = 0;
+
+	pdev = pci_get_drvdata(pcidev);
+
+	pci_set_power_state(pcidev, PCI_D0);
+	pci_restore_state(pcidev);
+	ret = pci_enable_device(pcidev);
+	if (ret)
+		return ret;
+
+	return ret;
+}
+
+#else /* CONFIG_PM */
+
+#define rtsx_pci_suspend NULL
+#define rtsx_pci_resume NULL
+
+#endif /* CONFIG_PM */
+
+static struct pci_driver rtsx_pci_driver = {
+	.name = DRV_NAME,
+	.id_table = rtsx_pci_ids,
+	.probe = rtsx_pci_probe,
+	.remove = __devexit_p(rtsx_pci_remove),
+	.suspend = rtsx_pci_suspend,
+	.resume = rtsx_pci_resume,
+};
+
+static int __init rtsx_pci_drv_init(void)
+{
+	pr_info(DRV_NAME ": Realtek PCI-E Card Reader adapter driver\n");
+
+	return pci_register_driver(&rtsx_pci_driver);
+}
+
+static void __exit rtsx_pci_drv_exit(void)
+{
+	pci_unregister_driver(&rtsx_pci_driver);
+}
+
+module_init(rtsx_pci_drv_init);
+module_exit(rtsx_pci_drv_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Realtek Corp.");
+MODULE_DESCRIPTION("Realtek PCI-E Card Reader Adapter Driver");
diff --git a/drivers/misc/realtek_cr/pci/rtsx_pci.h b/drivers/misc/realtek_cr/pci/rtsx_pci.h
new file mode 100644
index 0000000..0735fab
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/rtsx_pci.h
@@ -0,0 +1,684 @@
+/* Driver for Realtek PCI-Express card reader
+ *
+ * Copyright(c) 2009 Realtek Semiconductor Corp. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2, or (at your option) any
+ * later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, see <http://www.gnu.org/licenses/>.
+ *
+ * Author:
+ *   Wei WANG <wei_wang@xxxxxxxxxxxxxx>
+ *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China
+ */
+
+#ifndef __RTSX_PCI_H
+#define __RTSX_PCI_H
+
+#include <linux/sched.h>
+#include <linux/pci.h>
+
+#define DRV_NAME	"rtsx_pci"
+
+#define MAX_RW_REG_CNT			1024
+
+#define RTSX_MAX_BLOCK_COUNT		65536
+#define RTSX_MAX_BLOCK_LENGTH		2048
+
+/* PCI Operation Register Address */
+#define RTSX_HCBAR			0x00
+#define RTSX_HCBCTLR			0x04
+#define RTSX_HDBAR			0x08
+#define RTSX_HDBCTLR			0x0C
+#define RTSX_HAIMR			0x10
+#define RTSX_BIPR			0x14
+#define RTSX_BIER			0x18
+
+/* Host command buffer control register */
+#define STOP_CMD			(0x01 << 28)
+
+/* Host data buffer control register */
+#define SDMA_MODE			0x00
+#define ADMA_MODE			(0x02 << 26)
+#define STOP_DMA			(0x01 << 28)
+#define TRIG_DMA			(0x01 << 31)
+
+/* Bus interrupt pending register */
+#define CMD_DONE_INT			(1 << 31)
+#define DATA_DONE_INT			(1 << 30)
+#define TRANS_OK_INT			(1 << 29)
+#define TRANS_FAIL_INT			(1 << 28)
+#define XD_INT				(1 << 27)
+#define MS_INT				(1 << 26)
+#define SD_INT				(1 << 25)
+#define GPIO0_INT			(1 << 24)
+#define OC_INT				(1 << 23)
+#define SD_WRITE_PROTECT		(1 << 19)
+#define XD_EXIST			(1 << 18)
+#define MS_EXIST			(1 << 17)
+#define SD_EXIST			(1 << 16)
+#define DELINK_INT			GPIO0_INT
+#define MS_OC_INT			(1 << 23)
+#define SD_OC_INT			(1 << 22)
+
+#define CARD_INT		(XD_INT | MS_INT | SD_INT)
+#define NEED_COMPLETE_INT	(DATA_DONE_INT | TRANS_OK_INT | TRANS_FAIL_INT)
+#define RTSX_INT		(CMD_DONE_INT | NEED_COMPLETE_INT | \
+					CARD_INT | GPIO0_INT | OC_INT)
+
+#define CARD_EXIST		(XD_EXIST | MS_EXIST | SD_EXIST)
+
+/* Bus interrupt enable register */
+#define CMD_DONE_INT_EN		(1 << 31)
+#define DATA_DONE_INT_EN	(1 << 30)
+#define TRANS_OK_INT_EN		(1 << 29)
+#define TRANS_FAIL_INT_EN	(1 << 28)
+#define XD_INT_EN		(1 << 27)
+#define MS_INT_EN		(1 << 26)
+#define SD_INT_EN		(1 << 25)
+#define GPIO0_INT_EN		(1 << 24)
+#define OC_INT_EN		(1 << 23)
+#define DELINK_INT_EN		GPIO0_INT_EN
+#define MS_OC_INT_EN		(1 << 23)
+#define SD_OC_INT_EN		(1 << 22)
+
+#define READ_REG_CMD		0
+#define WRITE_REG_CMD		1
+#define CHECK_REG_CMD		2
+
+/*
+ * macros for easy use
+ */
+#define rtsx_pci_writel(pdev, reg, value) \
+	iowrite32(value, (pdev)->remap_addr + reg)
+#define rtsx_pci_readl(pdev, reg) \
+	ioread32((pdev)->remap_addr + reg)
+#define rtsx_pci_writew(pdev, reg, value) \
+	iowrite16(value, (pdev)->remap_addr + reg)
+#define rtsx_pci_readw(pdev, reg) \
+	ioread16((pdev)->remap_addr + reg)
+#define rtsx_pci_writeb(pdev, reg, value) \
+	iowrite8(value, (pdev)->remap_addr + reg)
+#define rtsx_pci_readb(pdev, reg) \
+	ioread8((pdev)->remap_addr + reg)
+
+#define rtsx_pci_read_config_byte(pdev, where, val) \
+	pci_read_config_byte((pdev)->pci, where, val)
+
+#define rtsx_pci_write_config_byte(pdev, where, val) \
+	pci_write_config_byte((pdev)->pci, where, val)
+
+#define rtsx_pci_read_config_dword(pdev, where, val) \
+	pci_read_config_dword((pdev)->pci, where, val)
+
+#define rtsx_pci_write_config_dword(pdev, where, val) \
+	pci_write_config_dword((pdev)->pci, where, val)
+
+#define STATE_TRANS_NONE	0
+#define STATE_TRANS_CMD		1
+#define STATE_TRANS_BUF		2
+#define STATE_TRANS_SG		3
+
+#define TRANS_NOT_READY		0
+#define TRANS_RESULT_OK		1
+#define TRANS_RESULT_FAIL	2
+#define TRANS_NO_DEVICE		3
+
+#define RTSX_RESV_BUF_LEN	4096
+#define HOST_CMDS_BUF_LEN	1024
+#define HOST_SG_TBL_BUF_LEN	(RTSX_RESV_BUF_LEN - HOST_CMDS_BUF_LEN)
+
+#define HOST_TO_DEVICE		0
+#define DEVICE_TO_HOST		1
+
+#define MAX_PHASE		31
+#define RX_TUNING_CNT		3
+
+/* SG descriptor */
+#define SG_INT			0x04
+#define SG_END			0x02
+#define SG_VALID		0x01
+
+#define SG_NO_OP		0x00
+#define SG_TRANS_DATA		(0x02 << 4)
+#define SG_LINK_DESC		(0x03 << 4)
+
+/* SD bank voltage */
+#define SD_IO_3V3		0
+#define SD_IO_1V8		1
+
+
+/* Card Clock Enable Register */
+#define SD_CLK_EN			0x04
+
+/* Card Select Register */
+#define SD_MOD_SEL			2
+
+/* Card Output Enable Register */
+#define SD_OUTPUT_EN			0x04
+
+/* CARD_SHARE_MODE */
+#define CARD_SHARE_MASK			0x0F
+#define CARD_SHARE_MULTI_LUN		0x00
+#define	CARD_SHARE_NORMAL		0x00
+#define	CARD_SHARE_48_SD		0x04
+/* CARD_SHARE_MODE for barossa */
+#define CARD_SHARE_BAROSSA_SD		0x01
+
+/* SD30_DRIVE_SEL */
+#define DRIVER_TYPE_A			0x05
+#define DRIVER_TYPE_B			0x03
+#define DRIVER_TYPE_C			0x02
+#define DRIVER_TYPE_D			0x01
+
+/* FPDCTL */
+#define SSC_POWER_DOWN			0x01
+#define SD_OC_POWER_DOWN		0x02
+#define ALL_POWER_DOWN			0x07
+#define OC_POWER_DOWN			0x06
+
+/* CLK_CTL */
+#define CHANGE_CLK			0x01
+
+/* SD_STAT1 */
+#define	SD_CRC7_ERR			0x80
+#define	SD_CRC16_ERR			0x40
+#define	SD_CRC_WRITE_ERR		0x20
+#define	SD_CRC_WRITE_ERR_MASK		0x1C
+#define	GET_CRC_TIME_OUT		0x02
+#define	SD_TUNING_COMPARE_ERR		0x01
+
+/* SD_STAT2 */
+#define	SD_RSP_80CLK_TIMEOUT		0x01
+
+/* SD_BUS_STAT */
+#define	SD_CLK_TOGGLE_EN		0x80
+#define	SD_CLK_FORCE_STOP	        0x40
+#define	SD_DAT3_STATUS		        0x10
+#define	SD_DAT2_STATUS		        0x08
+#define	SD_DAT1_STATUS		        0x04
+#define	SD_DAT0_STATUS		        0x02
+#define	SD_CMD_STATUS			0x01
+
+/* SD_PAD_CTL */
+#define	SD_IO_USING_1V8		        0x80
+#define	SD_IO_USING_3V3		        0x7F
+#define	TYPE_A_DRIVING		        0x00
+#define	TYPE_B_DRIVING			0x01
+#define	TYPE_C_DRIVING			0x02
+#define	TYPE_D_DRIVING		        0x03
+
+/* SD_SAMPLE_POINT_CTL */
+#define	DDR_FIX_RX_DAT			0x00
+#define	DDR_VAR_RX_DAT			0x80
+#define	DDR_FIX_RX_DAT_EDGE		0x00
+#define	DDR_FIX_RX_DAT_14_DELAY		0x40
+#define	DDR_FIX_RX_CMD			0x00
+#define	DDR_VAR_RX_CMD			0x20
+#define	DDR_FIX_RX_CMD_POS_EDGE		0x00
+#define	DDR_FIX_RX_CMD_14_DELAY		0x10
+#define	SD20_RX_POS_EDGE		0x00
+#define	SD20_RX_14_DELAY		0x08
+#define SD20_RX_SEL_MASK		0x08
+
+/* SD_PUSH_POINT_CTL */
+#define	DDR_FIX_TX_CMD_DAT		0x00
+#define	DDR_VAR_TX_CMD_DAT		0x80
+#define	DDR_FIX_TX_DAT_14_TSU		0x00
+#define	DDR_FIX_TX_DAT_12_TSU		0x40
+#define	DDR_FIX_TX_CMD_NEG_EDGE		0x00
+#define	DDR_FIX_TX_CMD_14_AHEAD		0x20
+#define	SD20_TX_NEG_EDGE		0x00
+#define	SD20_TX_14_AHEAD		0x10
+#define SD20_TX_SEL_MASK		0x10
+#define	DDR_VAR_SDCLK_POL_SWAP		0x01
+
+/* SD_TRANSFER */
+#define	SD_TRANSFER_START		0x80
+#define	SD_TRANSFER_END			0x40
+#define SD_STAT_IDLE			0x20
+#define	SD_TRANSFER_ERR			0x10
+/* SD Transfer Mode definition */
+#define	SD_TM_NORMAL_WRITE		0x00
+#define	SD_TM_AUTO_WRITE_3		0x01
+#define	SD_TM_AUTO_WRITE_4		0x02
+#define	SD_TM_AUTO_READ_3		0x05
+#define	SD_TM_AUTO_READ_4		0x06
+#define	SD_TM_CMD_RSP			0x08
+#define	SD_TM_AUTO_WRITE_1		0x09
+#define	SD_TM_AUTO_WRITE_2		0x0A
+#define	SD_TM_NORMAL_READ		0x0C
+#define	SD_TM_AUTO_READ_1		0x0D
+#define	SD_TM_AUTO_READ_2		0x0E
+#define	SD_TM_AUTO_TUNING		0x0F
+
+/* SD_VPTX_CTL / SD_VPRX_CTL */
+#define PHASE_CHANGE			0x80
+#define PHASE_NOT_RESET			0x40
+
+/* SD_DCMPS_TX_CTL / SD_DCMPS_RX_CTL */
+#define DCMPS_CHANGE			0x80
+#define DCMPS_CHANGE_DONE		0x40
+#define DCMPS_ERROR			0x20
+#define DCMPS_CURRENT_PHASE		0x1F
+
+/* SD Configure 1 Register */
+#define SD_CLK_DIVIDE_0			0x00
+#define	SD_CLK_DIVIDE_256		0xC0
+#define	SD_CLK_DIVIDE_128		0x80
+#define	SD_BUS_WIDTH_1BIT		0x00
+#define	SD_BUS_WIDTH_4BIT		0x01
+#define	SD_BUS_WIDTH_8BIT		0x02
+#define	SD_ASYNC_FIFO_NOT_RST		0x10
+#define	SD_20_MODE			0x00
+#define	SD_DDR_MODE			0x04
+#define	SD_30_MODE			0x08
+
+#define SD_CLK_DIVIDE_MASK		0xC0
+
+/* SD_CMD_STATE */
+#define SD_CMD_IDLE			0x80
+
+/* SD_DATA_STATE */
+#define SD_DATA_IDLE			0x80
+
+/* DCM_DRP_CTL */
+#define DCM_RESET			0x08
+#define DCM_LOCKED			0x04
+#define DCM_208M			0x00
+#define DCM_TX			        0x01
+#define DCM_RX			        0x02
+
+/* DCM_DRP_TRIG */
+#define DRP_START			0x80
+#define DRP_DONE			0x40
+
+/* DCM_DRP_CFG */
+#define DRP_WRITE			0x80
+#define DRP_READ			0x00
+#define DCM_WRITE_ADDRESS_50		0x50
+#define DCM_WRITE_ADDRESS_51		0x51
+#define DCM_READ_ADDRESS_00		0x00
+#define DCM_READ_ADDRESS_51		0x51
+
+/* IRQSTAT0 */
+#define DMA_DONE_INT			0x80
+#define SUSPEND_INT			0x40
+#define LINK_RDY_INT			0x20
+#define LINK_DOWN_INT			0x10
+
+/* DMACTL */
+#define DMA_RST				0x80
+#define DMA_BUSY			0x04
+#define DMA_DIR_TO_CARD			0x00
+#define DMA_DIR_FROM_CARD		0x02
+#define DMA_EN				0x01
+#define DMA_128				(0 << 4)
+#define DMA_256				(1 << 4)
+#define DMA_512				(2 << 4)
+#define DMA_1024			(3 << 4)
+#define DMA_PACK_SIZE_MASK		0x30
+
+/* SSC_CTL1 */
+#define SSC_RSTB			0x80
+#define SSC_8X_EN			0x40
+#define SSC_FIX_FRAC			0x20
+#define SSC_SEL_1M			0x00
+#define SSC_SEL_2M			0x08
+#define SSC_SEL_4M			0x10
+#define SSC_SEL_8M			0x18
+
+/* SSC_CTL2 */
+#define SSC_DEPTH_MASK			0x07
+#define SSC_DEPTH_DISALBE		0x00
+#define SSC_DEPTH_4M			0x01
+#define SSC_DEPTH_2M			0x02
+#define SSC_DEPTH_1M			0x03
+#define SSC_DEPTH_500K			0x04
+#define SSC_DEPTH_250K			0x05
+
+/* System Clock Control Register */
+#define CLK_LOW_FREQ			0x01
+
+/* System Clock Divider Register */
+#define CLK_DIV_1			0x01
+#define CLK_DIV_2			0x02
+#define CLK_DIV_4			0x03
+#define CLK_DIV_8			0x04
+
+/* SD Configure 2 Register */
+#define	SD_CALCULATE_CRC7		0x00
+#define	SD_NO_CALCULATE_CRC7		0x80
+#define	SD_CHECK_CRC16			0x00
+#define	SD_NO_CHECK_CRC16		0x40
+#define SD_NO_CHECK_WAIT_CRC_TO		0x20
+#define	SD_WAIT_BUSY_END		0x08
+#define	SD_NO_WAIT_BUSY_END		0x00
+#define	SD_CHECK_CRC7			0x00
+#define	SD_NO_CHECK_CRC7		0x04
+#define	SD_RSP_LEN_0			0x00
+#define	SD_RSP_LEN_6			0x01
+#define	SD_RSP_LEN_17			0x02
+/* SD/MMC Response Type Definition */
+#define	SD_RSP_TYPE_R0			0x04
+#define	SD_RSP_TYPE_R1			0x01
+#define	SD_RSP_TYPE_R1b			0x09
+#define	SD_RSP_TYPE_R2			0x02
+#define	SD_RSP_TYPE_R3			0x05
+#define	SD_RSP_TYPE_R4			0x05
+#define	SD_RSP_TYPE_R5			0x01
+#define	SD_RSP_TYPE_R6			0x01
+#define	SD_RSP_TYPE_R7			0x01
+
+/* SD_CONFIURE3 */
+#define	SD_RSP_80CLK_TIMEOUT_EN		0x01
+
+/* Card Transfer Reset Register */
+#define SPI_STOP			0x01
+#define XD_STOP				0x02
+#define SD_STOP				0x04
+#define MS_STOP				0x08
+#define SPI_CLR_ERR			0x10
+#define XD_CLR_ERR			0x20
+#define SD_CLR_ERR			0x40
+#define MS_CLR_ERR			0x80
+
+/* Card Data Source Register */
+#define PINGPONG_BUFFER			0x01
+#define RING_BUFFER			0x00
+
+/* Card Power Control Register */
+#define PMOS_STRG_MASK			0x10
+#define PMOS_STRG_800mA			0x10
+#define PMOS_STRG_400mA			0x00
+#define SD_POWER_OFF			0x03
+#define SD_PARTIAL_POWER_ON		0x01
+#define SD_POWER_ON			0x00
+#define SD_POWER_MASK			0x03
+
+/* PWR_GATE_CTRL */
+#define PWR_GATE_EN			0x01
+#define LDO3318_PWR_MASK		0x06
+#define LDO_ON				0x00
+#define LDO_SUSPEND			0x04
+#define LDO_OFF				0x06
+
+/* CARD_CLK_SOURCE */
+#define CRC_FIX_CLK			(0x00 << 0)
+#define CRC_VAR_CLK0			(0x01 << 0)
+#define CRC_VAR_CLK1			(0x02 << 0)
+#define SD30_FIX_CLK			(0x00 << 2)
+#define SD30_VAR_CLK0			(0x01 << 2)
+#define SD30_VAR_CLK1			(0x02 << 2)
+#define SAMPLE_FIX_CLK			(0x00 << 4)
+#define SAMPLE_VAR_CLK0			(0x01 << 4)
+#define SAMPLE_VAR_CLK1			(0x02 << 4)
+
+#define SD_CFG1				0xFDA0
+#define SD_CFG2				0xFDA1
+#define SD_CFG3				0xFDA2
+#define SD_STAT1			0xFDA3
+#define SD_STAT2			0xFDA4
+#define SD_BUS_STAT			0xFDA5
+#define SD_PAD_CTL			0xFDA6
+#define SD_SAMPLE_POINT_CTL		0xFDA7
+#define SD_PUSH_POINT_CTL		0xFDA8
+#define SD_CMD0				0xFDA9
+#define SD_CMD1				0xFDAA
+#define SD_CMD2				0xFDAB
+#define SD_CMD3				0xFDAC
+#define SD_CMD4				0xFDAD
+#define SD_CMD5				0xFDAE
+#define SD_BYTE_CNT_L			0xFDAF
+#define SD_BYTE_CNT_H			0xFDB0
+#define SD_BLOCK_CNT_L			0xFDB1
+#define SD_BLOCK_CNT_H			0xFDB2
+#define SD_TRANSFER			0xFDB3
+#define SD_CMD_STATE			0xFDB5
+#define SD_DATA_STATE			0xFDB6
+
+#define SRCTL				0xFC13
+
+#define	DCM_DRP_CTL			0xFC23
+#define	DCM_DRP_TRIG			0xFC24
+#define	DCM_DRP_CFG			0xFC25
+#define	DCM_DRP_WR_DATA_L		0xFC26
+#define	DCM_DRP_WR_DATA_H		0xFC27
+#define	DCM_DRP_RD_DATA_L		0xFC28
+#define	DCM_DRP_RD_DATA_H		0xFC29
+#define SD_VPCLK0_CTL			0xFC2A
+#define SD_VPCLK1_CTL			0xFC2B
+#define SD_DCMPS0_CTL			0xFC2C
+#define SD_DCMPS1_CTL			0xFC2D
+#define SD_VPTX_CTL			SD_VPCLK0_CTL
+#define SD_VPRX_CTL			SD_VPCLK1_CTL
+#define SD_DCMPS_TX_CTL			SD_DCMPS0_CTL
+#define SD_DCMPS_RX_CTL			SD_DCMPS1_CTL
+#define CARD_CLK_SOURCE			0xFC2E
+
+#define CARD_PWR_CTL			0xFD50
+#define CARD_CLK_SWITCH			0xFD51
+#define CARD_SHARE_MODE			0xFD52
+#define CARD_DRIVE_SEL			0xFD53
+#define CARD_STOP			0xFD54
+#define CARD_OE				0xFD55
+#define CARD_AUTO_BLINK			0xFD56
+#define CARD_GPIO_DIR			0xFD57
+#define CARD_GPIO			0xFD58
+
+#define CARD_DATA_SOURCE		0xFD5B
+#define CARD_SELECT			0xFD5C
+#define SD30_DRIVE_SEL			0xFD5E
+
+#define CARD_CLK_EN			0xFD69
+
+#define SDIO_CTRL			0xFD6B
+
+#define FPDCTL				0xFC00
+#define PDINFO				0xFC01
+
+#define CLK_CTL				0xFC02
+#define CLK_DIV				0xFC03
+#define CLK_SEL				0xFC04
+
+#define SSC_DIV_N_0			0xFC0F
+#define SSC_DIV_N_1			0xFC10
+#define SSC_CTL1			0xFC11
+#define SSC_CTL2			0xFC12
+
+#define RCCTL				0xFC14
+
+#define FPGA_PULL_CTL			0xFC1D
+
+#define CARD_PULL_CTL1			0xFD60
+#define CARD_PULL_CTL2			0xFD61
+#define CARD_PULL_CTL3			0xFD62
+#define CARD_PULL_CTL4			0xFD63
+#define CARD_PULL_CTL5			0xFD64
+#define CARD_PULL_CTL6			0xFD65
+
+/* PCI Express Related Registers */
+#define IRQEN0				0xFE20
+#define IRQSTAT0			0xFE21
+#define IRQEN1				0xFE22
+#define IRQSTAT1			0xFE23
+#define TLPRIEN				0xFE24
+#define TLPRISTAT			0xFE25
+#define TLPTIEN				0xFE26
+#define TLPTISTAT			0xFE27
+#define DMATC0				0xFE28
+#define DMATC1				0xFE29
+#define DMATC2				0xFE2A
+#define DMATC3				0xFE2B
+#define DMACTL				0xFE2C
+#define BCTL				0xFE2D
+#define RBBC0				0xFE2E
+#define RBBC1				0xFE2F
+#define RBDAT				0xFE30
+#define RBCTL				0xFE34
+#define CFGADDR0			0xFE35
+#define CFGADDR1			0xFE36
+#define CFGDATA0			0xFE37
+#define CFGDATA1			0xFE38
+#define CFGDATA2			0xFE39
+#define CFGDATA3			0xFE3A
+#define CFGRWCTL			0xFE3B
+#define PHYRWCTL			0xFE3C
+#define PHYDATA0			0xFE3D
+#define PHYDATA1			0xFE3E
+#define PHYADDR				0xFE3F
+#define MSGRXDATA0			0xFE40
+#define MSGRXDATA1			0xFE41
+#define MSGRXDATA2			0xFE42
+#define MSGRXDATA3			0xFE43
+#define MSGTXDATA0			0xFE44
+#define MSGTXDATA1			0xFE45
+#define MSGTXDATA2			0xFE46
+#define MSGTXDATA3			0xFE47
+#define MSGTXCTL			0xFE48
+#define PETXCFG				0xFE49
+
+#define CDRESUMECTL			0xFE52
+#define WAKE_SEL_CTL			0xFE54
+#define PME_FORCE_CTL			0xFE56
+#define ASPM_FORCE_CTL			0xFE57
+#define PM_CLK_FORCE_CTL		0xFE58
+#define PERST_GLITCH_WIDTH		0xFE5C
+#define CHANGE_LINK_STATE		0xFE5B
+#define RESET_LOAD_REG			0xFE5E
+#define EFUSE_CONTENT			0xFE5F
+#define HOST_SLEEP_STATE		0xFE60
+#define MAIN_PWR_OFF_CTL		0xFE70 /* RTS5208 */
+#define SDIO_CFG			0xFE70 /* RTS5209 */
+
+#define NFTS_TX_CTRL			0xFE72
+
+#define PWR_GATE_CTRL			0xFE75
+#define PWD_SUSPEND_EN			0xFE76
+
+/* Memory mapping */
+#define SRAM_BASE			0xE600
+#define RBUF_BASE			0xF400
+#define PPBUF_BASE1			0xF800
+#define PPBUF_BASE2			0xFA00
+#define IMAGE_FLAG_ADDR0		0xCE80
+#define IMAGE_FLAG_ADDR1		0xCE81
+
+#define rtsx_pci_init_cmd(pdev)		((pdev)->ci = 0)
+
+/* SD Tuning Data Structure
+ * Record continuous timing phase path
+ */
+struct timing_phase_path {
+	int start;
+	int end;
+	int mid;
+	int len;
+};
+
+struct sd_info {
+	int initial_mode;
+	int ddr_mode;
+};
+
+enum IC_VER	{IC_VER_AB, IC_VER_C = 2, IC_VER_D = 3};
+
+struct rtsx_adapter;
+struct rtsx_pdev;
+
+struct pdev_ops {
+	int		(*extra_init_hw)(struct rtsx_pdev *pdev);
+	int		(*optimize_phy)(struct rtsx_pdev *pdev);
+	void		(*turn_on_led)(struct rtsx_pdev *pdev);
+	void		(*turn_off_led)(struct rtsx_pdev *pdev);
+	void		(*enable_auto_blink)(struct rtsx_pdev *pdev);
+	void		(*disable_auto_blink)(struct rtsx_pdev *pdev);
+};
+
+enum PDEV_STAT  {PDEV_STAT_IDLE, PDEV_STAT_RUN};
+
+struct rtsx_pdev {
+	struct pci_dev		*pci;
+
+	/* pci resources */
+	unsigned long		addr;
+	void __iomem		*remap_addr;
+	int			irq;
+
+	/* host reserved buffer */
+	void			*rtsx_resv_buf;
+	dma_addr_t		rtsx_resv_buf_addr;
+
+	void			*host_cmds_ptr;
+	dma_addr_t		host_cmds_addr;
+	int			ci;
+
+	void			*host_sg_tbl_ptr;
+	dma_addr_t		host_sg_tbl_addr;
+	int			sgi;
+
+	u32			int_reg;
+	char			trans_result;
+	char			trans_state;
+
+	int			need_reset;
+	int			need_release;
+
+	spinlock_t		lock;
+	struct mutex		pdev_mutex;
+	struct completion	*done;
+	struct completion	*finish_me;
+
+	int			remove_pci;
+
+	int			msi_en;
+	u8			ic_version;
+	/* Data transferred in ADMA mode or not */
+	int			adma_mode;
+
+	struct delayed_work	carddet_work;
+	struct delayed_work	idle_work;
+
+	struct sd_info		sd_card;
+
+	struct pdev_ops		ops;
+	enum PDEV_STAT		state;
+
+	struct rtsx_adapter	*adapter;
+};
+
+#define CHK_PCI_PID(pdev, pid)		((pdev)->pci->device == (pid))
+#define PCI_VID(pdev)			((pdev)->pci->vendor)
+#define PCI_PID(pdev)			((pdev)->pci->device)
+
+void rtsx_pci_start_run(struct rtsx_pdev *pdev);
+int rtsx_pci_write_register(struct rtsx_pdev *pdev, u16 addr, u8 mask, u8 data);
+int rtsx_pci_read_register(struct rtsx_pdev *pdev, u16 addr, u8 *data);
+int rtsx_pci_write_phy_register(struct rtsx_pdev *pdev, u8 addr, u16 val);
+int rtsx_pci_read_phy_register(struct rtsx_pdev *pdev, u8 addr, u16 *val);
+void rtsx_pci_stop_cmd(struct rtsx_pdev *pdev);
+void rtsx_pci_add_cmd(struct rtsx_pdev *pdev,
+		u8 cmd_type, u16 reg_addr, u8 mask, u8 data);
+void rtsx_pci_send_cmd_no_wait(struct rtsx_pdev *pdev);
+int rtsx_pci_send_cmd(struct rtsx_pdev *pdev, int timeout);
+void rtsx_pci_add_sg_tbl(struct rtsx_pdev *pdev, u32 addr, u32 len, u8 option);
+int rtsx_pci_transfer_data(struct rtsx_pdev *pdev,
+		void *buf, size_t len, int use_sg, int read, int timeout);
+int rtsx_pci_read_ppbuf(struct rtsx_pdev *pdev, u8 *buf, int buf_len);
+int rtsx_pci_write_ppbuf(struct rtsx_pdev *pdev, u8 *buf, int buf_len);
+
+static inline u8 *rtsx_pci_get_cmd_data(struct rtsx_pdev *pdev)
+{
+	return (u8 *)(pdev->host_cmds_ptr);
+}
+
+#endif
+
diff --git a/drivers/misc/realtek_cr/pci/sdmmc.c b/drivers/misc/realtek_cr/pci/sdmmc.c
new file mode 100644
index 0000000..3fe7dc2
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/sdmmc.c
@@ -0,0 +1,1096 @@
+/* Driver for Realtek PCI-Express card reader
+ *
+ * Copyright(c) 2009 Realtek Semiconductor Corp. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2, or (at your option) any
+ * later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, see <http://www.gnu.org/licenses/>.
+ *
+ * Author:
+ *   Wei WANG <wei_wang@xxxxxxxxxxxxxx>
+ *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China
+ */
+
+#include <linux/dma-mapping.h>
+#include <linux/highmem.h>
+#include <linux/delay.h>
+#include <linux/mmc/mmc.h>
+#include <linux/mmc/sd.h>
+#include <linux/mmc/host.h>
+#include <linux/rtsx_core.h>
+
+#include "rtsx_pci.h"
+#include "sdmmc.h"
+
+static inline void sd_clear_error(struct rtsx_pdev *pdev)
+{
+	rtsx_pci_write_register(pdev, CARD_STOP,
+			SD_STOP | SD_CLR_ERR, SD_STOP | SD_CLR_ERR);
+}
+
+static void sd_print_debug_regs(struct rtsx_pdev *pdev)
+{
+	u16 i;
+	u8 *ptr;
+
+	rtsx_pci_init_cmd(pdev);
+	for (i = 0xFDA0; i <= 0xFDAE; i++)
+		rtsx_pci_add_cmd(pdev, READ_REG_CMD, i, 0, 0);
+	for (i = 0xFD52; i <= 0xFD69; i++)
+		rtsx_pci_add_cmd(pdev, READ_REG_CMD, i, 0, 0);
+	rtsx_pci_send_cmd(pdev, 100);
+
+	ptr = rtsx_pci_get_cmd_data(pdev);
+	for (i = 0xFDA0; i <= 0xFDAE; i++)
+		pr_debug("0x%04X: 0x%02x\n", i, *(ptr++));
+	for (i = 0xFD52; i <= 0xFD69; i++)
+		pr_debug("0x%04X: 0x%02x\n", i, *(ptr++));
+}
+
+static int sd_read_data(struct rtsx_pdev *pdev, u8 *cmd,
+		u16 byte_cnt, u8 *buf, int buf_len, int timeout)
+{
+	struct sd_info *sd_card = &(pdev->sd_card);
+	int err, i;
+	u8 trans_mode;
+
+	BUG_ON(!cmd);
+	BUG_ON(buf_len > 512);
+
+	pr_debug("%s: SD/MMC CMD %d\n", __func__, cmd[0] - 0x40);
+
+	if (!buf)
+		buf_len = 0;
+
+	if ((cmd[0] & 0x3F) == MMC_SEND_TUNING_BLOCK)
+		trans_mode = SD_TM_AUTO_TUNING;
+	else
+		trans_mode = SD_TM_NORMAL_READ;
+
+	rtsx_pci_init_cmd(pdev);
+
+	for (i = 0; i < 5; i++)
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD,
+				SD_CMD0 + i, 0xFF, cmd[i]);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BYTE_CNT_L,
+			0xFF, (u8)byte_cnt);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BYTE_CNT_H,
+			0xFF, (u8)(byte_cnt >> 8));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BLOCK_CNT_L, 0xFF, 1);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BLOCK_CNT_H, 0xFF, 0);
+
+	if (sd_card->initial_mode)
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CFG1,
+				SD_CLK_DIVIDE_MASK, SD_CLK_DIVIDE_0);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CFG2, 0xFF,
+			SD_CALCULATE_CRC7 | SD_CHECK_CRC16 |
+			SD_NO_WAIT_BUSY_END | SD_CHECK_CRC7 | SD_RSP_LEN_6);
+	if (trans_mode != SD_TM_AUTO_TUNING)
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD,
+				CARD_DATA_SOURCE, 0x01, PINGPONG_BUFFER);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_TRANSFER,
+			0xFF, trans_mode | SD_TRANSFER_START);
+	rtsx_pci_add_cmd(pdev, CHECK_REG_CMD, SD_TRANSFER,
+			SD_TRANSFER_END, SD_TRANSFER_END);
+
+	err = rtsx_pci_send_cmd(pdev, timeout);
+	if (err < 0) {
+		sd_print_debug_regs(pdev);
+		pr_debug("rtsx_pci_send_cmd fail (err = %d)\n", err);
+		return err;
+	}
+
+	if (buf && buf_len) {
+		err = rtsx_pci_read_ppbuf(pdev, buf, buf_len);
+		if (err < 0) {
+			pr_debug("rtsx_read_ppbuf fail (err = %d)\n", err);
+			return err;
+		}
+	}
+
+	if (sd_card->initial_mode) {
+		err = rtsx_pci_write_register(pdev, SD_CFG1,
+				SD_CLK_DIVIDE_MASK, SD_CLK_DIVIDE_128);
+		if (err < 0)
+			return err;
+	}
+
+	return 0;
+}
+
+static int sd_write_data(struct rtsx_pdev *pdev, u8 *cmd, u16 byte_cnt,
+		u8 *buf, int buf_len, int timeout)
+{
+	int err, i;
+	u8 trans_mode;
+
+	BUG_ON(buf_len > 512);
+
+	if (!buf)
+		buf_len = 0;
+
+	if (buf && buf_len) {
+		err = rtsx_pci_write_ppbuf(pdev, buf, buf_len);
+		if (err < 0) {
+			pr_debug("rtsx_write_ppbuf fail (err = %d)\n", err);
+			return err;
+		}
+	}
+
+	if (cmd)
+		trans_mode = SD_TM_AUTO_WRITE_2;
+	else
+		trans_mode = SD_TM_AUTO_WRITE_3;
+
+	rtsx_pci_init_cmd(pdev);
+
+	if (cmd) {
+		pr_debug("%s: SD/MMC CMD %d\n", __func__, cmd[0] - 0x40);
+
+		for (i = 0; i < 5; i++)
+			rtsx_pci_add_cmd(pdev, WRITE_REG_CMD,
+					SD_CMD0 + i, 0xFF, cmd[i]);
+	}
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BYTE_CNT_L,
+			0xFF, (u8)byte_cnt);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BYTE_CNT_H,
+			0xFF, (u8)(byte_cnt >> 8));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BLOCK_CNT_L, 0xFF, 1);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BLOCK_CNT_H, 0xFF, 0);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CFG2, 0xFF,
+		SD_CALCULATE_CRC7 | SD_CHECK_CRC16 |
+		SD_NO_WAIT_BUSY_END | SD_CHECK_CRC7 | SD_RSP_LEN_6);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_TRANSFER, 0xFF,
+			trans_mode | SD_TRANSFER_START);
+	rtsx_pci_add_cmd(pdev, CHECK_REG_CMD, SD_TRANSFER,
+			SD_TRANSFER_END, SD_TRANSFER_END);
+
+	err = rtsx_pci_send_cmd(pdev, timeout);
+	if (err < 0) {
+		sd_print_debug_regs(pdev);
+		pr_debug("rtsx_pci_send_cmd fail (err = %d)\n", err);
+		return err;
+	}
+
+	return 0;
+}
+
+static int sd_rw_multi(struct rtsx_pdev *pdev, void *buf, unsigned int blksz,
+		unsigned int blocks, unsigned int use_sg, int read, int uhs)
+{
+	u8 cfg2, trans_mode;
+	int err;
+	size_t data_len = blksz * blocks;
+
+	if (read) {
+		cfg2 = SD_CALCULATE_CRC7 | SD_CHECK_CRC16 |
+			SD_NO_WAIT_BUSY_END | SD_CHECK_CRC7 | SD_RSP_LEN_0;
+		trans_mode = SD_TM_AUTO_READ_3;
+	} else {
+		cfg2 = SD_NO_CALCULATE_CRC7 | SD_CHECK_CRC16 |
+			SD_NO_WAIT_BUSY_END | SD_NO_CHECK_CRC7 | SD_RSP_LEN_0;
+		trans_mode = SD_TM_AUTO_WRITE_3;
+	}
+
+	if (!uhs)
+		cfg2 |= SD_NO_CHECK_WAIT_CRC_TO;
+
+	rtsx_pci_init_cmd(pdev);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BYTE_CNT_L, 0xFF, 0x00);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BYTE_CNT_H, 0xFF, 0x02);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BLOCK_CNT_L,
+			0xFF, (u8)blocks);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_BLOCK_CNT_H,
+			0xFF, (u8)(blocks >> 8));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD,
+			CARD_DATA_SOURCE, 0x01, RING_BUFFER);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, IRQSTAT0,
+			DMA_DONE_INT, DMA_DONE_INT);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, DMATC3,
+			0xFF, (u8)(data_len >> 24));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, DMATC2,
+			0xFF, (u8)(data_len >> 16));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, DMATC1,
+			0xFF, (u8)(data_len >> 8));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, DMATC0, 0xFF, (u8)data_len);
+	if (read) {
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, DMACTL,
+				0x03 | DMA_PACK_SIZE_MASK,
+				DMA_DIR_FROM_CARD | DMA_EN | DMA_512);
+	} else {
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, DMACTL,
+				0x03 | DMA_PACK_SIZE_MASK,
+				DMA_DIR_TO_CARD | DMA_EN | DMA_512);
+	}
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_DATA_SOURCE,
+			0x01, RING_BUFFER);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_TRANSFER, 0xFF,
+			trans_mode | SD_TRANSFER_START);
+	rtsx_pci_add_cmd(pdev, CHECK_REG_CMD, SD_TRANSFER,
+			SD_TRANSFER_END, SD_TRANSFER_END);
+
+	rtsx_pci_send_cmd_no_wait(pdev);
+
+	err = rtsx_pci_transfer_data(pdev, buf, data_len, use_sg, read, 10000);
+	if (err < 0) {
+		sd_clear_error(pdev);
+
+		return err;
+	}
+
+	return 0;
+}
+
+static int sd_wait_voltage_stable_1(struct rtsx_pdev *pdev)
+{
+	int err;
+	u8 stat;
+
+	mdelay(1);
+
+	/* SD_CMD, SD_DAT3~0 should be drived to low by card;
+	 * If either one of SD_CMD,SD_DAT3~0 is not low,
+	 * abort the voltage switch sequence;
+	 */
+	err = rtsx_pci_read_register(pdev, SD_BUS_STAT, &stat);
+	if (err < 0)
+		return err;
+
+	if (stat & (SD_CMD_STATUS | SD_DAT3_STATUS | SD_DAT2_STATUS |
+				SD_DAT1_STATUS | SD_DAT0_STATUS))
+		return -EINVAL;
+
+	/* Stop toggle SD clock */
+	err = rtsx_pci_write_register(pdev, SD_BUS_STAT,
+			0xFF, SD_CLK_FORCE_STOP);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+static int sd_wait_voltage_stable_2(struct rtsx_pdev *pdev)
+{
+	int err;
+	u8 stat, mask, val;
+
+	wait_timeout(50);
+
+	/* Toggle SD clock again */
+	err = rtsx_pci_write_register(pdev, SD_BUS_STAT,
+			0xFF, SD_CLK_TOGGLE_EN);
+	if (err < 0)
+		return err;
+
+	wait_timeout(10);
+
+	/* SD_CMD, SD_DAT3~0 should be pulled high by host */
+	err = rtsx_pci_read_register(pdev, SD_BUS_STAT, &stat);
+	if (err < 0)
+		return err;
+
+	mask = SD_CMD_STATUS | SD_DAT3_STATUS | SD_DAT2_STATUS |
+		SD_DAT1_STATUS | SD_DAT0_STATUS;
+	val = SD_CMD_STATUS | SD_DAT3_STATUS | SD_DAT2_STATUS |
+		SD_DAT1_STATUS | SD_DAT0_STATUS;
+	if ((stat & mask) != val) {
+		pr_debug("%s: SD_BUS_STAT = 0x%x\n", __func__, stat);
+		rtsx_pci_write_register(pdev, SD_BUS_STAT,
+				SD_CLK_TOGGLE_EN | SD_CLK_FORCE_STOP, 0);
+		rtsx_pci_write_register(pdev, CARD_CLK_EN, 0xFF, 0);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int sd_change_bank_voltage(struct rtsx_pdev *pdev, u8 voltage)
+{
+	int err;
+
+	if (voltage == SD_IO_3V3) {
+		err = rtsx_pci_write_phy_register(pdev, 0x08, 0x4FC0 | 0x24);
+		if (err < 0)
+			return err;
+	} else if (voltage == SD_IO_1V8) {
+		err = rtsx_pci_write_phy_register(pdev, 0x08, 0x4C40 | 0x24);
+		if (err < 0)
+			return err;
+	} else {
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int sd_pull_ctl_disable(struct rtsx_pdev *pdev)
+{
+	int err;
+
+	rtsx_pci_init_cmd(pdev);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL1, 0xFF, 0x55);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL2, 0xFF, 0x55);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL3, 0xFF, 0xD5);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL4, 0xFF, 0x55);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL5, 0xFF, 0x55);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL6, 0xFF, 0x15);
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+static int sd_pull_ctl_enable(struct rtsx_pdev *pdev)
+{
+	int err;
+
+	rtsx_pci_init_cmd(pdev);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL1, 0xFF, 0xAA);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL2, 0xFF, 0xAA);
+	/* SD CLK pull down */
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL3, 0xFF, 0xE9);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL4, 0xFF, 0x55);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL5, 0xFF, 0x55);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PULL_CTL6, 0xFF, 0x15);
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+static int sd_power_on(struct rtsx_pdev *pdev)
+{
+	int err;
+	u8 ldo_on, ldo_suspend;
+
+	if (CHK_PCI_PID(pdev, 0x5209)) {
+		ldo_on = 0x00;
+		ldo_suspend = 0x04;
+	} else {
+		ldo_on = 0x06;
+		ldo_suspend = 0x02;
+	}
+
+	rtsx_pci_init_cmd(pdev);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_SELECT, 0x07, SD_MOD_SEL);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_SHARE_MODE,
+			CARD_SHARE_MASK, CARD_SHARE_48_SD);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_CLK_EN,
+			SD_CLK_EN, SD_CLK_EN);
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	err = sd_pull_ctl_enable(pdev);
+	if (err < 0)
+		return err;
+
+	rtsx_pci_init_cmd(pdev);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PWR_CTL,
+			SD_POWER_MASK, SD_PARTIAL_POWER_ON);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PWR_GATE_CTRL,
+			LDO3318_PWR_MASK, ldo_suspend);
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	udelay(150);
+
+	rtsx_pci_init_cmd(pdev);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PWR_CTL,
+			SD_POWER_MASK, SD_POWER_ON);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PWR_GATE_CTRL,
+			LDO3318_PWR_MASK, ldo_on);
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	err = rtsx_pci_write_register(pdev, CARD_OE,
+			SD_OUTPUT_EN, SD_OUTPUT_EN);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+static int sd_power_off(struct rtsx_pdev *pdev)
+{
+	int err;
+	u8 ldo_off;
+
+	if (CHK_PCI_PID(pdev, 0x5209))
+		ldo_off = 0x06;
+	else
+		ldo_off = 0x00;
+
+	rtsx_pci_init_cmd(pdev);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_CLK_EN, SD_CLK_EN, 0);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_OE, SD_OUTPUT_EN, 0);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_PWR_CTL,
+			SD_POWER_MASK | PMOS_STRG_MASK,
+			SD_POWER_OFF | PMOS_STRG_400mA);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, PWR_GATE_CTRL,
+			LDO3318_PWR_MASK, ldo_off);
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	return sd_pull_ctl_disable(pdev);
+}
+
+static int sd_change_phase(struct rtsx_pdev *pdev, u8 sample_point)
+{
+	int err;
+
+	pr_debug("%s: sample_point = %d\n", __func__, sample_point);
+
+	rtsx_pci_init_cmd(pdev);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL, CHANGE_CLK, CHANGE_CLK);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_VPRX_CTL, 0x1F, sample_point);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_VPCLK0_CTL,
+			PHASE_NOT_RESET, 0);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_VPCLK0_CTL,
+			PHASE_NOT_RESET, PHASE_NOT_RESET);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL, CHANGE_CLK, 0);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CFG1,
+			SD_ASYNC_FIFO_NOT_RST, 0);
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+	if (err < 0)
+		return err;
+
+	return 0;
+}
+
+static u8 sd_search_final_phase(struct rtsx_pdev *pdev, u32 phase_map)
+{
+	struct timing_phase_path path[MAX_PHASE + 1];
+	int i, j, cont_path_cnt;
+	int new_block, max_len, final_path_idx;
+	u8 final_phase = 0xFF;
+
+	/* Parse phase_map, take it as a bit-ring */
+	cont_path_cnt = 0;
+	new_block = 1;
+	j = 0;
+	for (i = 0; i < MAX_PHASE + 1; i++) {
+		if (phase_map & (1 << i)) {
+			if (new_block) {
+				new_block = 0;
+				j = cont_path_cnt++;
+				path[j].start = i;
+				path[j].end = i;
+			} else {
+				path[j].end = i;
+			}
+		} else {
+			new_block = 1;
+			if (cont_path_cnt) {
+				/* Calculate path length and middle point */
+				int idx = cont_path_cnt - 1;
+				path[idx].len =
+					path[idx].end - path[idx].start + 1;
+				path[idx].mid =
+					path[idx].start + path[idx].len / 2;
+			}
+		}
+	}
+
+	if (cont_path_cnt == 0) {
+		pr_debug("No continuous phase path\n");
+		goto finish;
+	} else {
+		/* Calculate last continuous path length and middle point */
+		int idx = cont_path_cnt - 1;
+		path[idx].len = path[idx].end - path[idx].start + 1;
+		path[idx].mid = path[idx].start + path[idx].len / 2;
+	}
+
+	/* Connect the first continuous path
+	 * and the last one if they are adjacent */
+	if (!path[0].start && (path[cont_path_cnt - 1].end == MAX_PHASE)) {
+		/* Using negative index */
+		path[0].start = path[cont_path_cnt - 1].start - MAX_PHASE - 1;
+		path[0].len += path[cont_path_cnt - 1].len;
+		path[0].mid = path[0].start + path[0].len / 2;
+		/* Convert negative middle point index to positive one */
+		if (path[0].mid < 0)
+			path[0].mid += MAX_PHASE + 1;
+		cont_path_cnt--;
+	}
+
+	/* Choose the longest continuous phase path */
+	max_len = 0;
+	final_phase = 0;
+	final_path_idx = 0;
+	for (i = 0; i < cont_path_cnt; i++) {
+		if (path[i].len > max_len) {
+			max_len = path[i].len;
+			final_phase = (u8)path[i].mid;
+			final_path_idx = i;
+		}
+
+		pr_debug("path[%d].start = %d\n", i, path[i].start);
+		pr_debug("path[%d].end = %d\n", i, path[i].end);
+		pr_debug("path[%d].len = %d\n", i, path[i].len);
+		pr_debug("path[%d].mid = %d\n", i, path[i].mid);
+	}
+
+finish:
+	pr_debug("Final choosen phase: %d\n", final_phase);
+	return final_phase;
+}
+
+static void sd_wait_data_idle(struct rtsx_pdev *pdev)
+{
+	int err, i;
+	u8 val = 0;
+
+	for (i = 0; i < 100; i++) {
+		err = rtsx_pci_read_register(pdev, SD_DATA_STATE, &val);
+		if (val & SD_DATA_IDLE)
+			return;
+
+		udelay(100);
+	}
+}
+
+static int sd_tuning_rx_cmd(struct rtsx_pdev *pdev, u8 opcode, u8 sample_point)
+{
+	int err;
+	u8 _cmd[5];
+
+	err = sd_change_phase(pdev, sample_point);
+	if (err < 0)
+		return err;
+
+	_cmd[0] = 0x40 | opcode;
+	_cmd[1] = 0;
+	_cmd[2] = 0;
+	_cmd[3] = 0;
+	_cmd[4] = 0;
+
+	err = sd_read_data(pdev, _cmd, 0x40, NULL, 0, 100);
+	if (err < 0) {
+		/* Wait till SD DATA IDLE */
+		sd_wait_data_idle(pdev);
+		sd_clear_error(pdev);
+		return err;
+	}
+
+	return 0;
+}
+
+static int sd_tuning_phase(struct rtsx_pdev *pdev, u8 opcode, u32 *phase_map)
+{
+	int err, i;
+	u32 raw_phase_map = 0;
+
+	for (i = MAX_PHASE; i >= 0; i--) {
+		err = sd_tuning_rx_cmd(pdev, opcode, (u8)i);
+		if (err == 0)
+			raw_phase_map |= 1 << i;
+	}
+
+	if (phase_map)
+		*phase_map = raw_phase_map;
+
+	return 0;
+}
+
+static int sd_tuning_rx(struct rtsx_pdev *pdev, u8 opcode)
+{
+	int err, i;
+	u32 raw_phase_map[RX_TUNING_CNT] = {0}, phase_map;
+	u8 final_phase;
+
+	for (i = 0; i < RX_TUNING_CNT; i++) {
+		err = sd_tuning_phase(pdev, opcode, &(raw_phase_map[i]));
+		if (err < 0)
+			return err;
+
+		if (raw_phase_map[i] == 0)
+			break;
+	}
+
+	phase_map = 0xFFFFFFFF;
+	for (i = 0; i < RX_TUNING_CNT; i++) {
+		pr_debug("RX raw_phase_map[%d] = 0x%08x\n",
+				i, raw_phase_map[i]);
+		phase_map &= raw_phase_map[i];
+	}
+	pr_debug("RX phase_map = 0x%08x\n", phase_map);
+
+	if (phase_map) {
+		final_phase = sd_search_final_phase(pdev, phase_map);
+		if (final_phase == 0xFF)
+			return -EINVAL;
+
+		err = sd_change_phase(pdev, final_phase);
+		if (err < 0)
+			return err;
+	} else {
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int pci_sdmmc_set_bus_width(struct rtsx_adapter *adapter,
+		unsigned char bus_width)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int err = 0;
+	u8 width[] = {
+		[MMC_BUS_WIDTH_1] = SD_BUS_WIDTH_1BIT,
+		[MMC_BUS_WIDTH_4] = SD_BUS_WIDTH_4BIT,
+		[MMC_BUS_WIDTH_8] = SD_BUS_WIDTH_8BIT,
+	};
+
+	mutex_lock(&pdev->pdev_mutex);
+
+	rtsx_pci_start_run(pdev);
+
+	if (bus_width <= MMC_BUS_WIDTH_8)
+		err = rtsx_pci_write_register(pdev, SD_CFG1,
+				0x03, width[bus_width]);
+
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return err;
+}
+
+static int pci_sdmmc_set_power_mode(struct rtsx_adapter *adapter,
+		unsigned char power_mode)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int err;
+
+	mutex_lock(&pdev->pdev_mutex);
+
+	rtsx_pci_start_run(pdev);
+
+	if (power_mode == MMC_POWER_OFF)
+		err = sd_power_off(pdev);
+	else
+		err = sd_power_on(pdev);
+
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return err;
+}
+
+static int pci_sdmmc_set_timing(struct rtsx_adapter *adapter,
+		unsigned char timing)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	struct sd_info *sd_card = &(pdev->sd_card);
+	int err = 0;
+
+	mutex_lock(&pdev->pdev_mutex);
+
+	rtsx_pci_start_run(pdev);
+
+	sd_card->ddr_mode = 0;
+
+	rtsx_pci_init_cmd(pdev);
+
+	switch (timing) {
+	case MMC_TIMING_UHS_SDR104:
+	case MMC_TIMING_UHS_SDR50:
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CFG1,
+				0x0C | SD_ASYNC_FIFO_NOT_RST,
+				SD_30_MODE | SD_ASYNC_FIFO_NOT_RST);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL,
+				CLK_LOW_FREQ, CLK_LOW_FREQ);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_CLK_SOURCE, 0xFF,
+				CRC_VAR_CLK0 | SD30_FIX_CLK | SAMPLE_VAR_CLK1);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL, CLK_LOW_FREQ, 0);
+		break;
+
+	case MMC_TIMING_UHS_DDR50:
+		sd_card->ddr_mode = 1;
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CFG1,
+				0x0C | SD_ASYNC_FIFO_NOT_RST,
+				SD_DDR_MODE | SD_ASYNC_FIFO_NOT_RST);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL,
+				CLK_LOW_FREQ, CLK_LOW_FREQ);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_CLK_SOURCE, 0xFF,
+				CRC_VAR_CLK0 | SD30_FIX_CLK | SAMPLE_VAR_CLK1);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL, CLK_LOW_FREQ, 0);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_PUSH_POINT_CTL,
+				DDR_VAR_TX_CMD_DAT, DDR_VAR_TX_CMD_DAT);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_SAMPLE_POINT_CTL,
+				DDR_VAR_RX_DAT | DDR_VAR_RX_CMD,
+				DDR_VAR_RX_DAT | DDR_VAR_RX_CMD);
+		break;
+
+	case MMC_TIMING_MMC_HS:
+	case MMC_TIMING_SD_HS:
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CFG1,
+				0x0C, SD_20_MODE);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL,
+				CLK_LOW_FREQ, CLK_LOW_FREQ);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_CLK_SOURCE, 0xFF,
+				CRC_FIX_CLK | SD30_VAR_CLK0 | SAMPLE_VAR_CLK1);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL, CLK_LOW_FREQ, 0);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_PUSH_POINT_CTL,
+				SD20_TX_SEL_MASK, SD20_TX_14_AHEAD);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_SAMPLE_POINT_CTL,
+				SD20_RX_SEL_MASK, SD20_RX_14_DELAY);
+		break;
+
+	default:
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD,
+				SD_CFG1, 0x0C, SD_20_MODE);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL,
+				CLK_LOW_FREQ, CLK_LOW_FREQ);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_CLK_SOURCE, 0xFF,
+				CRC_FIX_CLK | SD30_VAR_CLK0 | SAMPLE_VAR_CLK1);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CLK_CTL, CLK_LOW_FREQ, 0);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD,
+				SD_PUSH_POINT_CTL, 0xFF, 0);
+		rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_SAMPLE_POINT_CTL,
+				SD20_RX_SEL_MASK, SD20_RX_POS_EDGE);
+		break;
+	}
+
+	err = rtsx_pci_send_cmd(pdev, 100);
+
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return err;
+}
+
+static int pci_sdmmc_switch_voltage(struct rtsx_adapter *adapter,
+		unsigned char signal_voltage)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int err = 0;
+	u8 voltage;
+
+	pr_debug("%s: signal_voltage = %d\n", __func__, signal_voltage);
+
+	mutex_lock(&pdev->pdev_mutex);
+
+	rtsx_pci_start_run(pdev);
+
+	if (signal_voltage == MMC_SIGNAL_VOLTAGE_330)
+		voltage = SD_IO_3V3;
+	else
+		voltage = SD_IO_1V8;
+
+	if (voltage == SD_IO_1V8) {
+		err = rtsx_pci_write_register(pdev,
+				SD30_DRIVE_SEL, 0x07, DRIVER_TYPE_B);
+		if (err < 0)
+			goto out;
+
+		err = sd_wait_voltage_stable_1(pdev);
+		if (err < 0)
+			goto out;
+	}
+
+	err = sd_change_bank_voltage(pdev, voltage);
+	if (err < 0)
+		goto out;
+
+	if (voltage == SD_IO_1V8) {
+		err = sd_wait_voltage_stable_2(pdev);
+		if (err < 0)
+			goto out;
+	}
+
+	/* Stop toggle SD clock in idle */
+	err = rtsx_pci_write_register(pdev, SD_BUS_STAT,
+			SD_CLK_TOGGLE_EN | SD_CLK_FORCE_STOP, 0);
+
+out:
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return err;
+}
+
+static int pci_sdmmc_get_ro(struct rtsx_adapter *adapter)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int ro = 0;
+	u32 val;
+
+	mutex_lock(&pdev->pdev_mutex);
+
+	rtsx_pci_start_run(pdev);
+
+	/* Check SD Machanical Write-Protect Switch */
+	val = rtsx_pci_readl(pdev, RTSX_BIPR);
+	pr_debug("%s: RTSX_BIPR = 0x%08x\n", __func__, val);
+	if (val & SD_WRITE_PROTECT)
+		ro = 1;
+
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return ro;
+}
+
+static int pci_sdmmc_get_cd(struct rtsx_adapter *adapter)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int cd = 0;
+	u32 val;
+
+	mutex_lock(&pdev->pdev_mutex);
+
+	rtsx_pci_start_run(pdev);
+
+	/* Check SD Machanical Write-Protect Switch */
+	val = rtsx_pci_readl(pdev, RTSX_BIPR);
+	pr_debug("%s: RTSX_BIPR = 0x%08x\n", __func__, val);
+	if (val & SD_EXIST)
+		cd = 1;
+
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return cd;
+}
+
+static int pci_sdmmc_execute_tuning(struct rtsx_adapter *adapter)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int err = 0;
+
+	mutex_lock(&pdev->pdev_mutex);
+
+	rtsx_pci_start_run(pdev);
+
+	if (!pdev->sd_card.ddr_mode)
+		err = sd_tuning_rx(pdev, MMC_SEND_TUNING_BLOCK);
+
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return err;
+}
+
+static int pci_sdmmc_send_cmd_get_rsp(struct rtsx_adapter *adapter, u8 cmd_idx,
+		u32 arg, unsigned int resp_type, u32 *resp)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int err = 0;
+	int timeout = 100;
+	int i;
+	u8 *ptr;
+	int stat_idx = 0;
+	u8 rsp_type;
+	int rsp_len = 5;
+
+	BUG_ON(!resp);
+
+	pr_debug("%s: SD/MMC CMD %d, arg = 0x%08x\n", __func__, cmd_idx, arg);
+
+	mutex_lock(&pdev->pdev_mutex);
+
+	rtsx_pci_start_run(pdev);
+
+	/* Response type */
+	/* R0
+	 * R1, R5, R6, R7
+	 * R1b
+	 * R2
+	 * R3, R4
+	 */
+	switch (resp_type) {
+	case MMC_RSP_NONE:
+		rsp_type = SD_RSP_TYPE_R0;
+		rsp_len = 0;
+		break;
+	case MMC_RSP_R1:
+		rsp_type = SD_RSP_TYPE_R1;
+		break;
+	case MMC_RSP_R1B:
+		rsp_type = SD_RSP_TYPE_R1b;
+		break;
+	case MMC_RSP_R2:
+		rsp_type = SD_RSP_TYPE_R2;
+		rsp_len = 16;
+		break;
+	case MMC_RSP_R3:
+		rsp_type = SD_RSP_TYPE_R3;
+		break;
+	default:
+		pr_debug("cmd->flag is not valid\n");
+		err = -EINVAL;
+		goto out;
+	}
+
+	if (rsp_type == SD_RSP_TYPE_R1b)
+		timeout = 3000;
+
+	if (cmd_idx == SD_SWITCH_VOLTAGE) {
+		err = rtsx_pci_write_register(pdev, SD_BUS_STAT,
+				0xFF, SD_CLK_TOGGLE_EN);
+		if (err < 0)
+			goto out;
+	}
+
+	rtsx_pci_init_cmd(pdev);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CMD0, 0xFF, 0x40 | cmd_idx);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CMD1, 0xFF, (u8)(arg >> 24));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CMD2, 0xFF, (u8)(arg >> 16));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CMD3, 0xFF, (u8)(arg >> 8));
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CMD4, 0xFF, (u8)arg);
+
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_CFG2, 0xFF, rsp_type);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, CARD_DATA_SOURCE,
+			0x01, PINGPONG_BUFFER);
+	rtsx_pci_add_cmd(pdev, WRITE_REG_CMD, SD_TRANSFER,
+			0xFF, SD_TM_CMD_RSP | SD_TRANSFER_START);
+	rtsx_pci_add_cmd(pdev, CHECK_REG_CMD, SD_TRANSFER,
+		     SD_TRANSFER_END | SD_STAT_IDLE,
+		     SD_TRANSFER_END | SD_STAT_IDLE);
+
+	if (rsp_type == SD_RSP_TYPE_R2) {
+		/* Read data from ping-pong buffer */
+		for (i = PPBUF_BASE2; i < PPBUF_BASE2 + 16; i++)
+			rtsx_pci_add_cmd(pdev, READ_REG_CMD, (u16)i, 0, 0);
+		stat_idx = 16;
+	} else if (rsp_type != SD_RSP_TYPE_R0) {
+		/* Read data from SD_CMDx registers */
+		for (i = SD_CMD0; i <= SD_CMD4; i++)
+			rtsx_pci_add_cmd(pdev, READ_REG_CMD, (u16)i, 0, 0);
+		stat_idx = 5;
+	}
+
+	rtsx_pci_add_cmd(pdev, READ_REG_CMD, SD_STAT1, 0, 0);
+
+	err = rtsx_pci_send_cmd(pdev, timeout);
+	if (err < 0) {
+		sd_print_debug_regs(pdev);
+		sd_clear_error(pdev);
+		pr_debug("rtsx_pci_send_cmd error (err = %d)\n", err);
+		goto out;
+	}
+
+	if (rsp_type == SD_RSP_TYPE_R0) {
+		err = 0;
+		goto out;
+	}
+
+	/* Eliminate returned value of CHECK_REG_CMD */
+	ptr = rtsx_pci_get_cmd_data(pdev) + 1;
+
+	/* Check (Start,Transmission) bit of Response */
+	if ((ptr[0] & 0xC0) != 0) {
+		err = -EILSEQ;
+		pr_debug("Invalid response bit\n");
+		goto out;
+	}
+
+	/* Check CRC7 */
+	if (!(rsp_type & SD_NO_CHECK_CRC7)) {
+		if (ptr[stat_idx] & SD_CRC7_ERR) {
+			err = -EILSEQ;
+			pr_debug("CRC7 error\n");
+			goto out;
+		}
+	}
+
+	if (rsp_type == SD_RSP_TYPE_R2) {
+		for (i = 0; i < 4; i++) {
+			resp[i] = GET_BE32(ptr + 1 + i * 4);
+			pr_debug("cmd->resp[%d] = 0x%08x\n", i, resp[i]);
+		}
+	} else {
+		resp[0] = GET_BE32(ptr + 1);
+		pr_debug("cmd->resp[0] = 0x%08x\n", resp[0]);
+	}
+
+out:
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return err;
+}
+
+static int pci_sdmmc_read_data(struct rtsx_adapter *adapter, u8 *cmd,
+		u16 byte_cnt, u8 *buf, int buf_len, int timeout)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int err;
+
+	mutex_lock(&pdev->pdev_mutex);
+	rtsx_pci_start_run(pdev);
+	err = sd_read_data(pdev, cmd, byte_cnt, buf, buf_len, timeout);
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return err;
+}
+
+static int pci_sdmmc_write_data(struct rtsx_adapter *adapter, u8 *cmd,
+		u16 byte_cnt, u8 *buf, int buf_len, int timeout)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int err;
+
+	mutex_lock(&pdev->pdev_mutex);
+	rtsx_pci_start_run(pdev);
+	err = sd_write_data(pdev, cmd, byte_cnt, buf, buf_len, timeout);
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return err;
+}
+
+static int pci_sdmmc_rw_multi(struct rtsx_adapter *adapter, void *buf,
+		unsigned int blksz, unsigned int blocks,
+		unsigned int use_sg, int read, int uhs)
+{
+	struct rtsx_pdev *pdev = dev_get_drvdata(adapter->dev.parent);
+	int err;
+
+	mutex_lock(&pdev->pdev_mutex);
+	rtsx_pci_start_run(pdev);
+	err = sd_rw_multi(pdev, buf, blksz, blocks, use_sg, read, uhs);
+	mutex_unlock(&pdev->pdev_mutex);
+
+	return err;
+}
+
+void rtsx_pci_init_sdmmc_callback(struct rtsx_adapter *adapter)
+{
+	adapter->sdmmc_ops.sdmmc_set_bus_width = pci_sdmmc_set_bus_width;
+	adapter->sdmmc_ops.sdmmc_set_power_mode = pci_sdmmc_set_power_mode;
+	adapter->sdmmc_ops.sdmmc_set_timing = pci_sdmmc_set_timing;
+	adapter->sdmmc_ops.sdmmc_switch_voltage = pci_sdmmc_switch_voltage;
+	adapter->sdmmc_ops.sdmmc_get_ro = pci_sdmmc_get_ro;
+	adapter->sdmmc_ops.sdmmc_get_cd = pci_sdmmc_get_cd;
+	adapter->sdmmc_ops.sdmmc_execute_tuning = pci_sdmmc_execute_tuning;
+	adapter->sdmmc_ops.sdmmc_send_cmd_get_rsp = pci_sdmmc_send_cmd_get_rsp;
+	adapter->sdmmc_ops.sdmmc_read_data = pci_sdmmc_read_data;
+	adapter->sdmmc_ops.sdmmc_write_data = pci_sdmmc_write_data;
+	adapter->sdmmc_ops.sdmmc_rw_multi = pci_sdmmc_rw_multi;
+}
diff --git a/drivers/misc/realtek_cr/pci/sdmmc.h b/drivers/misc/realtek_cr/pci/sdmmc.h
new file mode 100644
index 0000000..c08abdd
--- /dev/null
+++ b/drivers/misc/realtek_cr/pci/sdmmc.h
@@ -0,0 +1,31 @@
+/* Driver for Realtek PCI-Express card reader
+ *
+ * Copyright(c) 2009 Realtek Semiconductor Corp. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2, or (at your option) any
+ * later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, see <http://www.gnu.org/licenses/>.
+ *
+ * Author:
+ *   Wei WANG <wei_wang@xxxxxxxxxxxxxx>
+ *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China
+ */
+
+#ifndef __RTSX_PCI_SDMMC_H
+#define __RTSX_PCI_SDMMC_H
+
+struct rtsx_adapter;
+
+void rtsx_pci_init_sdmmc_callback(struct rtsx_adapter *adapter);
+
+#endif
+
-- 
1.7.9.5

_______________________________________________
devel mailing list
devel@xxxxxxxxxxxxxxxxxxxxxx
http://driverdev.linuxdriverproject.org/mailman/listinfo/devel


[Index of Archives]     [Linux Driver Backports]     [DMA Engine]     [Linux GPIO]     [Linux SPI]     [Video for Linux]     [Linux USB Devel]     [Linux Coverity]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [Yosemite Backpacking]
  Powered by Linux