cpu/arm920t/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
  26 #include <common.h>
  27
  28 #ifdef CONFIG_IMX
  29
  30 #include <asm/arch/imx-regs.h>
  31
  32 void imx_gpio_mode(int gpio_mode)
  33 {
  34         unsigned int pin = gpio_mode & GPIO_PIN_MASK;
  35         unsigned int port = (gpio_mode & GPIO_PORT_MASK) >> 5;
  36         unsigned int ocr = (gpio_mode & GPIO_OCR_MASK) >> 10;
  37         unsigned int tmp;
  38
  39         /* Pullup enable */
  40         if(gpio_mode & GPIO_PUEN)
  41                 PUEN(port) |= (1<<pin);
  42         else
  43                 PUEN(port) &= ~(1<<pin);
  44
  45         /* Data direction */
  46         if(gpio_mode & GPIO_OUT)
  47                 DDIR(port) |= 1<<pin;
  48         else
  49                 DDIR(port) &= ~(1<<pin);
  50
  51         /* Primary / alternate function */
  52         if(gpio_mode & GPIO_AF)
  53                 GPR(port) |= (1<<pin);
  54         else
  55                 GPR(port) &= ~(1<<pin);
  56
  57         /* use as gpio? */
  58         if( ocr == 3 )
  59                 GIUS(port) |= (1<<pin);
  60         else
  61                 GIUS(port) &= ~(1<<pin);
  62
  63         /* Output / input configuration */
  64         /* FIXME: I'm not very sure about OCR and ICONF, someone
  65          * should have a look over it
  66          */
  67         if(pin<16) {
  68                 tmp = OCR1(port);
  69                 tmp &= ~( 3<<(pin*2));
  70                 tmp |= (ocr << (pin*2));
  71                 OCR1(port) = tmp;
  72
  73                 if( gpio_mode & GPIO_AOUT )
  74                         ICONFA1(port) &= ~( 3<<(pin*2));
  75                 if( gpio_mode & GPIO_BOUT )
  76                         ICONFB1(port) &= ~( 3<<(pin*2));
  77         } else {
  78                 tmp = OCR2(port);
  79                 tmp &= ~( 3<<((pin-16)*2));
  80                 tmp |= (ocr << ((pin-16)*2));
  81                 OCR2(port) = tmp;
  82
  83                 if( gpio_mode & GPIO_AOUT )
  84                         ICONFA2(port) &= ~( 3<<((pin-16)*2));
  85                 if( gpio_mode & GPIO_BOUT )
  86                         ICONFB2(port) &= ~( 3<<((pin-16)*2));
  87         }
  88 }
  89
  90 #endif /* CONFIG_IMX */