mach-mx31moboard.c 16.3 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14
/*
 *  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.
 */

15
#include <linux/delay.h>
V
Valentin Longchamp 已提交
16
#include <linux/dma-mapping.h>
17
#include <linux/gfp.h>
18
#include <linux/gpio.h>
19
#include <linux/init.h>
20
#include <linux/interrupt.h>
21
#include <linux/moduleparam.h>
22
#include <linux/leds.h>
23
#include <linux/memory.h>
24 25
#include <linux/mtd/physmap.h>
#include <linux/mtd/partitions.h>
26
#include <linux/platform_device.h>
27 28 29
#include <linux/regulator/machine.h>
#include <linux/mfd/mc13783.h>
#include <linux/spi/spi.h>
30
#include <linux/types.h>
31
#include <linux/memblock.h>
32 33 34
#include <linux/clk.h>
#include <linux/io.h>
#include <linux/err.h>
35
#include <linux/input.h>
36

37 38 39
#include <linux/usb/otg.h>
#include <linux/usb/ulpi.h>

40 41 42 43
#include <asm/mach-types.h>
#include <asm/mach/arch.h>
#include <asm/mach/time.h>
#include <asm/mach/map.h>
44
#include <asm/memblock.h>
45
#include <mach/board-mx31moboard.h>
46
#include <mach/common.h>
47
#include <mach/hardware.h>
48
#include <mach/iomux-mx3.h>
49
#include <mach/ulpi.h>
50
#include <mach/ssi.h>
51

52
#include "devices-imx31.h"
53

54 55 56
static unsigned int moboard_pins[] = {
	/* UART0 */
	MX31_PIN_TXD1__TXD1, MX31_PIN_RXD1__RXD1,
V
Valentin Longchamp 已提交
57
	MX31_PIN_CTS1__GPIO2_7,
58 59 60
	/* UART4 */
	MX31_PIN_PC_RST__CTS5, MX31_PIN_PC_VS2__RTS5,
	MX31_PIN_PC_BVD2__TXD5, MX31_PIN_PC_BVD1__RXD5,
61 62 63 64 65 66 67 68 69
	/* 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,
70 71
	/* USB reset */
	MX31_PIN_GPIO1_0__GPIO1_0,
72 73 74 75 76 77 78 79 80 81 82 83
	/* 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,
84 85 86 87 88 89 90 91 92
	/* 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,
93 94 95
	/* LEDs */
	MX31_PIN_SVEN0__GPIO2_0, MX31_PIN_STX0__GPIO2_1,
	MX31_PIN_SRX0__GPIO2_2, MX31_PIN_SIMPD0__GPIO2_3,
96 97 98 99 100 101 102 103 104 105
	/* 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,
106 107 108
	/* SSI */
	MX31_PIN_STXD4__STXD4, MX31_PIN_SRXD4__SRXD4,
	MX31_PIN_SCK4__SCK4, MX31_PIN_SFS4__SFS4,
109 110
};

111
static struct physmap_flash_data mx31moboard_flash_data = {
112
	.width	= 2,
113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130
};

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,
};

V
Valentin Longchamp 已提交
131 132
static int moboard_uart0_init(struct platform_device *pdev)
{
133 134 135 136 137 138 139 140 141 142 143 144 145 146
	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));
V
Valentin Longchamp 已提交
147 148
}

149
static const struct imxuart_platform_data uart0_pdata __initconst = {
V
Valentin Longchamp 已提交
150
	.init = moboard_uart0_init,
151
	.exit = moboard_uart0_exit,
V
Valentin Longchamp 已提交
152 153
};

154
static const struct imxuart_platform_data uart4_pdata __initconst = {
155 156 157
	.flags = IMXUART_HAVE_RTSCTS,
};

158
static const struct imxi2c_platform_data moboard_i2c0_data __initconst = {
159 160 161
	.bitrate = 400000,
};

162
static const struct imxi2c_platform_data moboard_i2c1_data __initconst = {
163 164 165
	.bitrate = 100000,
};

166 167 168 169 170
static int moboard_spi1_cs[] = {
	MXC_SPI_CS(0),
	MXC_SPI_CS(2),
};

171
static const struct spi_imx_master moboard_spi1_pdata __initconst = {
172 173 174 175 176 177
	.chipselect	= moboard_spi1_cs,
	.num_chipselect	= ARRAY_SIZE(moboard_spi1_cs),
};

static struct regulator_consumer_supply sdhc_consumers[] = {
	{
178
		.dev_name = "mxc-mmc.0",
179 180 181
		.supply	= "sdhc0_vcc",
	},
	{
182
		.dev_name = "mxc-mmc.1",
183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203
		.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[] = {
	{
204 205
		.dev_name = "mx3_camera.0",
		.supply = "cam_vcc",
206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223
	},
};

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,
};

224
static struct mc13xxx_regulator_init_data moboard_regulators[] = {
225
	{
226
		.id = MC13783_REG_VMMC1,
227 228 229
		.init_data = &sdhc_vreg_data,
	},
	{
230
		.id = MC13783_REG_VCAM,
231 232 233 234
		.init_data = &cam_vreg_data,
	},
};

235
static struct mc13xxx_led_platform_data moboard_led[] = {
236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267
	{
		.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,
	},
};

268
static struct mc13xxx_leds_platform_data moboard_leds = {
269 270 271 272 273 274 275 276
	.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,
};

277
static struct mc13xxx_buttons_platform_data moboard_buttons = {
278 279 280 281 282
	.b1on_flags = MC13783_BUTTON_DBNC_750MS | MC13783_BUTTON_ENABLE |
			MC13783_BUTTON_POL_INVERT,
	.b1on_key = KEY_POWER,
};

283 284 285 286 287
static struct mc13xxx_codec_platform_data moboard_codec = {
	.dac_ssi_port = MC13783_SSI1_PORT,
	.adc_ssi_port = MC13783_SSI1_PORT,
};

288
static struct mc13xxx_platform_data moboard_pmic = {
289 290 291 292
	.regulators = {
		.regulators = moboard_regulators,
		.num_regulators = ARRAY_SIZE(moboard_regulators),
	},
293
	.leds = &moboard_leds,
294
	.buttons = &moboard_buttons,
295 296 297 298 299 300
	.codec = &moboard_codec,
	.flags = MC13XXX_USE_RTC | MC13XXX_USE_ADC | MC13XXX_USE_CODEC,
};

static struct imx_ssi_platform_data moboard_ssi_pdata = {
	.flags = IMX_SSI_DMA | IMX_SSI_NET,
301 302 303 304 305
};

static struct spi_board_info moboard_spi_board_info[] __initdata = {
	{
		.modalias = "mc13783",
306
		/* irq number is run-time assigned */
307 308 309 310 311 312 313 314 315 316 317 318
		.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),
};

319
static const struct spi_imx_master moboard_spi2_pdata __initconst = {
320 321 322 323
	.chipselect	= moboard_spi2_cs,
	.num_chipselect	= ARRAY_SIZE(moboard_spi2_cs),
};

324 325 326 327 328
#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)
{
329
	return !gpio_get_value(SDHC1_WP);
330 331 332 333 334
}

static int moboard_sdhc1_init(struct device *dev, irq_handler_t detect_irq,
		void *data)
{
335 336 337 338 339 340 341 342 343 344 345 346 347 348
	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,
349 350
		IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
		"sdhc1-card-detect", data);
351 352 353 354 355 356 357 358 359 360 361
	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;
362 363 364 365 366
}

static void moboard_sdhc1_exit(struct device *dev, void *data)
{
	free_irq(gpio_to_irq(SDHC1_CD), data);
367 368
	gpio_free(SDHC1_WP);
	gpio_free(SDHC1_CD);
369 370
}

371
static const struct imxmmc_platform_data sdhc1_pdata __initconst = {
372 373 374 375 376
	.get_ro	= moboard_sdhc1_get_ro,
	.init	= moboard_sdhc1_init,
	.exit	= moboard_sdhc1_exit,
};

377 378 379 380
/*
 * this pin is dedicated for all mx31moboard systems, so we do it here
 */
#define USB_RESET_B	IOMUX_TO_GPIO(MX31_PIN_GPIO1_0)
381
#define USB_PAD_CFG (PAD_CTL_DRV_MAX | PAD_CTL_SRE_FAST | PAD_CTL_HYS_CMOS | \
382
		      PAD_CTL_ODE_CMOS)
383 384

#define OTG_EN_B IOMUX_TO_GPIO(MX31_PIN_USB_OC)
385
#define USBH2_EN_B IOMUX_TO_GPIO(MX31_PIN_SCK6)
386

387
static void usb_xcvr_reset(void)
388
{
389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414
	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);
415 416 417

	gpio_request(OTG_EN_B, "usb-udc-en");
	gpio_direction_output(OTG_EN_B, 0);
418 419 420 421 422 423 424 425
	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);
426 427
}

428 429 430 431
static int moboard_usbh2_init_hw(struct platform_device *pdev)
{
	return mx31_initialize_usb_hw(pdev->id, MXC_EHCI_POWER_PINS_ENABLED);
}
432

433
static struct mxc_usbh_platform_data usbh2_pdata __initdata = {
434
	.init	= moboard_usbh2_init_hw,
435 436 437 438 439
	.portsc	= MXC_EHCI_MODE_ULPI | MXC_EHCI_UTMI_8BIT,
};

static int __init moboard_usbh2_init(void)
{
440 441
	struct platform_device *pdev;

442 443 444 445
	usbh2_pdata.otg = imx_otg_ulpi_create(ULPI_OTG_DRVVBUS |
			ULPI_OTG_DRVVBUS_EXT);
	if (!usbh2_pdata.otg)
		return -ENODEV;
446

447 448 449 450 451
	pdev = imx31_add_mxc_ehci_hs(2, &usbh2_pdata);
	if (IS_ERR(pdev))
		return PTR_ERR(pdev);

	return 0;
452 453
}

454
static const struct gpio_led mx31moboard_leds[] __initconst = {
455
	{
456
		.name	= "coreboard-led-0:red:running",
457
		.default_trigger = "heartbeat",
458
		.gpio	= IOMUX_TO_GPIO(MX31_PIN_SVEN0),
459 460 461 462 463 464 465 466 467 468 469 470
	}, {
		.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),
	},
};

471
static const struct gpio_led_platform_data mx31moboard_led_pdata __initconst = {
472
	.num_leds	= ARRAY_SIZE(mx31moboard_leds),
473 474 475
	.leds		= mx31moboard_leds,
};

476 477 478 479
static struct platform_device *devices[] __initdata = {
	&mx31moboard_flash,
};

480
static struct mx3_camera_pdata camera_pdata __initdata = {
V
Valentin Longchamp 已提交
481 482 483 484
	.flags		= MX3_CAMERA_DATAWIDTH_8 | MX3_CAMERA_DATAWIDTH_10,
	.mclk_10khz	= 4800,
};

485 486
static phys_addr_t mx3_camera_base __initdata;
#define MX3_CAMERA_BUF_SIZE SZ_4M
V
Valentin Longchamp 已提交
487

488
static int __init mx31moboard_init_cam(void)
V
Valentin Longchamp 已提交
489
{
490 491 492
	int dma, ret = -ENOMEM;
	struct platform_device *pdev;

493
	imx31_add_ipu_core();
V
Valentin Longchamp 已提交
494

495 496 497
	pdev = imx31_alloc_mx3_camera(&camera_pdata);
	if (IS_ERR(pdev))
		return PTR_ERR(pdev);
V
Valentin Longchamp 已提交
498

499
	dma = dma_declare_coherent_memory(&pdev->dev,
500 501
					mx3_camera_base, mx3_camera_base,
					MX3_CAMERA_BUF_SIZE,
V
Valentin Longchamp 已提交
502
					DMA_MEMORY_MAP | DMA_MEMORY_EXCLUSIVE);
503 504 505 506 507 508 509 510 511
	if (!(dma & DMA_MEMORY_MAP))
		goto err;

	ret = platform_device_add(pdev);
	if (ret)
err:
		platform_device_put(pdev);

	return ret;
V
Valentin Longchamp 已提交
512 513 514

}

515 516 517 518 519
static void mx31moboard_poweroff(void)
{
	struct clk *clk = clk_get_sys("imx2-wdt.0", NULL);

	if (!IS_ERR(clk))
520
		clk_prepare_enable(clk);
521 522 523 524 525 526

	mxc_iomux_mode(MX31_PIN_WATCHDOG_RST__WATCHDOG_RST);

	__raw_writew(1 << 6 | 1 << 2, MX31_IO_ADDRESS(MX31_WDOG_BASE_ADDR));
}

527 528 529
static int mx31moboard_baseboard;
core_param(mx31moboard_baseboard, mx31moboard_baseboard, int, 0444);

530 531 532
/*
 * Board specific initialization.
 */
533
static void __init mx31moboard_init(void)
534
{
535 536
	imx31_soc_init();

537 538 539
	mxc_iomux_setup_multiple_pins(moboard_pins, ARRAY_SIZE(moboard_pins),
		"moboard");

540
	platform_add_devices(devices, ARRAY_SIZE(devices));
541
	gpio_led_register_device(-1, &mx31moboard_led_pdata);
542

543
	imx31_add_imx2_wdt();
544

545 546
	imx31_add_imx_uart0(&uart0_pdata);
	imx31_add_imx_uart4(&uart4_pdata);
547

548 549
	imx31_add_imx_i2c0(&moboard_i2c0_data);
	imx31_add_imx_i2c1(&moboard_i2c1_data);
550

551 552
	imx31_add_spi_imx1(&moboard_spi1_pdata);
	imx31_add_spi_imx2(&moboard_spi2_pdata);
553 554 555

	gpio_request(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3), "pmic-irq");
	gpio_direction_input(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3));
556 557
	moboard_spi_board_info[0].irq =
			gpio_to_irq(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3));
558 559 560
	spi_register_board_info(moboard_spi_board_info,
		ARRAY_SIZE(moboard_spi_board_info));

561
	imx31_add_mxc_mmc(0, &sdhc1_pdata);
562

563
	mx31moboard_init_cam();
564

565 566
	usb_xcvr_reset();

567
	moboard_usbh2_init();
568

569 570 571 572
	imx31_add_imx_ssi(0, &moboard_ssi_pdata);

	imx_add_platform_device("imx_mc13783", 0, NULL, 0, NULL, 0);

573 574
	pm_power_off = mx31moboard_poweroff;

575 576 577 578 579 580 581 582 583
	switch (mx31moboard_baseboard) {
	case MX31NOBOARD:
		break;
	case MX31DEVBOARD:
		mx31moboard_devboard_init();
		break;
	case MX31MARXBOT:
		mx31moboard_marxbot_init();
		break;
584
	case MX31SMARTBOT:
585 586
	case MX31EYEBOT:
		mx31moboard_smartbot_init(mx31moboard_baseboard);
587
		break;
588
	default:
589 590
		printk(KERN_ERR "Illegal mx31moboard_baseboard type %d\n",
			mx31moboard_baseboard);
591
	}
592 593 594 595
}

static void __init mx31moboard_timer_init(void)
{
596
	mx31_clocks_init(26000000);
597 598
}

599
static struct sys_timer mx31moboard_timer = {
600 601 602
	.init	= mx31moboard_timer_init,
};

603 604 605
static void __init mx31moboard_reserve(void)
{
	/* reserve 4 MiB for mx3-camera */
606
	mx3_camera_base = arm_memblock_steal(MX3_CAMERA_BUF_SIZE,
607 608 609
			MX3_CAMERA_BUF_SIZE);
}

610
MACHINE_START(MX31MOBOARD, "EPFL Mobots mx31moboard")
611
	/* Maintainer: Philippe Retornaz, EPFL Mobots group */
612
	.atag_offset = 0x100,
613
	.reserve = mx31moboard_reserve,
614 615 616
	.map_io = mx31_map_io,
	.init_early = imx31_init_early,
	.init_irq = mx31_init_irq,
617
	.handle_irq = imx31_handle_irq,
618
	.timer = &mx31moboard_timer,
619
	.init_machine = mx31moboard_init,
620
	.restart	= mxc_restart,
621
MACHINE_END