Quelle  board-ams-delta.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * linux/arch/arm/mach-omap1/board-ams-delta.c
 *
 * Modified from board-generic.c
 *
 * Board specific inits for the Amstrad E3 (codename Delta) videophone
 *
 * Copyright (C) 2006 Jonathan McDowell <noodles@earth.li>
 */
#include <linux/gpio/driver.h>
#include <linux/gpio/machine.h>
#include <linux/gpio/consumer.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/leds.h>
#include <linux/mtd/nand-gpio.h>
#include <linux/mtd/partitions.h>
#include <linux/platform_device.h>
#include <linux/property.h>
#include <linux/regulator/consumer.h>
#include <linux/regulator/fixed.h>
#include <linux/regulator/machine.h>
#include <linux/serial_8250.h>
#include <linux/export.h>
#include <linux/omapfb.h>
#include <linux/io.h>
#include <linux/platform_data/gpio-omap.h>
#include <linux/soc/ti/omap1-mux.h>

#include <asm/serial.h>
#include <asm/mach-types.h>
#include <asm/mach/arch.h>
#include <asm/mach/map.h>

#include <linux/platform_data/keypad-omap.h>

#include "hardware.h"
#include "usb.h"
#include "ams-delta-fiq.h"
#include "board-ams-delta.h"
#include "iomap.h"
#include "common.h"

static const unsigned int ams_delta_keymap[] = {
 KEY(0, 0, KEY_F1),  /* Advert    */

 KEY(0, 3, KEY_COFFEE),  /* Games     */
 KEY(0, 2, KEY_QUESTION), /* Directory */
 KEY(2, 3, KEY_CONNECT),  /* Internet  */
 KEY(1, 2, KEY_SHOP),  /* Services  */
 KEY(1, 1, KEY_PHONE),  /* VoiceMail */

 KEY(0, 1, KEY_DELETE),  /* Delete    */
 KEY(2, 2, KEY_PLAY),  /* Play      */
 KEY(1, 0, KEY_PAGEUP),  /* Up        */
 KEY(1, 3, KEY_PAGEDOWN), /* Down      */
 KEY(2, 0, KEY_EMAIL),  /* ReadEmail */
 KEY(2, 1, KEY_STOP),  /* Stop      */

 /* Numeric keypad portion */
 KEY(0, 7, KEY_KP1),
 KEY(0, 6, KEY_KP2),
 KEY(0, 5, KEY_KP3),
 KEY(1, 7, KEY_KP4),
 KEY(1, 6, KEY_KP5),
 KEY(1, 5, KEY_KP6),
 KEY(2, 7, KEY_KP7),
 KEY(2, 6, KEY_KP8),
 KEY(2, 5, KEY_KP9),
 KEY(3, 6, KEY_KP0),
 KEY(3, 7, KEY_KPASTERISK),
 KEY(3, 5, KEY_KPDOT),  /* # key     */
 KEY(7, 2, KEY_NUMLOCK),  /* Mute      */
 KEY(7, 1, KEY_KPMINUS),  /* Recall    */
 KEY(6, 1, KEY_KPPLUS),  /* Redial    */
 KEY(7, 6, KEY_KPSLASH),  /* Handsfree */
 KEY(6, 0, KEY_ENTER),  /* Video     */

 KEY(7, 4, KEY_CAMERA),  /* Photo     */

 KEY(0, 4, KEY_F2),  /* Home      */
 KEY(1, 4, KEY_F3),  /* Office    */
 KEY(2, 4, KEY_F4),  /* Mobile    */
 KEY(7, 7, KEY_F5),  /* SMS       */
 KEY(7, 5, KEY_F6),  /* Email     */

 /* QWERTY portion of keypad */
 KEY(3, 4, KEY_Q),
 KEY(3, 3, KEY_W),
 KEY(3, 2, KEY_E),
 KEY(3, 1, KEY_R),
 KEY(3, 0, KEY_T),
 KEY(4, 7, KEY_Y),
 KEY(4, 6, KEY_U),
 KEY(4, 5, KEY_I),
 KEY(4, 4, KEY_O),
 KEY(4, 3, KEY_P),

 KEY(4, 2, KEY_A),
 KEY(4, 1, KEY_S),
 KEY(4, 0, KEY_D),
 KEY(5, 7, KEY_F),
 KEY(5, 6, KEY_G),
 KEY(5, 5, KEY_H),
 KEY(5, 4, KEY_J),
 KEY(5, 3, KEY_K),
 KEY(5, 2, KEY_L),

 KEY(5, 1, KEY_Z),
 KEY(5, 0, KEY_X),
 KEY(6, 7, KEY_C),
 KEY(6, 6, KEY_V),
 KEY(6, 5, KEY_B),
 KEY(6, 4, KEY_N),
 KEY(6, 3, KEY_M),
 KEY(6, 2, KEY_SPACE),

 KEY(7, 0, KEY_LEFTSHIFT), /* Vol up    */
 KEY(7, 3, KEY_LEFTCTRL), /* Vol down  */
};

#define LATCH1_PHYS 0x01000000
#define LATCH1_VIRT 0xEA000000
#define MODEM_PHYS 0x04000000
#define MODEM_VIRT 0xEB000000
#define LATCH2_PHYS 0x08000000
#define LATCH2_VIRT 0xEC000000

static struct map_desc ams_delta_io_desc[] __initdata = {
 /* AMS_DELTA_LATCH1 */
 {
  .virtual = LATCH1_VIRT,
  .pfn  = __phys_to_pfn(LATCH1_PHYS),
  .length  = 0x01000000,
  .type  = MT_DEVICE
 },
 /* AMS_DELTA_LATCH2 */
 {
  .virtual = LATCH2_VIRT,
  .pfn  = __phys_to_pfn(LATCH2_PHYS),
  .length  = 0x01000000,
  .type  = MT_DEVICE
 },
 /* AMS_DELTA_MODEM */
 {
  .virtual = MODEM_VIRT,
  .pfn  = __phys_to_pfn(MODEM_PHYS),
  .length  = 0x01000000,
  .type  = MT_DEVICE
 }
};

static const struct omap_lcd_config ams_delta_lcd_config __initconst = {
 .ctrl_name = "internal",
};

static struct omap_usb_config ams_delta_usb_config __initdata = {
 .register_host = 1,
 .hmc_mode = 16,
 .pins[0] = 2,
};

#define LATCH1_NGPIO  8

static struct resource latch1_resources[] = {
 [0] = {
  .name = "dat",
  .start = LATCH1_PHYS,
  .end = LATCH1_PHYS + (LATCH1_NGPIO - 1) / 8,
  .flags = IORESOURCE_MEM,
 },
};

#define LATCH1_LABEL "latch1"

static const struct property_entry latch1_gpio_props[] = {
 PROPERTY_ENTRY_STRING("label", LATCH1_LABEL),
 PROPERTY_ENTRY_U32("ngpios", LATCH1_NGPIO),
 { }
};

static const struct platform_device_info latch1_gpio_devinfo = {
 .name  = "basic-mmio-gpio",
 .id  = 0,
 .res  = latch1_resources,
 .num_res = ARRAY_SIZE(latch1_resources),
 .properties = latch1_gpio_props,
};

#define LATCH1_PIN_LED_CAMERA  0
#define LATCH1_PIN_LED_ADVERT  1
#define LATCH1_PIN_LED_MAIL  2
#define LATCH1_PIN_LED_HANDSFREE 3
#define LATCH1_PIN_LED_VOICEMAIL 4
#define LATCH1_PIN_LED_VOICE  5
#define LATCH1_PIN_DOCKIT1  6
#define LATCH1_PIN_DOCKIT2  7

#define LATCH2_NGPIO   16

static struct resource latch2_resources[] = {
 [0] = {
  .name = "dat",
  .start = LATCH2_PHYS,
  .end = LATCH2_PHYS + (LATCH2_NGPIO - 1) / 8,
  .flags = IORESOURCE_MEM,
 },
};

#define LATCH2_LABEL "latch2"

static const struct property_entry latch2_gpio_props[] = {
 PROPERTY_ENTRY_STRING("label", LATCH2_LABEL),
 PROPERTY_ENTRY_U32("ngpios", LATCH2_NGPIO),
 { }
};

static struct platform_device_info latch2_gpio_devinfo = {
 .name  = "basic-mmio-gpio",
 .id  = 1,
 .res  = latch2_resources,
 .num_res = ARRAY_SIZE(latch2_resources),
 .properties = latch2_gpio_props,
};

#define LATCH2_PIN_LCD_VBLEN  0
#define LATCH2_PIN_LCD_NDISP  1
#define LATCH2_PIN_NAND_NCE  2
#define LATCH2_PIN_NAND_NRE  3
#define LATCH2_PIN_NAND_NWP  4
#define LATCH2_PIN_NAND_NWE  5
#define LATCH2_PIN_NAND_ALE  6
#define LATCH2_PIN_NAND_CLE  7
#define LATCH2_PIN_KEYBRD_PWR  8
#define LATCH2_PIN_KEYBRD_DATAOUT 9
#define LATCH2_PIN_SCARD_RSTIN  10
#define LATCH2_PIN_SCARD_CMDVCC  11
#define LATCH2_PIN_MODEM_NRESET  12
#define LATCH2_PIN_MODEM_CODEC  13
#define LATCH2_PIN_HANDSFREE_MUTE 14
#define LATCH2_PIN_HANDSET_MUTE  15

static struct regulator_consumer_supply modem_nreset_consumers[] = {
 REGULATOR_SUPPLY("RESET#", "serial8250.1"),
 REGULATOR_SUPPLY("POR", "cx20442-codec"),
};

static struct regulator_init_data modem_nreset_data = {
 .constraints  = {
  .valid_ops_mask  = REGULATOR_CHANGE_STATUS,
  .boot_on  = 1,
 },
 .num_consumer_supplies = ARRAY_SIZE(modem_nreset_consumers),
 .consumer_supplies = modem_nreset_consumers,
};

static struct fixed_voltage_config modem_nreset_config = {
 .supply_name  = "modem_nreset",
 .microvolts  = 3300000,
 .startup_delay  = 25000,
 .enabled_at_boot = 1,
 .init_data  = &modem_nreset_data,
};

static struct platform_device modem_nreset_device = {
 .name = "reg-fixed-voltage",
 .id = -1,
 .dev = {
  .platform_data = &modem_nreset_config,
 },
};

static struct gpiod_lookup_table ams_delta_nreset_gpiod_table = {
 .dev_id = "reg-fixed-voltage",
 .table = {
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_MODEM_NRESET,
       NULL, GPIO_ACTIVE_HIGH),
  { },
 },
};

struct modem_private_data {
 struct regulator *regulator;
};

static struct modem_private_data modem_priv;

/*
 * Define partitions for flash device
 */

static struct mtd_partition partition_info[] = {
 { .name  = "Kernel",
   .offset = 0,
   .size  = 3 * SZ_1M + SZ_512K },
 { .name  = "u-boot",
   .offset = 3 * SZ_1M + SZ_512K,
   .size  = SZ_256K },
 { .name  = "u-boot params",
   .offset = 3 * SZ_1M + SZ_512K + SZ_256K,
   .size  = SZ_256K },
 { .name  = "Amstrad LDR",
   .offset = 4 * SZ_1M,
   .size  = SZ_256K },
 { .name  = "File system",
   .offset = 4 * SZ_1M + 1 * SZ_256K,
   .size  = 27 * SZ_1M },
 { .name  = "PBL reserved",
   .offset = 32 * SZ_1M - 3 * SZ_256K,
   .size  =  3 * SZ_256K },
};

static struct gpio_nand_platdata nand_platdata = {
 .parts  = partition_info,
 .num_parts = ARRAY_SIZE(partition_info),
};

static struct platform_device ams_delta_nand_device = {
 .name = "ams-delta-nand",
 .id = -1,
 .dev = {
  .platform_data = &nand_platdata,
 },
};

#define OMAP_GPIO_LABEL  "gpio-0-15"
#define OMAP_MPUIO_LABEL "mpuio"

static struct gpiod_lookup_table ams_delta_nand_gpio_table = {
 .table = {
  GPIO_LOOKUP(OMAP_GPIO_LABEL, AMS_DELTA_GPIO_PIN_NAND_RB, "rdy",
       0),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_NCE, "nce",
       GPIO_ACTIVE_LOW),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_NRE, "nre",
       GPIO_ACTIVE_LOW),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_NWP, "nwp",
       GPIO_ACTIVE_LOW),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_NWE, "nwe",
       GPIO_ACTIVE_LOW),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_ALE, "ale", 0),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_CLE, "cle", 0),
  GPIO_LOOKUP_IDX(OMAP_MPUIO_LABEL, 0, "data", 0, 0),
  GPIO_LOOKUP_IDX(OMAP_MPUIO_LABEL, 1, "data", 1, 0),
  GPIO_LOOKUP_IDX(OMAP_MPUIO_LABEL, 2, "data", 2, 0),
  GPIO_LOOKUP_IDX(OMAP_MPUIO_LABEL, 3, "data", 3, 0),
  GPIO_LOOKUP_IDX(OMAP_MPUIO_LABEL, 4, "data", 4, 0),
  GPIO_LOOKUP_IDX(OMAP_MPUIO_LABEL, 5, "data", 5, 0),
  GPIO_LOOKUP_IDX(OMAP_MPUIO_LABEL, 6, "data", 6, 0),
  GPIO_LOOKUP_IDX(OMAP_MPUIO_LABEL, 7, "data", 7, 0),
  { },
 },
};

static struct resource ams_delta_kp_resources[] = {
 [0] = {
  .start = INT_KEYBOARD,
  .end = INT_KEYBOARD,
  .flags = IORESOURCE_IRQ,
 },
};

static const struct matrix_keymap_data ams_delta_keymap_data = {
 .keymap  = ams_delta_keymap,
 .keymap_size = ARRAY_SIZE(ams_delta_keymap),
};

static struct omap_kp_platform_data ams_delta_kp_data = {
 .rows  = 8,
 .cols  = 8,
 .keymap_data = &ams_delta_keymap_data,
 .delay  = 9,
};

static struct platform_device ams_delta_kp_device = {
 .name  = "omap-keypad",
 .id  = -1,
 .dev  = {
  .platform_data = &ams_delta_kp_data,
 },
 .num_resources = ARRAY_SIZE(ams_delta_kp_resources),
 .resource = ams_delta_kp_resources,
};

static struct platform_device ams_delta_lcd_device = {
 .name = "lcd_ams_delta",
 .id = -1,
};

static struct gpiod_lookup_table ams_delta_lcd_gpio_table = {
 .table = {
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_LCD_VBLEN, "vblen", 0),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_LCD_NDISP, "ndisp", 0),
  { },
 },
};

static struct gpio_led gpio_leds[] __initdata = {
 [LATCH1_PIN_LED_CAMERA] = {
  .name   = "camera",
  .default_state  = LEDS_GPIO_DEFSTATE_OFF,
 },
 [LATCH1_PIN_LED_ADVERT] = {
  .name   = "advert",
  .default_state  = LEDS_GPIO_DEFSTATE_OFF,
 },
 [LATCH1_PIN_LED_MAIL] = {
  .name   = "email",
  .default_state  = LEDS_GPIO_DEFSTATE_OFF,
 },
 [LATCH1_PIN_LED_HANDSFREE] = {
  .name   = "handsfree",
  .default_state  = LEDS_GPIO_DEFSTATE_OFF,
 },
 [LATCH1_PIN_LED_VOICEMAIL] = {
  .name   = "voicemail",
  .default_state  = LEDS_GPIO_DEFSTATE_OFF,
 },
 [LATCH1_PIN_LED_VOICE] = {
  .name   = "voice",
  .default_state  = LEDS_GPIO_DEFSTATE_OFF,
 },
};

static const struct gpio_led_platform_data leds_pdata __initconst = {
 .leds  = gpio_leds,
 .num_leds = ARRAY_SIZE(gpio_leds),
};

static struct gpiod_lookup_table leds_gpio_table = {
 .table = {
  GPIO_LOOKUP_IDX(LATCH1_LABEL, LATCH1_PIN_LED_CAMERA, NULL,
    LATCH1_PIN_LED_CAMERA, 0),
  GPIO_LOOKUP_IDX(LATCH1_LABEL, LATCH1_PIN_LED_ADVERT, NULL,
    LATCH1_PIN_LED_ADVERT, 0),
  GPIO_LOOKUP_IDX(LATCH1_LABEL, LATCH1_PIN_LED_MAIL, NULL,
    LATCH1_PIN_LED_MAIL, 0),
  GPIO_LOOKUP_IDX(LATCH1_LABEL, LATCH1_PIN_LED_HANDSFREE, NULL,
    LATCH1_PIN_LED_HANDSFREE, 0),
  GPIO_LOOKUP_IDX(LATCH1_LABEL, LATCH1_PIN_LED_VOICEMAIL, NULL,
    LATCH1_PIN_LED_VOICEMAIL, 0),
  GPIO_LOOKUP_IDX(LATCH1_LABEL, LATCH1_PIN_LED_VOICE, NULL,
    LATCH1_PIN_LED_VOICE, 0),
  { },
 },
};

static struct platform_device ams_delta_audio_device = {
 .name   = "ams-delta-audio",
 .id     = -1,
};

static struct gpiod_lookup_table ams_delta_audio_gpio_table = {
 .table = {
  GPIO_LOOKUP(OMAP_GPIO_LABEL, AMS_DELTA_GPIO_PIN_HOOK_SWITCH,
       "hook_switch", 0),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_MODEM_CODEC,
       "modem_codec", 0),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_HANDSFREE_MUTE,
       "handsfree_mute", 0),
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_HANDSET_MUTE,
       "handset_mute", 0),
  { },
 },
};

static struct platform_device cx20442_codec_device = {
 .name   = "cx20442-codec",
 .id     = -1,
};

static struct resource ams_delta_serio_resources[] = {
 {
  .flags = IORESOURCE_IRQ,
  /*
 * Initialize IRQ resource with invalid IRQ number.
 * It will be replaced with dynamically allocated GPIO IRQ
 * obtained from GPIO chip as soon as the chip is available.
 */
  .start = -EINVAL,
  .end = -EINVAL,
 },
};

static struct platform_device ams_delta_serio_device = {
 .name  = "ams-delta-serio",
 .id  = PLATFORM_DEVID_NONE,
 .dev  = {
  /*
 * Initialize .platform_data explicitly with NULL to
 * indicate it is going to be used.  It will be replaced
 * with FIQ buffer address as soon as FIQ is initialized.
 */
  .platform_data = NULL,
 },
 .num_resources = ARRAY_SIZE(ams_delta_serio_resources),
 .resource = ams_delta_serio_resources,
};

static struct regulator_consumer_supply keybrd_pwr_consumers[] = {
 /*
 * Initialize supply .dev_name with NULL.  It will be replaced
 * with serio dev_name() as soon as the serio device is registered.
 */
 REGULATOR_SUPPLY("vcc", NULL),
};

static struct regulator_init_data keybrd_pwr_initdata = {
 .constraints  = {
  .valid_ops_mask  = REGULATOR_CHANGE_STATUS,
 },
 .num_consumer_supplies = ARRAY_SIZE(keybrd_pwr_consumers),
 .consumer_supplies = keybrd_pwr_consumers,
};

static struct fixed_voltage_config keybrd_pwr_config = {
 .supply_name  = "keybrd_pwr",
 .microvolts  = 5000000,
 .init_data  = &keybrd_pwr_initdata,
};

static struct platform_device keybrd_pwr_device = {
 .name = "reg-fixed-voltage",
 .id = PLATFORM_DEVID_AUTO,
 .dev = {
  .platform_data = &keybrd_pwr_config,
 },
};

static struct gpiod_lookup_table keybrd_pwr_gpio_table = {
 .table = {
  GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_KEYBRD_PWR, NULL,
       GPIO_ACTIVE_HIGH),
  { },
 },
};

static struct platform_device *ams_delta_devices[] __initdata = {
 &ams_delta_kp_device,
 &ams_delta_audio_device,
 &ams_delta_serio_device,
 &ams_delta_nand_device,
 &ams_delta_lcd_device,
 &cx20442_codec_device,
 &modem_nreset_device,
};

static struct gpiod_lookup_table *ams_delta_gpio_tables[] __initdata = {
 &ams_delta_nreset_gpiod_table,
 &ams_delta_audio_gpio_table,
 &keybrd_pwr_gpio_table,
 &ams_delta_lcd_gpio_table,
 &ams_delta_nand_gpio_table,
};

static struct gpiod_hog ams_delta_gpio_hogs[] = {
 GPIO_HOG(LATCH2_LABEL, LATCH2_PIN_KEYBRD_DATAOUT, "keybrd_dataout",
   GPIO_ACTIVE_HIGH, GPIOD_OUT_LOW),
 {},
};

static struct plat_serial8250_port ams_delta_modem_ports[];

/*
 * Obtain MODEM IRQ GPIO descriptor using its hardware pin
 * number and assign related IRQ number to the MODEM port.
 * Keep the GPIO descriptor open so nobody steps in.
 */
static void __init modem_assign_irq(struct gpio_chip *chip)
{
 struct gpio_desc *gpiod;

 gpiod = gpiochip_request_own_desc(chip, AMS_DELTA_GPIO_PIN_MODEM_IRQ,
       "modem_irq", GPIO_ACTIVE_HIGH,
       GPIOD_IN);
 if (IS_ERR(gpiod)) {
  pr_err("%s: modem IRQ GPIO request failed (%ld)\n", __func__,
         PTR_ERR(gpiod));
 } else {
  ams_delta_modem_ports[0].irq = gpiod_to_irq(gpiod);
 }
}

/*
 * The purpose of this function is to take care of proper initialization of
 * devices and data structures which depend on GPIO lines provided by OMAP GPIO
 * banks but their drivers don't use GPIO lookup tables or GPIO layer at all.
 * The function may be called as soon as OMAP GPIO devices are probed.
 * Since that happens at postcore_initcall, it can be called successfully
 * from init_machine or later.
 * Dependent devices may be registered from within this function or later.
 */
static void __init omap_gpio_deps_init(void)
{
 struct gpio_device *gdev;
 struct gpio_chip *chip;

 /*
 * Some drivers may not use GPIO lookup tables but need to be provided
 * with GPIO numbers. The same applies to GPIO based IRQ lines - some
 * drivers may even not use GPIO layer but expect just IRQ numbers.
 * We could either define GPIO lookup tables then use them on behalf
 * of those devices, or we can use GPIO driver level methods for
 * identification of GPIO and IRQ numbers.
 *
 * This reference will be leaked but that's alright as this device
 * never goes down.
 */
 gdev = gpio_device_find_by_label(OMAP_GPIO_LABEL);
 if (!gdev) {
  pr_err("%s: OMAP GPIO device not found\n", __func__);
  return;
 }

 chip = gpio_device_get_chip(gdev);

 /*
 * Start with FIQ initialization as it may have to request
 * and release successfully each OMAP GPIO pin in turn.
 */
 ams_delta_init_fiq(chip, &ams_delta_serio_device);

 modem_assign_irq(chip);
}

/*
 * Initialize latch2 pins with values which are safe for dependent on-board
 * devices or useful for their successull initialization even before GPIO
 * driver takes control over the latch pins:
 * - LATCH2_PIN_LCD_VBLEN = 0
 * - LATCH2_PIN_LCD_NDISP = 0 Keep LCD device powered off before its
 * driver takes control over it.
 * - LATCH2_PIN_NAND_NCE = 0
 * - LATCH2_PIN_NAND_NWP = 0 Keep NAND device down and write-
 * protected before its driver takes
 * control over it.
 * - LATCH2_PIN_KEYBRD_PWR = 0 Keep keyboard powered off before serio
 * driver takes control over it.
 * - LATCH2_PIN_KEYBRD_DATAOUT = 0 Keep low to avoid corruption of first
 * byte of data received from attached
 * keyboard when serio device is probed;
 * the pin is also hogged low by the latch2
 * GPIO driver as soon as it is ready.
 * - LATCH2_PIN_MODEM_NRESET = 1 Enable voice MODEM device, allowing for
 * its successful probe even before a
 * regulator it depends on, which in turn
 * takes control over the pin, is set up.
 * - LATCH2_PIN_MODEM_CODEC = 1 Attach voice MODEM CODEC data port
 * to the MODEM so the CODEC is under
 * control even if audio driver doesn't
 * take it over.
 */
static void __init ams_delta_latch2_init(void)
{
 u16 latch2 = 1 << LATCH2_PIN_MODEM_NRESET | 1 << LATCH2_PIN_MODEM_CODEC;

 __raw_writew(latch2, IOMEM(LATCH2_VIRT));
}

static void __init ams_delta_init(void)
{
 struct platform_device *leds_pdev;

 /* mux pins for uarts */
 omap_cfg_reg(UART1_TX);
 omap_cfg_reg(UART1_RTS);

 /* parallel camera interface */
 omap_cfg_reg(H19_1610_CAM_EXCLK);
 omap_cfg_reg(J15_1610_CAM_LCLK);
 omap_cfg_reg(L18_1610_CAM_VS);
 omap_cfg_reg(L15_1610_CAM_HS);
 omap_cfg_reg(L19_1610_CAM_D0);
 omap_cfg_reg(K14_1610_CAM_D1);
 omap_cfg_reg(K15_1610_CAM_D2);
 omap_cfg_reg(K19_1610_CAM_D3);
 omap_cfg_reg(K18_1610_CAM_D4);
 omap_cfg_reg(J14_1610_CAM_D5);
 omap_cfg_reg(J19_1610_CAM_D6);
 omap_cfg_reg(J18_1610_CAM_D7);

 omap_gpio_deps_init();
 ams_delta_latch2_init();
 gpiod_add_hogs(ams_delta_gpio_hogs);

 omap_serial_init();
 omap_register_i2c_bus(1, 100, NULL, 0);

 omap1_usb_init(&ams_delta_usb_config);
 platform_add_devices(ams_delta_devices, ARRAY_SIZE(ams_delta_devices));

 platform_device_register_full(&latch1_gpio_devinfo);
 platform_device_register_full(&latch2_gpio_devinfo);

 /*
 * As soon as regulator consumers have been registered, assign their
 * dev_names to consumer supply entries of respective regulators.
 */
 keybrd_pwr_consumers[0].dev_name =
   dev_name(&ams_delta_serio_device.dev);

 /*
 * Once consumer supply entries are populated with dev_names,
 * register regulator devices.  At this stage only the keyboard
 * power regulator has its consumer supply table fully populated.
 */
 platform_device_register(&keybrd_pwr_device);

 /*
 * As soon as GPIO consumers have been registered, assign
 * their dev_names to respective GPIO lookup tables.
 */
 ams_delta_audio_gpio_table.dev_id =
   dev_name(&ams_delta_audio_device.dev);
 keybrd_pwr_gpio_table.dev_id = dev_name(&keybrd_pwr_device.dev);
 ams_delta_nand_gpio_table.dev_id = dev_name(&ams_delta_nand_device.dev);
 ams_delta_lcd_gpio_table.dev_id = dev_name(&ams_delta_lcd_device.dev);

 /*
 * Once GPIO lookup tables are populated with dev_names, register them.
 */
 gpiod_add_lookup_tables(ams_delta_gpio_tables,
    ARRAY_SIZE(ams_delta_gpio_tables));

 leds_pdev = gpio_led_register_device(PLATFORM_DEVID_NONE, &leds_pdata);
 if (!IS_ERR_OR_NULL(leds_pdev)) {
  leds_gpio_table.dev_id = dev_name(&leds_pdev->dev);
  gpiod_add_lookup_table(&leds_gpio_table);
 }

 omap_writew(omap_readw(ARM_RSTCT1) | 0x0004, ARM_RSTCT1);

 omapfb_set_lcd_config(&ams_delta_lcd_config);
}

static void modem_pm(struct uart_port *port, unsigned int state, unsigned old)
{
 struct modem_private_data *priv = port->private_data;
 int ret;

 if (!priv)
  return;

 if (IS_ERR(priv->regulator))
  return;

 if (state == old)
  return;

 if (state == 0)
  ret = regulator_enable(priv->regulator);
 else if (old == 0)
  ret = regulator_disable(priv->regulator);
 else
  ret = 0;

 if (ret)
  dev_warn(port->dev,
    "ams_delta modem_pm: failed to %sable regulator: %d\n",
    state ? "dis" : "en", ret);
}

static struct plat_serial8250_port ams_delta_modem_ports[] = {
 {
  .membase = IOMEM(MODEM_VIRT),
  .mapbase = MODEM_PHYS,
  .irq  = IRQ_NOTCONNECTED, /* changed later */
  .flags  = UPF_BOOT_AUTOCONF,
  .irqflags = IRQF_TRIGGER_RISING,
  .iotype  = UPIO_MEM,
  .regshift = 1,
  .uartclk = BASE_BAUD * 16,
  .pm  = modem_pm,
  .private_data = &modem_priv,
 },
 { },
};

static int ams_delta_modem_pm_activate(struct device *dev)
{
 modem_priv.regulator = regulator_get(dev, "RESET#");
 if (IS_ERR(modem_priv.regulator))
  return -EPROBE_DEFER;

 return 0;
}

static struct dev_pm_domain ams_delta_modem_pm_domain = {
 .activate = ams_delta_modem_pm_activate,
};

static struct platform_device ams_delta_modem_device = {
 .name = "serial8250",
 .id = PLAT8250_DEV_PLATFORM1,
 .dev  = {
  .platform_data = ams_delta_modem_ports,
  .pm_domain = &ams_delta_modem_pm_domain,
 },
};

/*
 * This function expects MODEM IRQ number already assigned to the port.
 * The MODEM device requires its RESET# pin kept high during probe.
 * That requirement can be fulfilled in several ways:
 * - with a descriptor of already functional modem_nreset regulator
 *   assigned to the MODEM private data,
 * - with the regulator not yet controlled by modem_pm function but
 *   already enabled by default on probe,
 * - before the modem_nreset regulator is probed, with the pin already
 *   set high explicitly.
 * The last one is already guaranteed by ams_delta_latch2_init() called
 * from machine_init.
 * In order to avoid taking over ttyS0 device slot, the MODEM device
 * should be registered after OMAP serial ports.  Since those ports
 * are registered at arch_initcall, this function can be called safely
 * at arch_initcall_sync earliest.
 */
static int __init ams_delta_modem_init(void)
{
 if (!machine_is_ams_delta())
  return -ENODEV;

 omap_cfg_reg(M14_1510_GPIO2);

 /* Initialize the modem_nreset regulator consumer before use */
 modem_priv.regulator = ERR_PTR(-ENODEV);

 return platform_device_register(&ams_delta_modem_device);
}
arch_initcall_sync(ams_delta_modem_init);

static void __init ams_delta_map_io(void)
{
 omap1_map_io();
 iotable_init(ams_delta_io_desc, ARRAY_SIZE(ams_delta_io_desc));
}

MACHINE_START(AMS_DELTA, "Amstrad E3 (Delta)")
 /* Maintainer: Jonathan McDowell <noodles@earth.li> */
 .atag_offset = 0x100,
 .map_io  = ams_delta_map_io,
 .init_early = omap1_init_early,
 .init_irq = omap1_init_irq,
 .init_machine = ams_delta_init,
 .init_late = omap1_init_late,
 .init_time = omap1_timer_init,
 .restart = omap1_restart,
MACHINE_END