// 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 */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #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) { 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 */ .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