arch/arm/mach-w90x900/mfp.c

   1 /*
   2  * linux/arch/arm/mach-w90x900/mfp.c
   3  *
   4  * Copyright (c) 2008 Nuvoton technology corporation
   5  *
   6  * Wan ZongShun <mcuos.com@gmail.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation;version 2 of the License.
  11  */
  12
  13 #include <linux/module.h>
  14 #include <linux/kernel.h>
  15 #include <linux/device.h>
  16 #include <linux/list.h>
  17 #include <linux/errno.h>
  18 #include <linux/err.h>
  19 #include <linux/string.h>
  20 #include <linux/clk.h>
  21 #include <linux/mutex.h>
  22 #include <linux/io.h>
  23
  24 #include <mach/hardware.h>
  25
  26 #define REG_MFSEL       (W90X900_VA_GCR + 0xC)
  27
  28 #define GPSELF          (0x01 << 1)
  29 #define GPSELC          (0x03 << 2)
  30 #define GPSELD          (0x0f << 4)
  31
  32 #define GPSELEI0        (0x01 << 26)
  33 #define GPSELEI1        (0x01 << 27)
  34
  35 #define GPIOG0TO1       (0x03 << 14)
  36 #define GPIOG2TO3       (0x03 << 16)
  37 #define GPIOG22TO23     (0x03 << 22)
  38 #define GPIOG18TO20     (0x07 << 18)
  39
  40 #define ENSPI           (0x0a << 14)
  41 #define ENI2C0          (0x01 << 14)
  42 #define ENI2C1          (0x01 << 16)
  43 #define ENAC97          (0x02 << 22)
  44 #define ENSD1           (0x02 << 18)
  45 #define ENSD0           (0x0a << 4)
  46 #define ENKPI           (0x02 << 2)
  47 #define ENNAND          (0x01 << 2)
  48
  49 static DEFINE_MUTEX(mfp_mutex);
  50
  51 void mfp_set_groupf(struct device *dev)
  52 {
  53         unsigned long mfpen;
  54         const char *dev_id;
  55
  56         BUG_ON(!dev);
  57
  58         mutex_lock(&mfp_mutex);
  59
  60         dev_id = dev_name(dev);
  61
  62         mfpen = __raw_readl(REG_MFSEL);
  63
  64         if (strcmp(dev_id, "nuc900-emc") == 0)
  65                 mfpen |= GPSELF;/*enable mac*/
  66         else
  67                 mfpen &= ~GPSELF;/*GPIOF[9:0]*/
  68
  69         __raw_writel(mfpen, REG_MFSEL);
  70
  71         mutex_unlock(&mfp_mutex);
  72 }
  73 EXPORT_SYMBOL(mfp_set_groupf);
  74
  75 void mfp_set_groupc(struct device *dev)
  76 {
  77         unsigned long mfpen;
  78         const char *dev_id;
  79
  80         BUG_ON(!dev);
  81
  82         mutex_lock(&mfp_mutex);
  83
  84         dev_id = dev_name(dev);
  85
  86         mfpen = __raw_readl(REG_MFSEL);
  87
  88         if (strcmp(dev_id, "nuc900-lcd") == 0)
  89                 mfpen |= GPSELC;/*enable lcd*/
  90         else if (strcmp(dev_id, "nuc900-kpi") == 0) {
  91                 mfpen &= (~GPSELC);/*enable kpi*/
  92                 mfpen |= ENKPI;
  93         } else if (strcmp(dev_id, "nuc900-nand") == 0) {
  94                 mfpen &= (~GPSELC);/*enable nand*/
  95                 mfpen |= ENNAND;
  96         } else
  97                 mfpen &= (~GPSELC);/*GPIOC[14:0]*/
  98
  99         __raw_writel(mfpen, REG_MFSEL);
 100
 101         mutex_unlock(&mfp_mutex);
 102 }
 103 EXPORT_SYMBOL(mfp_set_groupc);
 104
 105 void mfp_set_groupi(struct device *dev)
 106 {
 107         unsigned long mfpen;
 108         const char *dev_id;
 109
 110         BUG_ON(!dev);
 111
 112         mutex_lock(&mfp_mutex);
 113
 114         dev_id = dev_name(dev);
 115
 116         mfpen = __raw_readl(REG_MFSEL);
 117
 118         mfpen &= ~GPSELEI1;/*default gpio16*/
 119
 120         if (strcmp(dev_id, "nuc900-wdog") == 0)
 121                 mfpen |= GPSELEI1;/*enable wdog*/
 122         else if (strcmp(dev_id, "nuc900-atapi") == 0)
 123                 mfpen |= GPSELEI0;/*enable atapi*/
 124         else if (strcmp(dev_id, "nuc900-keypad") == 0)
 125                 mfpen &= ~GPSELEI0;/*enable keypad*/
 126
 127         __raw_writel(mfpen, REG_MFSEL);
 128
 129         mutex_unlock(&mfp_mutex);
 130 }
 131 EXPORT_SYMBOL(mfp_set_groupi);
 132
 133 void mfp_set_groupg(struct device *dev, const char *subname)
 134 {
 135         unsigned long mfpen;
 136         const char *dev_id;
 137
 138         BUG_ON((!dev) && (!subname));
 139
 140         mutex_lock(&mfp_mutex);
 141
 142         if (subname != NULL)
 143                 dev_id = subname;
 144         else
 145                 dev_id = dev_name(dev);
 146
 147         mfpen = __raw_readl(REG_MFSEL);
 148
 149         if (strcmp(dev_id, "nuc900-spi") == 0) {
 150                 mfpen &= ~(GPIOG0TO1 | GPIOG2TO3);
 151                 mfpen |= ENSPI;/*enable spi*/
 152         } else if (strcmp(dev_id, "nuc900-i2c0") == 0) {
 153                 mfpen &= ~(GPIOG0TO1);
 154                 mfpen |= ENI2C0;/*enable i2c0*/
 155         } else if (strcmp(dev_id, "nuc900-i2c1") == 0) {
 156                 mfpen &= ~(GPIOG2TO3);
 157                 mfpen |= ENI2C1;/*enable i2c1*/
 158         } else if (strcmp(dev_id, "nuc900-ac97") == 0) {
 159                 mfpen &= ~(GPIOG22TO23);
 160                 mfpen |= ENAC97;/*enable AC97*/
 161         } else if (strcmp(dev_id, "nuc900-mmc-port1") == 0) {
 162                 mfpen &= ~(GPIOG18TO20);
 163                 mfpen |= (ENSD1 | 0x01);/*enable sd1*/
 164         } else {
 165                 mfpen &= ~(GPIOG0TO1 | GPIOG2TO3);/*GPIOG[3:0]*/
 166         }
 167
 168         __raw_writel(mfpen, REG_MFSEL);
 169
 170         mutex_unlock(&mfp_mutex);
 171 }
 172 EXPORT_SYMBOL(mfp_set_groupg);
 173
 174 void mfp_set_groupd(struct device *dev, const char *subname)
 175 {
 176         unsigned long mfpen;
 177         const char *dev_id;
 178
 179         BUG_ON((!dev) && (!subname));
 180
 181         mutex_lock(&mfp_mutex);
 182
 183         if (subname != NULL)
 184                 dev_id = subname;
 185         else
 186                 dev_id = dev_name(dev);
 187
 188         mfpen = __raw_readl(REG_MFSEL);
 189
 190         if (strcmp(dev_id, "nuc900-mmc-port0") == 0) {
 191                 mfpen &= ~GPSELD;/*enable sd0*/
 192                 mfpen |= ENSD0;
 193         } else
 194                 mfpen &= (~GPSELD);
 195
 196         __raw_writel(mfpen, REG_MFSEL);
 197
 198         mutex_unlock(&mfp_mutex);
 199 }
 200 EXPORT_SYMBOL(mfp_set_groupd);