mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-27 11:19:37 +00:00
![Roger Tseng](/assets/img/avatar_default.png)
Functions rtsx_usb_ep0_read_register() and rtsx_usb_get_card_status() both use arbitrary buffer addresses from arguments directly for DMA and the buffers could be located in stack. This was caught by DMA-API debug check. Fixes this by using double-buffers via kzalloc in both functions to guarantee the validity of DMA buffer. WARNING: CPU: 1 PID: 25 at lib/dma-debug.c:1166 check_for_stack+0x96/0xe0() ehci-pci 0000:00:1a.0: DMA-API: device driver maps memory from stack [addr=ffff8801199e3cef] Modules linked in: rtsx_usb_ms arc4 memstick intel_rapl iosf_mbi rtl8192ce snd_hda_codec_hdmi snd_hda_codec_realtek snd_hda_codec_generic snd_hda_intel rtl_pci rtl8192c_common snd_hda_controller x86_pkg_temp_thermal snd_hda_codec rtlwifi mac80211 coretemp kvm_intel kvm iTCO_wdt snd_hwdep snd_seq snd_seq_device crct10dif_pclmul iTCO_vendor_support sparse_keymap cfg80211 crc32_pclmul snd_pcm crc32c_intel ghash_clmulni_intel rfkill i2c_i801 snd_timer shpchp snd serio_raw mei_me lpc_ich soundcore mei tpm_tis tpm wmi nfsd auth_rpcgss nfs_acl lockd grace sunrpc i915 rtsx_usb_sdmmc mmc_core 8021q uas garp stp i2c_algo_bit llc mrp drm_kms_helper usb_storage drm rtsx_usb mfd_core r8169 mii video CPU: 1 PID: 25 Comm: kworker/1:2 Not tainted 3.20.0-0.rc0.git7.3.fc22.x86_64 #1 Hardware name: WB WB-B06211/WB-B0621, BIOS EB062IWB V1.0 12/12/2013 Workqueue: events rtsx_usb_ms_handle_req [rtsx_usb_ms] 0000000000000000 000000003d188e66 ffff8801199e3808 ffffffff8187642b 0000000000000000 ffff8801199e3860 ffff8801199e3848 ffffffff810ab39a ffff8801199e3864 ffff8801199e3cef ffff880119b57098 ffff880119b37320 Call Trace: [<ffffffff8187642b>] dump_stack+0x4c/0x65 [<ffffffff810ab39a>] warn_slowpath_common+0x8a/0xc0 [<ffffffff810ab425>] warn_slowpath_fmt+0x55/0x70 [<ffffffff8187efe6>] ? _raw_spin_unlock_irqrestore+0x36/0x70 [<ffffffff81453156>] check_for_stack+0x96/0xe0 [<ffffffff81453934>] debug_dma_map_page+0x104/0x150 [<ffffffff81613b86>] usb_hcd_map_urb_for_dma+0x646/0x790 [<ffffffff81614165>] usb_hcd_submit_urb+0x1d5/0xa90 [<ffffffff81106f8f>] ? mark_held_locks+0x7f/0xc0 [<ffffffff81106f8f>] ? mark_held_locks+0x7f/0xc0 [<ffffffff81103a15>] ? lockdep_init_map+0x65/0x5d0 [<ffffffff81615d7e>] usb_submit_urb+0x42e/0x5f0 [<ffffffff81616787>] usb_start_wait_urb+0x77/0x190 [<ffffffff8124f035>] ? __kmalloc+0x205/0x2d0 [<ffffffff8161697c>] usb_control_msg+0xdc/0x130 [<ffffffffa0031669>] rtsx_usb_ep0_read_register+0x59/0x70 [rtsx_usb] [<ffffffffa00310c1>] ? rtsx_usb_get_rsp+0x41/0x50 [rtsx_usb] [<ffffffffa071da4e>] rtsx_usb_ms_handle_req+0x7ce/0x9c5 [rtsx_usb_ms] Reported-by: Josh Boyer <jwboyer@fedoraproject.org> Signed-off-by: Roger Tseng <rogerable@realtek.com> Signed-off-by: Lee Jones <lee.jones@linaro.org>
791 lines
19 KiB
C
791 lines
19 KiB
C
/* Driver for Realtek USB card reader
|
|
*
|
|
* 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/slab.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/usb.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/mfd/core.h>
|
|
#include <linux/mfd/rtsx_usb.h>
|
|
|
|
static int polling_pipe = 1;
|
|
module_param(polling_pipe, int, S_IRUGO | S_IWUSR);
|
|
MODULE_PARM_DESC(polling_pipe, "polling pipe (0: ctl, 1: bulk)");
|
|
|
|
static const struct mfd_cell rtsx_usb_cells[] = {
|
|
[RTSX_USB_SD_CARD] = {
|
|
.name = "rtsx_usb_sdmmc",
|
|
.pdata_size = 0,
|
|
},
|
|
[RTSX_USB_MS_CARD] = {
|
|
.name = "rtsx_usb_ms",
|
|
.pdata_size = 0,
|
|
},
|
|
};
|
|
|
|
static void rtsx_usb_sg_timed_out(unsigned long data)
|
|
{
|
|
struct rtsx_ucr *ucr = (struct rtsx_ucr *)data;
|
|
|
|
dev_dbg(&ucr->pusb_intf->dev, "%s: sg transfer timed out", __func__);
|
|
usb_sg_cancel(&ucr->current_sg);
|
|
|
|
/* we know the cancellation is caused by time-out */
|
|
ucr->current_sg.status = -ETIMEDOUT;
|
|
}
|
|
|
|
static int rtsx_usb_bulk_transfer_sglist(struct rtsx_ucr *ucr,
|
|
unsigned int pipe, struct scatterlist *sg, int num_sg,
|
|
unsigned int length, unsigned int *act_len, int timeout)
|
|
{
|
|
int ret;
|
|
|
|
dev_dbg(&ucr->pusb_intf->dev, "%s: xfer %u bytes, %d entries\n",
|
|
__func__, length, num_sg);
|
|
ret = usb_sg_init(&ucr->current_sg, ucr->pusb_dev, pipe, 0,
|
|
sg, num_sg, length, GFP_NOIO);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ucr->sg_timer.expires = jiffies + msecs_to_jiffies(timeout);
|
|
add_timer(&ucr->sg_timer);
|
|
usb_sg_wait(&ucr->current_sg);
|
|
del_timer_sync(&ucr->sg_timer);
|
|
|
|
if (act_len)
|
|
*act_len = ucr->current_sg.bytes;
|
|
|
|
return ucr->current_sg.status;
|
|
}
|
|
|
|
int rtsx_usb_transfer_data(struct rtsx_ucr *ucr, unsigned int pipe,
|
|
void *buf, unsigned int len, int num_sg,
|
|
unsigned int *act_len, int timeout)
|
|
{
|
|
if (timeout < 600)
|
|
timeout = 600;
|
|
|
|
if (num_sg)
|
|
return rtsx_usb_bulk_transfer_sglist(ucr, pipe,
|
|
(struct scatterlist *)buf, num_sg, len, act_len,
|
|
timeout);
|
|
else
|
|
return usb_bulk_msg(ucr->pusb_dev, pipe, buf, len, act_len,
|
|
timeout);
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_transfer_data);
|
|
|
|
static inline void rtsx_usb_seq_cmd_hdr(struct rtsx_ucr *ucr,
|
|
u16 addr, u16 len, u8 seq_type)
|
|
{
|
|
rtsx_usb_cmd_hdr_tag(ucr);
|
|
|
|
ucr->cmd_buf[PACKET_TYPE] = seq_type;
|
|
ucr->cmd_buf[5] = (u8)(len >> 8);
|
|
ucr->cmd_buf[6] = (u8)len;
|
|
ucr->cmd_buf[8] = (u8)(addr >> 8);
|
|
ucr->cmd_buf[9] = (u8)addr;
|
|
|
|
if (seq_type == SEQ_WRITE)
|
|
ucr->cmd_buf[STAGE_FLAG] = 0;
|
|
else
|
|
ucr->cmd_buf[STAGE_FLAG] = STAGE_R;
|
|
}
|
|
|
|
static int rtsx_usb_seq_write_register(struct rtsx_ucr *ucr,
|
|
u16 addr, u16 len, u8 *data)
|
|
{
|
|
u16 cmd_len = ALIGN(SEQ_WRITE_DATA_OFFSET + len, 4);
|
|
|
|
if (!data)
|
|
return -EINVAL;
|
|
|
|
if (cmd_len > IOBUF_SIZE)
|
|
return -EINVAL;
|
|
|
|
rtsx_usb_seq_cmd_hdr(ucr, addr, len, SEQ_WRITE);
|
|
memcpy(ucr->cmd_buf + SEQ_WRITE_DATA_OFFSET, data, len);
|
|
|
|
return rtsx_usb_transfer_data(ucr,
|
|
usb_sndbulkpipe(ucr->pusb_dev, EP_BULK_OUT),
|
|
ucr->cmd_buf, cmd_len, 0, NULL, 100);
|
|
}
|
|
|
|
static int rtsx_usb_seq_read_register(struct rtsx_ucr *ucr,
|
|
u16 addr, u16 len, u8 *data)
|
|
{
|
|
int i, ret;
|
|
u16 rsp_len = round_down(len, 4);
|
|
u16 res_len = len - rsp_len;
|
|
|
|
if (!data)
|
|
return -EINVAL;
|
|
|
|
/* 4-byte aligned part */
|
|
if (rsp_len) {
|
|
rtsx_usb_seq_cmd_hdr(ucr, addr, len, SEQ_READ);
|
|
ret = rtsx_usb_transfer_data(ucr,
|
|
usb_sndbulkpipe(ucr->pusb_dev, EP_BULK_OUT),
|
|
ucr->cmd_buf, 12, 0, NULL, 100);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = rtsx_usb_transfer_data(ucr,
|
|
usb_rcvbulkpipe(ucr->pusb_dev, EP_BULK_IN),
|
|
data, rsp_len, 0, NULL, 100);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
/* unaligned part */
|
|
for (i = 0; i < res_len; i++) {
|
|
ret = rtsx_usb_read_register(ucr, addr + rsp_len + i,
|
|
data + rsp_len + i);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rtsx_usb_read_ppbuf(struct rtsx_ucr *ucr, u8 *buf, int buf_len)
|
|
{
|
|
return rtsx_usb_seq_read_register(ucr, PPBUF_BASE2, (u16)buf_len, buf);
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_read_ppbuf);
|
|
|
|
int rtsx_usb_write_ppbuf(struct rtsx_ucr *ucr, u8 *buf, int buf_len)
|
|
{
|
|
return rtsx_usb_seq_write_register(ucr, PPBUF_BASE2, (u16)buf_len, buf);
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_write_ppbuf);
|
|
|
|
int rtsx_usb_ep0_write_register(struct rtsx_ucr *ucr, u16 addr,
|
|
u8 mask, u8 data)
|
|
{
|
|
u16 value, index;
|
|
|
|
addr |= EP0_WRITE_REG_CMD << EP0_OP_SHIFT;
|
|
value = swab16(addr);
|
|
index = mask | data << 8;
|
|
|
|
return usb_control_msg(ucr->pusb_dev,
|
|
usb_sndctrlpipe(ucr->pusb_dev, 0), RTSX_USB_REQ_REG_OP,
|
|
USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
|
value, index, NULL, 0, 100);
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_ep0_write_register);
|
|
|
|
int rtsx_usb_ep0_read_register(struct rtsx_ucr *ucr, u16 addr, u8 *data)
|
|
{
|
|
u16 value;
|
|
u8 *buf;
|
|
int ret;
|
|
|
|
if (!data)
|
|
return -EINVAL;
|
|
|
|
buf = kzalloc(sizeof(u8), GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
|
|
addr |= EP0_READ_REG_CMD << EP0_OP_SHIFT;
|
|
value = swab16(addr);
|
|
|
|
ret = usb_control_msg(ucr->pusb_dev,
|
|
usb_rcvctrlpipe(ucr->pusb_dev, 0), RTSX_USB_REQ_REG_OP,
|
|
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
|
value, 0, buf, 1, 100);
|
|
*data = *buf;
|
|
|
|
kfree(buf);
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_ep0_read_register);
|
|
|
|
void rtsx_usb_add_cmd(struct rtsx_ucr *ucr, u8 cmd_type, u16 reg_addr,
|
|
u8 mask, u8 data)
|
|
{
|
|
int i;
|
|
|
|
if (ucr->cmd_idx < (IOBUF_SIZE - CMD_OFFSET) / 4) {
|
|
i = CMD_OFFSET + ucr->cmd_idx * 4;
|
|
|
|
ucr->cmd_buf[i++] = ((cmd_type & 0x03) << 6) |
|
|
(u8)((reg_addr >> 8) & 0x3F);
|
|
ucr->cmd_buf[i++] = (u8)reg_addr;
|
|
ucr->cmd_buf[i++] = mask;
|
|
ucr->cmd_buf[i++] = data;
|
|
|
|
ucr->cmd_idx++;
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_add_cmd);
|
|
|
|
int rtsx_usb_send_cmd(struct rtsx_ucr *ucr, u8 flag, int timeout)
|
|
{
|
|
int ret;
|
|
|
|
ucr->cmd_buf[CNT_H] = (u8)(ucr->cmd_idx >> 8);
|
|
ucr->cmd_buf[CNT_L] = (u8)(ucr->cmd_idx);
|
|
ucr->cmd_buf[STAGE_FLAG] = flag;
|
|
|
|
ret = rtsx_usb_transfer_data(ucr,
|
|
usb_sndbulkpipe(ucr->pusb_dev, EP_BULK_OUT),
|
|
ucr->cmd_buf, ucr->cmd_idx * 4 + CMD_OFFSET,
|
|
0, NULL, timeout);
|
|
if (ret) {
|
|
rtsx_usb_clear_fsm_err(ucr);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_send_cmd);
|
|
|
|
int rtsx_usb_get_rsp(struct rtsx_ucr *ucr, int rsp_len, int timeout)
|
|
{
|
|
if (rsp_len <= 0)
|
|
return -EINVAL;
|
|
|
|
rsp_len = ALIGN(rsp_len, 4);
|
|
|
|
return rtsx_usb_transfer_data(ucr,
|
|
usb_rcvbulkpipe(ucr->pusb_dev, EP_BULK_IN),
|
|
ucr->rsp_buf, rsp_len, 0, NULL, timeout);
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_get_rsp);
|
|
|
|
static int rtsx_usb_get_status_with_bulk(struct rtsx_ucr *ucr, u16 *status)
|
|
{
|
|
int ret;
|
|
|
|
rtsx_usb_init_cmd(ucr);
|
|
rtsx_usb_add_cmd(ucr, READ_REG_CMD, CARD_EXIST, 0x00, 0x00);
|
|
rtsx_usb_add_cmd(ucr, READ_REG_CMD, OCPSTAT, 0x00, 0x00);
|
|
ret = rtsx_usb_send_cmd(ucr, MODE_CR, 100);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = rtsx_usb_get_rsp(ucr, 2, 100);
|
|
if (ret)
|
|
return ret;
|
|
|
|
*status = ((ucr->rsp_buf[0] >> 2) & 0x0f) |
|
|
((ucr->rsp_buf[1] & 0x03) << 4);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int rtsx_usb_get_card_status(struct rtsx_ucr *ucr, u16 *status)
|
|
{
|
|
int ret;
|
|
u16 *buf;
|
|
|
|
if (!status)
|
|
return -EINVAL;
|
|
|
|
if (polling_pipe == 0) {
|
|
buf = kzalloc(sizeof(u16), GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
|
|
ret = usb_control_msg(ucr->pusb_dev,
|
|
usb_rcvctrlpipe(ucr->pusb_dev, 0),
|
|
RTSX_USB_REQ_POLL,
|
|
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
|
0, 0, buf, 2, 100);
|
|
*status = *buf;
|
|
|
|
kfree(buf);
|
|
} else {
|
|
ret = rtsx_usb_get_status_with_bulk(ucr, status);
|
|
}
|
|
|
|
/* usb_control_msg may return positive when success */
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_get_card_status);
|
|
|
|
static int rtsx_usb_write_phy_register(struct rtsx_ucr *ucr, u8 addr, u8 val)
|
|
{
|
|
dev_dbg(&ucr->pusb_intf->dev, "Write 0x%x to phy register 0x%x\n",
|
|
val, addr);
|
|
|
|
rtsx_usb_init_cmd(ucr);
|
|
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, HS_VSTAIN, 0xFF, val);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, HS_VCONTROL, 0xFF, addr & 0x0F);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, HS_VLOADM, 0xFF, 0x00);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, HS_VLOADM, 0xFF, 0x00);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, HS_VLOADM, 0xFF, 0x01);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, HS_VCONTROL,
|
|
0xFF, (addr >> 4) & 0x0F);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, HS_VLOADM, 0xFF, 0x00);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, HS_VLOADM, 0xFF, 0x00);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, HS_VLOADM, 0xFF, 0x01);
|
|
|
|
return rtsx_usb_send_cmd(ucr, MODE_C, 100);
|
|
}
|
|
|
|
int rtsx_usb_write_register(struct rtsx_ucr *ucr, u16 addr, u8 mask, u8 data)
|
|
{
|
|
rtsx_usb_init_cmd(ucr);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, addr, mask, data);
|
|
return rtsx_usb_send_cmd(ucr, MODE_C, 100);
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_write_register);
|
|
|
|
int rtsx_usb_read_register(struct rtsx_ucr *ucr, u16 addr, u8 *data)
|
|
{
|
|
int ret;
|
|
|
|
if (data != NULL)
|
|
*data = 0;
|
|
|
|
rtsx_usb_init_cmd(ucr);
|
|
rtsx_usb_add_cmd(ucr, READ_REG_CMD, addr, 0, 0);
|
|
ret = rtsx_usb_send_cmd(ucr, MODE_CR, 100);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = rtsx_usb_get_rsp(ucr, 1, 100);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (data != NULL)
|
|
*data = ucr->rsp_buf[0];
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_read_register);
|
|
|
|
static inline u8 double_ssc_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_2M;
|
|
}
|
|
|
|
return ssc_depth;
|
|
}
|
|
|
|
int rtsx_usb_switch_clock(struct rtsx_ucr *ucr, unsigned int card_clock,
|
|
u8 ssc_depth, bool initial_mode, bool double_clk, bool vpclk)
|
|
{
|
|
int ret;
|
|
u8 n, clk_divider, mcu_cnt, div;
|
|
|
|
if (!card_clock) {
|
|
ucr->cur_clk = 0;
|
|
return 0;
|
|
}
|
|
|
|
if (initial_mode) {
|
|
/* We use 250k(around) here, in initial stage */
|
|
clk_divider = SD_CLK_DIVIDE_128;
|
|
card_clock = 30000000;
|
|
} else {
|
|
clk_divider = SD_CLK_DIVIDE_0;
|
|
}
|
|
|
|
ret = rtsx_usb_write_register(ucr, SD_CFG1,
|
|
SD_CLK_DIVIDE_MASK, clk_divider);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
card_clock /= 1000000;
|
|
dev_dbg(&ucr->pusb_intf->dev,
|
|
"Switch card clock to %dMHz\n", card_clock);
|
|
|
|
if (!initial_mode && double_clk)
|
|
card_clock *= 2;
|
|
dev_dbg(&ucr->pusb_intf->dev,
|
|
"Internal SSC clock: %dMHz (cur_clk = %d)\n",
|
|
card_clock, ucr->cur_clk);
|
|
|
|
if (card_clock == ucr->cur_clk)
|
|
return 0;
|
|
|
|
/* Converting clock value into internal settings: n and div */
|
|
n = card_clock - 2;
|
|
if ((card_clock <= 2) || (n > MAX_DIV_N))
|
|
return -EINVAL;
|
|
|
|
mcu_cnt = 60/card_clock + 3;
|
|
if (mcu_cnt > 15)
|
|
mcu_cnt = 15;
|
|
|
|
/* Make sure that the SSC clock div_n is not less than MIN_DIV_N */
|
|
|
|
div = CLK_DIV_1;
|
|
while (n < MIN_DIV_N && div < CLK_DIV_4) {
|
|
n = (n + 2) * 2 - 2;
|
|
div++;
|
|
}
|
|
dev_dbg(&ucr->pusb_intf->dev, "n = %d, div = %d\n", n, div);
|
|
|
|
if (double_clk)
|
|
ssc_depth = double_ssc_depth(ssc_depth);
|
|
|
|
ssc_depth = revise_ssc_depth(ssc_depth, div);
|
|
dev_dbg(&ucr->pusb_intf->dev, "ssc_depth = %d\n", ssc_depth);
|
|
|
|
rtsx_usb_init_cmd(ucr);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CLK_DIV, CLK_CHANGE, CLK_CHANGE);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CLK_DIV,
|
|
0x3F, (div << 4) | mcu_cnt);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, SSC_CTL1, SSC_RSTB, 0);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, SSC_CTL2,
|
|
SSC_DEPTH_MASK, ssc_depth);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, SSC_DIV_N_0, 0xFF, n);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, SSC_CTL1, SSC_RSTB, SSC_RSTB);
|
|
if (vpclk) {
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, SD_VPCLK0_CTL,
|
|
PHASE_NOT_RESET, 0);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, SD_VPCLK0_CTL,
|
|
PHASE_NOT_RESET, PHASE_NOT_RESET);
|
|
}
|
|
|
|
ret = rtsx_usb_send_cmd(ucr, MODE_C, 2000);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = rtsx_usb_write_register(ucr, SSC_CTL1, 0xff,
|
|
SSC_RSTB | SSC_8X_EN | SSC_SEL_4M);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Wait SSC clock stable */
|
|
usleep_range(100, 1000);
|
|
|
|
ret = rtsx_usb_write_register(ucr, CLK_DIV, CLK_CHANGE, 0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ucr->cur_clk = card_clock;
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_switch_clock);
|
|
|
|
int rtsx_usb_card_exclusive_check(struct rtsx_ucr *ucr, int card)
|
|
{
|
|
int ret;
|
|
u16 val;
|
|
u16 cd_mask[] = {
|
|
[RTSX_USB_SD_CARD] = (CD_MASK & ~SD_CD),
|
|
[RTSX_USB_MS_CARD] = (CD_MASK & ~MS_CD)
|
|
};
|
|
|
|
ret = rtsx_usb_get_card_status(ucr, &val);
|
|
/*
|
|
* If get status fails, return 0 (ok) for the exclusive check
|
|
* and let the flow fail at somewhere else.
|
|
*/
|
|
if (ret)
|
|
return 0;
|
|
|
|
if (val & cd_mask[card])
|
|
return -EIO;
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(rtsx_usb_card_exclusive_check);
|
|
|
|
static int rtsx_usb_reset_chip(struct rtsx_ucr *ucr)
|
|
{
|
|
int ret;
|
|
u8 val;
|
|
|
|
rtsx_usb_init_cmd(ucr);
|
|
|
|
if (CHECK_PKG(ucr, LQFP48)) {
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PWR_CTL,
|
|
LDO3318_PWR_MASK, LDO_SUSPEND);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PWR_CTL,
|
|
FORCE_LDO_POWERB, FORCE_LDO_POWERB);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL1,
|
|
0x30, 0x10);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL5,
|
|
0x03, 0x01);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_PULL_CTL6,
|
|
0x0C, 0x04);
|
|
}
|
|
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, SYS_DUMMY0, NYET_MSAK, NYET_EN);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CD_DEGLITCH_WIDTH, 0xFF, 0x08);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD,
|
|
CD_DEGLITCH_EN, XD_CD_DEGLITCH_EN, 0x0);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, SD30_DRIVE_SEL,
|
|
SD30_DRIVE_MASK, DRIVER_TYPE_D);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD,
|
|
CARD_DRIVE_SEL, SD20_DRIVE_MASK, 0x0);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, LDO_POWER_CFG, 0xE0, 0x0);
|
|
|
|
if (ucr->is_rts5179)
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD,
|
|
CARD_PULL_CTL5, 0x03, 0x01);
|
|
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_DMA1_CTL,
|
|
EXTEND_DMA1_ASYNC_SIGNAL, EXTEND_DMA1_ASYNC_SIGNAL);
|
|
rtsx_usb_add_cmd(ucr, WRITE_REG_CMD, CARD_INT_PEND,
|
|
XD_INT | MS_INT | SD_INT,
|
|
XD_INT | MS_INT | SD_INT);
|
|
|
|
ret = rtsx_usb_send_cmd(ucr, MODE_C, 100);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* config non-crystal mode */
|
|
rtsx_usb_read_register(ucr, CFG_MODE, &val);
|
|
if ((val & XTAL_FREE) || ((val & CLK_MODE_MASK) == CLK_MODE_NON_XTAL)) {
|
|
ret = rtsx_usb_write_phy_register(ucr, 0xC2, 0x7C);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtsx_usb_init_chip(struct rtsx_ucr *ucr)
|
|
{
|
|
int ret;
|
|
u8 val;
|
|
|
|
rtsx_usb_clear_fsm_err(ucr);
|
|
|
|
/* power on SSC */
|
|
ret = rtsx_usb_write_register(ucr,
|
|
FPDCTL, SSC_POWER_MASK, SSC_POWER_ON);
|
|
if (ret)
|
|
return ret;
|
|
|
|
usleep_range(100, 1000);
|
|
ret = rtsx_usb_write_register(ucr, CLK_DIV, CLK_CHANGE, 0x00);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* determine IC version */
|
|
ret = rtsx_usb_read_register(ucr, HW_VERSION, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ucr->ic_version = val & HW_VER_MASK;
|
|
|
|
/* determine package */
|
|
ret = rtsx_usb_read_register(ucr, CARD_SHARE_MODE, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (val & CARD_SHARE_LQFP_SEL) {
|
|
ucr->package = LQFP48;
|
|
dev_dbg(&ucr->pusb_intf->dev, "Package: LQFP48\n");
|
|
} else {
|
|
ucr->package = QFN24;
|
|
dev_dbg(&ucr->pusb_intf->dev, "Package: QFN24\n");
|
|
}
|
|
|
|
/* determine IC variations */
|
|
rtsx_usb_read_register(ucr, CFG_MODE_1, &val);
|
|
if (val & RTS5179) {
|
|
ucr->is_rts5179 = true;
|
|
dev_dbg(&ucr->pusb_intf->dev, "Device is rts5179\n");
|
|
} else {
|
|
ucr->is_rts5179 = false;
|
|
}
|
|
|
|
return rtsx_usb_reset_chip(ucr);
|
|
}
|
|
|
|
static int rtsx_usb_probe(struct usb_interface *intf,
|
|
const struct usb_device_id *id)
|
|
{
|
|
struct usb_device *usb_dev = interface_to_usbdev(intf);
|
|
struct rtsx_ucr *ucr;
|
|
int ret;
|
|
|
|
dev_dbg(&intf->dev,
|
|
": Realtek USB Card Reader found at bus %03d address %03d\n",
|
|
usb_dev->bus->busnum, usb_dev->devnum);
|
|
|
|
ucr = devm_kzalloc(&intf->dev, sizeof(*ucr), GFP_KERNEL);
|
|
if (!ucr)
|
|
return -ENOMEM;
|
|
|
|
ucr->pusb_dev = usb_dev;
|
|
|
|
ucr->iobuf = usb_alloc_coherent(ucr->pusb_dev, IOBUF_SIZE,
|
|
GFP_KERNEL, &ucr->iobuf_dma);
|
|
if (!ucr->iobuf)
|
|
return -ENOMEM;
|
|
|
|
usb_set_intfdata(intf, ucr);
|
|
|
|
ucr->vendor_id = id->idVendor;
|
|
ucr->product_id = id->idProduct;
|
|
ucr->cmd_buf = ucr->rsp_buf = ucr->iobuf;
|
|
|
|
mutex_init(&ucr->dev_mutex);
|
|
|
|
ucr->pusb_intf = intf;
|
|
|
|
/* initialize */
|
|
ret = rtsx_usb_init_chip(ucr);
|
|
if (ret)
|
|
goto out_init_fail;
|
|
|
|
/* initialize USB SG transfer timer */
|
|
setup_timer(&ucr->sg_timer, rtsx_usb_sg_timed_out, (unsigned long) ucr);
|
|
|
|
ret = mfd_add_hotplug_devices(&intf->dev, rtsx_usb_cells,
|
|
ARRAY_SIZE(rtsx_usb_cells));
|
|
if (ret)
|
|
goto out_init_fail;
|
|
|
|
#ifdef CONFIG_PM
|
|
intf->needs_remote_wakeup = 1;
|
|
usb_enable_autosuspend(usb_dev);
|
|
#endif
|
|
|
|
return 0;
|
|
|
|
out_init_fail:
|
|
usb_free_coherent(ucr->pusb_dev, IOBUF_SIZE, ucr->iobuf,
|
|
ucr->iobuf_dma);
|
|
return ret;
|
|
}
|
|
|
|
static void rtsx_usb_disconnect(struct usb_interface *intf)
|
|
{
|
|
struct rtsx_ucr *ucr = (struct rtsx_ucr *)usb_get_intfdata(intf);
|
|
|
|
dev_dbg(&intf->dev, "%s called\n", __func__);
|
|
|
|
mfd_remove_devices(&intf->dev);
|
|
|
|
usb_set_intfdata(ucr->pusb_intf, NULL);
|
|
usb_free_coherent(ucr->pusb_dev, IOBUF_SIZE, ucr->iobuf,
|
|
ucr->iobuf_dma);
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int rtsx_usb_suspend(struct usb_interface *intf, pm_message_t message)
|
|
{
|
|
struct rtsx_ucr *ucr =
|
|
(struct rtsx_ucr *)usb_get_intfdata(intf);
|
|
u16 val = 0;
|
|
|
|
dev_dbg(&intf->dev, "%s called with pm message 0x%04x\n",
|
|
__func__, message.event);
|
|
|
|
if (PMSG_IS_AUTO(message)) {
|
|
if (mutex_trylock(&ucr->dev_mutex)) {
|
|
rtsx_usb_get_card_status(ucr, &val);
|
|
mutex_unlock(&ucr->dev_mutex);
|
|
|
|
/* Defer the autosuspend if card exists */
|
|
if (val & (SD_CD | MS_CD))
|
|
return -EAGAIN;
|
|
} else {
|
|
/* There is an ongoing operation*/
|
|
return -EAGAIN;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtsx_usb_resume(struct usb_interface *intf)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int rtsx_usb_reset_resume(struct usb_interface *intf)
|
|
{
|
|
struct rtsx_ucr *ucr =
|
|
(struct rtsx_ucr *)usb_get_intfdata(intf);
|
|
|
|
rtsx_usb_reset_chip(ucr);
|
|
return 0;
|
|
}
|
|
|
|
#else /* CONFIG_PM */
|
|
|
|
#define rtsx_usb_suspend NULL
|
|
#define rtsx_usb_resume NULL
|
|
#define rtsx_usb_reset_resume NULL
|
|
|
|
#endif /* CONFIG_PM */
|
|
|
|
|
|
static int rtsx_usb_pre_reset(struct usb_interface *intf)
|
|
{
|
|
struct rtsx_ucr *ucr = (struct rtsx_ucr *)usb_get_intfdata(intf);
|
|
|
|
mutex_lock(&ucr->dev_mutex);
|
|
return 0;
|
|
}
|
|
|
|
static int rtsx_usb_post_reset(struct usb_interface *intf)
|
|
{
|
|
struct rtsx_ucr *ucr = (struct rtsx_ucr *)usb_get_intfdata(intf);
|
|
|
|
mutex_unlock(&ucr->dev_mutex);
|
|
return 0;
|
|
}
|
|
|
|
static struct usb_device_id rtsx_usb_usb_ids[] = {
|
|
{ USB_DEVICE(0x0BDA, 0x0129) },
|
|
{ USB_DEVICE(0x0BDA, 0x0139) },
|
|
{ USB_DEVICE(0x0BDA, 0x0140) },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(usb, rtsx_usb_usb_ids);
|
|
|
|
static struct usb_driver rtsx_usb_driver = {
|
|
.name = "rtsx_usb",
|
|
.probe = rtsx_usb_probe,
|
|
.disconnect = rtsx_usb_disconnect,
|
|
.suspend = rtsx_usb_suspend,
|
|
.resume = rtsx_usb_resume,
|
|
.reset_resume = rtsx_usb_reset_resume,
|
|
.pre_reset = rtsx_usb_pre_reset,
|
|
.post_reset = rtsx_usb_post_reset,
|
|
.id_table = rtsx_usb_usb_ids,
|
|
.supports_autosuspend = 1,
|
|
.soft_unbind = 1,
|
|
};
|
|
|
|
module_usb_driver(rtsx_usb_driver);
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_AUTHOR("Roger Tseng <rogerable@realtek.com>");
|
|
MODULE_DESCRIPTION("Realtek USB Card Reader Driver");
|