Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit ada8a8a1 authored by Wei WANG's avatar Wei WANG Committed by Samuel Ortiz
Browse files

mfd: Add realtek pcie card reader driver 



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

Signed-off-by: default avatarWei WANG <wei_wang@realsil.com.cn>
Reviewed-by: default avatarArnd Bergmann <arnd@arndb.de>
Tested-by: default avatarBorislav Petkov <bp@alien8.de>
Signed-off-by: default avatarSamuel Ortiz <sameo@linux.intel.com>
parent 0312e024

drivers/mfd/Kconfig

+9 −0
Original line number Diff line number Diff line
@@ -63,6 +63,15 @@ config MFD_SM501_GPIO 
	 lines on the SM501. The platform data is used to supply the

	 base number for the first GPIO line to register.



config MFD_RTSX_PCI

	tristate "Support for Realtek PCI-E card reader"

	depends on PCI

	help

	  This supports for Realtek PCI-Express card reader including rts5209,

	  rts5229, rtl8411, etc. Realtek card reader supports access to many

	  types of memory cards, such as Memory Stick, Memory Stick Pro,

	  Secure Digital and MultiMediaCard.



config MFD_ASIC3

	bool "Support for Compaq ASIC3"

	depends on GENERIC_HARDIRQS && GPIOLIB && ARM

drivers/mfd/Makefile

+3 −0
Original line number Diff line number Diff line
@@ -9,6 +9,9 @@ obj-$(CONFIG_MFD_88PM805) += 88pm805.o 88pm80x.o 
obj-$(CONFIG_MFD_SM501)		+= sm501.o

obj-$(CONFIG_MFD_ASIC3)		+= asic3.o tmio_core.o



rtsx_pci-objs			:= rtsx_pcr.o rts5209.o rts5229.o rtl8411.o

obj-$(CONFIG_MFD_RTSX_PCI)	+= rtsx_pci.o



obj-$(CONFIG_HTC_EGPIO)		+= htc-egpio.o

obj-$(CONFIG_HTC_PASIC3)	+= htc-pasic3.o

obj-$(CONFIG_HTC_I2CPLD)	+= htc-i2cpld.o

drivers/mfd/rtl8411.c

0 → 100644
+251 −0
Original line number Diff line number Diff line 
/* 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@realsil.com.cn>

 *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China

 */



#include <linux/module.h>

#include <linux/bitops.h>

#include <linux/delay.h>

#include <linux/mfd/rtsx_pci.h>



#include "rtsx_pcr.h"



static u8 rtl8411_get_ic_version(struct rtsx_pcr *pcr)

{

	u8 val;



	rtsx_pci_read_register(pcr, SYS_VER, &val);

	return val & 0x0F;

}



static int rtl8411_extra_init_hw(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, CD_PAD_CTL,

			CD_DISABLE_MASK | CD_AUTO_DISABLE, CD_ENABLE);

}



static int rtl8411_turn_on_led(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, CARD_GPIO, 0x01, 0x00);

}



static int rtl8411_turn_off_led(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, CARD_GPIO, 0x01, 0x01);

}



static int rtl8411_enable_auto_blink(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, CARD_AUTO_BLINK, 0xFF, 0x0D);

}



static int rtl8411_disable_auto_blink(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, CARD_AUTO_BLINK, 0x08, 0x00);

}



static int rtl8411_card_power_on(struct rtsx_pcr *pcr, int card)

{

	int err;



	rtsx_pci_init_cmd(pcr);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_PWR_CTL,

			BPP_POWER_MASK, BPP_POWER_5_PERCENT_ON);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, LDO_CTL,

			BPP_LDO_POWB, BPP_LDO_SUSPEND);

	err = rtsx_pci_send_cmd(pcr, 100);

	if (err < 0)

		return err;



	/* To avoid too large in-rush current */

	udelay(150);



	err = rtsx_pci_write_register(pcr, CARD_PWR_CTL,

			BPP_POWER_MASK, BPP_POWER_10_PERCENT_ON);

	if (err < 0)

		return err;



	udelay(150);



	err = rtsx_pci_write_register(pcr, CARD_PWR_CTL,

			BPP_POWER_MASK, BPP_POWER_15_PERCENT_ON);

	if (err < 0)

		return err;



	udelay(150);



	err = rtsx_pci_write_register(pcr, CARD_PWR_CTL,

			BPP_POWER_MASK, BPP_POWER_ON);

	if (err < 0)

		return err;



	return rtsx_pci_write_register(pcr, LDO_CTL, BPP_LDO_POWB, BPP_LDO_ON);

}



static int rtl8411_card_power_off(struct rtsx_pcr *pcr, int card)

{

	int err;



	err = rtsx_pci_write_register(pcr, CARD_PWR_CTL,

			BPP_POWER_MASK, BPP_POWER_OFF);

	if (err < 0)

		return err;



	return rtsx_pci_write_register(pcr, LDO_CTL,

			BPP_LDO_POWB, BPP_LDO_SUSPEND);

}



static unsigned int rtl8411_cd_deglitch(struct rtsx_pcr *pcr)

{

	unsigned int card_exist;



	card_exist = rtsx_pci_readl(pcr, RTSX_BIPR);

	card_exist &= CARD_EXIST;

	if (!card_exist) {

		/* Enable card CD */

		rtsx_pci_write_register(pcr, CD_PAD_CTL,

				CD_DISABLE_MASK, CD_ENABLE);

		/* Enable card interrupt */

		rtsx_pci_write_register(pcr, EFUSE_CONTENT, 0xe0, 0x00);

		return 0;

	}



	if (hweight32(card_exist) > 1) {

		rtsx_pci_write_register(pcr, CARD_PWR_CTL,

				BPP_POWER_MASK, BPP_POWER_5_PERCENT_ON);

		msleep(100);



		card_exist = rtsx_pci_readl(pcr, RTSX_BIPR);

		if (card_exist & MS_EXIST)

			card_exist = MS_EXIST;

		else if (card_exist & SD_EXIST)

			card_exist = SD_EXIST;

		else

			card_exist = 0;



		rtsx_pci_write_register(pcr, CARD_PWR_CTL,

				BPP_POWER_MASK, BPP_POWER_OFF);



		dev_dbg(&(pcr->pci->dev),

				"After CD deglitch, card_exist = 0x%x\n",

				card_exist);

	}



	if (card_exist & MS_EXIST) {

		/* Disable SD interrupt */

		rtsx_pci_write_register(pcr, EFUSE_CONTENT, 0xe0, 0x40);

		rtsx_pci_write_register(pcr, CD_PAD_CTL,

				CD_DISABLE_MASK, MS_CD_EN_ONLY);

	} else if (card_exist & SD_EXIST) {

		/* Disable MS interrupt */

		rtsx_pci_write_register(pcr, EFUSE_CONTENT, 0xe0, 0x80);

		rtsx_pci_write_register(pcr, CD_PAD_CTL,

				CD_DISABLE_MASK, SD_CD_EN_ONLY);

	}



	return card_exist;

}



static const struct pcr_ops rtl8411_pcr_ops = {

	.extra_init_hw = rtl8411_extra_init_hw,

	.optimize_phy = NULL,

	.turn_on_led = rtl8411_turn_on_led,

	.turn_off_led = rtl8411_turn_off_led,

	.enable_auto_blink = rtl8411_enable_auto_blink,

	.disable_auto_blink = rtl8411_disable_auto_blink,

	.card_power_on = rtl8411_card_power_on,

	.card_power_off = rtl8411_card_power_off,

	.cd_deglitch = rtl8411_cd_deglitch,

};



/* SD Pull Control Enable:

 *     SD_DAT[3:0] ==> pull up

 *     SD_CD       ==> pull up

 *     SD_WP       ==> pull up

 *     SD_CMD      ==> pull up

 *     SD_CLK      ==> pull down

 */

static const u32 rtl8411_sd_pull_ctl_enable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL1, 0xAA),

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0xAA),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0xA9),

	RTSX_REG_PAIR(CARD_PULL_CTL4, 0x09),

	RTSX_REG_PAIR(CARD_PULL_CTL5, 0x09),

	RTSX_REG_PAIR(CARD_PULL_CTL6, 0x04),

	0,

};



/* SD Pull Control Disable:

 *     SD_DAT[3:0] ==> pull down

 *     SD_CD       ==> pull up

 *     SD_WP       ==> pull down

 *     SD_CMD      ==> pull down

 *     SD_CLK      ==> pull down

 */

static const u32 rtl8411_sd_pull_ctl_disable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL1, 0x65),

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0x95),

	RTSX_REG_PAIR(CARD_PULL_CTL4, 0x09),

	RTSX_REG_PAIR(CARD_PULL_CTL5, 0x05),

	RTSX_REG_PAIR(CARD_PULL_CTL6, 0x04),

	0,

};



/* MS Pull Control Enable:

 *     MS CD       ==> pull up

 *     others      ==> pull down

 */

static const u32 rtl8411_ms_pull_ctl_enable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL1, 0x65),

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0x95),

	RTSX_REG_PAIR(CARD_PULL_CTL4, 0x05),

	RTSX_REG_PAIR(CARD_PULL_CTL5, 0x05),

	RTSX_REG_PAIR(CARD_PULL_CTL6, 0x04),

	0,

};



/* MS Pull Control Disable:

 *     MS CD       ==> pull up

 *     others      ==> pull down

 */

static const u32 rtl8411_ms_pull_ctl_disable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL1, 0x65),

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0x95),

	RTSX_REG_PAIR(CARD_PULL_CTL4, 0x09),

	RTSX_REG_PAIR(CARD_PULL_CTL5, 0x05),

	RTSX_REG_PAIR(CARD_PULL_CTL6, 0x04),

	0,

};



void rtl8411_init_params(struct rtsx_pcr *pcr)

{

	pcr->extra_caps = EXTRA_CAPS_SD_SDR50 | EXTRA_CAPS_SD_SDR104;

	pcr->num_slots = 2;

	pcr->ops = &rtl8411_pcr_ops;



	pcr->ic_version = rtl8411_get_ic_version(pcr);

	pcr->sd_pull_ctl_enable_tbl = rtl8411_sd_pull_ctl_enable_tbl;

	pcr->sd_pull_ctl_disable_tbl = rtl8411_sd_pull_ctl_disable_tbl;

	pcr->ms_pull_ctl_enable_tbl = rtl8411_ms_pull_ctl_enable_tbl;

	pcr->ms_pull_ctl_disable_tbl = rtl8411_ms_pull_ctl_disable_tbl;

}

drivers/mfd/rts5209.c

0 → 100644
+223 −0
Original line number Diff line number Diff line 
/* 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@realsil.com.cn>

 *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China

 */



#include <linux/module.h>

#include <linux/delay.h>

#include <linux/mfd/rtsx_pci.h>



#include "rtsx_pcr.h"



static u8 rts5209_get_ic_version(struct rtsx_pcr *pcr)

{

	u8 val;



	val = rtsx_pci_readb(pcr, 0x1C);

	return val & 0x0F;

}



static void rts5209_init_vendor_cfg(struct rtsx_pcr *pcr)

{

	u32 val;



	rtsx_pci_read_config_dword(pcr, 0x724, &val);

	dev_dbg(&(pcr->pci->dev), "Cfg 0x724: 0x%x\n", val);



	if (!(val & 0x80)) {

		if (val & 0x08)

			pcr->ms_pmos = false;

		else

			pcr->ms_pmos = true;

	}

}



static int rts5209_extra_init_hw(struct rtsx_pcr *pcr)

{

	rtsx_pci_init_cmd(pcr);



	/* Turn off LED */

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_GPIO, 0xFF, 0x03);

	/* Configure GPIO as output */

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_GPIO_DIR, 0xFF, 0x03);



	return rtsx_pci_send_cmd(pcr, 100);

}



static int rts5209_optimize_phy(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_phy_register(pcr, 0x00, 0xB966);

}



static int rts5209_turn_on_led(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, CARD_GPIO, 0x01, 0x00);

}



static int rts5209_turn_off_led(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, CARD_GPIO, 0x01, 0x01);

}



static int rts5209_enable_auto_blink(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, CARD_AUTO_BLINK, 0xFF, 0x0D);

}



static int rts5209_disable_auto_blink(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, CARD_AUTO_BLINK, 0x08, 0x00);

}



static int rts5209_card_power_on(struct rtsx_pcr *pcr, int card)

{

	int err;

	u8 pwr_mask, partial_pwr_on, pwr_on;



	pwr_mask = SD_POWER_MASK;

	partial_pwr_on = SD_PARTIAL_POWER_ON;

	pwr_on = SD_POWER_ON;



	if (pcr->ms_pmos && (card == RTSX_MS_CARD)) {

		pwr_mask = MS_POWER_MASK;

		partial_pwr_on = MS_PARTIAL_POWER_ON;

		pwr_on = MS_POWER_ON;

	}



	rtsx_pci_init_cmd(pcr);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_PWR_CTL,

			pwr_mask, partial_pwr_on);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, PWR_GATE_CTRL,

			LDO3318_PWR_MASK, 0x04);

	err = rtsx_pci_send_cmd(pcr, 100);

	if (err < 0)

		return err;



	/* To avoid too large in-rush current */

	udelay(150);



	rtsx_pci_init_cmd(pcr);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_PWR_CTL, pwr_mask, pwr_on);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, PWR_GATE_CTRL,

			LDO3318_PWR_MASK, 0x00);

	err = rtsx_pci_send_cmd(pcr, 100);

	if (err < 0)

		return err;



	return 0;

}



static int rts5209_card_power_off(struct rtsx_pcr *pcr, int card)

{

	u8 pwr_mask, pwr_off;



	pwr_mask = SD_POWER_MASK;

	pwr_off = SD_POWER_OFF;



	if (pcr->ms_pmos && (card == RTSX_MS_CARD)) {

		pwr_mask = MS_POWER_MASK;

		pwr_off = MS_POWER_OFF;

	}



	rtsx_pci_init_cmd(pcr);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_PWR_CTL,

			pwr_mask | PMOS_STRG_MASK, pwr_off | PMOS_STRG_400mA);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, PWR_GATE_CTRL,

			LDO3318_PWR_MASK, 0X06);

	return rtsx_pci_send_cmd(pcr, 100);

}



static const struct pcr_ops rts5209_pcr_ops = {

	.extra_init_hw = rts5209_extra_init_hw,

	.optimize_phy = rts5209_optimize_phy,

	.turn_on_led = rts5209_turn_on_led,

	.turn_off_led = rts5209_turn_off_led,

	.enable_auto_blink = rts5209_enable_auto_blink,

	.disable_auto_blink = rts5209_disable_auto_blink,

	.card_power_on = rts5209_card_power_on,

	.card_power_off = rts5209_card_power_off,

	.cd_deglitch = NULL,

};



/* SD Pull Control Enable:

 *     SD_DAT[3:0] ==> pull up

 *     SD_CD       ==> pull up

 *     SD_WP       ==> pull up

 *     SD_CMD      ==> pull up

 *     SD_CLK      ==> pull down

 */

static const u32 rts5209_sd_pull_ctl_enable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL1, 0xAA),

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0xAA),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0xE9),

	0,

};



/* SD Pull Control Disable:

 *     SD_DAT[3:0] ==> pull down

 *     SD_CD       ==> pull up

 *     SD_WP       ==> pull down

 *     SD_CMD      ==> pull down

 *     SD_CLK      ==> pull down

 */

static const u32 rts5209_sd_pull_ctl_disable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL1, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0xD5),

	0,

};



/* MS Pull Control Enable:

 *     MS CD       ==> pull up

 *     others      ==> pull down

 */

static const u32 rts5209_ms_pull_ctl_enable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL4, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL5, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL6, 0x15),

	0,

};



/* MS Pull Control Disable:

 *     MS CD       ==> pull up

 *     others      ==> pull down

 */

static const u32 rts5209_ms_pull_ctl_disable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL4, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL5, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL6, 0x15),

	0,

};



void rts5209_init_params(struct rtsx_pcr *pcr)

{

	pcr->extra_caps = EXTRA_CAPS_SD_SDR50 |

		EXTRA_CAPS_SD_SDR104 | EXTRA_CAPS_MMC_8BIT;

	pcr->num_slots = 2;

	pcr->ops = &rts5209_pcr_ops;



	rts5209_init_vendor_cfg(pcr);



	pcr->ic_version = rts5209_get_ic_version(pcr);

	pcr->sd_pull_ctl_enable_tbl = rts5209_sd_pull_ctl_enable_tbl;

	pcr->sd_pull_ctl_disable_tbl = rts5209_sd_pull_ctl_disable_tbl;

	pcr->ms_pull_ctl_enable_tbl = rts5209_ms_pull_ctl_enable_tbl;

	pcr->ms_pull_ctl_disable_tbl = rts5209_ms_pull_ctl_disable_tbl;

}

drivers/mfd/rts5229.c

0 → 100644
+205 −0
Original line number Diff line number Diff line 
/* 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@realsil.com.cn>

 *   No. 450, Shenhu Road, Suzhou Industry Park, Suzhou, China

 */



#include <linux/module.h>

#include <linux/delay.h>

#include <linux/mfd/rtsx_pci.h>



#include "rtsx_pcr.h"



static u8 rts5229_get_ic_version(struct rtsx_pcr *pcr)

{

	u8 val;



	rtsx_pci_read_register(pcr, DUMMY_REG_RESET_0, &val);

	return val & 0x0F;

}



static int rts5229_extra_init_hw(struct rtsx_pcr *pcr)

{

	rtsx_pci_init_cmd(pcr);



	/* Configure GPIO as output */

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, GPIO_CTL, 0x02, 0x02);

	/* Switch LDO3318 source from DV33 to card_3v3 */

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, LDO_PWR_SEL, 0x03, 0x00);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, LDO_PWR_SEL, 0x03, 0x01);

	/* LED shine disabled, set initial shine cycle period */

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, OLT_LED_CTL, 0x0F, 0x02);



	return rtsx_pci_send_cmd(pcr, 100);

}



static int rts5229_optimize_phy(struct rtsx_pcr *pcr)

{

	/* Optimize RX sensitivity */

	return rtsx_pci_write_phy_register(pcr, 0x00, 0xBA42);

}



static int rts5229_turn_on_led(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, GPIO_CTL, 0x02, 0x02);

}



static int rts5229_turn_off_led(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, GPIO_CTL, 0x02, 0x00);

}



static int rts5229_enable_auto_blink(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, OLT_LED_CTL, 0x08, 0x08);

}



static int rts5229_disable_auto_blink(struct rtsx_pcr *pcr)

{

	return rtsx_pci_write_register(pcr, OLT_LED_CTL, 0x08, 0x00);

}



static int rts5229_card_power_on(struct rtsx_pcr *pcr, int card)

{

	int err;



	rtsx_pci_init_cmd(pcr);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_PWR_CTL,

			SD_POWER_MASK, SD_PARTIAL_POWER_ON);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, PWR_GATE_CTRL,

			LDO3318_PWR_MASK, 0x02);

	err = rtsx_pci_send_cmd(pcr, 100);

	if (err < 0)

		return err;



	/* To avoid too large in-rush current */

	udelay(150);



	rtsx_pci_init_cmd(pcr);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_PWR_CTL,

			SD_POWER_MASK, SD_POWER_ON);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, PWR_GATE_CTRL,

			LDO3318_PWR_MASK, 0x06);

	err = rtsx_pci_send_cmd(pcr, 100);

	if (err < 0)

		return err;



	return 0;

}



static int rts5229_card_power_off(struct rtsx_pcr *pcr, int card)

{

	rtsx_pci_init_cmd(pcr);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_PWR_CTL,

			SD_POWER_MASK | PMOS_STRG_MASK,

			SD_POWER_OFF | PMOS_STRG_400mA);

	rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, PWR_GATE_CTRL,

			LDO3318_PWR_MASK, 0X00);

	return rtsx_pci_send_cmd(pcr, 100);

}



static const struct pcr_ops rts5229_pcr_ops = {

	.extra_init_hw = rts5229_extra_init_hw,

	.optimize_phy = rts5229_optimize_phy,

	.turn_on_led = rts5229_turn_on_led,

	.turn_off_led = rts5229_turn_off_led,

	.enable_auto_blink = rts5229_enable_auto_blink,

	.disable_auto_blink = rts5229_disable_auto_blink,

	.card_power_on = rts5229_card_power_on,

	.card_power_off = rts5229_card_power_off,

	.cd_deglitch = NULL,

};



/* SD Pull Control Enable:

 *     SD_DAT[3:0] ==> pull up

 *     SD_CD       ==> pull up

 *     SD_WP       ==> pull up

 *     SD_CMD      ==> pull up

 *     SD_CLK      ==> pull down

 */

static const u32 rts5229_sd_pull_ctl_enable_tbl1[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0xAA),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0xE9),

	0,

};



/* For RTS5229 version C */

static const u32 rts5229_sd_pull_ctl_enable_tbl2[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0xAA),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0xD9),

	0,

};



/* SD Pull Control Disable:

 *     SD_DAT[3:0] ==> pull down

 *     SD_CD       ==> pull up

 *     SD_WP       ==> pull down

 *     SD_CMD      ==> pull down

 *     SD_CLK      ==> pull down

 */

static const u32 rts5229_sd_pull_ctl_disable_tbl1[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0xD5),

	0,

};



/* For RTS5229 version C */

static const u32 rts5229_sd_pull_ctl_disable_tbl2[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL2, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL3, 0xE5),

	0,

};



/* MS Pull Control Enable:

 *     MS CD       ==> pull up

 *     others      ==> pull down

 */

static const u32 rts5229_ms_pull_ctl_enable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL5, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL6, 0x15),

	0,

};



/* MS Pull Control Disable:

 *     MS CD       ==> pull up

 *     others      ==> pull down

 */

static const u32 rts5229_ms_pull_ctl_disable_tbl[] = {

	RTSX_REG_PAIR(CARD_PULL_CTL5, 0x55),

	RTSX_REG_PAIR(CARD_PULL_CTL6, 0x15),

	0,

};



void rts5229_init_params(struct rtsx_pcr *pcr)

{

	pcr->extra_caps = EXTRA_CAPS_SD_SDR50 | EXTRA_CAPS_SD_SDR104;

	pcr->num_slots = 2;

	pcr->ops = &rts5229_pcr_ops;



	pcr->ic_version = rts5229_get_ic_version(pcr);

	if (pcr->ic_version == IC_VER_C) {

		pcr->sd_pull_ctl_enable_tbl = rts5229_sd_pull_ctl_enable_tbl2;

		pcr->sd_pull_ctl_disable_tbl = rts5229_sd_pull_ctl_disable_tbl2;

	} else {

		pcr->sd_pull_ctl_enable_tbl = rts5229_sd_pull_ctl_enable_tbl1;

		pcr->sd_pull_ctl_disable_tbl = rts5229_sd_pull_ctl_disable_tbl1;

	}

	pcr->ms_pull_ctl_enable_tbl = rts5229_ms_pull_ctl_enable_tbl;

	pcr->ms_pull_ctl_disable_tbl = rts5229_ms_pull_ctl_disable_tbl;

}