Revert "ARM: OMAP: Get rid of controller vs slot confusion, initialize MMC devices...
[pandora-kernel.git] / arch / arm / mach-omap1 / board-sx1-mmc.c
1 /*
2  * linux/arch/arm/mach-omap1/board-sx1-mmc.c
3  *
4  * Copyright (C) 2007 Instituto Nokia de Tecnologia - INdT
5  * Author: Carlos Eduardo Aguiar <carlos.aguiar@indt.org.br>
6  *
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
9  *
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.
13  */
14
15 #include <linux/platform_device.h>
16
17 #include <mach/hardware.h>
18 #include <mach/mmc.h>
19 #include <mach/gpio.h>
20
21 #ifdef CONFIG_MMC_OMAP
22 static int slot_cover_open;
23 static struct device *mmc_device;
24
25 static int sx1_mmc_set_power(struct device *dev, int slot, int power_on,
26                                 int vdd)
27 {
28         int err;
29         u8 dat = 0;
30
31 #ifdef CONFIG_MMC_DEBUG
32         dev_dbg(dev, "Set slot %d power: %s (vdd %d)\n", slot + 1,
33                 power_on ? "on" : "off", vdd);
34 #endif
35
36         if (slot != 0) {
37                 dev_err(dev, "No such slot %d\n", slot + 1);
38                 return -ENODEV;
39         }
40
41         err = sx1_i2c_read_byte(SOFIA_I2C_ADDR, SOFIA_POWER1_REG, &dat);
42         if (err < 0)
43                 return err;
44
45         if (power_on)
46                 dat |= SOFIA_MMC_POWER;
47         else
48                 dat &= ~SOFIA_MMC_POWER;
49
50         return sx1_i2c_write_byte(SOFIA_I2C_ADDR, SOFIA_POWER1_REG, dat);
51 }
52
53 static int sx1_mmc_set_bus_mode(struct device *dev, int slot, int bus_mode)
54 {
55 #ifdef CONFIG_MMC_DEBUG
56         dev_dbg(dev, "Set slot %d bus_mode %s\n", slot + 1,
57                 bus_mode == MMC_BUSMODE_OPENDRAIN ? "open-drain" : "push-pull");
58 #endif
59         if (slot != 0) {
60                 dev_err(dev, "No such slot %d\n", slot + 1);
61                 return -ENODEV;
62         }
63
64         return 0;
65 }
66
67 static int sx1_mmc_get_cover_state(struct device *dev, int slot)
68 {
69         BUG_ON(slot != 0);
70
71         return slot_cover_open;
72 }
73
74 void sx1_mmc_slot_cover_handler(void *arg, int state)
75 {
76         if (mmc_device == NULL)
77                 return;
78
79         slot_cover_open = state;
80         omap_mmc_notify_cover_event(mmc_device, 0, state);
81 }
82
83 static int sx1_mmc_late_init(struct device *dev)
84 {
85         int ret = 0;
86
87         mmc_device = dev;
88
89         return ret;
90 }
91
92 static void sx1_mmc_cleanup(struct device *dev)
93 {
94 }
95
96 static struct omap_mmc_platform_data sx1_mmc_data = {
97         .nr_slots                       = 1,
98         .switch_slot                    = NULL,
99         .init                           = sx1_mmc_late_init,
100         .cleanup                        = sx1_mmc_cleanup,
101         .slots[0]       = {
102                 .enabled                = 1,
103                 .wire4                  = 0,
104                 .set_power              = sx1_mmc_set_power,
105                 .set_bus_mode           = sx1_mmc_set_bus_mode,
106                 .get_ro                 = NULL,
107                 .get_cover_state        = sx1_mmc_get_cover_state,
108                 .ocr_mask               = MMC_VDD_28_29 | MMC_VDD_30_31 |
109                                           MMC_VDD_32_33 | MMC_VDD_33_34,
110                 .name                   = "mmcblk",
111         },
112 };
113
114 void __init sx1_mmc_init(void)
115 {
116         omap1_init_mmc(&sx1_mmc_data);
117 }
118
119 #else
120
121 void __init sx1_mmc_init(void)
122 {
123 }
124
125 void sx1_mmc_slot_cover_handler(void *arg, int state)
126 {
127 }
128 #endif