ARM: MX3: add MMC suuport for lilly1131-db (d0b1eabc) · Commits · e / devices / android_kernel_fairphone_FP3

arch/arm/mach-mx3/mx31lilly-db.c

+67 −0

Original line number	Diff line number	Diff line
		@@ -27,6 +27,7 @@
		#include <linux/kernel.h>
		#include <linux/types.h>
		#include <linux/init.h>
		#include <linux/gpio.h>

		#include <asm/mach-types.h>
		#include <asm/mach/arch.h>
		@@ -37,6 +38,7 @@
		#include <mach/imx-uart.h>
		#include <mach/iomux-mx3.h>
		#include <mach/board-mx31lilly.h>
		#include <mach/mmc.h>

		#include "devices.h"

		@@ -51,6 +53,12 @@ static unsigned int lilly_db_board_pins[] __initdata = {
		MX31_PIN_RTS1__RTS1,
		MX31_PIN_TXD1__TXD1,
		MX31_PIN_RXD1__RXD1,
		MX31_PIN_SD1_DATA3__SD1_DATA3,
		MX31_PIN_SD1_DATA2__SD1_DATA2,
		MX31_PIN_SD1_DATA1__SD1_DATA1,
		MX31_PIN_SD1_DATA0__SD1_DATA0,
		MX31_PIN_SD1_CLK__SD1_CLK,
		MX31_PIN_SD1_CMD__SD1_CMD,
		};

		/* UART */
		@@ -58,11 +66,70 @@ static struct imxuart_platform_data uart_pdata __initdata = {
		.flags = IMXUART_HAVE_RTSCTS,
		};

		/* MMC support */

		static int mxc_mmc1_get_ro(struct device *dev)
		{
		return gpio_get_value(IOMUX_TO_GPIO(MX31_PIN_LCS0));
		}

		static int gpio_det, gpio_wp;

		static int mxc_mmc1_init(struct device *dev,
		irq_handler_t detect_irq, void *data)
		{
		int ret;

		gpio_det = IOMUX_TO_GPIO(MX31_PIN_GPIO1_1);
		gpio_wp = IOMUX_TO_GPIO(MX31_PIN_LCS0);

		ret = gpio_request(gpio_det, "MMC detect");
		if (ret)
		return ret;

		ret = gpio_request(gpio_wp, "MMC w/p");
		if (ret)
		goto exit_free_det;

		gpio_direction_input(gpio_det);
		gpio_direction_input(gpio_wp);

		ret = request_irq(IOMUX_TO_IRQ(MX31_PIN_GPIO1_1), detect_irq,
		IRQF_DISABLED \| IRQF_TRIGGER_FALLING,
		"MMC detect", data);
		if (ret)
		goto exit_free_wp;

		return 0;

		exit_free_wp:
		gpio_free(gpio_wp);

		exit_free_det:
		gpio_free(gpio_det);

		return ret;
		}

		static void mxc_mmc1_exit(struct device dev, void data)
		{
		gpio_free(gpio_det);
		gpio_free(gpio_wp);
		free_irq(IOMUX_TO_IRQ(MX31_PIN_GPIO1_1), data);
		}

		static struct imxmmc_platform_data mmc_pdata = {
		.get_ro = mxc_mmc1_get_ro,
		.init = mxc_mmc1_init,
		.exit = mxc_mmc1_exit,
		};

		void __init mx31lilly_db_init(void)
		{
		mxc_iomux_setup_multiple_pins(lilly_db_board_pins,
		ARRAY_SIZE(lilly_db_board_pins),
		"development board pins");
		mxc_register_device(&mxc_uart_device0, &uart_pdata);
		mxc_register_device(&mxcsdhc_device0, &mmc_pdata);
		}