memstick: Add realtek USB memstick host driver

Realtek USB memstick host driver provides memstick host support based on the
Realtek USB card reader MFD driver.

Signed-off-by: Roger Tseng <rogerable@realtek.com>
Signed-off-by: Lee Jones <lee.jones@linaro.org>

3 files changed, 850 insertions, 0 deletions

diff --git a/drivers/memstick/host/Kconfig b/drivers/memstick/host/Kconfig
index 1b37cf8cd204..7310e32b5991 100644
--- a/drivers/memstick/host/Kconfig
+++ b/drivers/memstick/host/Kconfig
@@ -52,3 +52,13 @@ config MEMSTICK_REALTEK_PCI
 
           To compile this driver as a module, choose M here: the module will
           be called rtsx_pci_ms.
+
+config MEMSTICK_REALTEK_USB
+        tristate "Realtek USB Memstick Card Interface Driver"
+        depends on MFD_RTSX_USB
+        help
+          Say Y here to include driver code to support Memstick card interface
+          of Realtek RTS5129/39 series USB card reader
+
+          To compile this driver as a module, choose M here: the module will
+          be called rts5139_ms.
diff --git a/drivers/memstick/host/Makefile b/drivers/memstick/host/Makefile
index af3459d7686e..491c9557441d 100644
--- a/drivers/memstick/host/Makefile
+++ b/drivers/memstick/host/Makefile
@@ -6,3 +6,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
+obj-$(CONFIG_MEMSTICK_REALTEK_USB)      += rtsx_usb_ms.o
diff --git a/drivers/memstick/host/rtsx_usb_ms.c b/drivers/memstick/host/rtsx_usb_ms.c
new file mode 100644
index 000000000000..a7282b7d4de8
--- /dev/null
+++ b/drivers/memstick/host/rtsx_usb_ms.c
@@ -0,0 +1,839 @@
+/* Realtek USB Memstick Card Interface driver
+ *
+ * Copyright(c) 2009-2013 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 version 2
+ * as published by the Free Software Foundation.
+ *
+ * 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:
+ *   Roger Tseng <rogerable@realtek.com>
+ */
+
+#include <linux/module.h>
+#include <linux/highmem.h>
+#include <linux/delay.h>
+#include <linux/platform_device.h>
+#include <linux/workqueue.h>
+#include <linux/memstick.h>
+#include <linux/kthread.h>
+#include <linux/mfd/rtsx_usb.h>
+#include <linux/pm_runtime.h>
+#include <linux/mutex.h>
+#include <linux/sched.h>
+#include <linux/completion.h>
+#include <asm/unaligned.h>
+
+struct rtsx_usb_ms {
+        struct platform_device  *pdev;
+        struct rtsx_ucr *ucr;
+        struct memstick_host    *msh;
+        struct memstick_request *req;
+
+        struct mutex            host_mutex;
+        struct work_struct      handle_req;
+
+        struct task_struct      *detect_ms;
+        struct completion       detect_ms_exit;
+
+        u8                      ssc_depth;
+        unsigned int            clock;
+        int                     power_mode;
+        unsigned char           ifmode;
+        bool                    eject;
+};
+
+static inline struct device *ms_dev(struct rtsx_usb_ms *host)
+{
+        return &(host->pdev->dev);
+}
+
+static inline void ms_clear_error(struct rtsx_usb_ms *host)
+{
+        struct rtsx_ucr *ucr = host->ucr;
+        rtsx_usb_ep0_write_register(ucr, CARD_STOP,
+                                  MS_STOP | MS_CLR_ERR,
+                                  MS_STOP | MS_CLR_ERR);
+
+        rtsx_usb_clear_dma_err(ucr);
+        rtsx_usb_clear_fsm_err(ucr);
+}
+
+#ifdef DEBUG
+
+static void ms_print_debug_regs(struct rtsx_usb_ms *host)
+{
+        struct rtsx_ucr *ucr = host->ucr;
+        u16 i;
+        u8 *ptr;
+
+        /* Print MS host internal registers */
+        rtsx_usb_init_cmd(ucr);
+
+        /* MS_CFG to MS_INT_REG */
+        for (i = 0xFD40; i <= 0xFD44; i++)
+                rtsx_usb_add_cmd(ucr, READ_REG_CMD, i, 0, 0);
+
+        /* CARD_SHARE_MODE to CARD_GPIO */
+        for (i = 0xFD51; i <= 0xFD56; i++)
+                rtsx_usb_add_cmd(ucr, READ_REG_CMD, i, 0, 0);
+
+        /* CARD_PULL_CTLx */
+        for (i = 0xFD60; i <= 0xFD65; i++)
+                rtsx_usb_add_cmd(ucr, READ_REG_CMD, i, 0, 0);
+
+        /* CARD_DATA_SOURCE, CARD_SELECT, CARD_CLK_EN, CARD_PWR_CTL */
+        rtsx_usb_add_cmd(ucr, READ_REG_CMD, CARD_DATA_SOURCE, 0, 0);
+        rtsx_usb_add_cmd(ucr, READ_REG_CMD, CARD_SELECT, 0, 0);
+        rtsx_usb_add_cmd(ucr, READ_REG_CMD, CARD_CLK_EN, 0, 0);
+        rtsx_usb_add_cmd(ucr, READ_REG_CMD, CARD_PWR_CTL, 0, 0);
+
+        rtsx_usb_send_cmd(ucr, MODE_CR, 100);
+        rtsx_usb_get_rsp(ucr, 21, 100);
+
+        ptr = ucr->rsp_buf;
+        for (i = 0xFD40; i <= 0xFD44; i++)
+                dev_dbg(ms_dev(host), "0x%04X: 0x%02x\n", i, *(ptr++));
+        for (i = 0xFD51; i <= 0xFD56; i++)
+                dev_dbg(ms_dev(host), "0x%04X: 0x%02x\n", i, *(ptr++));
+        for (i = 0xFD60; i <= 0xFD65; i++)
+                dev_dbg(ms_dev(host), "0x%04X: 0x%02x\n", i, *(ptr++));
+
+        dev_dbg(ms_dev(host), "0x%04X: 0x%02x\n", CARD_DATA_SOURCE, *(ptr++));
+        dev_dbg(ms_dev(host), "0x%04X: 0x%02x\n", CARD_SELECT, *(ptr++));
+        dev_dbg(ms_dev(host), "0x%04X: 0x%02x\n", CARD_CLK_EN, *(ptr++));
+        dev_dbg(ms_dev(host), "0x%04X: 0x%02x\n", CARD_PWR_CTL, *(ptr++));
+}
+
+#else
+
+static void ms_print_debug_regs(struct rtsx_usb_ms *host)
+{
+}
+
+#endif
+
+static int ms_pull_ctl_disable_lqfp48(struct rtsx_ucr *ucr)
+{
+        rtsx_usb_init_cmd(ucr);
+
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL1, 0xFF, 0x55);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL2, 0xFF, 0x55);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL3, 0xFF, 0x95);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL4, 0xFF, 0x55);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL5, 0xFF, 0x55);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL6, 0xFF, 0xA5);
+
+        return rtsx_usb_send_cmd(ucr, MODE_C, 100);
+}
+
+static int ms_pull_ctl_disable_qfn24(struct rtsx_ucr *ucr)
+{
+        rtsx_usb_init_cmd(ucr);
+
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL1, 0xFF, 0x65);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL2, 0xFF, 0x55);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL3, 0xFF, 0x95);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL4, 0xFF, 0x55);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL5, 0xFF, 0x56);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL6, 0xFF, 0x59);
+
+        return rtsx_usb_send_cmd(ucr, MODE_C, 100);
+}
+
+static int ms_pull_ctl_enable_lqfp48(struct rtsx_ucr *ucr)
+{
+        rtsx_usb_init_cmd(ucr);
+
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL1, 0xFF, 0x55);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL2, 0xFF, 0x55);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL3, 0xFF, 0x95);
+        rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL4, 0xFF, 0x55);