2 * linux/arch/arm/mach-omap1/board-ams-delta.c
4 * Modified from board-generic.c
6 * Board specific inits for the Amstrad E3 (codename Delta) videophone
8 * Copyright (C) 2006 Jonathan McDowell <noodles@earth.li>
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.
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>
30 #include <linux/platform_data/gpio-omap.h>
32 #include <media/soc_camera.h>
34 #include <asm/serial.h>
35 #include <asm/mach-types.h>
36 #include <asm/mach/arch.h>
37 #include <asm/mach/map.h>
39 #include <mach/board-ams-delta.h>
40 #include <linux/platform_data/keypad-omap.h>
43 #include <mach/hardware.h>
47 #include "ams-delta-fiq.h"
51 static const unsigned int ams_delta_keymap[] = {
52 KEY(0, 0, KEY_F1), /* Advert */
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 */
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 */
67 /* Numeric keypad portion */
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 */
86 KEY(7, 4, KEY_CAMERA), /* Photo */
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 */
94 /* QWERTY portion of keypad */
123 KEY(6, 2, KEY_SPACE),
125 KEY(7, 0, KEY_LEFTSHIFT), /* Vol up */
126 KEY(7, 3, KEY_LEFTCTRL), /* Vol down */
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
136 static struct map_desc ams_delta_io_desc[] __initdata = {
137 /* AMS_DELTA_LATCH1 */
139 .virtual = LATCH1_VIRT,
140 .pfn = __phys_to_pfn(LATCH1_PHYS),
141 .length = 0x01000000,
144 /* AMS_DELTA_LATCH2 */
146 .virtual = LATCH2_VIRT,
147 .pfn = __phys_to_pfn(LATCH2_PHYS),
148 .length = 0x01000000,
151 /* AMS_DELTA_MODEM */
153 .virtual = MODEM_VIRT,
154 .pfn = __phys_to_pfn(MODEM_PHYS),
155 .length = 0x01000000,
160 static const struct omap_lcd_config ams_delta_lcd_config __initconst = {
161 .ctrl_name = "internal",
164 static struct omap_usb_config ams_delta_usb_config __initdata = {
170 #define LATCH1_GPIO_BASE 232
171 #define LATCH1_NGPIO 8
173 static struct resource latch1_resources[] = {
176 .start = LATCH1_PHYS,
177 .end = LATCH1_PHYS + (LATCH1_NGPIO - 1) / 8,
178 .flags = IORESOURCE_MEM,
182 #define LATCH1_LABEL "latch1"
184 static struct bgpio_pdata latch1_pdata = {
185 .label = LATCH1_LABEL,
186 .base = LATCH1_GPIO_BASE,
187 .ngpio = LATCH1_NGPIO,
190 static struct platform_device latch1_gpio_device = {
191 .name = "basic-mmio-gpio",
193 .resource = latch1_resources,
194 .num_resources = ARRAY_SIZE(latch1_resources),
196 .platform_data = &latch1_pdata,
200 #define LATCH1_PIN_LED_CAMERA 0
201 #define LATCH1_PIN_LED_ADVERT 1
202 #define LATCH1_PIN_LED_MAIL 2
203 #define LATCH1_PIN_LED_HANDSFREE 3
204 #define LATCH1_PIN_LED_VOICEMAIL 4
205 #define LATCH1_PIN_LED_VOICE 5
206 #define LATCH1_PIN_DOCKIT1 6
207 #define LATCH1_PIN_DOCKIT2 7
209 static struct resource latch2_resources[] = {
212 .start = LATCH2_PHYS,
213 .end = LATCH2_PHYS + (AMS_DELTA_LATCH2_NGPIO - 1) / 8,
214 .flags = IORESOURCE_MEM,
218 #define LATCH2_LABEL "latch2"
220 static struct bgpio_pdata latch2_pdata = {
221 .label = LATCH2_LABEL,
222 .base = AMS_DELTA_LATCH2_GPIO_BASE,
223 .ngpio = AMS_DELTA_LATCH2_NGPIO,
226 static struct platform_device latch2_gpio_device = {
227 .name = "basic-mmio-gpio",
229 .resource = latch2_resources,
230 .num_resources = ARRAY_SIZE(latch2_resources),
232 .platform_data = &latch2_pdata,
236 #define LATCH2_PIN_LCD_VBLEN 0
237 #define LATCH2_PIN_LCD_NDISP 1
238 #define LATCH2_PIN_NAND_NCE 2
239 #define LATCH2_PIN_NAND_NRE 3
240 #define LATCH2_PIN_NAND_NWP 4
241 #define LATCH2_PIN_NAND_NWE 5
242 #define LATCH2_PIN_NAND_ALE 6
243 #define LATCH2_PIN_NAND_CLE 7
244 #define LATCH2_PIN_KEYBRD_PWR 8
245 #define LATCH2_PIN_KEYBRD_DATAOUT 9
246 #define LATCH2_PIN_SCARD_RSTIN 10
247 #define LATCH2_PIN_SCARD_CMDVCC 11
248 #define LATCH2_PIN_MODEM_NRESET 12
249 #define LATCH2_PIN_MODEM_CODEC 13
250 #define LATCH2_PIN_HOOKFLASH1 14
251 #define LATCH2_PIN_HOOKFLASH2 15
253 static const struct gpio latch_gpios[] __initconst = {
255 .gpio = LATCH1_GPIO_BASE + 6,
256 .flags = GPIOF_OUT_INIT_LOW,
260 .gpio = LATCH1_GPIO_BASE + 7,
261 .flags = GPIOF_OUT_INIT_LOW,
265 .gpio = AMS_DELTA_GPIO_PIN_SCARD_RSTIN,
266 .flags = GPIOF_OUT_INIT_LOW,
267 .label = "scard_rstin",
270 .gpio = AMS_DELTA_GPIO_PIN_SCARD_CMDVCC,
271 .flags = GPIOF_OUT_INIT_LOW,
272 .label = "scard_cmdvcc",
275 .gpio = AMS_DELTA_LATCH2_GPIO_BASE + 14,
276 .flags = GPIOF_OUT_INIT_LOW,
277 .label = "hookflash1",
280 .gpio = AMS_DELTA_LATCH2_GPIO_BASE + 15,
281 .flags = GPIOF_OUT_INIT_LOW,
282 .label = "hookflash2",
286 static struct regulator_consumer_supply modem_nreset_consumers[] = {
287 REGULATOR_SUPPLY("RESET#", "serial8250.1"),
288 REGULATOR_SUPPLY("POR", "cx20442-codec"),
291 static struct regulator_init_data modem_nreset_data = {
293 .valid_ops_mask = REGULATOR_CHANGE_STATUS,
296 .num_consumer_supplies = ARRAY_SIZE(modem_nreset_consumers),
297 .consumer_supplies = modem_nreset_consumers,
300 static struct fixed_voltage_config modem_nreset_config = {
301 .supply_name = "modem_nreset",
302 .microvolts = 3300000,
303 .startup_delay = 25000,
305 .enabled_at_boot = 1,
306 .init_data = &modem_nreset_data,
309 static struct platform_device modem_nreset_device = {
310 .name = "reg-fixed-voltage",
313 .platform_data = &modem_nreset_config,
317 static struct gpiod_lookup_table ams_delta_nreset_gpiod_table = {
318 .dev_id = "reg-fixed-voltage",
320 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_MODEM_NRESET,
321 NULL, GPIO_ACTIVE_HIGH),
326 struct modem_private_data {
327 struct regulator *regulator;
330 static struct modem_private_data modem_priv;
332 void ams_delta_latch_write(int base, int ngpio, u16 mask, u16 value)
335 u16 bitpos = 1 << bit;
337 for (; bit < ngpio; bit++, bitpos = bitpos << 1) {
338 if (!(mask & bitpos))
341 gpio_set_value(base + bit, (value & bitpos) != 0);
344 EXPORT_SYMBOL(ams_delta_latch_write);
346 static struct resource ams_delta_nand_resources[] = {
348 .start = OMAP1_MPUIO_BASE,
349 .end = OMAP1_MPUIO_BASE +
350 OMAP_MPUIO_IO_CNTL + sizeof(u32) - 1,
351 .flags = IORESOURCE_MEM,
355 static struct platform_device ams_delta_nand_device = {
356 .name = "ams-delta-nand",
358 .num_resources = ARRAY_SIZE(ams_delta_nand_resources),
359 .resource = ams_delta_nand_resources,
362 #define OMAP_GPIO_LABEL "gpio-0-15"
364 static struct gpiod_lookup_table ams_delta_nand_gpio_table = {
366 GPIO_LOOKUP(OMAP_GPIO_LABEL, AMS_DELTA_GPIO_PIN_NAND_RB, "rdy",
368 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_NCE, "nce", 0),
369 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_NRE, "nre", 0),
370 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_NWP, "nwp", 0),
371 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_NWE, "nwe", 0),
372 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_ALE, "ale", 0),
373 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_NAND_CLE, "cle", 0),
378 static struct resource ams_delta_kp_resources[] = {
380 .start = INT_KEYBOARD,
382 .flags = IORESOURCE_IRQ,
386 static const struct matrix_keymap_data ams_delta_keymap_data = {
387 .keymap = ams_delta_keymap,
388 .keymap_size = ARRAY_SIZE(ams_delta_keymap),
391 static struct omap_kp_platform_data ams_delta_kp_data = {
394 .keymap_data = &ams_delta_keymap_data,
398 static struct platform_device ams_delta_kp_device = {
399 .name = "omap-keypad",
402 .platform_data = &ams_delta_kp_data,
404 .num_resources = ARRAY_SIZE(ams_delta_kp_resources),
405 .resource = ams_delta_kp_resources,
408 static struct platform_device ams_delta_lcd_device = {
409 .name = "lcd_ams_delta",
413 static struct gpiod_lookup_table ams_delta_lcd_gpio_table = {
415 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_LCD_VBLEN, "vblen", 0),
416 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_LCD_NDISP, "ndisp", 0),
422 * Dynamically allocated GPIO numbers must be obtained fromm GPIO device
423 * before they can be put in the gpio_led table. Before that happens,
424 * initialize the table with invalid GPIO numbers, not 0.
426 static struct gpio_led gpio_leds[] __initdata = {
427 [LATCH1_PIN_LED_CAMERA] = {
430 .default_state = LEDS_GPIO_DEFSTATE_OFF,
431 #ifdef CONFIG_LEDS_TRIGGERS
432 .default_trigger = "ams_delta_camera",
435 [LATCH1_PIN_LED_ADVERT] = {
438 .default_state = LEDS_GPIO_DEFSTATE_OFF,
440 [LATCH1_PIN_LED_MAIL] = {
443 .default_state = LEDS_GPIO_DEFSTATE_OFF,
445 [LATCH1_PIN_LED_HANDSFREE] = {
448 .default_state = LEDS_GPIO_DEFSTATE_OFF,
450 [LATCH1_PIN_LED_VOICEMAIL] = {
453 .default_state = LEDS_GPIO_DEFSTATE_OFF,
455 [LATCH1_PIN_LED_VOICE] = {
458 .default_state = LEDS_GPIO_DEFSTATE_OFF,
462 static const struct gpio_led_platform_data leds_pdata __initconst = {
464 .num_leds = ARRAY_SIZE(gpio_leds),
467 static struct i2c_board_info ams_delta_camera_board_info[] = {
469 I2C_BOARD_INFO("ov6650", 0x60),
473 #ifdef CONFIG_LEDS_TRIGGERS
474 DEFINE_LED_TRIGGER(ams_delta_camera_led_trigger);
476 static int ams_delta_camera_power(struct device *dev, int power)
482 led_trigger_event(ams_delta_camera_led_trigger, LED_FULL);
484 led_trigger_event(ams_delta_camera_led_trigger, LED_OFF);
488 #define ams_delta_camera_power NULL
491 static struct soc_camera_link ams_delta_iclink = {
492 .bus_id = 0, /* OMAP1 SoC camera bus */
494 .board_info = &ams_delta_camera_board_info[0],
495 .module_name = "ov6650",
496 .power = ams_delta_camera_power,
499 static struct platform_device ams_delta_camera_device = {
500 .name = "soc-camera-pdrv",
503 .platform_data = &ams_delta_iclink,
507 static struct omap1_cam_platform_data ams_delta_camera_platform_data = {
508 .camexclk_khz = 12000, /* default 12MHz clock, no extra DPLL */
509 .lclk_khz_max = 1334, /* results in 5fps CIF, 10fps QCIF */
512 static struct platform_device ams_delta_audio_device = {
513 .name = "ams-delta-audio",
517 static struct gpiod_lookup_table ams_delta_audio_gpio_table = {
519 GPIO_LOOKUP(OMAP_GPIO_LABEL, AMS_DELTA_GPIO_PIN_HOOK_SWITCH,
521 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_MODEM_CODEC,
527 static struct platform_device cx20442_codec_device = {
528 .name = "cx20442-codec",
532 static struct resource ams_delta_serio_resources[] = {
534 .flags = IORESOURCE_IRQ,
536 * Initialize IRQ resource with invalid IRQ number.
537 * It will be replaced with dynamically allocated GPIO IRQ
538 * obtained from GPIO chip as soon as the chip is available.
545 static struct platform_device ams_delta_serio_device = {
546 .name = "ams-delta-serio",
547 .id = PLATFORM_DEVID_NONE,
550 * Initialize .platform_data explicitly with NULL to
551 * indicate it is going to be used. It will be replaced
552 * with FIQ buffer address as soon as FIQ is initialized.
554 .platform_data = NULL,
556 .num_resources = ARRAY_SIZE(ams_delta_serio_resources),
557 .resource = ams_delta_serio_resources,
560 static struct regulator_consumer_supply keybrd_pwr_consumers[] = {
562 * Initialize supply .dev_name with NULL. It will be replaced
563 * with serio dev_name() as soon as the serio device is registered.
565 REGULATOR_SUPPLY("vcc", NULL),
568 static struct regulator_init_data keybrd_pwr_initdata = {
570 .valid_ops_mask = REGULATOR_CHANGE_STATUS,
572 .num_consumer_supplies = ARRAY_SIZE(keybrd_pwr_consumers),
573 .consumer_supplies = keybrd_pwr_consumers,
576 static struct fixed_voltage_config keybrd_pwr_config = {
577 .supply_name = "keybrd_pwr",
578 .microvolts = 5000000,
580 .init_data = &keybrd_pwr_initdata,
583 static struct platform_device keybrd_pwr_device = {
584 .name = "reg-fixed-voltage",
585 .id = PLATFORM_DEVID_AUTO,
587 .platform_data = &keybrd_pwr_config,
591 static struct gpiod_lookup_table keybrd_pwr_gpio_table = {
593 GPIO_LOOKUP(LATCH2_LABEL, LATCH2_PIN_KEYBRD_PWR, NULL,
599 static struct platform_device *ams_delta_devices[] __initdata = {
602 &ams_delta_kp_device,
603 &ams_delta_camera_device,
604 &ams_delta_audio_device,
605 &ams_delta_serio_device,
606 &ams_delta_nand_device,
607 &ams_delta_lcd_device,
608 &cx20442_codec_device,
611 static struct gpiod_lookup_table *ams_delta_gpio_tables[] __initdata = {
612 &ams_delta_nreset_gpiod_table,
613 &ams_delta_audio_gpio_table,
614 &keybrd_pwr_gpio_table,
615 &ams_delta_lcd_gpio_table,
616 &ams_delta_nand_gpio_table,
620 * Some drivers may not use GPIO lookup tables but need to be provided
621 * with GPIO numbers. The same applies to GPIO based IRQ lines - some
622 * drivers may even not use GPIO layer but expect just IRQ numbers.
623 * We could either define GPIO lookup tables then use them on behalf
624 * of those devices, or we can use GPIO driver level methods for
625 * identification of GPIO and IRQ numbers. For the purpose of the latter,
626 * defina a helper function which identifies GPIO chips by their labels.
628 static int gpiochip_match_by_label(struct gpio_chip *chip, void *data)
632 return !strcmp(label, chip->label);
635 static struct gpiod_hog ams_delta_gpio_hogs[] = {
636 GPIO_HOG(LATCH2_LABEL, LATCH2_PIN_KEYBRD_DATAOUT, "keybrd_dataout",
637 GPIO_ACTIVE_HIGH, GPIOD_OUT_LOW),
642 * The purpose of this function is to take care of proper initialization of
643 * devices and data structures which depend on GPIO lines provided by OMAP GPIO
644 * banks but their drivers don't use GPIO lookup tables or GPIO layer at all.
645 * The function may be called as soon as OMAP GPIO devices are probed.
646 * Since that happens at postcore_initcall, it can be called successfully
647 * from init_machine or later.
648 * Dependent devices may be registered from within this function or later.
650 static void __init omap_gpio_deps_init(void)
652 struct gpio_chip *chip;
654 chip = gpiochip_find(OMAP_GPIO_LABEL, gpiochip_match_by_label);
656 pr_err("%s: OMAP GPIO chip not found\n", __func__);
660 ams_delta_init_fiq(chip, &ams_delta_serio_device);
663 static void __init ams_delta_init(void)
665 /* mux pins for uarts */
666 omap_cfg_reg(UART1_TX);
667 omap_cfg_reg(UART1_RTS);
669 /* parallel camera interface */
670 omap_cfg_reg(H19_1610_CAM_EXCLK);
671 omap_cfg_reg(J15_1610_CAM_LCLK);
672 omap_cfg_reg(L18_1610_CAM_VS);
673 omap_cfg_reg(L15_1610_CAM_HS);
674 omap_cfg_reg(L19_1610_CAM_D0);
675 omap_cfg_reg(K14_1610_CAM_D1);
676 omap_cfg_reg(K15_1610_CAM_D2);
677 omap_cfg_reg(K19_1610_CAM_D3);
678 omap_cfg_reg(K18_1610_CAM_D4);
679 omap_cfg_reg(J14_1610_CAM_D5);
680 omap_cfg_reg(J19_1610_CAM_D6);
681 omap_cfg_reg(J18_1610_CAM_D7);
683 omap_gpio_deps_init();
684 gpiod_add_hogs(ams_delta_gpio_hogs);
687 omap_register_i2c_bus(1, 100, NULL, 0);
689 omap1_usb_init(&ams_delta_usb_config);
690 omap1_set_camera_info(&ams_delta_camera_platform_data);
691 #ifdef CONFIG_LEDS_TRIGGERS
692 led_trigger_register_simple("ams_delta_camera",
693 &ams_delta_camera_led_trigger);
695 platform_add_devices(ams_delta_devices, ARRAY_SIZE(ams_delta_devices));
698 * As soon as regulator consumers have been registered, assign their
699 * dev_names to consumer supply entries of respective regulators.
701 keybrd_pwr_consumers[0].dev_name =
702 dev_name(&ams_delta_serio_device.dev);
705 * Once consumer supply entries are populated with dev_names,
706 * register regulator devices. At this stage only the keyboard
707 * power regulator has its consumer supply table fully populated.
709 platform_device_register(&keybrd_pwr_device);
712 * As soon as GPIO consumers have been registered, assign
713 * their dev_names to respective GPIO lookup tables.
715 ams_delta_audio_gpio_table.dev_id =
716 dev_name(&ams_delta_audio_device.dev);
717 keybrd_pwr_gpio_table.dev_id = dev_name(&keybrd_pwr_device.dev);
718 ams_delta_nand_gpio_table.dev_id = dev_name(&ams_delta_nand_device.dev);
719 ams_delta_lcd_gpio_table.dev_id = dev_name(&ams_delta_lcd_device.dev);
722 * Once GPIO lookup tables are populated with dev_names, register them.
724 gpiod_add_lookup_tables(ams_delta_gpio_tables,
725 ARRAY_SIZE(ams_delta_gpio_tables));
727 omap_writew(omap_readw(ARM_RSTCT1) | 0x0004, ARM_RSTCT1);
729 omapfb_set_lcd_config(&ams_delta_lcd_config);
732 static void modem_pm(struct uart_port *port, unsigned int state, unsigned old)
734 struct modem_private_data *priv = port->private_data;
737 if (IS_ERR(priv->regulator))
744 ret = regulator_enable(priv->regulator);
746 ret = regulator_disable(priv->regulator);
752 "ams_delta modem_pm: failed to %sable regulator: %d\n",
753 state ? "dis" : "en", ret);
756 static struct plat_serial8250_port ams_delta_modem_ports[] = {
758 .membase = IOMEM(MODEM_VIRT),
759 .mapbase = MODEM_PHYS,
760 .irq = -EINVAL, /* changed later */
761 .flags = UPF_BOOT_AUTOCONF,
762 .irqflags = IRQF_TRIGGER_RISING,
765 .uartclk = BASE_BAUD * 16,
767 .private_data = &modem_priv,
772 static struct platform_device ams_delta_modem_device = {
773 .name = "serial8250",
774 .id = PLAT8250_DEV_PLATFORM1,
776 .platform_data = ams_delta_modem_ports,
781 * leds-gpio driver doesn't make use of GPIO lookup tables,
782 * it has to be provided with GPIO numbers over platform data
783 * if GPIO descriptor info can't be obtained from device tree.
784 * We could either define GPIO lookup tables and use them on behalf
785 * of the leds-gpio device, or we can use GPIO driver level methods
786 * for identification of GPIO numbers as long as we don't support
787 * device tree. Let's do the latter.
789 static void __init ams_delta_led_init(struct gpio_chip *chip)
791 struct gpio_desc *gpiod;
794 for (i = LATCH1_PIN_LED_CAMERA; i < LATCH1_PIN_DOCKIT1; i++) {
795 gpiod = gpiochip_request_own_desc(chip, i, NULL);
797 pr_warn("%s: %s GPIO %d request failed (%ld)\n",
798 __func__, LATCH1_LABEL, i, PTR_ERR(gpiod));
802 /* Assign GPIO numbers to LED device. */
803 gpio_leds[i].gpio = desc_to_gpio(gpiod);
805 gpiochip_free_own_desc(gpiod);
808 gpio_led_register_device(PLATFORM_DEVID_NONE, &leds_pdata);
812 * The purpose of this function is to take care of assignment of GPIO numbers
813 * to platform devices which depend on GPIO lines provided by Amstrad Delta
814 * latch1 and/or latch2 GPIO devices but don't use GPIO lookup tables.
815 * The function may be called as soon as latch1/latch2 GPIO devices are
816 * initilized. Since basic-mmio-gpio driver is not registered before
817 * device_initcall, this may happen at erliest during device_initcall_sync.
818 * Dependent devices shouldn't be registered before that, their
819 * registration may be performed from within this function or later.
821 static int __init ams_delta_gpio_init(void)
823 struct gpio_chip *chip;
826 if (!machine_is_ams_delta())
829 chip = gpiochip_find(LATCH1_LABEL, gpiochip_match_by_label);
831 pr_err("%s: latch1 GPIO chip not found\n", __func__);
833 ams_delta_led_init(chip);
835 err = gpio_request_array(latch_gpios, ARRAY_SIZE(latch_gpios));
837 pr_err("Couldn't take over latch1/latch2 GPIO pins\n");
841 device_initcall_sync(ams_delta_gpio_init);
843 static int __init modem_nreset_init(void)
847 err = platform_device_register(&modem_nreset_device);
849 pr_err("Couldn't register the modem regulator device\n");
855 static int __init ams_delta_modem_init(void)
859 omap_cfg_reg(M14_1510_GPIO2);
860 ams_delta_modem_ports[0].irq =
861 gpio_to_irq(AMS_DELTA_GPIO_PIN_MODEM_IRQ);
863 err = gpio_request(AMS_DELTA_GPIO_PIN_MODEM_IRQ, "modem");
865 pr_err("Couldn't request gpio pin for modem\n");
868 gpio_direction_input(AMS_DELTA_GPIO_PIN_MODEM_IRQ);
870 /* Initialize the modem_nreset regulator consumer before use */
871 modem_priv.regulator = ERR_PTR(-ENODEV);
873 ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC,
874 AMS_DELTA_LATCH2_MODEM_CODEC);
876 err = platform_device_register(&ams_delta_modem_device);
878 gpio_free(AMS_DELTA_GPIO_PIN_MODEM_IRQ);
883 static int __init late_init(void)
887 err = modem_nreset_init();
891 err = ams_delta_modem_init();
896 * Once the modem device is registered, the modem_nreset
897 * regulator can be requested on behalf of that device.
899 modem_priv.regulator = regulator_get(&ams_delta_modem_device.dev,
901 if (IS_ERR(modem_priv.regulator)) {
902 err = PTR_ERR(modem_priv.regulator);
908 platform_device_unregister(&ams_delta_modem_device);
909 gpio_free(AMS_DELTA_GPIO_PIN_MODEM_IRQ);
913 static void __init ams_delta_init_late(void)
919 static void __init ams_delta_map_io(void)
922 iotable_init(ams_delta_io_desc, ARRAY_SIZE(ams_delta_io_desc));
925 MACHINE_START(AMS_DELTA, "Amstrad E3 (Delta)")
926 /* Maintainer: Jonathan McDowell <noodles@earth.li> */
927 .atag_offset = 0x100,
928 .map_io = ams_delta_map_io,
929 .init_early = omap1_init_early,
930 .init_irq = omap1_init_irq,
931 .handle_irq = omap1_handle_irq,
932 .init_machine = ams_delta_init,
933 .init_late = ams_delta_init_late,
934 .init_time = omap1_timer_init,
935 .restart = omap1_restart,