release/src-rt-6.x/linux/linux-2.6/arch/arm/mach-imx/generic.c

   1 /*
   2  *  arch/arm/mach-imx/generic.c
   3  *
   4  *  author: Sascha Hauer
   5  *  Created: april 20th, 2004
   6  *  Copyright: Synertronixx GmbH
   7  *
   8  *  Common code for i.MX machines
   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 as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  23  *
  24  */
  25 #include <linux/platform_device.h>
  26 #include <linux/init.h>
  27 #include <linux/kernel.h>
  28 #include <linux/module.h>
  29 #include <linux/string.h>
  30
  31 #include <asm/arch/imxfb.h>
  32 #include <asm/hardware.h>
  33 #include <asm/arch/imx-regs.h>
  34
  35 #include <asm/mach/map.h>
  36 #include <asm/arch/mmc.h>
  37
  38 void imx_gpio_mode(int gpio_mode)
  39 {
  40         unsigned int pin = gpio_mode & GPIO_PIN_MASK;
  41         unsigned int port = (gpio_mode & GPIO_PORT_MASK) >> GPIO_PORT_SHIFT;
  42         unsigned int ocr = (gpio_mode & GPIO_OCR_MASK) >> GPIO_OCR_SHIFT;
  43         unsigned int tmp;
  44
  45         /* Pullup enable */
  46         if(gpio_mode & GPIO_PUEN)
  47                 PUEN(port) |= (1<<pin);
  48         else
  49                 PUEN(port) &= ~(1<<pin);
  50
  51         /* Data direction */
  52         if(gpio_mode & GPIO_OUT)
  53                 DDIR(port) |= 1<<pin;
  54         else
  55                 DDIR(port) &= ~(1<<pin);
  56
  57         /* Primary / alternate function */
  58         if(gpio_mode & GPIO_AF)
  59                 GPR(port) |= (1<<pin);
  60         else
  61                 GPR(port) &= ~(1<<pin);
  62
  63         /* use as gpio? */
  64         if(gpio_mode &  GPIO_GIUS)
  65                 GIUS(port) |= (1<<pin);
  66         else
  67                 GIUS(port) &= ~(1<<pin);
  68
  69         /* Output / input configuration */
  70         /* FIXME: I'm not very sure about OCR and ICONF, someone
  71          * should have a look over it
  72          */
  73         if(pin<16) {
  74                 tmp = OCR1(port);
  75                 tmp &= ~( 3<<(pin*2));
  76                 tmp |= (ocr << (pin*2));
  77                 OCR1(port) = tmp;
  78
  79                 ICONFA1(port) &= ~( 3<<(pin*2));
  80                 ICONFA1(port) |= ((gpio_mode >> GPIO_AOUT_SHIFT) & 3) << (pin * 2);
  81                 ICONFB1(port) &= ~( 3<<(pin*2));
  82                 ICONFB1(port) |= ((gpio_mode >> GPIO_BOUT_SHIFT) & 3) << (pin * 2);
  83         } else {
  84                 tmp = OCR2(port);
  85                 tmp &= ~( 3<<((pin-16)*2));
  86                 tmp |= (ocr << ((pin-16)*2));
  87                 OCR2(port) = tmp;
  88
  89                 ICONFA2(port) &= ~( 3<<((pin-16)*2));
  90                 ICONFA2(port) |= ((gpio_mode >> GPIO_AOUT_SHIFT) & 3) << ((pin-16) * 2);
  91                 ICONFB2(port) &= ~( 3<<((pin-16)*2));
  92                 ICONFB2(port) |= ((gpio_mode >> GPIO_BOUT_SHIFT) & 3) << ((pin-16) * 2);
  93         }
  94 }
  95
  96 EXPORT_SYMBOL(imx_gpio_mode);
  97
  98 /*
  99  *  get the system pll clock in Hz
 100  *
 101  *                  mfi + mfn / (mfd +1)
 102  *  f = 2 * f_ref * --------------------
 103  *                        pd + 1
 104  */
 105 static unsigned int imx_decode_pll(unsigned int pll, u32 f_ref)
 106 {
 107         unsigned long long ll;
 108         unsigned long quot;
 109
 110         u32 mfi = (pll >> 10) & 0xf;
 111         u32 mfn = pll & 0x3ff;
 112         u32 mfd = (pll >> 16) & 0x3ff;
 113         u32 pd =  (pll >> 26) & 0xf;
 114
 115         mfi = mfi <= 5 ? 5 : mfi;
 116
 117         ll = 2 * (unsigned long long)f_ref * ( (mfi<<16) + (mfn<<16) / (mfd+1) );
 118         quot = (pd+1) * (1<<16);
 119         ll += quot / 2;
 120         do_div(ll, quot);
 121         return (unsigned int) ll;
 122 }
 123
 124 unsigned int imx_get_system_clk(void)
 125 {
 126         u32 f_ref = (CSCR & CSCR_SYSTEM_SEL) ? 16000000 : (CLK32 * 512);
 127
 128         return imx_decode_pll(SPCTL0, f_ref);
 129 }
 130 EXPORT_SYMBOL(imx_get_system_clk);
 131
 132 unsigned int imx_get_mcu_clk(void)
 133 {
 134         return imx_decode_pll(MPCTL0, CLK32 * 512);
 135 }
 136 EXPORT_SYMBOL(imx_get_mcu_clk);
 137
 138 /*
 139  *  get peripheral clock 1 ( UART[12], Timer[12], PWM )
 140  */
 141 unsigned int imx_get_perclk1(void)
 142 {
 143         return imx_get_system_clk() / (((PCDR) & 0xf)+1);
 144 }
 145 EXPORT_SYMBOL(imx_get_perclk1);
 146
 147 /*
 148  *  get peripheral clock 2 ( LCD, SD, SPI[12] )
 149  */
 150 unsigned int imx_get_perclk2(void)
 151 {
 152         return imx_get_system_clk() / (((PCDR>>4) & 0xf)+1);
 153 }
 154 EXPORT_SYMBOL(imx_get_perclk2);
 155
 156 /*
 157  *  get peripheral clock 3 ( SSI )
 158  */
 159 unsigned int imx_get_perclk3(void)
 160 {
 161         return imx_get_system_clk() / (((PCDR>>16) & 0x7f)+1);
 162 }
 163 EXPORT_SYMBOL(imx_get_perclk3);
 164
 165 /*
 166  *  get hclk ( SDRAM, CSI, Memory Stick, I2C, DMA )
 167  */
 168 unsigned int imx_get_hclk(void)
 169 {
 170         return imx_get_system_clk() / (((CSCR>>10) & 0xf)+1);
 171 }
 172 EXPORT_SYMBOL(imx_get_hclk);
 173
 174 static struct resource imx_mmc_resources[] = {
 175         [0] = {
 176                 .start  = 0x00214000,
 177                 .end    = 0x002140FF,
 178                 .flags  = IORESOURCE_MEM,
 179         },
 180         [1] = {
 181                 .start  = (SDHC_INT),
 182                 .end    = (SDHC_INT),
 183                 .flags  = IORESOURCE_IRQ,
 184         },
 185 };
 186
 187 static u64 imxmmmc_dmamask = 0xffffffffUL;
 188
 189 static struct platform_device imx_mmc_device = {
 190         .name           = "imx-mmc",
 191         .id             = 0,
 192         .dev            = {
 193                 .dma_mask = &imxmmmc_dmamask,
 194                 .coherent_dma_mask = 0xffffffff,
 195         },
 196         .num_resources  = ARRAY_SIZE(imx_mmc_resources),
 197         .resource       = imx_mmc_resources,
 198 };
 199
 200 void __init imx_set_mmc_info(struct imxmmc_platform_data *info)
 201 {
 202         imx_mmc_device.dev.platform_data = info;
 203 }
 204
 205 static struct imxfb_mach_info imx_fb_info;
 206
 207 void __init set_imx_fb_info(struct imxfb_mach_info *hard_imx_fb_info)
 208 {
 209         memcpy(&imx_fb_info,hard_imx_fb_info,sizeof(struct imxfb_mach_info));
 210 }
 211 EXPORT_SYMBOL(set_imx_fb_info);
 212
 213 static struct resource imxfb_resources[] = {
 214         [0] = {
 215                 .start  = 0x00205000,
 216                 .end    = 0x002050FF,
 217                 .flags  = IORESOURCE_MEM,
 218         },
 219         [1] = {
 220                 .start  = LCDC_INT,
 221                 .end    = LCDC_INT,
 222                 .flags  = IORESOURCE_IRQ,
 223         },
 224 };
 225
 226 static u64 fb_dma_mask = ~(u64)0;
 227
 228 static struct platform_device imxfb_device = {
 229         .name           = "imx-fb",
 230         .id             = 0,
 231         .dev            = {
 232                 .platform_data  = &imx_fb_info,
 233                 .dma_mask       = &fb_dma_mask,
 234                 .coherent_dma_mask = 0xffffffff,
 235         },
 236         .num_resources  = ARRAY_SIZE(imxfb_resources),
 237         .resource       = imxfb_resources,
 238 };
 239
 240 static struct platform_device *devices[] __initdata = {
 241         &imx_mmc_device,
 242         &imxfb_device,
 243 };
 244
 245 static struct map_desc imx_io_desc[] __initdata = {
 246         {
 247                 .virtual        = IMX_IO_BASE,
 248                 .pfn            = __phys_to_pfn(IMX_IO_PHYS),
 249                 .length         = IMX_IO_SIZE,
 250                 .type           = MT_DEVICE
 251         }
 252 };
 253
 254 void __init
 255 imx_map_io(void)
 256 {
 257         iotable_init(imx_io_desc, ARRAY_SIZE(imx_io_desc));
 258 }
 259
 260 static int __init imx_init(void)
 261 {
 262         return platform_add_devices(devices, ARRAY_SIZE(devices));
 263 }
 264
 265 subsys_initcall(imx_init);