OSCL-LXR linux-6.0.1/​arch/​arm/​mach-omap1/​board-ams-delta.c	Source navigation Diff markup Identifier search General search
	Version: linux-6.0.1 spark-3.0.0 hadoop-3.2.0-src hadoop-3.3.0-src spark-2.4.7 linux-4.15.13 hadoop-2.7.4-src Revert   Change

 // 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/gpio.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/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 struct bgpio_pdata latch1_pdata = {
     .label  = LATCH1_LABEL,
     .base   = -1,
     .ngpio  = LATCH1_NGPIO,
 };
 
 static struct platform_device latch1_gpio_device = {
     .name       = "basic-mmio-gpio",
     .id     = 0,
     .resource   = latch1_resources,
     .num_resources  = ARRAY_SIZE(latch1_resources),
     .dev        = {
         .platform_data  = &latch1_pdata,
     },
 };
 
 #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 struct bgpio_pdata latch2_pdata = {
     .label  = LATCH2_LABEL,
     .base   = -1,
     .ngpio  = LATCH2_NGPIO,
 };
 
 static struct platform_device latch2_gpio_device = {
     .name       = "basic-mmio-gpio",
     .id     = 1,
     .resource   = latch2_resources,
     .num_resources  = ARRAY_SIZE(latch2_resources),
     .dev        = {
         .platform_data  = &latch2_pdata,
     },
 };
 
 #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 = {
     &latch1_gpio_device,
     &latch2_gpio_device,
     &ams_delta_kp_device,
     &ams_delta_audio_device,
     &ams_delta_serio_device,
     &ams_delta_nand_device,
     &ams_delta_lcd_device,
     &cx20442_codec_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,
 };
 
 /*
  * 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. For the purpose of the latter,
  * defina a helper function which identifies GPIO chips by their labels.
  */
 static int gpiochip_match_by_label(struct gpio_chip *chip, void *data)
 {
     char *label = data;
 
     return !strcmp(label, chip->label);
 }
 
 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_chip *chip;
 
     chip = gpiochip_find(OMAP_GPIO_LABEL, gpiochip_match_by_label);
     if (!chip) {
         pr_err("%s: OMAP GPIO chip not found\n", __func__);
         return;
     }
 
     /*
      * 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));
 
     /*
      * 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 struct platform_device ams_delta_modem_device = {
     .name   = "serial8250",
     .id = PLAT8250_DEV_PLATFORM1,
     .dev        = {
         .platform_data = ams_delta_modem_ports,
     },
 };
 
 static int __init modem_nreset_init(void)
 {
     int err;
 
     err = platform_device_register(&modem_nreset_device);
     if (err)
         pr_err("Couldn't register the modem regulator device\n");
 
     return err;
 }
 
 
 /*
  * 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)
 {
     int err;
 
     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);
 
     err = platform_device_register(&ams_delta_modem_device);
 
     return err;
 }
 arch_initcall_sync(ams_delta_modem_init);
 
 static int __init late_init(void)
 {
     int err;
 
     err = modem_nreset_init();
     if (err)
         return err;
 
     /*
      * Once the modem device is registered, the modem_nreset
      * regulator can be requested on behalf of that device.
      */
     modem_priv.regulator = regulator_get(&ams_delta_modem_device.dev,
             "RESET#");
     if (IS_ERR(modem_priv.regulator)) {
         err = PTR_ERR(modem_priv.regulator);
         goto unregister;
     }
     return 0;
 
 unregister:
     platform_device_unregister(&ams_delta_modem_device);
     return err;
 }
 
 static void __init ams_delta_init_late(void)
 {
     omap1_init_late();
     late_init();
 }
 
 static void __init ams_delta_map_io(void)
 {
     omap15xx_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,
     .handle_irq = omap1_handle_irq,
     .init_machine   = ams_delta_init,
     .init_late  = ams_delta_init_late,
     .init_time  = omap1_timer_init,
     .restart    = omap1_restart,
 MACHINE_END

This page was automatically generated by the 2.1.0 LXR engine. The LXR team