arch/arm/mach-omap1/board-ams-delta.c

   1 /*
   2  * linux/arch/arm/mach-omap1/board-ams-delta.c
   3  *
   4  * Modified from board-generic.c
   5  *
   6  * Board specific inits for the Amstrad E3 (codename Delta) videophone
   7  *
   8  * Copyright (C) 2006 Jonathan McDowell <noodles@earth.li>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License version 2 as
  12  * published by the Free Software Foundation.
  13  */
  14 #include <linux/gpio/driver.h>
  15 #include <linux/gpio/machine.h>
  16 #include <linux/gpio.h>
  17 #include <linux/kernel.h>
  18 #include <linux/init.h>
  19 #include <linux/input.h>
  20 #include <linux/interrupt.h>
  21 #include <linux/leds.h>
  22 #include <linux/platform_device.h>
  23 #include <linux/regulator/consumer.h>
  24 #include <linux/regulator/fixed.h>
  25 #include <linux/regulator/machine.h>
  26 #include <linux/serial_8250.h>
  27 #include <linux/export.h>
  28 #include <linux/omapfb.h>
  29 #include <linux/io.h>
  30 #include <linux/platform_data/gpio-omap.h>
  31
  32 #include <media/soc_camera.h>
  33
  34 #include <asm/serial.h>
  35 #include <asm/mach-types.h>
  36 #include <asm/mach/arch.h>
  37 #include <asm/mach/map.h>
  38
  39 #include <mach/board-ams-delta.h>
  40 #include <linux/platform_data/keypad-omap.h>
  41 #include <mach/mux.h>
  42
  43 #include <mach/hardware.h>
  44 #include <mach/ams-delta-fiq.h>
  45 #include "camera.h"
  46 #include <mach/usb.h>
  47
  48 #include "iomap.h"
  49 #include "common.h"
  50
  51 static const unsigned int ams_delta_keymap[] = {
  52         KEY(0, 0, KEY_F1),              /* Advert    */
  53
  54         KEY(0, 3, KEY_COFFEE),          /* Games     */
  55         KEY(0, 2, KEY_QUESTION),        /* Directory */
  56         KEY(2, 3, KEY_CONNECT),         /* Internet  */
  57         KEY(1, 2, KEY_SHOP),            /* Services  */
  58         KEY(1, 1, KEY_PHONE),           /* VoiceMail */
  59
  60         KEY(0, 1, KEY_DELETE),          /* Delete    */
  61         KEY(2, 2, KEY_PLAY),            /* Play      */
  62         KEY(1, 0, KEY_PAGEUP),          /* Up        */
  63         KEY(1, 3, KEY_PAGEDOWN),        /* Down      */
  64         KEY(2, 0, KEY_EMAIL),           /* ReadEmail */
  65         KEY(2, 1, KEY_STOP),            /* Stop      */
  66
  67         /* Numeric keypad portion */
  68         KEY(0, 7, KEY_KP1),
  69         KEY(0, 6, KEY_KP2),
  70         KEY(0, 5, KEY_KP3),
  71         KEY(1, 7, KEY_KP4),
  72         KEY(1, 6, KEY_KP5),
  73         KEY(1, 5, KEY_KP6),
  74         KEY(2, 7, KEY_KP7),
  75         KEY(2, 6, KEY_KP8),
  76         KEY(2, 5, KEY_KP9),
  77         KEY(3, 6, KEY_KP0),
  78         KEY(3, 7, KEY_KPASTERISK),
  79         KEY(3, 5, KEY_KPDOT),           /* # key     */
  80         KEY(7, 2, KEY_NUMLOCK),         /* Mute      */
  81         KEY(7, 1, KEY_KPMINUS),         /* Recall    */
  82         KEY(6, 1, KEY_KPPLUS),          /* Redial    */
  83         KEY(7, 6, KEY_KPSLASH),         /* Handsfree */
  84         KEY(6, 0, KEY_ENTER),           /* Video     */
  85
  86         KEY(7, 4, KEY_CAMERA),          /* Photo     */
  87
  88         KEY(0, 4, KEY_F2),              /* Home      */
  89         KEY(1, 4, KEY_F3),              /* Office    */
  90         KEY(2, 4, KEY_F4),              /* Mobile    */
  91         KEY(7, 7, KEY_F5),              /* SMS       */
  92         KEY(7, 5, KEY_F6),              /* Email     */
  93
  94         /* QWERTY portion of keypad */
  95         KEY(3, 4, KEY_Q),
  96         KEY(3, 3, KEY_W),
  97         KEY(3, 2, KEY_E),
  98         KEY(3, 1, KEY_R),
  99         KEY(3, 0, KEY_T),
 100         KEY(4, 7, KEY_Y),
 101         KEY(4, 6, KEY_U),
 102         KEY(4, 5, KEY_I),
 103         KEY(4, 4, KEY_O),
 104         KEY(4, 3, KEY_P),
 105
 106         KEY(4, 2, KEY_A),
 107         KEY(4, 1, KEY_S),
 108         KEY(4, 0, KEY_D),
 109         KEY(5, 7, KEY_F),
 110         KEY(5, 6, KEY_G),
 111         KEY(5, 5, KEY_H),
 112         KEY(5, 4, KEY_J),
 113         KEY(5, 3, KEY_K),
 114         KEY(5, 2, KEY_L),
 115
 116         KEY(5, 1, KEY_Z),
 117         KEY(5, 0, KEY_X),
 118         KEY(6, 7, KEY_C),
 119         KEY(6, 6, KEY_V),
 120         KEY(6, 5, KEY_B),
 121         KEY(6, 4, KEY_N),
 122         KEY(6, 3, KEY_M),
 123         KEY(6, 2, KEY_SPACE),
 124
 125         KEY(7, 0, KEY_LEFTSHIFT),       /* Vol up    */
 126         KEY(7, 3, KEY_LEFTCTRL),        /* Vol down  */
 127 };
 128
 129 #define LATCH1_PHYS     0x01000000
 130 #define LATCH1_VIRT     0xEA000000
 131 #define MODEM_PHYS      0x04000000
 132 #define MODEM_VIRT      0xEB000000
 133 #define LATCH2_PHYS     0x08000000
 134 #define LATCH2_VIRT     0xEC000000
 135
 136 static struct map_desc ams_delta_io_desc[] __initdata = {
 137         /* AMS_DELTA_LATCH1 */
 138         {
 139                 .virtual        = LATCH1_VIRT,
 140                 .pfn            = __phys_to_pfn(LATCH1_PHYS),
 141                 .length         = 0x01000000,
 142                 .type           = MT_DEVICE
 143         },
 144         /* AMS_DELTA_LATCH2 */
 145         {
 146                 .virtual        = LATCH2_VIRT,
 147                 .pfn            = __phys_to_pfn(LATCH2_PHYS),
 148                 .length         = 0x01000000,
 149                 .type           = MT_DEVICE
 150         },
 151         /* AMS_DELTA_MODEM */
 152         {
 153                 .virtual        = MODEM_VIRT,
 154                 .pfn            = __phys_to_pfn(MODEM_PHYS),
 155                 .length         = 0x01000000,
 156                 .type           = MT_DEVICE
 157         }
 158 };
 159
 160 static const struct omap_lcd_config ams_delta_lcd_config __initconst = {
 161         .ctrl_name      = "internal",
 162 };
 163
 164 static struct omap_usb_config ams_delta_usb_config __initdata = {
 165         .register_host  = 1,
 166         .hmc_mode       = 16,
 167         .pins[0]        = 2,
 168 };
 169
 170 #define LATCH1_GPIO_BASE        232
 171 #define LATCH1_NGPIO            8
 172
 173 static struct resource latch1_resources[] = {
 174         [0] = {
 175                 .name   = "dat",
 176                 .start  = LATCH1_PHYS,
 177                 .end    = LATCH1_PHYS + (LATCH1_NGPIO - 1) / 8,
 178                 .flags  = IORESOURCE_MEM,
 179         },
 180 };
 181
 182 static struct bgpio_pdata latch1_pdata = {
 183         .base   = LATCH1_GPIO_BASE,
 184         .ngpio  = LATCH1_NGPIO,
 185 };
 186
 187 static struct platform_device latch1_gpio_device = {
 188         .name           = "basic-mmio-gpio",
 189         .id             = 0,
 190         .resource       = latch1_resources,
 191         .num_resources  = ARRAY_SIZE(latch1_resources),
 192         .dev            = {
 193                 .platform_data  = &latch1_pdata,
 194         },
 195 };
 196
 197 static struct resource latch2_resources[] = {
 198         [0] = {
 199                 .name   = "dat",
 200                 .start  = LATCH2_PHYS,
 201                 .end    = LATCH2_PHYS + (AMS_DELTA_LATCH2_NGPIO - 1) / 8,
 202                 .flags  = IORESOURCE_MEM,
 203         },
 204 };
 205
 206 static struct bgpio_pdata latch2_pdata = {
 207         .label  = "ams-delta-latch2",
 208         .base   = AMS_DELTA_LATCH2_GPIO_BASE,
 209         .ngpio  = AMS_DELTA_LATCH2_NGPIO,
 210 };
 211
 212 static struct platform_device latch2_gpio_device = {
 213         .name           = "basic-mmio-gpio",
 214         .id             = 1,
 215         .resource       = latch2_resources,
 216         .num_resources  = ARRAY_SIZE(latch2_resources),
 217         .dev            = {
 218                 .platform_data  = &latch2_pdata,
 219         },
 220 };
 221
 222 static const struct gpio latch_gpios[] __initconst = {
 223         {
 224                 .gpio   = LATCH1_GPIO_BASE + 6,
 225                 .flags  = GPIOF_OUT_INIT_LOW,
 226                 .label  = "dockit1",
 227         },
 228         {
 229                 .gpio   = LATCH1_GPIO_BASE + 7,
 230                 .flags  = GPIOF_OUT_INIT_LOW,
 231                 .label  = "dockit2",
 232         },
 233         {
 234                 .gpio   = AMS_DELTA_GPIO_PIN_SCARD_RSTIN,
 235                 .flags  = GPIOF_OUT_INIT_LOW,
 236                 .label  = "scard_rstin",
 237         },
 238         {
 239                 .gpio   = AMS_DELTA_GPIO_PIN_SCARD_CMDVCC,
 240                 .flags  = GPIOF_OUT_INIT_LOW,
 241                 .label  = "scard_cmdvcc",
 242         },
 243         {
 244                 .gpio   = AMS_DELTA_GPIO_PIN_MODEM_CODEC,
 245                 .flags  = GPIOF_OUT_INIT_LOW,
 246                 .label  = "modem_codec",
 247         },
 248         {
 249                 .gpio   = AMS_DELTA_LATCH2_GPIO_BASE + 14,
 250                 .flags  = GPIOF_OUT_INIT_LOW,
 251                 .label  = "hookflash1",
 252         },
 253         {
 254                 .gpio   = AMS_DELTA_LATCH2_GPIO_BASE + 15,
 255                 .flags  = GPIOF_OUT_INIT_LOW,
 256                 .label  = "hookflash2",
 257         },
 258 };
 259
 260 static struct regulator_consumer_supply modem_nreset_consumers[] = {
 261         REGULATOR_SUPPLY("RESET#", "serial8250.1"),
 262         REGULATOR_SUPPLY("POR", "cx20442-codec"),
 263 };
 264
 265 static struct regulator_init_data modem_nreset_data = {
 266         .constraints            = {
 267                 .valid_ops_mask         = REGULATOR_CHANGE_STATUS,
 268                 .boot_on                = 1,
 269         },
 270         .num_consumer_supplies  = ARRAY_SIZE(modem_nreset_consumers),
 271         .consumer_supplies      = modem_nreset_consumers,
 272 };
 273
 274 static struct fixed_voltage_config modem_nreset_config = {
 275         .supply_name            = "modem_nreset",
 276         .microvolts             = 3300000,
 277         .startup_delay          = 25000,
 278         .enable_high            = 1,
 279         .enabled_at_boot        = 1,
 280         .init_data              = &modem_nreset_data,
 281 };
 282
 283 static struct platform_device modem_nreset_device = {
 284         .name   = "reg-fixed-voltage",
 285         .id     = -1,
 286         .dev    = {
 287                 .platform_data  = &modem_nreset_config,
 288         },
 289 };
 290
 291 static struct gpiod_lookup_table modem_nreset_gpiod_table = {
 292         .dev_id = "reg-fixed-voltage",
 293         .table = {
 294                 /* The AMS_DELTA_GPIO_PIN_MODEM_NRESET is at offset 12 */
 295                 GPIO_LOOKUP("ams-delta-latch2", 12,
 296                             "enable", GPIO_ACTIVE_HIGH),
 297                 { },
 298         },
 299 };
 300
 301 struct modem_private_data {
 302         struct regulator *regulator;
 303 };
 304
 305 static struct modem_private_data modem_priv;
 306
 307 void ams_delta_latch_write(int base, int ngpio, u16 mask, u16 value)
 308 {
 309         int bit = 0;
 310         u16 bitpos = 1 << bit;
 311
 312         for (; bit < ngpio; bit++, bitpos = bitpos << 1) {
 313                 if (!(mask & bitpos))
 314                         continue;
 315                 else
 316                         gpio_set_value(base + bit, (value & bitpos) != 0);
 317         }
 318 }
 319 EXPORT_SYMBOL(ams_delta_latch_write);
 320
 321 static struct resource ams_delta_nand_resources[] = {
 322         [0] = {
 323                 .start  = OMAP1_MPUIO_BASE,
 324                 .end    = OMAP1_MPUIO_BASE +
 325                                 OMAP_MPUIO_IO_CNTL + sizeof(u32) - 1,
 326                 .flags  = IORESOURCE_MEM,
 327         },
 328 };
 329
 330 static struct platform_device ams_delta_nand_device = {
 331         .name   = "ams-delta-nand",
 332         .id     = -1,
 333         .num_resources  = ARRAY_SIZE(ams_delta_nand_resources),
 334         .resource       = ams_delta_nand_resources,
 335 };
 336
 337 static struct resource ams_delta_kp_resources[] = {
 338         [0] = {
 339                 .start  = INT_KEYBOARD,
 340                 .end    = INT_KEYBOARD,
 341                 .flags  = IORESOURCE_IRQ,
 342         },
 343 };
 344
 345 static const struct matrix_keymap_data ams_delta_keymap_data = {
 346         .keymap         = ams_delta_keymap,
 347         .keymap_size    = ARRAY_SIZE(ams_delta_keymap),
 348 };
 349
 350 static struct omap_kp_platform_data ams_delta_kp_data = {
 351         .rows           = 8,
 352         .cols           = 8,
 353         .keymap_data    = &ams_delta_keymap_data,
 354         .delay          = 9,
 355 };
 356
 357 static struct platform_device ams_delta_kp_device = {
 358         .name           = "omap-keypad",
 359         .id             = -1,
 360         .dev            = {
 361                 .platform_data = &ams_delta_kp_data,
 362         },
 363         .num_resources  = ARRAY_SIZE(ams_delta_kp_resources),
 364         .resource       = ams_delta_kp_resources,
 365 };
 366
 367 static struct platform_device ams_delta_lcd_device = {
 368         .name   = "lcd_ams_delta",
 369         .id     = -1,
 370 };
 371
 372 static const struct gpio_led gpio_leds[] __initconst = {
 373         {
 374                 .name            = "camera",
 375                 .gpio            = LATCH1_GPIO_BASE + 0,
 376                 .default_state   = LEDS_GPIO_DEFSTATE_OFF,
 377 #ifdef CONFIG_LEDS_TRIGGERS
 378                 .default_trigger = "ams_delta_camera",
 379 #endif
 380         },
 381         {
 382                 .name            = "advert",
 383                 .gpio            = LATCH1_GPIO_BASE + 1,
 384                 .default_state   = LEDS_GPIO_DEFSTATE_OFF,
 385         },
 386         {
 387                 .name            = "email",
 388                 .gpio            = LATCH1_GPIO_BASE + 2,
 389                 .default_state   = LEDS_GPIO_DEFSTATE_OFF,
 390         },
 391         {
 392                 .name            = "handsfree",
 393                 .gpio            = LATCH1_GPIO_BASE + 3,
 394                 .default_state   = LEDS_GPIO_DEFSTATE_OFF,
 395         },
 396         {
 397                 .name            = "voicemail",
 398                 .gpio            = LATCH1_GPIO_BASE + 4,
 399                 .default_state   = LEDS_GPIO_DEFSTATE_OFF,
 400         },
 401         {
 402                 .name            = "voice",
 403                 .gpio            = LATCH1_GPIO_BASE + 5,
 404                 .default_state   = LEDS_GPIO_DEFSTATE_OFF,
 405         },
 406 };
 407
 408 static const struct gpio_led_platform_data leds_pdata __initconst = {
 409         .leds           = gpio_leds,
 410         .num_leds       = ARRAY_SIZE(gpio_leds),
 411 };
 412
 413 static struct i2c_board_info ams_delta_camera_board_info[] = {
 414         {
 415                 I2C_BOARD_INFO("ov6650", 0x60),
 416         },
 417 };
 418
 419 #ifdef CONFIG_LEDS_TRIGGERS
 420 DEFINE_LED_TRIGGER(ams_delta_camera_led_trigger);
 421
 422 static int ams_delta_camera_power(struct device *dev, int power)
 423 {
 424         /*
 425          * turn on camera LED
 426          */
 427         if (power)
 428                 led_trigger_event(ams_delta_camera_led_trigger, LED_FULL);
 429         else
 430                 led_trigger_event(ams_delta_camera_led_trigger, LED_OFF);
 431         return 0;
 432 }
 433 #else
 434 #define ams_delta_camera_power  NULL
 435 #endif
 436
 437 static struct soc_camera_link ams_delta_iclink = {
 438         .bus_id         = 0,    /* OMAP1 SoC camera bus */
 439         .i2c_adapter_id = 1,
 440         .board_info     = &ams_delta_camera_board_info[0],
 441         .module_name    = "ov6650",
 442         .power          = ams_delta_camera_power,
 443 };
 444
 445 static struct platform_device ams_delta_camera_device = {
 446         .name   = "soc-camera-pdrv",
 447         .id     = 0,
 448         .dev    = {
 449                 .platform_data = &ams_delta_iclink,
 450         },
 451 };
 452
 453 static struct omap1_cam_platform_data ams_delta_camera_platform_data = {
 454         .camexclk_khz   = 12000,        /* default 12MHz clock, no extra DPLL */
 455         .lclk_khz_max   = 1334,         /* results in 5fps CIF, 10fps QCIF */
 456 };
 457
 458 static struct platform_device ams_delta_audio_device = {
 459         .name   = "ams-delta-audio",
 460         .id     = -1,
 461 };
 462
 463 static struct platform_device cx20442_codec_device = {
 464         .name   = "cx20442-codec",
 465         .id     = -1,
 466 };
 467
 468 static struct platform_device *ams_delta_devices[] __initdata = {
 469         &latch1_gpio_device,
 470         &latch2_gpio_device,
 471         &ams_delta_kp_device,
 472         &ams_delta_camera_device,
 473         &ams_delta_audio_device,
 474 };
 475
 476 static struct platform_device *late_devices[] __initdata = {
 477         &ams_delta_nand_device,
 478         &ams_delta_lcd_device,
 479         &cx20442_codec_device,
 480 };
 481
 482 static void __init ams_delta_init(void)
 483 {
 484         /* mux pins for uarts */
 485         omap_cfg_reg(UART1_TX);
 486         omap_cfg_reg(UART1_RTS);
 487
 488         /* parallel camera interface */
 489         omap_cfg_reg(H19_1610_CAM_EXCLK);
 490         omap_cfg_reg(J15_1610_CAM_LCLK);
 491         omap_cfg_reg(L18_1610_CAM_VS);
 492         omap_cfg_reg(L15_1610_CAM_HS);
 493         omap_cfg_reg(L19_1610_CAM_D0);
 494         omap_cfg_reg(K14_1610_CAM_D1);
 495         omap_cfg_reg(K15_1610_CAM_D2);
 496         omap_cfg_reg(K19_1610_CAM_D3);
 497         omap_cfg_reg(K18_1610_CAM_D4);
 498         omap_cfg_reg(J14_1610_CAM_D5);
 499         omap_cfg_reg(J19_1610_CAM_D6);
 500         omap_cfg_reg(J18_1610_CAM_D7);
 501
 502         omap_serial_init();
 503         omap_register_i2c_bus(1, 100, NULL, 0);
 504
 505         omap1_usb_init(&ams_delta_usb_config);
 506         omap1_set_camera_info(&ams_delta_camera_platform_data);
 507 #ifdef CONFIG_LEDS_TRIGGERS
 508         led_trigger_register_simple("ams_delta_camera",
 509                         &ams_delta_camera_led_trigger);
 510 #endif
 511         gpio_led_register_device(-1, &leds_pdata);
 512         platform_add_devices(ams_delta_devices, ARRAY_SIZE(ams_delta_devices));
 513
 514         ams_delta_init_fiq();
 515
 516         omap_writew(omap_readw(ARM_RSTCT1) | 0x0004, ARM_RSTCT1);
 517
 518         omapfb_set_lcd_config(&ams_delta_lcd_config);
 519 }
 520
 521 static void modem_pm(struct uart_port *port, unsigned int state, unsigned old)
 522 {
 523         struct modem_private_data *priv = port->private_data;
 524         int ret;
 525
 526         if (IS_ERR(priv->regulator))
 527                 return;
 528
 529         if (state == old)
 530                 return;
 531
 532         if (state == 0)
 533                 ret = regulator_enable(priv->regulator);
 534         else if (old == 0)
 535                 ret = regulator_disable(priv->regulator);
 536         else
 537                 ret = 0;
 538
 539         if (ret)
 540                 dev_warn(port->dev,
 541                          "ams_delta modem_pm: failed to %sable regulator: %d\n",
 542                          state ? "dis" : "en", ret);
 543 }
 544
 545 static struct plat_serial8250_port ams_delta_modem_ports[] = {
 546         {
 547                 .membase        = IOMEM(MODEM_VIRT),
 548                 .mapbase        = MODEM_PHYS,
 549                 .irq            = -EINVAL, /* changed later */
 550                 .flags          = UPF_BOOT_AUTOCONF,
 551                 .irqflags       = IRQF_TRIGGER_RISING,
 552                 .iotype         = UPIO_MEM,
 553                 .regshift       = 1,
 554                 .uartclk        = BASE_BAUD * 16,
 555                 .pm             = modem_pm,
 556                 .private_data   = &modem_priv,
 557         },
 558         { },
 559 };
 560
 561 static struct platform_device ams_delta_modem_device = {
 562         .name   = "serial8250",
 563         .id     = PLAT8250_DEV_PLATFORM1,
 564         .dev            = {
 565                 .platform_data = ams_delta_modem_ports,
 566         },
 567 };
 568
 569 static int __init late_init(void)
 570 {
 571         int err;
 572
 573         if (!machine_is_ams_delta())
 574                 return -ENODEV;
 575
 576         err = gpio_request_array(latch_gpios, ARRAY_SIZE(latch_gpios));
 577         if (err) {
 578                 pr_err("Couldn't take over latch1/latch2 GPIO pins\n");
 579                 return err;
 580         }
 581
 582         platform_add_devices(late_devices, ARRAY_SIZE(late_devices));
 583
 584         gpiod_add_lookup_table(&modem_nreset_gpiod_table);
 585         err = platform_device_register(&modem_nreset_device);
 586         if (err) {
 587                 pr_err("Couldn't register the modem regulator device\n");
 588                 return err;
 589         }
 590
 591         omap_cfg_reg(M14_1510_GPIO2);
 592         ams_delta_modem_ports[0].irq =
 593                         gpio_to_irq(AMS_DELTA_GPIO_PIN_MODEM_IRQ);
 594
 595         err = gpio_request(AMS_DELTA_GPIO_PIN_MODEM_IRQ, "modem");
 596         if (err) {
 597                 pr_err("Couldn't request gpio pin for modem\n");
 598                 return err;
 599         }
 600         gpio_direction_input(AMS_DELTA_GPIO_PIN_MODEM_IRQ);
 601
 602         /* Initialize the modem_nreset regulator consumer before use */
 603         modem_priv.regulator = ERR_PTR(-ENODEV);
 604
 605         ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC,
 606                         AMS_DELTA_LATCH2_MODEM_CODEC);
 607
 608         err = platform_device_register(&ams_delta_modem_device);
 609         if (err)
 610                 goto gpio_free;
 611
 612         /*
 613          * Once the modem device is registered, the modem_nreset
 614          * regulator can be requested on behalf of that device.
 615          */
 616         modem_priv.regulator = regulator_get(&ams_delta_modem_device.dev,
 617                         "RESET#");
 618         if (IS_ERR(modem_priv.regulator)) {
 619                 err = PTR_ERR(modem_priv.regulator);
 620                 goto unregister;
 621         }
 622         return 0;
 623
 624 unregister:
 625         platform_device_unregister(&ams_delta_modem_device);
 626 gpio_free:
 627         gpio_free(AMS_DELTA_GPIO_PIN_MODEM_IRQ);
 628         return err;
 629 }
 630
 631 static void __init ams_delta_init_late(void)
 632 {
 633         omap1_init_late();
 634         late_init();
 635 }
 636
 637 static void __init ams_delta_map_io(void)
 638 {
 639         omap15xx_map_io();
 640         iotable_init(ams_delta_io_desc, ARRAY_SIZE(ams_delta_io_desc));
 641 }
 642
 643 MACHINE_START(AMS_DELTA, "Amstrad E3 (Delta)")
 644         /* Maintainer: Jonathan McDowell <noodles@earth.li> */
 645         .atag_offset    = 0x100,
 646         .map_io         = ams_delta_map_io,
 647         .init_early     = omap1_init_early,
 648         .init_irq       = omap1_init_irq,
 649         .handle_irq     = omap1_handle_irq,
 650         .init_machine   = ams_delta_init,
 651         .init_late      = ams_delta_init_late,
 652         .init_time      = omap1_timer_init,
 653         .restart        = omap1_restart,
 654 MACHINE_END