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>
44 #include <mach/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 .gpio
= AMS_DELTA_GPIO_PIN_MODEM_NRESET
,
304 .startup_delay
= 25000,
306 .enabled_at_boot
= 1,
307 .init_data
= &modem_nreset_data
,
310 static struct platform_device modem_nreset_device
= {
311 .name
= "reg-fixed-voltage",
314 .platform_data
= &modem_nreset_config
,
318 struct modem_private_data
{
319 struct regulator
*regulator
;
322 static struct modem_private_data modem_priv
;
324 void ams_delta_latch_write(int base
, int ngpio
, u16 mask
, u16 value
)
327 u16 bitpos
= 1 << bit
;
329 for (; bit
< ngpio
; bit
++, bitpos
= bitpos
<< 1) {
330 if (!(mask
& bitpos
))
333 gpio_set_value(base
+ bit
, (value
& bitpos
) != 0);
336 EXPORT_SYMBOL(ams_delta_latch_write
);
338 static struct resource ams_delta_nand_resources
[] = {
340 .start
= OMAP1_MPUIO_BASE
,
341 .end
= OMAP1_MPUIO_BASE
+
342 OMAP_MPUIO_IO_CNTL
+ sizeof(u32
) - 1,
343 .flags
= IORESOURCE_MEM
,
347 static struct platform_device ams_delta_nand_device
= {
348 .name
= "ams-delta-nand",
350 .num_resources
= ARRAY_SIZE(ams_delta_nand_resources
),
351 .resource
= ams_delta_nand_resources
,
354 #define OMAP_GPIO_LABEL "gpio-0-15"
356 static struct gpiod_lookup_table ams_delta_nand_gpio_table
= {
358 GPIO_LOOKUP(OMAP_GPIO_LABEL
, AMS_DELTA_GPIO_PIN_NAND_RB
, "rdy",
360 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_NAND_NCE
, "nce", 0),
361 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_NAND_NRE
, "nre", 0),
362 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_NAND_NWP
, "nwp", 0),
363 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_NAND_NWE
, "nwe", 0),
364 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_NAND_ALE
, "ale", 0),
365 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_NAND_CLE
, "cle", 0),
370 static struct resource ams_delta_kp_resources
[] = {
372 .start
= INT_KEYBOARD
,
374 .flags
= IORESOURCE_IRQ
,
378 static const struct matrix_keymap_data ams_delta_keymap_data
= {
379 .keymap
= ams_delta_keymap
,
380 .keymap_size
= ARRAY_SIZE(ams_delta_keymap
),
383 static struct omap_kp_platform_data ams_delta_kp_data
= {
386 .keymap_data
= &ams_delta_keymap_data
,
390 static struct platform_device ams_delta_kp_device
= {
391 .name
= "omap-keypad",
394 .platform_data
= &ams_delta_kp_data
,
396 .num_resources
= ARRAY_SIZE(ams_delta_kp_resources
),
397 .resource
= ams_delta_kp_resources
,
400 static struct platform_device ams_delta_lcd_device
= {
401 .name
= "lcd_ams_delta",
405 static struct gpiod_lookup_table ams_delta_lcd_gpio_table
= {
407 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_LCD_VBLEN
, "vblen", 0),
408 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_LCD_NDISP
, "ndisp", 0),
414 * Dynamically allocated GPIO numbers must be obtained fromm GPIO device
415 * before they can be put in the gpio_led table. Before that happens,
416 * initialize the table with invalid GPIO numbers, not 0.
418 static struct gpio_led gpio_leds
[] __initdata
= {
419 [LATCH1_PIN_LED_CAMERA
] = {
422 .default_state
= LEDS_GPIO_DEFSTATE_OFF
,
423 #ifdef CONFIG_LEDS_TRIGGERS
424 .default_trigger
= "ams_delta_camera",
427 [LATCH1_PIN_LED_ADVERT
] = {
430 .default_state
= LEDS_GPIO_DEFSTATE_OFF
,
432 [LATCH1_PIN_LED_MAIL
] = {
435 .default_state
= LEDS_GPIO_DEFSTATE_OFF
,
437 [LATCH1_PIN_LED_HANDSFREE
] = {
440 .default_state
= LEDS_GPIO_DEFSTATE_OFF
,
442 [LATCH1_PIN_LED_VOICEMAIL
] = {
445 .default_state
= LEDS_GPIO_DEFSTATE_OFF
,
447 [LATCH1_PIN_LED_VOICE
] = {
450 .default_state
= LEDS_GPIO_DEFSTATE_OFF
,
454 static const struct gpio_led_platform_data leds_pdata __initconst
= {
456 .num_leds
= ARRAY_SIZE(gpio_leds
),
459 static struct i2c_board_info ams_delta_camera_board_info
[] = {
461 I2C_BOARD_INFO("ov6650", 0x60),
465 #ifdef CONFIG_LEDS_TRIGGERS
466 DEFINE_LED_TRIGGER(ams_delta_camera_led_trigger
);
468 static int ams_delta_camera_power(struct device
*dev
, int power
)
474 led_trigger_event(ams_delta_camera_led_trigger
, LED_FULL
);
476 led_trigger_event(ams_delta_camera_led_trigger
, LED_OFF
);
480 #define ams_delta_camera_power NULL
483 static struct soc_camera_link ams_delta_iclink
= {
484 .bus_id
= 0, /* OMAP1 SoC camera bus */
486 .board_info
= &ams_delta_camera_board_info
[0],
487 .module_name
= "ov6650",
488 .power
= ams_delta_camera_power
,
491 static struct platform_device ams_delta_camera_device
= {
492 .name
= "soc-camera-pdrv",
495 .platform_data
= &ams_delta_iclink
,
499 static struct omap1_cam_platform_data ams_delta_camera_platform_data
= {
500 .camexclk_khz
= 12000, /* default 12MHz clock, no extra DPLL */
501 .lclk_khz_max
= 1334, /* results in 5fps CIF, 10fps QCIF */
504 static struct platform_device ams_delta_audio_device
= {
505 .name
= "ams-delta-audio",
509 static struct gpiod_lookup_table ams_delta_audio_gpio_table
= {
511 GPIO_LOOKUP(OMAP_GPIO_LABEL
, AMS_DELTA_GPIO_PIN_HOOK_SWITCH
,
513 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_MODEM_CODEC
,
519 static struct platform_device cx20442_codec_device
= {
520 .name
= "cx20442-codec",
524 static struct platform_device ams_delta_serio_device
= {
525 .name
= "ams-delta-serio",
526 .id
= PLATFORM_DEVID_NONE
,
529 static struct regulator_consumer_supply keybrd_pwr_consumers
[] = {
531 * Initialize supply .dev_name with NULL. It will be replaced
532 * with serio dev_name() as soon as the serio device is registered.
534 REGULATOR_SUPPLY("vcc", NULL
),
537 static struct regulator_init_data keybrd_pwr_initdata
= {
539 .valid_ops_mask
= REGULATOR_CHANGE_STATUS
,
541 .num_consumer_supplies
= ARRAY_SIZE(keybrd_pwr_consumers
),
542 .consumer_supplies
= keybrd_pwr_consumers
,
545 static struct fixed_voltage_config keybrd_pwr_config
= {
546 .supply_name
= "keybrd_pwr",
547 .microvolts
= 5000000,
548 .gpio
= AMS_DELTA_GPIO_PIN_KEYBRD_PWR
,
550 .init_data
= &keybrd_pwr_initdata
,
553 static struct platform_device keybrd_pwr_device
= {
554 .name
= "reg-fixed-voltage",
555 .id
= PLATFORM_DEVID_AUTO
,
557 .platform_data
= &keybrd_pwr_config
,
561 static struct gpiod_lookup_table keybrd_pwr_gpio_table
= {
563 GPIO_LOOKUP(LATCH2_LABEL
, LATCH2_PIN_KEYBRD_PWR
, NULL
,
569 static struct platform_device
*ams_delta_devices
[] __initdata
= {
572 &ams_delta_kp_device
,
573 &ams_delta_camera_device
,
574 &ams_delta_audio_device
,
575 &ams_delta_serio_device
,
578 static struct platform_device
*late_devices
[] __initdata
= {
579 &ams_delta_nand_device
,
580 &ams_delta_lcd_device
,
581 &cx20442_codec_device
,
584 static struct gpiod_lookup_table
*ams_delta_gpio_tables
[] __initdata
= {
585 &ams_delta_audio_gpio_table
,
586 &keybrd_pwr_gpio_table
,
589 static struct gpiod_lookup_table
*late_gpio_tables
[] __initdata
= {
590 &ams_delta_lcd_gpio_table
,
591 &ams_delta_nand_gpio_table
,
595 * Some drivers may not use GPIO lookup tables but need to be provided
596 * with GPIO numbers. The same applies to GPIO based IRQ lines - some
597 * drivers may even not use GPIO layer but expect just IRQ numbers.
598 * We could either define GPIO lookup tables then use them on behalf
599 * of those devices, or we can use GPIO driver level methods for
600 * identification of GPIO and IRQ numbers. For the purpose of the latter,
601 * defina a helper function which identifies GPIO chips by their labels.
603 static int gpiochip_match_by_label(struct gpio_chip
*chip
, void *data
)
607 return !strcmp(label
, chip
->label
);
610 static struct gpiod_hog ams_delta_gpio_hogs
[] = {
611 GPIO_HOG(LATCH2_LABEL
, LATCH2_PIN_KEYBRD_DATAOUT
, "keybrd_dataout",
612 GPIO_ACTIVE_HIGH
, GPIOD_OUT_LOW
),
617 * The purpose of this function is to take care of proper initialization of
618 * devices and data structures which depend on GPIO lines provided by OMAP GPIO
619 * banks but their drivers don't use GPIO lookup tables or GPIO layer at all.
620 * The function may be called as soon as OMAP GPIO devices are probed.
621 * Since that happens at postcore_initcall, it can be called successfully
622 * from init_machine or later.
623 * Dependent devices may be registered from within this function or later.
625 static void __init
omap_gpio_deps_init(void)
627 struct gpio_chip
*chip
;
629 chip
= gpiochip_find(OMAP_GPIO_LABEL
, gpiochip_match_by_label
);
631 pr_err("%s: OMAP GPIO chip not found\n", __func__
);
635 ams_delta_init_fiq(chip
);
638 static void __init
ams_delta_init(void)
640 /* mux pins for uarts */
641 omap_cfg_reg(UART1_TX
);
642 omap_cfg_reg(UART1_RTS
);
644 /* parallel camera interface */
645 omap_cfg_reg(H19_1610_CAM_EXCLK
);
646 omap_cfg_reg(J15_1610_CAM_LCLK
);
647 omap_cfg_reg(L18_1610_CAM_VS
);
648 omap_cfg_reg(L15_1610_CAM_HS
);
649 omap_cfg_reg(L19_1610_CAM_D0
);
650 omap_cfg_reg(K14_1610_CAM_D1
);
651 omap_cfg_reg(K15_1610_CAM_D2
);
652 omap_cfg_reg(K19_1610_CAM_D3
);
653 omap_cfg_reg(K18_1610_CAM_D4
);
654 omap_cfg_reg(J14_1610_CAM_D5
);
655 omap_cfg_reg(J19_1610_CAM_D6
);
656 omap_cfg_reg(J18_1610_CAM_D7
);
658 omap_gpio_deps_init();
659 gpiod_add_hogs(ams_delta_gpio_hogs
);
662 omap_register_i2c_bus(1, 100, NULL
, 0);
664 omap1_usb_init(&ams_delta_usb_config
);
665 omap1_set_camera_info(&ams_delta_camera_platform_data
);
666 #ifdef CONFIG_LEDS_TRIGGERS
667 led_trigger_register_simple("ams_delta_camera",
668 &ams_delta_camera_led_trigger
);
670 platform_add_devices(ams_delta_devices
, ARRAY_SIZE(ams_delta_devices
));
673 * As soon as regulator consumers have been registered, assign their
674 * dev_names to consumer supply entries of respective regulators.
676 keybrd_pwr_consumers
[0].dev_name
=
677 dev_name(&ams_delta_serio_device
.dev
);
680 * Once consumer supply entries are populated with dev_names,
681 * register regulator devices. At this stage only the keyboard
682 * power regulator has its consumer supply table fully populated.
684 platform_device_register(&keybrd_pwr_device
);
687 * As soon as GPIO consumers have been registered, assign
688 * their dev_names to respective GPIO lookup tables.
690 ams_delta_audio_gpio_table
.dev_id
=
691 dev_name(&ams_delta_audio_device
.dev
);
692 keybrd_pwr_gpio_table
.dev_id
= dev_name(&keybrd_pwr_device
.dev
);
695 * Once GPIO lookup tables are populated with dev_names, register them.
697 gpiod_add_lookup_tables(ams_delta_gpio_tables
,
698 ARRAY_SIZE(ams_delta_gpio_tables
));
700 omap_writew(omap_readw(ARM_RSTCT1
) | 0x0004, ARM_RSTCT1
);
702 omapfb_set_lcd_config(&ams_delta_lcd_config
);
705 static void modem_pm(struct uart_port
*port
, unsigned int state
, unsigned old
)
707 struct modem_private_data
*priv
= port
->private_data
;
710 if (IS_ERR(priv
->regulator
))
717 ret
= regulator_enable(priv
->regulator
);
719 ret
= regulator_disable(priv
->regulator
);
725 "ams_delta modem_pm: failed to %sable regulator: %d\n",
726 state
? "dis" : "en", ret
);
729 static struct plat_serial8250_port ams_delta_modem_ports
[] = {
731 .membase
= IOMEM(MODEM_VIRT
),
732 .mapbase
= MODEM_PHYS
,
733 .irq
= -EINVAL
, /* changed later */
734 .flags
= UPF_BOOT_AUTOCONF
,
735 .irqflags
= IRQF_TRIGGER_RISING
,
738 .uartclk
= BASE_BAUD
* 16,
740 .private_data
= &modem_priv
,
745 static struct platform_device ams_delta_modem_device
= {
746 .name
= "serial8250",
747 .id
= PLAT8250_DEV_PLATFORM1
,
749 .platform_data
= ams_delta_modem_ports
,
754 * leds-gpio driver doesn't make use of GPIO lookup tables,
755 * it has to be provided with GPIO numbers over platform data
756 * if GPIO descriptor info can't be obtained from device tree.
757 * We could either define GPIO lookup tables and use them on behalf
758 * of the leds-gpio device, or we can use GPIO driver level methods
759 * for identification of GPIO numbers as long as we don't support
760 * device tree. Let's do the latter.
762 static void __init
ams_delta_led_init(struct gpio_chip
*chip
)
764 struct gpio_desc
*gpiod
;
767 for (i
= LATCH1_PIN_LED_CAMERA
; i
< LATCH1_PIN_DOCKIT1
; i
++) {
768 gpiod
= gpiochip_request_own_desc(chip
, i
, NULL
);
770 pr_warn("%s: %s GPIO %d request failed (%ld)\n",
771 __func__
, LATCH1_LABEL
, i
, PTR_ERR(gpiod
));
775 /* Assign GPIO numbers to LED device. */
776 gpio_leds
[i
].gpio
= desc_to_gpio(gpiod
);
778 gpiochip_free_own_desc(gpiod
);
781 gpio_led_register_device(PLATFORM_DEVID_NONE
, &leds_pdata
);
785 * The purpose of this function is to take care of assignment of GPIO numbers
786 * to platform devices which depend on GPIO lines provided by Amstrad Delta
787 * latch1 and/or latch2 GPIO devices but don't use GPIO lookup tables.
788 * The function may be called as soon as latch1/latch2 GPIO devices are
789 * initilized. Since basic-mmio-gpio driver is not registered before
790 * device_initcall, this may happen at erliest during device_initcall_sync.
791 * Dependent devices shouldn't be registered before that, their
792 * registration may be performed from within this function or later.
794 static int __init
ams_delta_gpio_init(void)
796 struct gpio_chip
*chip
;
799 if (!machine_is_ams_delta())
802 chip
= gpiochip_find(LATCH1_LABEL
, gpiochip_match_by_label
);
804 pr_err("%s: latch1 GPIO chip not found\n", __func__
);
806 ams_delta_led_init(chip
);
808 err
= gpio_request_array(latch_gpios
, ARRAY_SIZE(latch_gpios
));
810 pr_err("Couldn't take over latch1/latch2 GPIO pins\n");
814 device_initcall_sync(ams_delta_gpio_init
);
816 static void __init
ams_delta_late_devices(void)
818 platform_add_devices(late_devices
, ARRAY_SIZE(late_devices
));
821 * As soon as devices have been registered, assign their dev_names
822 * to respective GPIO lookup tables before they are added.
824 ams_delta_lcd_gpio_table
.dev_id
= dev_name(&ams_delta_lcd_device
.dev
);
825 ams_delta_nand_gpio_table
.dev_id
= dev_name(&ams_delta_nand_device
.dev
);
827 gpiod_add_lookup_tables(late_gpio_tables
, ARRAY_SIZE(late_gpio_tables
));
830 static int __init
modem_nreset_init(void)
834 err
= platform_device_register(&modem_nreset_device
);
836 pr_err("Couldn't register the modem regulator device\n");
842 static int __init
ams_delta_modem_init(void)
846 omap_cfg_reg(M14_1510_GPIO2
);
847 ams_delta_modem_ports
[0].irq
=
848 gpio_to_irq(AMS_DELTA_GPIO_PIN_MODEM_IRQ
);
850 err
= gpio_request(AMS_DELTA_GPIO_PIN_MODEM_IRQ
, "modem");
852 pr_err("Couldn't request gpio pin for modem\n");
855 gpio_direction_input(AMS_DELTA_GPIO_PIN_MODEM_IRQ
);
857 /* Initialize the modem_nreset regulator consumer before use */
858 modem_priv
.regulator
= ERR_PTR(-ENODEV
);
860 ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC
,
861 AMS_DELTA_LATCH2_MODEM_CODEC
);
863 err
= platform_device_register(&ams_delta_modem_device
);
865 gpio_free(AMS_DELTA_GPIO_PIN_MODEM_IRQ
);
870 static int __init
late_init(void)
874 ams_delta_late_devices();
876 err
= modem_nreset_init();
880 err
= ams_delta_modem_init();
885 * Once the modem device is registered, the modem_nreset
886 * regulator can be requested on behalf of that device.
888 modem_priv
.regulator
= regulator_get(&ams_delta_modem_device
.dev
,
890 if (IS_ERR(modem_priv
.regulator
)) {
891 err
= PTR_ERR(modem_priv
.regulator
);
897 platform_device_unregister(&ams_delta_modem_device
);
898 gpio_free(AMS_DELTA_GPIO_PIN_MODEM_IRQ
);
902 static void __init
ams_delta_init_late(void)
908 static void __init
ams_delta_map_io(void)
911 iotable_init(ams_delta_io_desc
, ARRAY_SIZE(ams_delta_io_desc
));
914 MACHINE_START(AMS_DELTA
, "Amstrad E3 (Delta)")
915 /* Maintainer: Jonathan McDowell <noodles@earth.li> */
916 .atag_offset
= 0x100,
917 .map_io
= ams_delta_map_io
,
918 .init_early
= omap1_init_early
,
919 .init_irq
= omap1_init_irq
,
920 .handle_irq
= omap1_handle_irq
,
921 .init_machine
= ams_delta_init
,
922 .init_late
= ams_delta_init_late
,
923 .init_time
= omap1_timer_init
,
924 .restart
= omap1_restart
,