| /* | 
 |  * Copyright (C) 2009 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. | 
 |  * | 
 |  * You should have received a copy of the GNU General Public License | 
 |  * along with this program; if not, write to the Free Software | 
 |  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA | 
 |  */ | 
 |  | 
 | #include <linux/delay.h> | 
 | #include <linux/gpio.h> | 
 | #include <linux/init.h> | 
 | #include <linux/interrupt.h> | 
 | #include <linux/i2c.h> | 
 | #include <linux/spi/spi.h> | 
 | #include <linux/platform_device.h> | 
 | #include <linux/types.h> | 
 |  | 
 | #include <linux/usb/otg.h> | 
 |  | 
 | #include <mach/common.h> | 
 | #include <mach/hardware.h> | 
 | #include <mach/imx-uart.h> | 
 | #include <mach/iomux-mx3.h> | 
 | #include <mach/mmc.h> | 
 | #include <mach/mxc_ehci.h> | 
 | #include <mach/ulpi.h> | 
 |  | 
 | #include <media/soc_camera.h> | 
 |  | 
 | #include "devices.h" | 
 |  | 
 | static unsigned int marxbot_pins[] = { | 
 | 	/* SDHC2 */ | 
 | 	MX31_PIN_PC_PWRON__SD2_DATA3, MX31_PIN_PC_VS1__SD2_DATA2, | 
 | 	MX31_PIN_PC_READY__SD2_DATA1, MX31_PIN_PC_WAIT_B__SD2_DATA0, | 
 | 	MX31_PIN_PC_CD2_B__SD2_CLK, MX31_PIN_PC_CD1_B__SD2_CMD, | 
 | 	MX31_PIN_ATA_DIOR__GPIO3_28, MX31_PIN_ATA_DIOW__GPIO3_29, | 
 | 	/* CSI */ | 
 | 	MX31_PIN_CSI_D6__CSI_D6, MX31_PIN_CSI_D7__CSI_D7, | 
 | 	MX31_PIN_CSI_D8__CSI_D8, MX31_PIN_CSI_D9__CSI_D9, | 
 | 	MX31_PIN_CSI_D10__CSI_D10, MX31_PIN_CSI_D11__CSI_D11, | 
 | 	MX31_PIN_CSI_D12__CSI_D12, MX31_PIN_CSI_D13__CSI_D13, | 
 | 	MX31_PIN_CSI_D14__CSI_D14, MX31_PIN_CSI_D15__CSI_D15, | 
 | 	MX31_PIN_CSI_HSYNC__CSI_HSYNC, MX31_PIN_CSI_MCLK__CSI_MCLK, | 
 | 	MX31_PIN_CSI_PIXCLK__CSI_PIXCLK, MX31_PIN_CSI_VSYNC__CSI_VSYNC, | 
 | 	MX31_PIN_CSI_D4__GPIO3_4, MX31_PIN_CSI_D5__GPIO3_5, | 
 | 	MX31_PIN_GPIO3_0__GPIO3_0, MX31_PIN_GPIO3_1__GPIO3_1, | 
 | 	MX31_PIN_TXD2__GPIO1_28, | 
 | 	/* dsPIC resets */ | 
 | 	MX31_PIN_STXD5__GPIO1_21, MX31_PIN_SRXD5__GPIO1_22, | 
 | 	/*battery detection */ | 
 | 	MX31_PIN_LCS0__GPIO3_23, | 
 | 	/* USB H1 */ | 
 | 	MX31_PIN_CSPI1_MISO__USBH1_RXDP, MX31_PIN_CSPI1_MOSI__USBH1_RXDM, | 
 | 	MX31_PIN_CSPI1_SS0__USBH1_TXDM, MX31_PIN_CSPI1_SS1__USBH1_TXDP, | 
 | 	MX31_PIN_CSPI1_SS2__USBH1_RCV, MX31_PIN_CSPI1_SCLK__USBH1_OEB, | 
 | 	MX31_PIN_CSPI1_SPI_RDY__USBH1_FS, MX31_PIN_SFS6__USBH1_SUSPEND, | 
 | 	MX31_PIN_NFRE_B__GPIO1_11, MX31_PIN_NFALE__GPIO1_12, | 
 | }; | 
 |  | 
 | #define SDHC2_CD IOMUX_TO_GPIO(MX31_PIN_ATA_DIOR) | 
 | #define SDHC2_WP IOMUX_TO_GPIO(MX31_PIN_ATA_DIOW) | 
 |  | 
 | static int marxbot_sdhc2_get_ro(struct device *dev) | 
 | { | 
 | 	return !gpio_get_value(SDHC2_WP); | 
 | } | 
 |  | 
 | static int marxbot_sdhc2_init(struct device *dev, irq_handler_t detect_irq, | 
 | 		void *data) | 
 | { | 
 | 	int ret; | 
 |  | 
 | 	ret = gpio_request(SDHC2_CD, "sdhc-detect"); | 
 | 	if (ret) | 
 | 		return ret; | 
 |  | 
 | 	gpio_direction_input(SDHC2_CD); | 
 |  | 
 | 	ret = gpio_request(SDHC2_WP, "sdhc-wp"); | 
 | 	if (ret) | 
 | 		goto err_gpio_free; | 
 | 	gpio_direction_input(SDHC2_WP); | 
 |  | 
 | 	ret = request_irq(gpio_to_irq(SDHC2_CD), detect_irq, | 
 | 		IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, | 
 | 		"sdhc2-card-detect", data); | 
 | 	if (ret) | 
 | 		goto err_gpio_free_2; | 
 |  | 
 | 	return 0; | 
 |  | 
 | err_gpio_free_2: | 
 | 	gpio_free(SDHC2_WP); | 
 | err_gpio_free: | 
 | 	gpio_free(SDHC2_CD); | 
 |  | 
 | 	return ret; | 
 | } | 
 |  | 
 | static void marxbot_sdhc2_exit(struct device *dev, void *data) | 
 | { | 
 | 	free_irq(gpio_to_irq(SDHC2_CD), data); | 
 | 	gpio_free(SDHC2_WP); | 
 | 	gpio_free(SDHC2_CD); | 
 | } | 
 |  | 
 | static struct imxmmc_platform_data sdhc2_pdata = { | 
 | 	.get_ro	= marxbot_sdhc2_get_ro, | 
 | 	.init	= marxbot_sdhc2_init, | 
 | 	.exit	= marxbot_sdhc2_exit, | 
 | }; | 
 |  | 
 | #define TRSLAT_RST_B	IOMUX_TO_GPIO(MX31_PIN_STXD5) | 
 | #define DSPICS_RST_B	IOMUX_TO_GPIO(MX31_PIN_SRXD5) | 
 |  | 
 | static void dspics_resets_init(void) | 
 | { | 
 | 	if (!gpio_request(TRSLAT_RST_B, "translator-rst")) { | 
 | 		gpio_direction_output(TRSLAT_RST_B, 1); | 
 | 		gpio_export(TRSLAT_RST_B, false); | 
 | 	} | 
 |  | 
 | 	if (!gpio_request(DSPICS_RST_B, "dspics-rst")) { | 
 | 		gpio_direction_output(DSPICS_RST_B, 1); | 
 | 		gpio_export(DSPICS_RST_B, false); | 
 | 	} | 
 | } | 
 |  | 
 | static struct spi_board_info marxbot_spi_board_info[] __initdata = { | 
 | 	{ | 
 | 		.modalias = "spidev", | 
 | 		.max_speed_hz = 300000, | 
 | 		.bus_num = 1, | 
 | 		.chip_select = 1, /* according spi1_cs[] ! */ | 
 | 	}, | 
 | }; | 
 |  | 
 | #define TURRETCAM_POWER	IOMUX_TO_GPIO(MX31_PIN_GPIO3_1) | 
 | #define BASECAM_POWER	IOMUX_TO_GPIO(MX31_PIN_CSI_D5) | 
 | #define TURRETCAM_RST_B	IOMUX_TO_GPIO(MX31_PIN_GPIO3_0) | 
 | #define BASECAM_RST_B	IOMUX_TO_GPIO(MX31_PIN_CSI_D4) | 
 | #define CAM_CHOICE	IOMUX_TO_GPIO(MX31_PIN_TXD2) | 
 |  | 
 | static int marxbot_basecam_power(struct device *dev, int on) | 
 | { | 
 | 	gpio_set_value(BASECAM_POWER, !on); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int marxbot_basecam_reset(struct device *dev) | 
 | { | 
 | 	gpio_set_value(BASECAM_RST_B, 0); | 
 | 	udelay(100); | 
 | 	gpio_set_value(BASECAM_RST_B, 1); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct i2c_board_info marxbot_i2c_devices[] = { | 
 | 	{ | 
 | 		I2C_BOARD_INFO("mt9t031", 0x5d), | 
 | 	}, | 
 | }; | 
 |  | 
 | static struct soc_camera_link base_iclink = { | 
 | 	.bus_id		= 0,		/* Must match with the camera ID */ | 
 | 	.power		= marxbot_basecam_power, | 
 | 	.reset		= marxbot_basecam_reset, | 
 | 	.board_info	= &marxbot_i2c_devices[0], | 
 | 	.i2c_adapter_id	= 0, | 
 | 	.module_name	= "mt9t031", | 
 | }; | 
 |  | 
 | static struct platform_device marxbot_camera[] = { | 
 | 	{ | 
 | 		.name	= "soc-camera-pdrv", | 
 | 		.id	= 0, | 
 | 		.dev	= { | 
 | 			.platform_data = &base_iclink, | 
 | 		}, | 
 | 	}, | 
 | }; | 
 |  | 
 | static struct platform_device *marxbot_cameras[] __initdata = { | 
 | 	&marxbot_camera[0], | 
 | }; | 
 |  | 
 | static int __init marxbot_cam_init(void) | 
 | { | 
 | 	int ret = gpio_request(CAM_CHOICE, "cam-choice"); | 
 | 	if (ret) | 
 | 		return ret; | 
 | 	gpio_direction_output(CAM_CHOICE, 1); | 
 |  | 
 | 	ret = gpio_request(BASECAM_RST_B, "basecam-reset"); | 
 | 	if (ret) | 
 | 		return ret; | 
 | 	gpio_direction_output(BASECAM_RST_B, 1); | 
 | 	ret = gpio_request(BASECAM_POWER, "basecam-standby"); | 
 | 	if (ret) | 
 | 		return ret; | 
 | 	gpio_direction_output(BASECAM_POWER, 0); | 
 |  | 
 | 	ret = gpio_request(TURRETCAM_RST_B, "turretcam-reset"); | 
 | 	if (ret) | 
 | 		return ret; | 
 | 	gpio_direction_output(TURRETCAM_RST_B, 1); | 
 | 	ret = gpio_request(TURRETCAM_POWER, "turretcam-standby"); | 
 | 	if (ret) | 
 | 		return ret; | 
 | 	gpio_direction_output(TURRETCAM_POWER, 0); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | #define USB_PAD_CFG (PAD_CTL_DRV_MAX | PAD_CTL_SRE_FAST | PAD_CTL_HYS_CMOS | \ | 
 | 			PAD_CTL_ODE_CMOS | PAD_CTL_100K_PU) | 
 |  | 
 | static int marxbot_usbh1_hw_init(struct platform_device *pdev) | 
 | { | 
 | 	mxc_iomux_set_gpr(MUX_PGP_USB_SUSPEND, true); | 
 |  | 
 | 	mxc_iomux_set_pad(MX31_PIN_CSPI1_MISO, USB_PAD_CFG); | 
 | 	mxc_iomux_set_pad(MX31_PIN_CSPI1_MOSI, USB_PAD_CFG); | 
 | 	mxc_iomux_set_pad(MX31_PIN_CSPI1_SS0, USB_PAD_CFG); | 
 | 	mxc_iomux_set_pad(MX31_PIN_CSPI1_SS1, USB_PAD_CFG); | 
 | 	mxc_iomux_set_pad(MX31_PIN_CSPI1_SS2, USB_PAD_CFG); | 
 | 	mxc_iomux_set_pad(MX31_PIN_CSPI1_SCLK, USB_PAD_CFG); | 
 | 	mxc_iomux_set_pad(MX31_PIN_CSPI1_SPI_RDY, USB_PAD_CFG); | 
 | 	mxc_iomux_set_pad(MX31_PIN_SFS6, USB_PAD_CFG); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | #define USBH1_VBUSEN_B	IOMUX_TO_GPIO(MX31_PIN_NFRE_B) | 
 | #define USBH1_MODE	IOMUX_TO_GPIO(MX31_PIN_NFALE) | 
 |  | 
 | static int marxbot_isp1105_init(struct otg_transceiver *otg) | 
 | { | 
 | 	int ret = gpio_request(USBH1_MODE, "usbh1-mode"); | 
 | 	if (ret) | 
 | 		return ret; | 
 | 	/* single ended */ | 
 | 	gpio_direction_output(USBH1_MODE, 0); | 
 |  | 
 | 	ret = gpio_request(USBH1_VBUSEN_B, "usbh1-vbusen"); | 
 | 	if (ret) { | 
 | 		gpio_free(USBH1_MODE); | 
 | 		return ret; | 
 | 	} | 
 | 	gpio_direction_output(USBH1_VBUSEN_B, 1); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 |  | 
 | static int marxbot_isp1105_set_vbus(struct otg_transceiver *otg, bool on) | 
 | { | 
 | 	if (on) | 
 | 		gpio_set_value(USBH1_VBUSEN_B, 0); | 
 | 	else | 
 | 		gpio_set_value(USBH1_VBUSEN_B, 1); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct mxc_usbh_platform_data usbh1_pdata = { | 
 | 	.init	= marxbot_usbh1_hw_init, | 
 | 	.portsc	= MXC_EHCI_MODE_UTMI | MXC_EHCI_SERIAL, | 
 | 	.flags	= MXC_EHCI_POWER_PINS_ENABLED | MXC_EHCI_INTERFACE_SINGLE_UNI, | 
 | }; | 
 |  | 
 | static int __init marxbot_usbh1_init(void) | 
 | { | 
 | 	struct otg_transceiver *otg; | 
 |  | 
 | 	otg = kzalloc(sizeof(*otg), GFP_KERNEL); | 
 | 	if (!otg) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	otg->label	= "ISP1105"; | 
 | 	otg->init	= marxbot_isp1105_init; | 
 | 	otg->set_vbus	= marxbot_isp1105_set_vbus; | 
 |  | 
 | 	usbh1_pdata.otg = otg; | 
 |  | 
 | 	return mxc_register_device(&mxc_usbh1, &usbh1_pdata); | 
 | } | 
 |  | 
 | /* | 
 |  * system init for baseboard usage. Will be called by mx31moboard init. | 
 |  */ | 
 | void __init mx31moboard_marxbot_init(void) | 
 | { | 
 | 	printk(KERN_INFO "Initializing mx31marxbot peripherals\n"); | 
 |  | 
 | 	mxc_iomux_setup_multiple_pins(marxbot_pins, ARRAY_SIZE(marxbot_pins), | 
 | 		"marxbot"); | 
 |  | 
 | 	dspics_resets_init(); | 
 |  | 
 | 	mxc_register_device(&mxcsdhc_device1, &sdhc2_pdata); | 
 |  | 
 | 	spi_register_board_info(marxbot_spi_board_info, | 
 | 		ARRAY_SIZE(marxbot_spi_board_info)); | 
 |  | 
 | 	marxbot_cam_init(); | 
 | 	platform_add_devices(marxbot_cameras, ARRAY_SIZE(marxbot_cameras)); | 
 |  | 
 | 	/* battery present pin */ | 
 | 	gpio_request(IOMUX_TO_GPIO(MX31_PIN_LCS0), "bat-present"); | 
 | 	gpio_direction_input(IOMUX_TO_GPIO(MX31_PIN_LCS0)); | 
 | 	gpio_export(IOMUX_TO_GPIO(MX31_PIN_LCS0), false); | 
 |  | 
 | 	marxbot_usbh1_init(); | 
 | } |