acpi: bus: check once more for an empty list after locking it
[linux-2.6/verdex.git] / arch / arm / mach-omap1 / board-sx1-mmc.c
blob8c93d47719e872fe3c88becb983386b482c51753
1 /*
2 * linux/arch/arm/mach-omap1/board-sx1-mmc.c
4 * Copyright (C) 2007 Instituto Nokia de Tecnologia - INdT
5 * Author: Carlos Eduardo Aguiar <carlos.aguiar@indt.org.br>
7 * This code is based on linux/arch/arm/mach-omap1/board-h2-mmc.c, which is:
8 * Copyright (C) 2007 Instituto Nokia de Tecnologia - INdT
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.
15 #include <asm/arch/hardware.h>
16 #include <asm/arch/mmc.h>
17 #include <asm/arch/gpio.h>
19 #ifdef CONFIG_MMC_OMAP
20 static int slot_cover_open;
21 static struct device *mmc_device;
23 static int sx1_mmc_set_power(struct device *dev, int slot, int power_on,
24 int vdd)
26 int err;
27 u8 dat = 0;
29 #ifdef CONFIG_MMC_DEBUG
30 dev_dbg(dev, "Set slot %d power: %s (vdd %d)\n", slot + 1,
31 power_on ? "on" : "off", vdd);
32 #endif
34 if (slot != 0) {
35 dev_err(dev, "No such slot %d\n", slot + 1);
36 return -ENODEV;
39 err = sx1_i2c_read_byte(SOFIA_I2C_ADDR, SOFIA_POWER1_REG, &dat);
40 if (err < 0)
41 return err;
43 if (power_on)
44 dat |= SOFIA_MMC_POWER;
45 else
46 dat &= ~SOFIA_MMC_POWER;
48 return sx1_i2c_write_byte(SOFIA_I2C_ADDR, SOFIA_POWER1_REG, dat);
51 static int sx1_mmc_set_bus_mode(struct device *dev, int slot, int bus_mode)
53 #ifdef CONFIG_MMC_DEBUG
54 dev_dbg(dev, "Set slot %d bus_mode %s\n", slot + 1,
55 bus_mode == MMC_BUSMODE_OPENDRAIN ? "open-drain" : "push-pull");
56 #endif
57 if (slot != 0) {
58 dev_err(dev, "No such slot %d\n", slot + 1);
59 return -ENODEV;
62 return 0;
65 static int sx1_mmc_get_cover_state(struct device *dev, int slot)
67 BUG_ON(slot != 0);
69 return slot_cover_open;
72 void sx1_mmc_slot_cover_handler(void *arg, int state)
74 if (mmc_device == NULL)
75 return;
77 slot_cover_open = state;
78 omap_mmc_notify_cover_event(mmc_device, 0, state);
81 static int sx1_mmc_late_init(struct device *dev)
83 int ret = 0;
85 mmc_device = dev;
87 return ret;
90 static void sx1_mmc_cleanup(struct device *dev)
94 static struct omap_mmc_platform_data sx1_mmc_data = {
95 .nr_slots = 1,
96 .switch_slot = NULL,
97 .init = sx1_mmc_late_init,
98 .cleanup = sx1_mmc_cleanup,
99 .slots[0] = {
100 .set_power = sx1_mmc_set_power,
101 .set_bus_mode = sx1_mmc_set_bus_mode,
102 .get_ro = NULL,
103 .get_cover_state = sx1_mmc_get_cover_state,
104 .ocr_mask = MMC_VDD_28_29 | MMC_VDD_30_31 |
105 MMC_VDD_32_33 | MMC_VDD_33_34,
106 .name = "mmcblk",
110 void __init sx1_mmc_init(void)
112 omap_set_mmc_info(1, &sx1_mmc_data);
115 #else
117 void __init sx1_mmc_init(void)
121 void sx1_mmc_slot_cover_handler(void *arg, int state)
124 #endif