drivers/memstick: Add realtek pcie memstick host driver

Realtek PCI-E Memstick card host driver is used to access Memstick
card, with the help of Realtek PCI-E card reader MFD driver.

Signed-off-by: Wei WANG <wei_wang@realsil.com.cn>
Acked-by: Alex Dubov <oakad@yahoo.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>

3 files changed, 652 insertions, 0 deletions

diff --git a/drivers/memstick/host/Kconfig b/drivers/memstick/host/Kconfig
index cc0997a05171..4f7a17fd1aa7 100644
--- a/drivers/memstick/host/Kconfig
+++ b/drivers/memstick/host/Kconfig
@@ -42,3 +42,13 @@ config MEMSTICK_R592
 
           To compile this driver as a module, choose M here: the module will
           be called r592.
+
+config MEMSTICK_REALTEK_PCI
+        tristate "Realtek PCI-E Memstick Card Interface Driver"
+        depends on MFD_RTSX_PCI
+        help
+          Say Y here to include driver code to support Memstick card interface
+          of Realtek PCI-E card reader
+
+          To compile this driver as a module, choose M here: the module will
+          be called rtsx_pci_ms.
diff --git a/drivers/memstick/host/Makefile b/drivers/memstick/host/Makefile
index 31ba8d378e46..af3459d7686e 100644
--- a/drivers/memstick/host/Makefile
+++ b/drivers/memstick/host/Makefile
@@ -5,3 +5,4 @@
 obj-$(CONFIG_MEMSTICK_TIFM_MS)          += tifm_ms.o
 obj-$(CONFIG_MEMSTICK_JMICRON_38X)      += jmb38x_ms.o
 obj-$(CONFIG_MEMSTICK_R592)             += r592.o
+obj-$(CONFIG_MEMSTICK_REALTEK_PCI)      += rtsx_pci_ms.o
diff --git a/drivers/memstick/host/rtsx_pci_ms.c b/drivers/memstick/host/rtsx_pci_ms.c
new file mode 100644
index 000000000000..f5ddb82dadb7
--- /dev/null
+++ b/drivers/memstick/host/rtsx_pci_ms.c
@@ -0,0 +1,641 @@
+/* Realtek PCI-Express Memstick Card Interface driver
+ *
+ * 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@realsil.com.cn>
+ *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China
+ */
+
+#include <linux/module.h>
+#include <linux/highmem.h>
+#include <linux/delay.h>
+#include <linux/platform_device.h>
+#include <linux/memstick.h>
+#include <linux/mfd/rtsx_pci.h>
+#include <asm/unaligned.h>
+
+struct realtek_pci_ms {
+        struct platform_device  *pdev;
+        struct rtsx_pcr         *pcr;
+        struct memstick_host    *msh;
+        struct memstick_request *req;
+
+        struct mutex            host_mutex;
+        struct work_struct      handle_req;
+
+        u8                      ssc_depth;
+        unsigned int            clock;
+        unsigned char           ifmode;
+        bool                    eject;
+};
+
+static inline struct device *ms_dev(struct realtek_pci_ms *host)
+{
+        return &(host->pdev->dev);
+}
+
+static inline void ms_clear_error(struct realtek_pci_ms *host)
+{
+        rtsx_pci_write_register(host->pcr, CARD_STOP,
+                        MS_STOP | MS_CLR_ERR, MS_STOP | MS_CLR_ERR);
+}
+
+#ifdef DEBUG
+
+static void ms_print_debug_regs(struct realtek_pci_ms *host)
+{
+        struct rtsx_pcr *pcr = host->pcr;
+        u16 i;
+        u8 *ptr;
+
+        /* Print MS host internal registers */
+        rtsx_pci_init_cmd(pcr);
+        for (i = 0xFD40; i <= 0xFD44; i++)
+                rtsx_pci_add_cmd(pcr, READ_REG_CMD, i, 0, 0);
+        for (i = 0xFD52; i <= 0xFD69; i++)
+                rtsx_pci_add_cmd(pcr, READ_REG_CMD, i, 0, 0);
+        rtsx_pci_send_cmd(pcr, 100);
+
+        ptr = rtsx_pci_get_cmd_data(pcr);
+        for (i = 0xFD40; i <= 0xFD44; i++)
+                dev_dbg(ms_dev(host), "0x%04X: 0x%02x\n", i, *(ptr++));
+        for (i = 0xFD52; i <= 0xFD69; i++)
+                dev_dbg(ms_dev(host), "0x%04X: 0x%02x\n", i, *(ptr++));
+}
+
+#else
+
+#define ms_print_debug_regs(host)
+
+#endif
+
+static int ms_power_on(struct realtek_pci_ms *host)
+{
+        struct rtsx_pcr *pcr = host->pcr;
+        int err;
+
+        rtsx_pci_init_cmd(pcr);
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_SELECT, 0x07, MS_MOD_SEL);
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_SHARE_MODE,
+                        CARD_SHARE_MASK, CARD_SHARE_48_MS);
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_CLK_EN,
+                        MS_CLK_EN, MS_CLK_EN);
+        err = rtsx_pci_send_cmd(pcr, 100);
+        if (err < 0)
+                return err;
+
+        err = rtsx_pci_card_pull_ctl_enable(pcr, RTSX_MS_CARD);
+        if (err < 0)
+                return err;
+
+        err = rtsx_pci_card_power_on(pcr, RTSX_MS_CARD);
+        if (err < 0)
+                return err;
+
+        /* Wait ms power stable */
+        msleep(150);
+
+        err = rtsx_pci_write_register(pcr, CARD_OE,
+                        MS_OUTPUT_EN, MS_OUTPUT_EN);
+        if (err < 0)
+                return err;
+
+        return 0;
+}
+
+static int ms_power_off(struct realtek_pci_ms *host)
+{
+        struct rtsx_pcr *pcr = host->pcr;
+        int err;
+
+        rtsx_pci_init_cmd(pcr);
+
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_CLK_EN, MS_CLK_EN, 0);
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_OE, MS_OUTPUT_EN, 0);
+
+        err = rtsx_pci_send_cmd(pcr, 100);
+        if (err < 0)
+                return err;
+
+        err = rtsx_pci_card_power_off(pcr, RTSX_MS_CARD);
+        if (err < 0)
+                return err;
+
+        return rtsx_pci_card_pull_ctl_disable(pcr, RTSX_MS_CARD);
+}
+
+static int ms_transfer_data(struct realtek_pci_ms *host, unsigned char data_dir,
+                u8 tpc, u8 cfg, struct scatterlist *sg)
+{
+        struct rtsx_pcr *pcr = host->pcr;
+        int err;
+        unsigned int length = sg->length;
+        u16 sec_cnt = (u16)(length / 512);
+        u8 val, trans_mode, dma_dir;
+
+        dev_dbg(ms_dev(host), "%s: tpc = 0x%02x, data_dir = %s, length = %d\n",
+                        __func__, tpc, (data_dir == READ) ? "READ" : "WRITE",
+                        length);
+
+        if (data_dir == READ) {
+                dma_dir = DMA_DIR_FROM_CARD;
+                trans_mode = MS_TM_AUTO_READ;
+        } else {
+                dma_dir = DMA_DIR_TO_CARD;
+                trans_mode = MS_TM_AUTO_WRITE;
+        }
+
+        rtsx_pci_init_cmd(pcr);
+
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, MS_TPC, 0xFF, tpc);
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, MS_SECTOR_CNT_H,
+                        0xFF, (u8)(sec_cnt >> 8));
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, MS_SECTOR_CNT_L,
+                        0xFF, (u8)sec_cnt);
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, MS_TRANS_CFG, 0xFF, cfg);
+
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, IRQSTAT0,
+                        DMA_DONE_INT, DMA_DONE_INT);
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMATC3, 0xFF, (u8)(length >> 24));
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMATC2, 0xFF, (u8)(length >> 16));
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMATC1, 0xFF, (u8)(length >> 8));
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMATC0, 0xFF, (u8)length);
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMACTL,
+                        0x03 | DMA_PACK_SIZE_MASK, dma_dir | DMA_EN | DMA_512);
+        rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CAR