kernel/2.6.29.6-aldebaran-rt/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 #if defined(CONFIG_MMC_OMAP) || defined(CONFIG_MMC_OMAP_MODULE)
  22
  23 static int mmc_set_power(struct device *dev, int slot, int power_on,
  24                                 int vdd)
  25 {
  26         int err;
  27         u8 dat = 0;
  28
  29         err = sx1_i2c_read_byte(SOFIA_I2C_ADDR, SOFIA_POWER1_REG, &dat);
  30         if (err < 0)
  31                 return err;
  32
  33         if (power_on)
  34                 dat |= SOFIA_MMC_POWER;
  35         else
  36                 dat &= ~SOFIA_MMC_POWER;
  37
  38         return sx1_i2c_write_byte(SOFIA_I2C_ADDR, SOFIA_POWER1_REG, dat);
  39 }
  40
  41 /* Cover switch is at OMAP_MPUIO(3) */
  42 static struct omap_mmc_platform_data mmc1_data = {
  43         .nr_slots                       = 1,
  44         .slots[0]       = {
  45                 .set_power              = mmc_set_power,
  46                 .ocr_mask               = MMC_VDD_28_29 | MMC_VDD_30_31 |
  47                                           MMC_VDD_32_33 | MMC_VDD_33_34,
  48                 .name                   = "mmcblk",
  49         },
  50 };
  51
  52 static struct omap_mmc_platform_data *mmc_data[OMAP15XX_NR_MMC];
  53
  54 void __init sx1_mmc_init(void)
  55 {
  56         mmc_data[0] = &mmc1_data;
  57         omap1_init_mmc(mmc_data, OMAP15XX_NR_MMC);
  58 }
  59
  60 #else
  61
  62 void __init sx1_mmc_init(void)
  63 {
  64 }
  65
  66 #endif