arch/arm/mach-imx/mach-mx31moboard.c

   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
 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
 297 static int moboard_sdhc1_get_ro(struct device *dev)
 298 {
 299         return !gpio_get_value(SDHC1_WP);
 300 }
 301
 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
 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
 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
 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
 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
 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
 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  */
 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
 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
 566 static void __init mx31moboard_timer_init(void)
 567 {
 568         mx31_clocks_init(26000000);
 569 }
 570
 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