• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *  Copyright (C) 2008 Valentin Longchamp, EPFL Mobots group
4  */
5 
6 #include <linux/delay.h>
7 #include <linux/dma-mapping.h>
8 #include <linux/gfp.h>
9 #include <linux/gpio.h>
10 #include <linux/init.h>
11 #include <linux/interrupt.h>
12 #include <linux/moduleparam.h>
13 #include <linux/leds.h>
14 #include <linux/memory.h>
15 #include <linux/mtd/physmap.h>
16 #include <linux/mtd/partitions.h>
17 #include <linux/platform_device.h>
18 #include <linux/regulator/machine.h>
19 #include <linux/mfd/mc13783.h>
20 #include <linux/spi/spi.h>
21 #include <linux/types.h>
22 #include <linux/memblock.h>
23 #include <linux/clk.h>
24 #include <linux/io.h>
25 #include <linux/err.h>
26 #include <linux/input.h>
27 
28 #include <linux/usb/otg.h>
29 #include <linux/usb/ulpi.h>
30 
31 #include <asm/mach-types.h>
32 #include <asm/mach/arch.h>
33 #include <asm/mach/time.h>
34 #include <asm/mach/map.h>
35 #include <asm/memblock.h>
36 #include <linux/platform_data/asoc-imx-ssi.h>
37 
38 #include "board-mx31moboard.h"
39 #include "common.h"
40 #include "devices-imx31.h"
41 #include "ehci.h"
42 #include "hardware.h"
43 #include "iomux-mx3.h"
44 #include "ulpi.h"
45 
46 static unsigned int moboard_pins[] = {
47 	/* UART0 */
48 	MX31_PIN_TXD1__TXD1, MX31_PIN_RXD1__RXD1,
49 	MX31_PIN_CTS1__GPIO2_7,
50 	/* UART4 */
51 	MX31_PIN_PC_RST__CTS5, MX31_PIN_PC_VS2__RTS5,
52 	MX31_PIN_PC_BVD2__TXD5, MX31_PIN_PC_BVD1__RXD5,
53 	/* I2C0 */
54 	MX31_PIN_I2C_DAT__I2C1_SDA, MX31_PIN_I2C_CLK__I2C1_SCL,
55 	/* I2C1 */
56 	MX31_PIN_DCD_DTE1__I2C2_SDA, MX31_PIN_RI_DTE1__I2C2_SCL,
57 	/* SDHC1 */
58 	MX31_PIN_SD1_DATA3__SD1_DATA3, MX31_PIN_SD1_DATA2__SD1_DATA2,
59 	MX31_PIN_SD1_DATA1__SD1_DATA1, MX31_PIN_SD1_DATA0__SD1_DATA0,
60 	MX31_PIN_SD1_CLK__SD1_CLK, MX31_PIN_SD1_CMD__SD1_CMD,
61 	MX31_PIN_ATA_CS0__GPIO3_26, MX31_PIN_ATA_CS1__GPIO3_27,
62 	/* USB reset */
63 	MX31_PIN_GPIO1_0__GPIO1_0,
64 	/* USB OTG */
65 	MX31_PIN_USBOTG_DATA0__USBOTG_DATA0,
66 	MX31_PIN_USBOTG_DATA1__USBOTG_DATA1,
67 	MX31_PIN_USBOTG_DATA2__USBOTG_DATA2,
68 	MX31_PIN_USBOTG_DATA3__USBOTG_DATA3,
69 	MX31_PIN_USBOTG_DATA4__USBOTG_DATA4,
70 	MX31_PIN_USBOTG_DATA5__USBOTG_DATA5,
71 	MX31_PIN_USBOTG_DATA6__USBOTG_DATA6,
72 	MX31_PIN_USBOTG_DATA7__USBOTG_DATA7,
73 	MX31_PIN_USBOTG_CLK__USBOTG_CLK, MX31_PIN_USBOTG_DIR__USBOTG_DIR,
74 	MX31_PIN_USBOTG_NXT__USBOTG_NXT, MX31_PIN_USBOTG_STP__USBOTG_STP,
75 	MX31_PIN_USB_OC__GPIO1_30,
76 	/* USB H2 */
77 	MX31_PIN_USBH2_DATA0__USBH2_DATA0,
78 	MX31_PIN_USBH2_DATA1__USBH2_DATA1,
79 	MX31_PIN_STXD3__USBH2_DATA2, MX31_PIN_SRXD3__USBH2_DATA3,
80 	MX31_PIN_SCK3__USBH2_DATA4, MX31_PIN_SFS3__USBH2_DATA5,
81 	MX31_PIN_STXD6__USBH2_DATA6, MX31_PIN_SRXD6__USBH2_DATA7,
82 	MX31_PIN_USBH2_CLK__USBH2_CLK, MX31_PIN_USBH2_DIR__USBH2_DIR,
83 	MX31_PIN_USBH2_NXT__USBH2_NXT, MX31_PIN_USBH2_STP__USBH2_STP,
84 	MX31_PIN_SCK6__GPIO1_25,
85 	/* LEDs */
86 	MX31_PIN_SVEN0__GPIO2_0, MX31_PIN_STX0__GPIO2_1,
87 	MX31_PIN_SRX0__GPIO2_2, MX31_PIN_SIMPD0__GPIO2_3,
88 	/* SPI1 */
89 	MX31_PIN_CSPI2_MOSI__MOSI, MX31_PIN_CSPI2_MISO__MISO,
90 	MX31_PIN_CSPI2_SCLK__SCLK, MX31_PIN_CSPI2_SPI_RDY__SPI_RDY,
91 	MX31_PIN_CSPI2_SS0__SS0, MX31_PIN_CSPI2_SS2__SS2,
92 	/* Atlas IRQ */
93 	MX31_PIN_GPIO1_3__GPIO1_3,
94 	/* SPI2 */
95 	MX31_PIN_CSPI3_MOSI__MOSI, MX31_PIN_CSPI3_MISO__MISO,
96 	MX31_PIN_CSPI3_SCLK__SCLK, MX31_PIN_CSPI3_SPI_RDY__SPI_RDY,
97 	MX31_PIN_CSPI2_SS1__CSPI3_SS1,
98 	/* SSI */
99 	MX31_PIN_STXD4__STXD4, MX31_PIN_SRXD4__SRXD4,
100 	MX31_PIN_SCK4__SCK4, MX31_PIN_SFS4__SFS4,
101 };
102 
103 static struct physmap_flash_data mx31moboard_flash_data = {
104 	.width	= 2,
105 };
106 
107 static struct resource mx31moboard_flash_resource = {
108 	.start	= 0xa0000000,
109 	.end	= 0xa1ffffff,
110 	.flags	= IORESOURCE_MEM,
111 };
112 
113 static struct platform_device mx31moboard_flash = {
114 	.name	= "physmap-flash",
115 	.id	= 0,
116 	.dev	= {
117 		.platform_data  = &mx31moboard_flash_data,
118 	},
119 	.resource = &mx31moboard_flash_resource,
120 	.num_resources = 1,
121 };
122 
moboard_uart0_init(void)123 static void __init moboard_uart0_init(void)
124 {
125 	if (!gpio_request(IOMUX_TO_GPIO(MX31_PIN_CTS1), "uart0-cts-hack")) {
126 		gpio_direction_output(IOMUX_TO_GPIO(MX31_PIN_CTS1), 0);
127 		gpio_free(IOMUX_TO_GPIO(MX31_PIN_CTS1));
128 	}
129 }
130 
131 static const struct imxuart_platform_data uart0_pdata __initconst = {
132 };
133 
134 static const struct imxuart_platform_data uart4_pdata __initconst = {
135 	.flags = IMXUART_HAVE_RTSCTS,
136 };
137 
138 static const struct imxi2c_platform_data moboard_i2c0_data __initconst = {
139 	.bitrate = 400000,
140 };
141 
142 static const struct imxi2c_platform_data moboard_i2c1_data __initconst = {
143 	.bitrate = 100000,
144 };
145 
146 static const struct spi_imx_master moboard_spi1_pdata __initconst = {
147 	.num_chipselect	= 3,
148 };
149 
150 static struct regulator_consumer_supply sdhc_consumers[] = {
151 	{
152 		.dev_name = "imx31-mmc.0",
153 		.supply	= "sdhc0_vcc",
154 	},
155 	{
156 		.dev_name = "imx31-mmc.1",
157 		.supply	= "sdhc1_vcc",
158 	},
159 };
160 
161 static struct regulator_init_data sdhc_vreg_data = {
162 	.constraints = {
163 		.min_uV = 2700000,
164 		.max_uV = 3000000,
165 		.valid_ops_mask = REGULATOR_CHANGE_VOLTAGE |
166 			REGULATOR_CHANGE_MODE | REGULATOR_CHANGE_STATUS,
167 		.valid_modes_mask = REGULATOR_MODE_NORMAL |
168 			REGULATOR_MODE_FAST,
169 		.always_on = 0,
170 		.boot_on = 1,
171 	},
172 	.num_consumer_supplies = ARRAY_SIZE(sdhc_consumers),
173 	.consumer_supplies = sdhc_consumers,
174 };
175 
176 static struct regulator_consumer_supply cam_consumers[] = {
177 	{
178 		.dev_name = "mx3_camera.0",
179 		.supply = "cam_vcc",
180 	},
181 };
182 
183 static struct regulator_init_data cam_vreg_data = {
184 	.constraints = {
185 		.min_uV = 2700000,
186 		.max_uV = 3000000,
187 		.valid_ops_mask = REGULATOR_CHANGE_VOLTAGE |
188 			REGULATOR_CHANGE_MODE | REGULATOR_CHANGE_STATUS,
189 		.valid_modes_mask = REGULATOR_MODE_NORMAL |
190 			REGULATOR_MODE_FAST,
191 		.always_on = 0,
192 		.boot_on = 1,
193 	},
194 	.num_consumer_supplies = ARRAY_SIZE(cam_consumers),
195 	.consumer_supplies = cam_consumers,
196 };
197 
198 static struct mc13xxx_regulator_init_data moboard_regulators[] = {
199 	{
200 		.id = MC13783_REG_VMMC1,
201 		.init_data = &sdhc_vreg_data,
202 	},
203 	{
204 		.id = MC13783_REG_VCAM,
205 		.init_data = &cam_vreg_data,
206 	},
207 };
208 
209 static struct mc13xxx_led_platform_data moboard_led[] = {
210 	{
211 		.id = MC13783_LED_R1,
212 		.name = "coreboard-led-4:red",
213 	},
214 	{
215 		.id = MC13783_LED_G1,
216 		.name = "coreboard-led-4:green",
217 	},
218 	{
219 		.id = MC13783_LED_B1,
220 		.name = "coreboard-led-4:blue",
221 	},
222 	{
223 		.id = MC13783_LED_R2,
224 		.name = "coreboard-led-5:red",
225 	},
226 	{
227 		.id = MC13783_LED_G2,
228 		.name = "coreboard-led-5:green",
229 	},
230 	{
231 		.id = MC13783_LED_B2,
232 		.name = "coreboard-led-5:blue",
233 	},
234 };
235 
236 static struct mc13xxx_leds_platform_data moboard_leds = {
237 	.num_leds = ARRAY_SIZE(moboard_led),
238 	.led = moboard_led,
239 	.led_control[0]	= MC13783_LED_C0_ENABLE | MC13783_LED_C0_ABMODE(0),
240 	.led_control[1]	= MC13783_LED_C1_SLEWLIM,
241 	.led_control[2]	= MC13783_LED_C2_SLEWLIM,
242 	.led_control[3]	= MC13783_LED_C3_PERIOD(0) |
243 			  MC13783_LED_C3_CURRENT_R1(2) |
244 			  MC13783_LED_C3_CURRENT_G1(2) |
245 			  MC13783_LED_C3_CURRENT_B1(2),
246 	.led_control[4]	= MC13783_LED_C4_PERIOD(0) |
247 			  MC13783_LED_C4_CURRENT_R2(3) |
248 			  MC13783_LED_C4_CURRENT_G2(3) |
249 			  MC13783_LED_C4_CURRENT_B2(3),
250 };
251 
252 static struct mc13xxx_buttons_platform_data moboard_buttons = {
253 	.b1on_flags = MC13783_BUTTON_DBNC_750MS | MC13783_BUTTON_ENABLE |
254 			MC13783_BUTTON_POL_INVERT,
255 	.b1on_key = KEY_POWER,
256 };
257 
258 static struct mc13xxx_codec_platform_data moboard_codec = {
259 	.dac_ssi_port = MC13783_SSI1_PORT,
260 	.adc_ssi_port = MC13783_SSI1_PORT,
261 };
262 
263 static struct mc13xxx_platform_data moboard_pmic = {
264 	.regulators = {
265 		.regulators = moboard_regulators,
266 		.num_regulators = ARRAY_SIZE(moboard_regulators),
267 	},
268 	.leds = &moboard_leds,
269 	.buttons = &moboard_buttons,
270 	.codec = &moboard_codec,
271 	.flags = MC13XXX_USE_RTC | MC13XXX_USE_ADC | MC13XXX_USE_CODEC,
272 };
273 
274 static struct imx_ssi_platform_data moboard_ssi_pdata = {
275 	.flags = IMX_SSI_DMA | IMX_SSI_NET,
276 };
277 
278 static struct spi_board_info moboard_spi_board_info[] __initdata = {
279 	{
280 		.modalias = "mc13783",
281 		/* irq number is run-time assigned */
282 		.max_speed_hz = 300000,
283 		.bus_num = 1,
284 		.chip_select = 0,
285 		.platform_data = &moboard_pmic,
286 		.mode = SPI_CS_HIGH,
287 	},
288 };
289 
290 static const struct spi_imx_master moboard_spi2_pdata __initconst = {
291 	.num_chipselect	= 2,
292 };
293 
294 #define SDHC1_CD IOMUX_TO_GPIO(MX31_PIN_ATA_CS0)
295 #define SDHC1_WP IOMUX_TO_GPIO(MX31_PIN_ATA_CS1)
296 
moboard_sdhc1_get_ro(struct device * dev)297 static int moboard_sdhc1_get_ro(struct device *dev)
298 {
299 	return !gpio_get_value(SDHC1_WP);
300 }
301 
moboard_sdhc1_init(struct device * dev,irq_handler_t detect_irq,void * data)302 static int moboard_sdhc1_init(struct device *dev, irq_handler_t detect_irq,
303 		void *data)
304 {
305 	int ret;
306 
307 	ret = gpio_request(SDHC1_CD, "sdhc-detect");
308 	if (ret)
309 		return ret;
310 
311 	gpio_direction_input(SDHC1_CD);
312 
313 	ret = gpio_request(SDHC1_WP, "sdhc-wp");
314 	if (ret)
315 		goto err_gpio_free;
316 	gpio_direction_input(SDHC1_WP);
317 
318 	ret = request_irq(gpio_to_irq(SDHC1_CD), detect_irq,
319 		IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
320 		"sdhc1-card-detect", data);
321 	if (ret)
322 		goto err_gpio_free_2;
323 
324 	return 0;
325 
326 err_gpio_free_2:
327 	gpio_free(SDHC1_WP);
328 err_gpio_free:
329 	gpio_free(SDHC1_CD);
330 
331 	return ret;
332 }
333 
moboard_sdhc1_exit(struct device * dev,void * data)334 static void moboard_sdhc1_exit(struct device *dev, void *data)
335 {
336 	free_irq(gpio_to_irq(SDHC1_CD), data);
337 	gpio_free(SDHC1_WP);
338 	gpio_free(SDHC1_CD);
339 }
340 
341 static const struct imxmmc_platform_data sdhc1_pdata __initconst = {
342 	.get_ro	= moboard_sdhc1_get_ro,
343 	.init	= moboard_sdhc1_init,
344 	.exit	= moboard_sdhc1_exit,
345 };
346 
347 /*
348  * this pin is dedicated for all mx31moboard systems, so we do it here
349  */
350 #define USB_RESET_B	IOMUX_TO_GPIO(MX31_PIN_GPIO1_0)
351 #define USB_PAD_CFG (PAD_CTL_DRV_MAX | PAD_CTL_SRE_FAST | PAD_CTL_HYS_CMOS | \
352 		      PAD_CTL_ODE_CMOS)
353 
354 #define OTG_EN_B IOMUX_TO_GPIO(MX31_PIN_USB_OC)
355 #define USBH2_EN_B IOMUX_TO_GPIO(MX31_PIN_SCK6)
356 
usb_xcvr_reset(void)357 static void usb_xcvr_reset(void)
358 {
359 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA0, USB_PAD_CFG | PAD_CTL_100K_PD);
360 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA1, USB_PAD_CFG | PAD_CTL_100K_PD);
361 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA2, USB_PAD_CFG | PAD_CTL_100K_PD);
362 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA3, USB_PAD_CFG | PAD_CTL_100K_PD);
363 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA4, USB_PAD_CFG | PAD_CTL_100K_PD);
364 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA5, USB_PAD_CFG | PAD_CTL_100K_PD);
365 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA6, USB_PAD_CFG | PAD_CTL_100K_PD);
366 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA7, USB_PAD_CFG | PAD_CTL_100K_PD);
367 	mxc_iomux_set_pad(MX31_PIN_USBOTG_CLK, USB_PAD_CFG | PAD_CTL_100K_PU);
368 	mxc_iomux_set_pad(MX31_PIN_USBOTG_DIR, USB_PAD_CFG | PAD_CTL_100K_PU);
369 	mxc_iomux_set_pad(MX31_PIN_USBOTG_NXT, USB_PAD_CFG | PAD_CTL_100K_PU);
370 	mxc_iomux_set_pad(MX31_PIN_USBOTG_STP, USB_PAD_CFG | PAD_CTL_100K_PU);
371 
372 	mxc_iomux_set_gpr(MUX_PGP_UH2, true);
373 	mxc_iomux_set_pad(MX31_PIN_USBH2_CLK, USB_PAD_CFG | PAD_CTL_100K_PU);
374 	mxc_iomux_set_pad(MX31_PIN_USBH2_DIR, USB_PAD_CFG | PAD_CTL_100K_PU);
375 	mxc_iomux_set_pad(MX31_PIN_USBH2_NXT, USB_PAD_CFG | PAD_CTL_100K_PU);
376 	mxc_iomux_set_pad(MX31_PIN_USBH2_STP, USB_PAD_CFG | PAD_CTL_100K_PU);
377 	mxc_iomux_set_pad(MX31_PIN_USBH2_DATA0, USB_PAD_CFG | PAD_CTL_100K_PD);
378 	mxc_iomux_set_pad(MX31_PIN_USBH2_DATA1, USB_PAD_CFG | PAD_CTL_100K_PD);
379 	mxc_iomux_set_pad(MX31_PIN_SRXD6, USB_PAD_CFG | PAD_CTL_100K_PD);
380 	mxc_iomux_set_pad(MX31_PIN_STXD6, USB_PAD_CFG | PAD_CTL_100K_PD);
381 	mxc_iomux_set_pad(MX31_PIN_SFS3, USB_PAD_CFG | PAD_CTL_100K_PD);
382 	mxc_iomux_set_pad(MX31_PIN_SCK3, USB_PAD_CFG | PAD_CTL_100K_PD);
383 	mxc_iomux_set_pad(MX31_PIN_SRXD3, USB_PAD_CFG | PAD_CTL_100K_PD);
384 	mxc_iomux_set_pad(MX31_PIN_STXD3, USB_PAD_CFG | PAD_CTL_100K_PD);
385 
386 	gpio_request(OTG_EN_B, "usb-udc-en");
387 	gpio_direction_output(OTG_EN_B, 0);
388 	gpio_request(USBH2_EN_B, "usbh2-en");
389 	gpio_direction_output(USBH2_EN_B, 0);
390 
391 	gpio_request(USB_RESET_B, "usb-reset");
392 	gpio_direction_output(USB_RESET_B, 0);
393 	mdelay(1);
394 	gpio_set_value(USB_RESET_B, 1);
395 	mdelay(1);
396 }
397 
moboard_usbh2_init_hw(struct platform_device * pdev)398 static int moboard_usbh2_init_hw(struct platform_device *pdev)
399 {
400 	return mx31_initialize_usb_hw(pdev->id, MXC_EHCI_POWER_PINS_ENABLED);
401 }
402 
403 static struct mxc_usbh_platform_data usbh2_pdata __initdata = {
404 	.init	= moboard_usbh2_init_hw,
405 	.portsc	= MXC_EHCI_MODE_ULPI | MXC_EHCI_UTMI_8BIT,
406 };
407 
moboard_usbh2_init(void)408 static int __init moboard_usbh2_init(void)
409 {
410 	struct platform_device *pdev;
411 
412 	usbh2_pdata.otg = imx_otg_ulpi_create(ULPI_OTG_DRVVBUS |
413 			ULPI_OTG_DRVVBUS_EXT);
414 	if (!usbh2_pdata.otg)
415 		return -ENODEV;
416 
417 	pdev = imx31_add_mxc_ehci_hs(2, &usbh2_pdata);
418 
419 	return PTR_ERR_OR_ZERO(pdev);
420 }
421 
422 static const struct gpio_led mx31moboard_leds[] __initconst = {
423 	{
424 		.name	= "coreboard-led-0:red:running",
425 		.default_trigger = "heartbeat",
426 		.gpio	= IOMUX_TO_GPIO(MX31_PIN_SVEN0),
427 	}, {
428 		.name	= "coreboard-led-1:red",
429 		.gpio	= IOMUX_TO_GPIO(MX31_PIN_STX0),
430 	}, {
431 		.name	= "coreboard-led-2:red",
432 		.gpio	= IOMUX_TO_GPIO(MX31_PIN_SRX0),
433 	}, {
434 		.name	= "coreboard-led-3:red",
435 		.gpio	= IOMUX_TO_GPIO(MX31_PIN_SIMPD0),
436 	},
437 };
438 
439 static const struct gpio_led_platform_data mx31moboard_led_pdata __initconst = {
440 	.num_leds	= ARRAY_SIZE(mx31moboard_leds),
441 	.leds		= mx31moboard_leds,
442 };
443 
444 static struct platform_device *devices[] __initdata = {
445 	&mx31moboard_flash,
446 };
447 
448 static struct mx3_camera_pdata camera_pdata __initdata = {
449 	.flags		= MX3_CAMERA_DATAWIDTH_8 | MX3_CAMERA_DATAWIDTH_10,
450 	.mclk_10khz	= 4800,
451 };
452 
453 static phys_addr_t mx3_camera_base __initdata;
454 #define MX3_CAMERA_BUF_SIZE SZ_4M
455 
mx31moboard_init_cam(void)456 static int __init mx31moboard_init_cam(void)
457 {
458 	int ret;
459 	struct platform_device *pdev;
460 
461 	imx31_add_ipu_core();
462 
463 	pdev = imx31_alloc_mx3_camera(&camera_pdata);
464 	if (IS_ERR(pdev))
465 		return PTR_ERR(pdev);
466 
467 	ret = dma_declare_coherent_memory(&pdev->dev,
468 					  mx3_camera_base, mx3_camera_base,
469 					  MX3_CAMERA_BUF_SIZE);
470 	if (ret)
471 		goto err;
472 
473 	ret = platform_device_add(pdev);
474 	if (ret)
475 err:
476 		platform_device_put(pdev);
477 
478 	return ret;
479 
480 }
481 
mx31moboard_poweroff(void)482 static void mx31moboard_poweroff(void)
483 {
484 	struct clk *clk = clk_get_sys("imx2-wdt.0", NULL);
485 
486 	if (!IS_ERR(clk))
487 		clk_prepare_enable(clk);
488 
489 	mxc_iomux_mode(MX31_PIN_WATCHDOG_RST__WATCHDOG_RST);
490 
491 	imx_writew(1 << 6 | 1 << 2, MX31_IO_ADDRESS(MX31_WDOG_BASE_ADDR));
492 }
493 
494 static int mx31moboard_baseboard;
495 core_param(mx31moboard_baseboard, mx31moboard_baseboard, int, 0444);
496 
497 /*
498  * Board specific initialization.
499  */
mx31moboard_init(void)500 static void __init mx31moboard_init(void)
501 {
502 	imx31_soc_init();
503 
504 	mxc_iomux_setup_multiple_pins(moboard_pins, ARRAY_SIZE(moboard_pins),
505 		"moboard");
506 
507 	platform_add_devices(devices, ARRAY_SIZE(devices));
508 
509 	imx31_add_imx2_wdt();
510 
511 	imx31_add_imx_uart0(&uart0_pdata);
512 	imx31_add_imx_uart4(&uart4_pdata);
513 
514 	imx31_add_imx_i2c0(&moboard_i2c0_data);
515 	imx31_add_imx_i2c1(&moboard_i2c1_data);
516 
517 	imx31_add_spi_imx1(&moboard_spi1_pdata);
518 	imx31_add_spi_imx2(&moboard_spi2_pdata);
519 
520 	mx31moboard_init_cam();
521 
522 	imx31_add_imx_ssi(0, &moboard_ssi_pdata);
523 
524 	pm_power_off = mx31moboard_poweroff;
525 }
526 
mx31moboard_late(void)527 static void __init mx31moboard_late(void)
528 {
529 	gpio_led_register_device(-1, &mx31moboard_led_pdata);
530 
531 	moboard_uart0_init();
532 
533 	gpio_request(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3), "pmic-irq");
534 	gpio_direction_input(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3));
535 	moboard_spi_board_info[0].irq =
536 			gpio_to_irq(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3));
537 	spi_register_board_info(moboard_spi_board_info,
538 		ARRAY_SIZE(moboard_spi_board_info));
539 
540 	imx31_add_mxc_mmc(0, &sdhc1_pdata);
541 
542 	usb_xcvr_reset();
543 	moboard_usbh2_init();
544 
545 	imx_add_platform_device("imx_mc13783", 0, NULL, 0, NULL, 0);
546 
547 	switch (mx31moboard_baseboard) {
548 	case MX31NOBOARD:
549 		break;
550 	case MX31DEVBOARD:
551 		mx31moboard_devboard_init();
552 		break;
553 	case MX31MARXBOT:
554 		mx31moboard_marxbot_init();
555 		break;
556 	case MX31SMARTBOT:
557 	case MX31EYEBOT:
558 		mx31moboard_smartbot_init(mx31moboard_baseboard);
559 		break;
560 	default:
561 		printk(KERN_ERR "Illegal mx31moboard_baseboard type %d\n",
562 			mx31moboard_baseboard);
563 	}
564 }
565 
mx31moboard_timer_init(void)566 static void __init mx31moboard_timer_init(void)
567 {
568 	mx31_clocks_init(26000000);
569 }
570 
mx31moboard_reserve(void)571 static void __init mx31moboard_reserve(void)
572 {
573 	/* reserve 4 MiB for mx3-camera */
574 	mx3_camera_base = arm_memblock_steal(MX3_CAMERA_BUF_SIZE,
575 			MX3_CAMERA_BUF_SIZE);
576 }
577 
578 MACHINE_START(MX31MOBOARD, "EPFL Mobots mx31moboard")
579 	/* Maintainer: Philippe Retornaz, EPFL Mobots group */
580 	.atag_offset = 0x100,
581 	.reserve = mx31moboard_reserve,
582 	.map_io = mx31_map_io,
583 	.init_early = imx31_init_early,
584 	.init_irq = mx31_init_irq,
585 	.init_time	= mx31moboard_timer_init,
586 	.init_machine = mx31moboard_init,
587 	.init_late	= mx31moboard_late,
588 	.restart	= mxc_restart,
589 MACHINE_END
590