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