Index: linux-2.6.21/arch/arm/mach-pxa/ezx-e680.c =================================================================== --- linux-2.6.21.orig/arch/arm/mach-pxa/ezx-e680.c 2007-06-28 22:45:27.000000000 -0300 +++ linux-2.6.21/arch/arm/mach-pxa/ezx-e680.c 2007-06-28 22:53:10.000000000 -0300 @@ -13,6 +13,8 @@ #include #include #include +#include +#include #include #include @@ -20,12 +22,106 @@ #include #include #include +#include #include "generic.h" extern void ezx_lcd_power(int, struct fb_var_screeninfo *); extern void ezx_backlight_power(int); +#ifdef CONFIG_EZX_PCAP +extern int ezx_pcap_mmcsd_power(int); +extern void ezx_pcap_mmcsd_voltage(u_int32_t); +#else +#define ezx_pcap_mmcsd_voltage(x) {} +#define ezx_pcap_mmcsd_power(x) {} +#endif + +static struct pxamci_platform_data e680_mci_platform_data; + +static u_int8_t mmc_voltage[] = { + [MMC_VDD_160] = 3, + [MMC_VDD_170] = 3, + [MMC_VDD_180] = 3, + [MMC_VDD_190] = 3, + [MMC_VDD_200] = 3, + [MMC_VDD_210] = 3, + [MMC_VDD_220] = 3, + [MMC_VDD_230] = 3, + [MMC_VDD_240] = 3, + [MMC_VDD_250] = 3, + [MMC_VDD_260] = 3, + [MMC_VDD_270] = 3, + [MMC_VDD_280] = 3, + [MMC_VDD_290] = 3, + [MMC_VDD_300] = 3, + [MMC_VDD_310] = 3, + [MMC_VDD_320] = 3, + [MMC_VDD_330] = 3, + [MMC_VDD_340] = 3, + [MMC_VDD_350] = 3, + [MMC_VDD_360] = 3, +}; + +static int e680_mci_init(struct device *dev, + irqreturn_t (*ezx_detect_int)(int, void *), + void *data) +{ + int err; + + /* Setup GPIO for PXA27x MMC/SD controller */ + pxa_gpio_mode(GPIO32_MMCCLK_MD); + pxa_gpio_mode(GPIO112_MMCCMD_MD); + pxa_gpio_mode(GPIO92_MMCDAT0_MD); + pxa_gpio_mode(GPIO109_MMCDAT1_MD); + pxa_gpio_mode(GPIO110_MMCDAT2_MD); + pxa_gpio_mode(GPIO111_MMCDAT3_MD); + + ezx_pcap_mmcsd_power(1); + + e680_mci_platform_data.detect_delay = msecs_to_jiffies(250); + + err = request_irq(0x49, ezx_detect_int, SA_INTERRUPT, + "MMC card detect", data); + if (err) { + printk(KERN_ERR "ezx_mci_detect: MMC/SD: can't request " + "MMC card detect IRQ\n"); + return -1; + } + + set_irq_type(0x0b, IRQT_BOTHEDGE); + + return 0; +} + + +static inline int e680_mci_get_ro(struct device *dev) +{ + return (GPLR3 & 0x800); +} + +static void e680_mci_setpower(struct device *dev, unsigned int vdd) +{ + if (vdd <= MMC_VDD_360) + ezx_pcap_mmcsd_voltage(mmc_voltage[vdd]); + + ezx_pcap_mmcsd_power(1); +} + +static void e680_mci_exit(struct device *dev, void *data) +{ + ezx_pcap_mmcsd_power(0); + free_irq(0x49, data); +} + +static struct pxamci_platform_data e680_mci_platform_data = { + .ocr_mask = MMC_VDD_27_28, + .init = e680_mci_init, + .get_ro = e680_mci_get_ro, + .setpower = e680_mci_setpower, + .exit = e680_mci_exit, +}; + static struct pxafb_mode_info mode_e680 = { .pixclock = 150000, .xres = 240, @@ -144,6 +240,7 @@ PSLR = 0x05800f00; set_pxa_fb_info(&e680_fb_info); + pxa_set_mci_info(&e680_mci_platform_data); /* clear EMU MUX1/MUX2 (low) to close the audio path to EMU */ pxa_gpio_mode(GPIO_EMU_MUX1|GPIO_OUT);