| /* | 
 |  *  Copyright (C) 2008 Valentin Longchamp, EPFL Mobots group | 
 |  * | 
 |  * 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 of the License, 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. | 
 |  */ | 
 |  | 
 | #include <linux/delay.h> | 
 | #include <linux/dma-mapping.h> | 
 | #include <linux/gfp.h> | 
 | #include <linux/gpio.h> | 
 | #include <linux/init.h> | 
 | #include <linux/interrupt.h> | 
 | #include <linux/leds.h> | 
 | #include <linux/memory.h> | 
 | #include <linux/mtd/physmap.h> | 
 | #include <linux/mtd/partitions.h> | 
 | #include <linux/platform_device.h> | 
 | #include <linux/regulator/machine.h> | 
 | #include <linux/mfd/mc13783.h> | 
 | #include <linux/spi/spi.h> | 
 | #include <linux/types.h> | 
 | #include <linux/memblock.h> | 
 |  | 
 | #include <linux/usb/otg.h> | 
 | #include <linux/usb/ulpi.h> | 
 |  | 
 | #include <asm/mach-types.h> | 
 | #include <asm/mach/arch.h> | 
 | #include <asm/mach/time.h> | 
 | #include <asm/mach/map.h> | 
 | #include <mach/board-mx31moboard.h> | 
 | #include <mach/common.h> | 
 | #include <mach/hardware.h> | 
 | #include <mach/iomux-mx3.h> | 
 | #include <mach/ulpi.h> | 
 |  | 
 | #include "devices-imx31.h" | 
 |  | 
 | static unsigned int moboard_pins[] = { | 
 | 	/* UART0 */ | 
 | 	MX31_PIN_TXD1__TXD1, MX31_PIN_RXD1__RXD1, | 
 | 	MX31_PIN_CTS1__GPIO2_7, | 
 | 	/* UART4 */ | 
 | 	MX31_PIN_PC_RST__CTS5, MX31_PIN_PC_VS2__RTS5, | 
 | 	MX31_PIN_PC_BVD2__TXD5, MX31_PIN_PC_BVD1__RXD5, | 
 | 	/* I2C0 */ | 
 | 	MX31_PIN_I2C_DAT__I2C1_SDA, MX31_PIN_I2C_CLK__I2C1_SCL, | 
 | 	/* I2C1 */ | 
 | 	MX31_PIN_DCD_DTE1__I2C2_SDA, MX31_PIN_RI_DTE1__I2C2_SCL, | 
 | 	/* SDHC1 */ | 
 | 	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, | 
 | 	MX31_PIN_ATA_CS0__GPIO3_26, MX31_PIN_ATA_CS1__GPIO3_27, | 
 | 	/* USB reset */ | 
 | 	MX31_PIN_GPIO1_0__GPIO1_0, | 
 | 	/* USB OTG */ | 
 | 	MX31_PIN_USBOTG_DATA0__USBOTG_DATA0, | 
 | 	MX31_PIN_USBOTG_DATA1__USBOTG_DATA1, | 
 | 	MX31_PIN_USBOTG_DATA2__USBOTG_DATA2, | 
 | 	MX31_PIN_USBOTG_DATA3__USBOTG_DATA3, | 
 | 	MX31_PIN_USBOTG_DATA4__USBOTG_DATA4, | 
 | 	MX31_PIN_USBOTG_DATA5__USBOTG_DATA5, | 
 | 	MX31_PIN_USBOTG_DATA6__USBOTG_DATA6, | 
 | 	MX31_PIN_USBOTG_DATA7__USBOTG_DATA7, | 
 | 	MX31_PIN_USBOTG_CLK__USBOTG_CLK, MX31_PIN_USBOTG_DIR__USBOTG_DIR, | 
 | 	MX31_PIN_USBOTG_NXT__USBOTG_NXT, MX31_PIN_USBOTG_STP__USBOTG_STP, | 
 | 	MX31_PIN_USB_OC__GPIO1_30, | 
 | 	/* USB H2 */ | 
 | 	MX31_PIN_USBH2_DATA0__USBH2_DATA0, | 
 | 	MX31_PIN_USBH2_DATA1__USBH2_DATA1, | 
 | 	MX31_PIN_STXD3__USBH2_DATA2, MX31_PIN_SRXD3__USBH2_DATA3, | 
 | 	MX31_PIN_SCK3__USBH2_DATA4, MX31_PIN_SFS3__USBH2_DATA5, | 
 | 	MX31_PIN_STXD6__USBH2_DATA6, MX31_PIN_SRXD6__USBH2_DATA7, | 
 | 	MX31_PIN_USBH2_CLK__USBH2_CLK, MX31_PIN_USBH2_DIR__USBH2_DIR, | 
 | 	MX31_PIN_USBH2_NXT__USBH2_NXT, MX31_PIN_USBH2_STP__USBH2_STP, | 
 | 	MX31_PIN_SCK6__GPIO1_25, | 
 | 	/* LEDs */ | 
 | 	MX31_PIN_SVEN0__GPIO2_0, MX31_PIN_STX0__GPIO2_1, | 
 | 	MX31_PIN_SRX0__GPIO2_2, MX31_PIN_SIMPD0__GPIO2_3, | 
 | 	/* SPI1 */ | 
 | 	MX31_PIN_CSPI2_MOSI__MOSI, MX31_PIN_CSPI2_MISO__MISO, | 
 | 	MX31_PIN_CSPI2_SCLK__SCLK, MX31_PIN_CSPI2_SPI_RDY__SPI_RDY, | 
 | 	MX31_PIN_CSPI2_SS0__SS0, MX31_PIN_CSPI2_SS2__SS2, | 
 | 	/* Atlas IRQ */ | 
 | 	MX31_PIN_GPIO1_3__GPIO1_3, | 
 | 	/* SPI2 */ | 
 | 	MX31_PIN_CSPI3_MOSI__MOSI, MX31_PIN_CSPI3_MISO__MISO, | 
 | 	MX31_PIN_CSPI3_SCLK__SCLK, MX31_PIN_CSPI3_SPI_RDY__SPI_RDY, | 
 | 	MX31_PIN_CSPI2_SS1__CSPI3_SS1, | 
 | }; | 
 |  | 
 | static struct physmap_flash_data mx31moboard_flash_data = { | 
 | 	.width	= 2, | 
 | }; | 
 |  | 
 | static struct resource mx31moboard_flash_resource = { | 
 | 	.start	= 0xa0000000, | 
 | 	.end	= 0xa1ffffff, | 
 | 	.flags	= IORESOURCE_MEM, | 
 | }; | 
 |  | 
 | static struct platform_device mx31moboard_flash = { | 
 | 	.name	= "physmap-flash", | 
 | 	.id	= 0, | 
 | 	.dev	= { | 
 | 		.platform_data  = &mx31moboard_flash_data, | 
 | 	}, | 
 | 	.resource = &mx31moboard_flash_resource, | 
 | 	.num_resources = 1, | 
 | }; | 
 |  | 
 | static int moboard_uart0_init(struct platform_device *pdev) | 
 | { | 
 | 	int ret = gpio_request(IOMUX_TO_GPIO(MX31_PIN_CTS1), "uart0-cts-hack"); | 
 | 	if (ret) | 
 | 		return ret; | 
 |  | 
 | 	ret = gpio_direction_output(IOMUX_TO_GPIO(MX31_PIN_CTS1), 0); | 
 | 	if (ret) | 
 | 		gpio_free(IOMUX_TO_GPIO(MX31_PIN_CTS1)); | 
 |  | 
 | 	return ret; | 
 | } | 
 |  | 
 | static void moboard_uart0_exit(struct platform_device *pdev) | 
 | { | 
 | 	gpio_free(IOMUX_TO_GPIO(MX31_PIN_CTS1)); | 
 | } | 
 |  | 
 | static const struct imxuart_platform_data uart0_pdata __initconst = { | 
 | 	.init = moboard_uart0_init, | 
 | 	.exit = moboard_uart0_exit, | 
 | }; | 
 |  | 
 | static const struct imxuart_platform_data uart4_pdata __initconst = { | 
 | 	.flags = IMXUART_HAVE_RTSCTS, | 
 | }; | 
 |  | 
 | static const struct imxi2c_platform_data moboard_i2c0_data __initconst = { | 
 | 	.bitrate = 400000, | 
 | }; | 
 |  | 
 | static const struct imxi2c_platform_data moboard_i2c1_data __initconst = { | 
 | 	.bitrate = 100000, | 
 | }; | 
 |  | 
 | static int moboard_spi1_cs[] = { | 
 | 	MXC_SPI_CS(0), | 
 | 	MXC_SPI_CS(2), | 
 | }; | 
 |  | 
 | static const struct spi_imx_master moboard_spi1_pdata __initconst = { | 
 | 	.chipselect	= moboard_spi1_cs, | 
 | 	.num_chipselect	= ARRAY_SIZE(moboard_spi1_cs), | 
 | }; | 
 |  | 
 | static struct regulator_consumer_supply sdhc_consumers[] = { | 
 | 	{ | 
 | 		.dev_name = "mxc-mmc.0", | 
 | 		.supply	= "sdhc0_vcc", | 
 | 	}, | 
 | 	{ | 
 | 		.dev_name = "mxc-mmc.1", | 
 | 		.supply	= "sdhc1_vcc", | 
 | 	}, | 
 | }; | 
 |  | 
 | static struct regulator_init_data sdhc_vreg_data = { | 
 | 	.constraints = { | 
 | 		.min_uV = 2700000, | 
 | 		.max_uV = 3000000, | 
 | 		.valid_ops_mask = REGULATOR_CHANGE_VOLTAGE | | 
 | 			REGULATOR_CHANGE_MODE | REGULATOR_CHANGE_STATUS, | 
 | 		.valid_modes_mask = REGULATOR_MODE_NORMAL | | 
 | 			REGULATOR_MODE_FAST, | 
 | 		.always_on = 0, | 
 | 		.boot_on = 1, | 
 | 	}, | 
 | 	.num_consumer_supplies = ARRAY_SIZE(sdhc_consumers), | 
 | 	.consumer_supplies = sdhc_consumers, | 
 | }; | 
 |  | 
 | static struct regulator_consumer_supply cam_consumers[] = { | 
 | 	{ | 
 | 		.dev_name = "mx3_camera.0", | 
 | 		.supply = "cam_vcc", | 
 | 	}, | 
 | }; | 
 |  | 
 | static struct regulator_init_data cam_vreg_data = { | 
 | 	.constraints = { | 
 | 		.min_uV = 2700000, | 
 | 		.max_uV = 3000000, | 
 | 		.valid_ops_mask = REGULATOR_CHANGE_VOLTAGE | | 
 | 			REGULATOR_CHANGE_MODE | REGULATOR_CHANGE_STATUS, | 
 | 		.valid_modes_mask = REGULATOR_MODE_NORMAL | | 
 | 			REGULATOR_MODE_FAST, | 
 | 		.always_on = 0, | 
 | 		.boot_on = 1, | 
 | 	}, | 
 | 	.num_consumer_supplies = ARRAY_SIZE(cam_consumers), | 
 | 	.consumer_supplies = cam_consumers, | 
 | }; | 
 |  | 
 | static struct mc13xxx_regulator_init_data moboard_regulators[] = { | 
 | 	{ | 
 | 		.id = MC13783_REG_VMMC1, | 
 | 		.init_data = &sdhc_vreg_data, | 
 | 	}, | 
 | 	{ | 
 | 		.id = MC13783_REG_VCAM, | 
 | 		.init_data = &cam_vreg_data, | 
 | 	}, | 
 | }; | 
 |  | 
 | static struct mc13783_led_platform_data moboard_led[] = { | 
 | 	{ | 
 | 		.id = MC13783_LED_R1, | 
 | 		.name = "coreboard-led-4:red", | 
 | 		.max_current = 2, | 
 | 	}, | 
 | 	{ | 
 | 		.id = MC13783_LED_G1, | 
 | 		.name = "coreboard-led-4:green", | 
 | 		.max_current = 2, | 
 | 	}, | 
 | 	{ | 
 | 		.id = MC13783_LED_B1, | 
 | 		.name = "coreboard-led-4:blue", | 
 | 		.max_current = 2, | 
 | 	}, | 
 | 	{ | 
 | 		.id = MC13783_LED_R2, | 
 | 		.name = "coreboard-led-5:red", | 
 | 		.max_current = 3, | 
 | 	}, | 
 | 	{ | 
 | 		.id = MC13783_LED_G2, | 
 | 		.name = "coreboard-led-5:green", | 
 | 		.max_current = 3, | 
 | 	}, | 
 | 	{ | 
 | 		.id = MC13783_LED_B2, | 
 | 		.name = "coreboard-led-5:blue", | 
 | 		.max_current = 3, | 
 | 	}, | 
 | }; | 
 |  | 
 | static struct mc13783_leds_platform_data moboard_leds = { | 
 | 	.num_leds = ARRAY_SIZE(moboard_led), | 
 | 	.led = moboard_led, | 
 | 	.flags = MC13783_LED_SLEWLIMTC, | 
 | 	.abmode = MC13783_LED_AB_DISABLED, | 
 | 	.tc1_period = MC13783_LED_PERIOD_10MS, | 
 | 	.tc2_period = MC13783_LED_PERIOD_10MS, | 
 | }; | 
 |  | 
 | static struct mc13xxx_platform_data moboard_pmic = { | 
 | 	.regulators = { | 
 | 		.regulators = moboard_regulators, | 
 | 		.num_regulators = ARRAY_SIZE(moboard_regulators), | 
 | 	}, | 
 | 	.leds = &moboard_leds, | 
 | 	.flags = MC13XXX_USE_REGULATOR | MC13XXX_USE_RTC | | 
 | 		MC13XXX_USE_ADC | MC13XXX_USE_LED, | 
 | }; | 
 |  | 
 | static struct spi_board_info moboard_spi_board_info[] __initdata = { | 
 | 	{ | 
 | 		.modalias = "mc13783", | 
 | 		.irq = IOMUX_TO_IRQ(MX31_PIN_GPIO1_3), | 
 | 		.max_speed_hz = 300000, | 
 | 		.bus_num = 1, | 
 | 		.chip_select = 0, | 
 | 		.platform_data = &moboard_pmic, | 
 | 		.mode = SPI_CS_HIGH, | 
 | 	}, | 
 | }; | 
 |  | 
 | static int moboard_spi2_cs[] = { | 
 | 	MXC_SPI_CS(1), | 
 | }; | 
 |  | 
 | static const struct spi_imx_master moboard_spi2_pdata __initconst = { | 
 | 	.chipselect	= moboard_spi2_cs, | 
 | 	.num_chipselect	= ARRAY_SIZE(moboard_spi2_cs), | 
 | }; | 
 |  | 
 | #define SDHC1_CD IOMUX_TO_GPIO(MX31_PIN_ATA_CS0) | 
 | #define SDHC1_WP IOMUX_TO_GPIO(MX31_PIN_ATA_CS1) | 
 |  | 
 | static int moboard_sdhc1_get_ro(struct device *dev) | 
 | { | 
 | 	return !gpio_get_value(SDHC1_WP); | 
 | } | 
 |  | 
 | static int moboard_sdhc1_init(struct device *dev, irq_handler_t detect_irq, | 
 | 		void *data) | 
 | { | 
 | 	int ret; | 
 |  | 
 | 	ret = gpio_request(SDHC1_CD, "sdhc-detect"); | 
 | 	if (ret) | 
 | 		return ret; | 
 |  | 
 | 	gpio_direction_input(SDHC1_CD); | 
 |  | 
 | 	ret = gpio_request(SDHC1_WP, "sdhc-wp"); | 
 | 	if (ret) | 
 | 		goto err_gpio_free; | 
 | 	gpio_direction_input(SDHC1_WP); | 
 |  | 
 | 	ret = request_irq(gpio_to_irq(SDHC1_CD), detect_irq, | 
 | 		IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, | 
 | 		"sdhc1-card-detect", data); | 
 | 	if (ret) | 
 | 		goto err_gpio_free_2; | 
 |  | 
 | 	return 0; | 
 |  | 
 | err_gpio_free_2: | 
 | 	gpio_free(SDHC1_WP); | 
 | err_gpio_free: | 
 | 	gpio_free(SDHC1_CD); | 
 |  | 
 | 	return ret; | 
 | } | 
 |  | 
 | static void moboard_sdhc1_exit(struct device *dev, void *data) | 
 | { | 
 | 	free_irq(gpio_to_irq(SDHC1_CD), data); | 
 | 	gpio_free(SDHC1_WP); | 
 | 	gpio_free(SDHC1_CD); | 
 | } | 
 |  | 
 | static const struct imxmmc_platform_data sdhc1_pdata __initconst = { | 
 | 	.get_ro	= moboard_sdhc1_get_ro, | 
 | 	.init	= moboard_sdhc1_init, | 
 | 	.exit	= moboard_sdhc1_exit, | 
 | }; | 
 |  | 
 | /* | 
 |  * this pin is dedicated for all mx31moboard systems, so we do it here | 
 |  */ | 
 | #define USB_RESET_B	IOMUX_TO_GPIO(MX31_PIN_GPIO1_0) | 
 | #define USB_PAD_CFG (PAD_CTL_DRV_MAX | PAD_CTL_SRE_FAST | PAD_CTL_HYS_CMOS | \ | 
 | 		      PAD_CTL_ODE_CMOS) | 
 |  | 
 | #define OTG_EN_B IOMUX_TO_GPIO(MX31_PIN_USB_OC) | 
 | #define USBH2_EN_B IOMUX_TO_GPIO(MX31_PIN_SCK6) | 
 |  | 
 | static void usb_xcvr_reset(void) | 
 | { | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA0, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA1, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA2, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA3, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA4, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA5, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA6, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA7, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_CLK, USB_PAD_CFG | PAD_CTL_100K_PU); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DIR, USB_PAD_CFG | PAD_CTL_100K_PU); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_NXT, USB_PAD_CFG | PAD_CTL_100K_PU); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBOTG_STP, USB_PAD_CFG | PAD_CTL_100K_PU); | 
 |  | 
 | 	mxc_iomux_set_gpr(MUX_PGP_UH2, true); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBH2_CLK, USB_PAD_CFG | PAD_CTL_100K_PU); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBH2_DIR, USB_PAD_CFG | PAD_CTL_100K_PU); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBH2_NXT, USB_PAD_CFG | PAD_CTL_100K_PU); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBH2_STP, USB_PAD_CFG | PAD_CTL_100K_PU); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBH2_DATA0, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_USBH2_DATA1, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_SRXD6, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_STXD6, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_SFS3, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_SCK3, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_SRXD3, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 | 	mxc_iomux_set_pad(MX31_PIN_STXD3, USB_PAD_CFG | PAD_CTL_100K_PD); | 
 |  | 
 | 	gpio_request(OTG_EN_B, "usb-udc-en"); | 
 | 	gpio_direction_output(OTG_EN_B, 0); | 
 | 	gpio_request(USBH2_EN_B, "usbh2-en"); | 
 | 	gpio_direction_output(USBH2_EN_B, 0); | 
 |  | 
 | 	gpio_request(USB_RESET_B, "usb-reset"); | 
 | 	gpio_direction_output(USB_RESET_B, 0); | 
 | 	mdelay(1); | 
 | 	gpio_set_value(USB_RESET_B, 1); | 
 | 	mdelay(1); | 
 | } | 
 |  | 
 | static int moboard_usbh2_init_hw(struct platform_device *pdev) | 
 | { | 
 | 	return mx31_initialize_usb_hw(pdev->id, MXC_EHCI_POWER_PINS_ENABLED); | 
 | } | 
 |  | 
 | static struct mxc_usbh_platform_data usbh2_pdata __initdata = { | 
 | 	.init	= moboard_usbh2_init_hw, | 
 | 	.portsc	= MXC_EHCI_MODE_ULPI | MXC_EHCI_UTMI_8BIT, | 
 | }; | 
 |  | 
 | static int __init moboard_usbh2_init(void) | 
 | { | 
 | 	struct platform_device *pdev; | 
 |  | 
 | 	usbh2_pdata.otg = imx_otg_ulpi_create(ULPI_OTG_DRVVBUS | | 
 | 			ULPI_OTG_DRVVBUS_EXT); | 
 | 	if (!usbh2_pdata.otg) | 
 | 		return -ENODEV; | 
 |  | 
 | 	pdev = imx31_add_mxc_ehci_hs(2, &usbh2_pdata); | 
 | 	if (IS_ERR(pdev)) | 
 | 		return PTR_ERR(pdev); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static const struct gpio_led mx31moboard_leds[] __initconst = { | 
 | 	{ | 
 | 		.name	= "coreboard-led-0:red:running", | 
 | 		.default_trigger = "heartbeat", | 
 | 		.gpio	= IOMUX_TO_GPIO(MX31_PIN_SVEN0), | 
 | 	}, { | 
 | 		.name	= "coreboard-led-1:red", | 
 | 		.gpio	= IOMUX_TO_GPIO(MX31_PIN_STX0), | 
 | 	}, { | 
 | 		.name	= "coreboard-led-2:red", | 
 | 		.gpio	= IOMUX_TO_GPIO(MX31_PIN_SRX0), | 
 | 	}, { | 
 | 		.name	= "coreboard-led-3:red", | 
 | 		.gpio	= IOMUX_TO_GPIO(MX31_PIN_SIMPD0), | 
 | 	}, | 
 | }; | 
 |  | 
 | static const struct gpio_led_platform_data mx31moboard_led_pdata __initconst = { | 
 | 	.num_leds	= ARRAY_SIZE(mx31moboard_leds), | 
 | 	.leds		= mx31moboard_leds, | 
 | }; | 
 |  | 
 | static const struct ipu_platform_data mx3_ipu_data __initconst = { | 
 | 	.irq_base = MXC_IPU_IRQ_START, | 
 | }; | 
 |  | 
 | static struct platform_device *devices[] __initdata = { | 
 | 	&mx31moboard_flash, | 
 | }; | 
 |  | 
 | static struct mx3_camera_pdata camera_pdata __initdata = { | 
 | 	.flags		= MX3_CAMERA_DATAWIDTH_8 | MX3_CAMERA_DATAWIDTH_10, | 
 | 	.mclk_10khz	= 4800, | 
 | }; | 
 |  | 
 | static phys_addr_t mx3_camera_base __initdata; | 
 | #define MX3_CAMERA_BUF_SIZE SZ_4M | 
 |  | 
 | static int __init mx31moboard_init_cam(void) | 
 | { | 
 | 	int dma, ret = -ENOMEM; | 
 | 	struct platform_device *pdev; | 
 |  | 
 | 	imx31_add_ipu_core(&mx3_ipu_data); | 
 |  | 
 | 	pdev = imx31_alloc_mx3_camera(&camera_pdata); | 
 | 	if (IS_ERR(pdev)) | 
 | 		return PTR_ERR(pdev); | 
 |  | 
 | 	dma = dma_declare_coherent_memory(&pdev->dev, | 
 | 					mx3_camera_base, mx3_camera_base, | 
 | 					MX3_CAMERA_BUF_SIZE, | 
 | 					DMA_MEMORY_MAP | DMA_MEMORY_EXCLUSIVE); | 
 | 	if (!(dma & DMA_MEMORY_MAP)) | 
 | 		goto err; | 
 |  | 
 | 	ret = platform_device_add(pdev); | 
 | 	if (ret) | 
 | err: | 
 | 		platform_device_put(pdev); | 
 |  | 
 | 	return ret; | 
 |  | 
 | } | 
 |  | 
 | static int mx31moboard_baseboard; | 
 | core_param(mx31moboard_baseboard, mx31moboard_baseboard, int, 0444); | 
 |  | 
 | /* | 
 |  * Board specific initialization. | 
 |  */ | 
 | static void __init mx31moboard_init(void) | 
 | { | 
 | 	imx31_soc_init(); | 
 |  | 
 | 	mxc_iomux_setup_multiple_pins(moboard_pins, ARRAY_SIZE(moboard_pins), | 
 | 		"moboard"); | 
 |  | 
 | 	platform_add_devices(devices, ARRAY_SIZE(devices)); | 
 | 	gpio_led_register_device(-1, &mx31moboard_led_pdata); | 
 |  | 
 | 	imx31_add_imx_uart0(&uart0_pdata); | 
 | 	imx31_add_imx_uart4(&uart4_pdata); | 
 |  | 
 | 	imx31_add_imx_i2c0(&moboard_i2c0_data); | 
 | 	imx31_add_imx_i2c1(&moboard_i2c1_data); | 
 |  | 
 | 	imx31_add_spi_imx1(&moboard_spi1_pdata); | 
 | 	imx31_add_spi_imx2(&moboard_spi2_pdata); | 
 |  | 
 | 	gpio_request(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3), "pmic-irq"); | 
 | 	gpio_direction_input(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3)); | 
 | 	spi_register_board_info(moboard_spi_board_info, | 
 | 		ARRAY_SIZE(moboard_spi_board_info)); | 
 |  | 
 | 	imx31_add_mxc_mmc(0, &sdhc1_pdata); | 
 |  | 
 | 	mx31moboard_init_cam(); | 
 |  | 
 | 	usb_xcvr_reset(); | 
 |  | 
 | 	moboard_usbh2_init(); | 
 |  | 
 | 	switch (mx31moboard_baseboard) { | 
 | 	case MX31NOBOARD: | 
 | 		break; | 
 | 	case MX31DEVBOARD: | 
 | 		mx31moboard_devboard_init(); | 
 | 		break; | 
 | 	case MX31MARXBOT: | 
 | 		mx31moboard_marxbot_init(); | 
 | 		break; | 
 | 	case MX31SMARTBOT: | 
 | 	case MX31EYEBOT: | 
 | 		mx31moboard_smartbot_init(mx31moboard_baseboard); | 
 | 		break; | 
 | 	default: | 
 | 		printk(KERN_ERR "Illegal mx31moboard_baseboard type %d\n", | 
 | 			mx31moboard_baseboard); | 
 | 	} | 
 | } | 
 |  | 
 | static void __init mx31moboard_timer_init(void) | 
 | { | 
 | 	mx31_clocks_init(26000000); | 
 | } | 
 |  | 
 | struct sys_timer mx31moboard_timer = { | 
 | 	.init	= mx31moboard_timer_init, | 
 | }; | 
 |  | 
 | static void __init mx31moboard_reserve(void) | 
 | { | 
 | 	/* reserve 4 MiB for mx3-camera */ | 
 | 	mx3_camera_base = memblock_alloc(MX3_CAMERA_BUF_SIZE, | 
 | 			MX3_CAMERA_BUF_SIZE); | 
 | 	memblock_free(mx3_camera_base, MX3_CAMERA_BUF_SIZE); | 
 | 	memblock_remove(mx3_camera_base, MX3_CAMERA_BUF_SIZE); | 
 | } | 
 |  | 
 | MACHINE_START(MX31MOBOARD, "EPFL Mobots mx31moboard") | 
 | 	/* Maintainer: Valentin Longchamp, EPFL Mobots group */ | 
 | 	.boot_params = MX3x_PHYS_OFFSET + 0x100, | 
 | 	.reserve = mx31moboard_reserve, | 
 | 	.map_io = mx31_map_io, | 
 | 	.init_early = imx31_init_early, | 
 | 	.init_irq = mx31_init_irq, | 
 | 	.timer = &mx31moboard_timer, | 
 | 	.init_machine = mx31moboard_init, | 
 | MACHINE_END |