drivers/staging/cx25821/cx25821-gpio.c

   1 /*
   2  *  Driver for the Conexant CX25821 PCIe bridge
   3  *
   4  *  Copyright (C) 2009 Conexant Systems Inc.
   5  *  Authors  <shu.lin@conexant.com>, <hiep.huynh@conexant.com>
   6  *
   7  *  This program is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License as published by
   9  *  the Free Software Foundation; either version 2 of the License, or
  10  *  (at your option) any later version.
  11  *
  12  *  This program is distributed in the hope that it will be useful,
  13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  *
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  21  */
  22
  23 #include "cx25821.h"
  24
  25
  26 /********************* GPIO stuffs *********************/
  27 void cx25821_set_gpiopin_direction( struct cx25821_dev *dev,
  28                                     int    pin_number,
  29                                     int    pin_logic_value)
  30 {
  31     int  bit = pin_number;
  32     u32 gpio_oe_reg = GPIO_LO_OE;
  33         u32 gpio_register = 0;
  34     u32 value = 0;
  35
  36     // Check for valid pinNumber
  37     if ( pin_number >= 47 )
  38         return;
  39
  40
  41     if ( pin_number > 31 )
  42         {
  43             bit = pin_number - 31;
  44             gpio_oe_reg = GPIO_HI_OE;
  45         }
  46
  47     // Here we will make sure that the GPIOs 0 and 1 are output. keep the rest as is
  48     gpio_register = cx_read( gpio_oe_reg );
  49
  50     if (pin_logic_value == 1)
  51     {
  52         value = gpio_register | Set_GPIO_Bit(bit) ;
  53     }
  54     else
  55     {
  56         value = gpio_register & Clear_GPIO_Bit(bit) ;
  57     }
  58
  59     cx_write( gpio_oe_reg, value );
  60 }
  61
  62 static void cx25821_set_gpiopin_logicvalue( struct cx25821_dev *dev,
  63                                             int    pin_number,
  64                                             int    pin_logic_value)
  65 {
  66     int bit      = pin_number;
  67     u32 gpio_reg = GPIO_LO;
  68         u32 value    = 0;
  69
  70
  71         // Check for valid pinNumber
  72     if (pin_number >= 47)
  73         return;
  74
  75     cx25821_set_gpiopin_direction(dev, pin_number, 0);   // change to output direction
  76
  77
  78     if ( pin_number > 31 )
  79         {
  80             bit      = pin_number - 31;
  81             gpio_reg = GPIO_HI;
  82         }
  83
  84     value = cx_read( gpio_reg );
  85
  86
  87     if (pin_logic_value == 0)
  88     {
  89         value &= Clear_GPIO_Bit(bit);
  90     }
  91     else
  92     {
  93         value |= Set_GPIO_Bit(bit);
  94     }
  95
  96     cx_write( gpio_reg, value);
  97 }
  98
  99 void cx25821_gpio_init(struct cx25821_dev *dev)
 100 {
 101         if( dev == NULL )
 102         {
 103             return;
 104         }
 105
 106         switch (dev->board)
 107         {
 108                 case CX25821_BOARD_CONEXANT_ATHENA10:
 109                 default:
 110                  //set GPIO 5 to select the path for Medusa/Athena
 111                         cx25821_set_gpiopin_logicvalue(dev, 5, 1);
 112                         mdelay(20);
 113                         break;
 114         }
 115
 116 }