git.oblomov.eu Git - linux-2.6/blob - arch/cris/arch-v10/drivers/gpio.c

   1 /* $Id: gpio.c,v 1.17 2005/06/19 17:06:46 starvik Exp $
   2  *
   3  * Etrax general port I/O device
   4  *
   5  * Copyright (c) 1999, 2000, 2001, 2002 Axis Communications AB
   6  *
   7  * Authors:    Bjorn Wesen      (initial version)
   8  *             Ola Knutsson     (LED handling)
   9  *             Johan Adolfsson  (read/set directions, write, port G)
  10  *
  11  * $Log: gpio.c,v $
  12  * Revision 1.17  2005/06/19 17:06:46  starvik
  13  * Merge of Linux 2.6.12.
  14  *
  15  * Revision 1.16  2005/03/07 13:02:29  starvik
  16  * Protect driver global states with spinlock
  17  *
  18  * Revision 1.15  2005/01/05 06:08:55  starvik
  19  * No need to do local_irq_disable after local_irq_save.
  20  *
  21  * Revision 1.14  2004/12/13 12:21:52  starvik
  22  * Added I/O and DMA allocators from Linux 2.4
  23  *
  24  * Revision 1.12  2004/08/24 07:19:59  starvik
  25  * Whitespace cleanup
  26  *
  27  * Revision 1.11  2004/05/14 07:58:03  starvik
  28  * Merge of changes from 2.4
  29  *
  30  * Revision 1.9  2003/09/11 07:29:48  starvik
  31  * Merge of Linux 2.6.0-test5
  32  *
  33  * Revision 1.8  2003/07/04 08:27:37  starvik
  34  * Merge of Linux 2.5.74
  35  *
  36  * Revision 1.7  2003/01/10 07:44:07  starvik
  37  * init_ioremap is now called by kernel before drivers are initialized
  38  *
  39  * Revision 1.6  2002/12/11 13:13:57  starvik
  40  * Added arch/ to v10 specific includes
  41  * Added fix from Linux 2.4 in serial.c (flush_to_flip_buffer)
  42  *
  43  * Revision 1.5  2002/11/20 11:56:11  starvik
  44  * Merge of Linux 2.5.48
  45  *
  46  * Revision 1.4  2002/11/18 10:10:05  starvik
  47  * Linux 2.5 port of latest gpio.c from Linux 2.4
  48  *
  49  * Revision 1.20  2002/10/16 21:16:24  johana
  50  * Added support for PA high level interrupt.
  51  * That gives 2ms response time with iodtest for high levels and 2-12 ms
  52  * response time on low levels if the check is not made in
  53  * process.c:cpu_idle() as well.
  54  *
  55  * Revision 1.19  2002/10/14 18:27:33  johana
  56  * Implemented alarm handling so select() now works.
  57  * Latency is around 6-9 ms with a etrax_gpio_wake_up_check() in
  58  * cpu_idle().
  59  * Otherwise I get 15-18 ms (same as doing the poll in userspace -
  60  * but less overhead).
  61  * TODO? Perhaps we should add the check in IMMEDIATE_BH (or whatever it
  62  * is in 2.4) as well?
  63  * TODO? Perhaps call request_irq()/free_irq() only when needed?
  64  * Increased version to 2.5
  65  *
  66  * Revision 1.18  2002/10/11 15:02:00  johana
  67  * Mask inverted 8 bit value in setget_input().
  68  *
  69  * Revision 1.17  2002/06/17 15:53:01  johana
  70  * Added IO_READ_INBITS, IO_READ_OUTBITS, IO_SETGET_INPUT and IO_SETGET_OUTPUT
  71  * that take a pointer as argument and thus can handle 32 bit ports (G)
  72  * correctly.
  73  * These should be used instead of IO_READBITS, IO_SETINPUT and IO_SETOUTPUT.
  74  * (especially if Port G bit 31 is used)
  75  *
  76  * Revision 1.16  2002/06/17 09:59:51  johana
  77  * Returning 32 bit values in the ioctl return value doesn't work if bit
  78  * 31 is set (could happen for port G), so mask it of with 0x7FFFFFFF.
  79  * A new set of ioctl's will be added.
  80  *
  81  * Revision 1.15  2002/05/06 13:19:13  johana
  82  * IO_SETINPUT returns mask with bit set = inputs for PA and PB as well.
  83  *
  84  * Revision 1.14  2002/04/12 12:01:53  johana
  85  * Use global r_port_g_data_shadow.
  86  * Moved gpio_init_port_g() closer to gpio_init() and marked it __init.
  87  *
  88  * Revision 1.13  2002/04/10 12:03:55  johana
  89  * Added support for port G /dev/gpiog (minor 3).
  90  * Changed indentation on switch cases.
  91  * Fixed other spaces to tabs.
  92  *
  93  * Revision 1.12  2001/11/12 19:42:15  pkj
  94  * * Corrected return values from gpio_leds_ioctl().
  95  * * Fixed compiler warnings.
  96  *
  97  * Revision 1.11  2001/10/30 14:39:12  johana
  98  * Added D() around gpio_write printk.
  99  *
 100  * Revision 1.10  2001/10/25 10:24:42  johana
 101  * Added IO_CFG_WRITE_MODE ioctl and write method that can do fast
 102  * bittoggling in the kernel. (This speeds up programming an FPGA with 450kB
 103  * from ~60 seconds to 4 seconds).
 104  * Added save_flags/cli/restore_flags in ioctl.
 105  *
 106  * Revision 1.9  2001/05/04 14:16:07  matsfg
 107  * Corrected spelling error
 108  *
 109  * Revision 1.8  2001/04/27 13:55:26  matsfg
 110  * Moved initioremap.
 111  * Turns off all LEDS on init.
 112  * Added support for shutdown and powerbutton.
 113  *
 114  * Revision 1.7  2001/04/04 13:30:08  matsfg
 115  * Added bitset and bitclear for leds. Calls init_ioremap to set up memmapping
 116  *
 117  * Revision 1.6  2001/03/26 16:03:06  bjornw
 118  * Needs linux/config.h
 119  *
 120  * Revision 1.5  2001/03/26 14:22:03  bjornw
 121  * Namechange of some config options
 122  *
 123  * Revision 1.4  2001/02/27 13:52:48  bjornw
 124  * malloc.h -> slab.h
 125  *
 126  * Revision 1.3  2001/01/24 15:06:48  bjornw
 127  * gpio_wq correct type
 128  *
 129  * Revision 1.2  2001/01/18 16:07:30  bjornw
 130  * 2.4 port
 131  *
 132  * Revision 1.1  2001/01/18 15:55:16  bjornw
 133  * Verbatim copy of etraxgpio.c from elinux 2.0 added
 134  *
 135  *
 136  */
 137
 138
 139 #include <linux/module.h>
 140 #include <linux/sched.h>
 141 #include <linux/slab.h>
 142 #include <linux/ioport.h>
 143 #include <linux/errno.h>
 144 #include <linux/kernel.h>
 145 #include <linux/fs.h>
 146 #include <linux/string.h>
 147 #include <linux/poll.h>
 148 #include <linux/init.h>
 149 #include <linux/interrupt.h>
 150
 151 #include <asm/etraxgpio.h>
 152 #include <asm/arch/svinto.h>
 153 #include <asm/io.h>
 154 #include <asm/system.h>
 155 #include <asm/irq.h>
 156 #include <asm/arch/io_interface_mux.h>
 157
 158 #define GPIO_MAJOR 120  /* experimental MAJOR number */
 159
 160 #define D(x)
 161
 162 #if 0
 163 static int dp_cnt;
 164 #define DP(x) do { dp_cnt++; if (dp_cnt % 1000 == 0) x; }while(0)
 165 #else
 166 #define DP(x)
 167 #endif
 168
 169 static char gpio_name[] = "etrax gpio";
 170
 171 #if 0
 172 static wait_queue_head_t *gpio_wq;
 173 #endif
 174
 175 static int gpio_ioctl(struct inode *inode, struct file *file,
 176                       unsigned int cmd, unsigned long arg);
 177 static ssize_t gpio_write(struct file * file, const char * buf, size_t count,
 178                           loff_t *off);
 179 static int gpio_open(struct inode *inode, struct file *filp);
 180 static int gpio_release(struct inode *inode, struct file *filp);
 181 static unsigned int gpio_poll(struct file *filp, struct poll_table_struct *wait);
 182
 183 /* private data per open() of this driver */
 184
 185 struct gpio_private {
 186         struct gpio_private *next;
 187         /* These fields are for PA and PB only */
 188         volatile unsigned char *port, *shadow;
 189         volatile unsigned char *dir, *dir_shadow;
 190         unsigned char changeable_dir;
 191         unsigned char changeable_bits;
 192         unsigned char clk_mask;
 193         unsigned char data_mask;
 194         unsigned char write_msb;
 195         unsigned char pad1, pad2, pad3;
 196         /* These fields are generic */
 197         unsigned long highalarm, lowalarm;
 198         wait_queue_head_t alarm_wq;
 199         int minor;
 200 };
 201
 202 /* linked list of alarms to check for */
 203
 204 static struct gpio_private *alarmlist = 0;
 205
 206 static int gpio_some_alarms = 0; /* Set if someone uses alarm */
 207 static unsigned long gpio_pa_irq_enabled_mask = 0;
 208
 209 static DEFINE_SPINLOCK(gpio_lock); /* Protect directions etc */
 210
 211 /* Port A and B use 8 bit access, but Port G is 32 bit */
 212 #define NUM_PORTS (GPIO_MINOR_B+1)
 213
 214 static volatile unsigned char *ports[NUM_PORTS] = {
 215         R_PORT_PA_DATA,
 216         R_PORT_PB_DATA,
 217 };
 218 static volatile unsigned char *shads[NUM_PORTS] = {
 219         &port_pa_data_shadow,
 220         &port_pb_data_shadow
 221 };
 222
 223 /* What direction bits that are user changeable 1=changeable*/
 224 #ifndef CONFIG_ETRAX_PA_CHANGEABLE_DIR
 225 #define CONFIG_ETRAX_PA_CHANGEABLE_DIR 0x00
 226 #endif
 227 #ifndef CONFIG_ETRAX_PB_CHANGEABLE_DIR
 228 #define CONFIG_ETRAX_PB_CHANGEABLE_DIR 0x00
 229 #endif
 230
 231 #ifndef CONFIG_ETRAX_PA_CHANGEABLE_BITS
 232 #define CONFIG_ETRAX_PA_CHANGEABLE_BITS 0xFF
 233 #endif
 234 #ifndef CONFIG_ETRAX_PB_CHANGEABLE_BITS
 235 #define CONFIG_ETRAX_PB_CHANGEABLE_BITS 0xFF
 236 #endif
 237
 238
 239 static unsigned char changeable_dir[NUM_PORTS] = {
 240         CONFIG_ETRAX_PA_CHANGEABLE_DIR,
 241         CONFIG_ETRAX_PB_CHANGEABLE_DIR
 242 };
 243 static unsigned char changeable_bits[NUM_PORTS] = {
 244         CONFIG_ETRAX_PA_CHANGEABLE_BITS,
 245         CONFIG_ETRAX_PB_CHANGEABLE_BITS
 246 };
 247
 248 static volatile unsigned char *dir[NUM_PORTS] = {
 249         R_PORT_PA_DIR,
 250         R_PORT_PB_DIR
 251 };
 252
 253 static volatile unsigned char *dir_shadow[NUM_PORTS] = {
 254         &port_pa_dir_shadow,
 255         &port_pb_dir_shadow
 256 };
 257
 258 /* All bits in port g that can change dir. */
 259 static const unsigned long int changeable_dir_g_mask = 0x01FFFF01;
 260
 261 /* Port G is 32 bit, handle it special, some bits are both inputs
 262    and outputs at the same time, only some of the bits can change direction
 263    and some of them in groups of 8 bit. */
 264 static unsigned long changeable_dir_g;
 265 static unsigned long dir_g_in_bits;
 266 static unsigned long dir_g_out_bits;
 267 static unsigned long dir_g_shadow; /* 1=output */
 268
 269 #define USE_PORTS(priv) ((priv)->minor <= GPIO_MINOR_B)
 270
 271
 272
 273 static unsigned int
 274 gpio_poll(struct file *file,
 275           poll_table *wait)
 276 {
 277         unsigned int mask = 0;
 278         struct gpio_private *priv = (struct gpio_private *)file->private_data;
 279         unsigned long data;
 280         spin_lock(&gpio_lock);
 281         poll_wait(file, &priv->alarm_wq, wait);
 282         if (priv->minor == GPIO_MINOR_A) {
 283                 unsigned long flags;
 284                 unsigned long tmp;
 285                 data = *R_PORT_PA_DATA;
 286                 /* PA has support for high level interrupt -
 287                  * lets activate for those low and with highalarm set
 288                  */
 289                 tmp = ~data & priv->highalarm & 0xFF;
 290                 tmp = (tmp << R_IRQ_MASK1_SET__pa0__BITNR);
 291                 local_irq_save(flags);
 292                 gpio_pa_irq_enabled_mask |= tmp;
 293                 *R_IRQ_MASK1_SET = tmp;
 294                 local_irq_restore(flags);
 295
 296         } else if (priv->minor == GPIO_MINOR_B)
 297                 data = *R_PORT_PB_DATA;
 298         else if (priv->minor == GPIO_MINOR_G)
 299                 data = *R_PORT_G_DATA;
 300         else
 301                 return 0;
 302
 303         if ((data & priv->highalarm) ||
 304             (~data & priv->lowalarm)) {
 305                 mask = POLLIN|POLLRDNORM;
 306         }
 307
 308         spin_unlock(&gpio_lock);
 309
 310         DP(printk("gpio_poll ready: mask 0x%08X\n", mask));
 311
 312         return mask;
 313 }
 314
 315 int etrax_gpio_wake_up_check(void)
 316 {
 317         struct gpio_private *priv = alarmlist;
 318         unsigned long data = 0;
 319         int ret = 0;
 320         spin_lock(&gpio_lock);
 321         while (priv) {
 322                 if (USE_PORTS(priv)) {
 323                         data = *priv->port;
 324                 } else if (priv->minor == GPIO_MINOR_G) {
 325                         data = *R_PORT_G_DATA;
 326                 }
 327                 if ((data & priv->highalarm) ||
 328                     (~data & priv->lowalarm)) {
 329                         DP(printk("etrax_gpio_wake_up_check %i\n",priv->minor));
 330                         wake_up_interruptible(&priv->alarm_wq);
 331                         ret = 1;
 332                 }
 333                 priv = priv->next;
 334         }
 335         spin_unlock(&gpio_lock);
 336         return ret;
 337 }
 338
 339 static irqreturn_t
 340 gpio_poll_timer_interrupt(int irq, void *dev_id, struct pt_regs *regs)
 341 {
 342         if (gpio_some_alarms) {
 343                 etrax_gpio_wake_up_check();
 344                 return IRQ_HANDLED;
 345         }
 346         return IRQ_NONE;
 347 }
 348
 349 static irqreturn_t
 350 gpio_pa_interrupt(int irq, void *dev_id, struct pt_regs *regs)
 351 {
 352         unsigned long tmp;
 353         spin_lock(&gpio_lock);
 354         /* Find what PA interrupts are active */
 355         tmp = (*R_IRQ_READ1);
 356
 357         /* Find those that we have enabled */
 358         tmp &= gpio_pa_irq_enabled_mask;
 359
 360         /* Clear them.. */
 361         *R_IRQ_MASK1_CLR = tmp;
 362         gpio_pa_irq_enabled_mask &= ~tmp;
 363
 364         spin_unlock(&gpio_lock);
 365
 366         if (gpio_some_alarms) {
 367                 return IRQ_RETVAL(etrax_gpio_wake_up_check());
 368         }
 369         return IRQ_NONE;
 370 }
 371
 372
 373 static ssize_t gpio_write(struct file * file, const char * buf, size_t count,
 374                           loff_t *off)
 375 {
 376         struct gpio_private *priv = (struct gpio_private *)file->private_data;
 377         unsigned char data, clk_mask, data_mask, write_msb;
 378         unsigned long flags;
 379
 380         spin_lock(&gpio_lock);
 381
 382         ssize_t retval = count;
 383         if (priv->minor !=GPIO_MINOR_A && priv->minor != GPIO_MINOR_B) {
 384                 return -EFAULT;
 385         }
 386
 387         if (!access_ok(VERIFY_READ, buf, count)) {
 388                 return -EFAULT;
 389         }
 390         clk_mask = priv->clk_mask;
 391         data_mask = priv->data_mask;
 392         /* It must have been configured using the IO_CFG_WRITE_MODE */
 393         /* Perhaps a better error code? */
 394         if (clk_mask == 0 || data_mask == 0) {
 395                 return -EPERM;
 396         }
 397         write_msb = priv->write_msb;
 398         D(printk("gpio_write: %lu to data 0x%02X clk 0x%02X msb: %i\n",count, data_mask, clk_mask, write_msb));
 399         while (count--) {
 400                 int i;
 401                 data = *buf++;
 402                 if (priv->write_msb) {
 403                         for (i = 7; i >= 0;i--) {
 404                                 local_irq_save(flags);
 405                                 *priv->port = *priv->shadow &= ~clk_mask;
 406                                 if (data & 1<<i)
 407                                         *priv->port = *priv->shadow |= data_mask;
 408                                 else
 409                                         *priv->port = *priv->shadow &= ~data_mask;
 410                         /* For FPGA: min 5.0ns (DCC) before CCLK high */
 411                                 *priv->port = *priv->shadow |= clk_mask;
 412                                 local_irq_restore(flags);
 413                         }
 414                 } else {
 415                         for (i = 0; i <= 7;i++) {
 416                                 local_irq_save(flags);
 417                                 *priv->port = *priv->shadow &= ~clk_mask;
 418                                 if (data & 1<<i)
 419                                         *priv->port = *priv->shadow |= data_mask;
 420                                 else
 421                                         *priv->port = *priv->shadow &= ~data_mask;
 422                         /* For FPGA: min 5.0ns (DCC) before CCLK high */
 423                                 *priv->port = *priv->shadow |= clk_mask;
 424                                 local_irq_restore(flags);
 425                         }
 426                 }
 427         }
 428         spin_unlock(&gpio_lock);
 429         return retval;
 430 }
 431
 432
 433
 434 static int
 435 gpio_open(struct inode *inode, struct file *filp)
 436 {
 437         struct gpio_private *priv;
 438         int p = iminor(inode);
 439
 440         if (p > GPIO_MINOR_LAST)
 441                 return -EINVAL;
 442
 443         priv = kmalloc(sizeof(struct gpio_private),
 444                                               GFP_KERNEL);
 445
 446         if (!priv)
 447                 return -ENOMEM;
 448
 449         priv->minor = p;
 450
 451         /* initialize the io/alarm struct and link it into our alarmlist */
 452
 453         priv->next = alarmlist;
 454         alarmlist = priv;
 455         if (USE_PORTS(priv)) { /* A and B */
 456                 priv->port = ports[p];
 457                 priv->shadow = shads[p];
 458                 priv->dir = dir[p];
 459                 priv->dir_shadow = dir_shadow[p];
 460                 priv->changeable_dir = changeable_dir[p];
 461                 priv->changeable_bits = changeable_bits[p];
 462         } else {
 463                 priv->port = NULL;
 464                 priv->shadow = NULL;
 465                 priv->dir = NULL;
 466                 priv->dir_shadow = NULL;
 467                 priv->changeable_dir = 0;
 468                 priv->changeable_bits = 0;
 469         }
 470
 471         priv->highalarm = 0;
 472         priv->lowalarm = 0;
 473         priv->clk_mask = 0;
 474         priv->data_mask = 0;
 475         init_waitqueue_head(&priv->alarm_wq);
 476
 477         filp->private_data = (void *)priv;
 478
 479         return 0;
 480 }
 481
 482 static int
 483 gpio_release(struct inode *inode, struct file *filp)
 484 {
 485         struct gpio_private *p;
 486         struct gpio_private *todel;
 487
 488         spin_lock(&gpio_lock);
 489
 490         p = alarmlist;
 491         todel = (struct gpio_private *)filp->private_data;
 492
 493         /* unlink from alarmlist and free the private structure */
 494
 495         if (p == todel) {
 496                 alarmlist = todel->next;
 497         } else {
 498                 while (p->next != todel)
 499                         p = p->next;
 500                 p->next = todel->next;
 501         }
 502
 503         kfree(todel);
 504         /* Check if there are still any alarms set */
 505         p = alarmlist;
 506         while (p) {
 507                 if (p->highalarm | p->lowalarm) {
 508                         gpio_some_alarms = 1;
 509                         return 0;
 510                 }
 511                 p = p->next;
 512         }
 513         gpio_some_alarms = 0;
 514         spin_unlock(&gpio_lock);
 515         return 0;
 516 }
 517
 518 /* Main device API. ioctl's to read/set/clear bits, as well as to
 519  * set alarms to wait for using a subsequent select().
 520  */
 521
 522 unsigned long inline setget_input(struct gpio_private *priv, unsigned long arg)
 523 {
 524         /* Set direction 0=unchanged 1=input,
 525          * return mask with 1=input
 526          */
 527         unsigned long flags;
 528         if (USE_PORTS(priv)) {
 529                 local_irq_save(flags);
 530                 *priv->dir = *priv->dir_shadow &=
 531                 ~((unsigned char)arg & priv->changeable_dir);
 532                 local_irq_restore(flags);
 533                 return ~(*priv->dir_shadow) & 0xFF; /* Only 8 bits */
 534         } else if (priv->minor == GPIO_MINOR_G) {
 535                 /* We must fiddle with R_GEN_CONFIG to change dir */
 536                 local_irq_save(flags);
 537                 if (((arg & dir_g_in_bits) != arg) &&
 538                     (arg & changeable_dir_g)) {
 539                         arg &= changeable_dir_g;
 540                         /* Clear bits in genconfig to set to input */
 541                         if (arg & (1<<0)) {
 542                                 genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG,g0dir);
 543                                 dir_g_in_bits |= (1<<0);
 544                                 dir_g_out_bits &= ~(1<<0);
 545                         }
 546                         if ((arg & 0x0000FF00) == 0x0000FF00) {
 547                                 genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG,g8_15dir);
 548                                 dir_g_in_bits |= 0x0000FF00;
 549                                 dir_g_out_bits &= ~0x0000FF00;
 550                         }
 551                         if ((arg & 0x00FF0000) == 0x00FF0000) {
 552                                 genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG,g16_23dir);
 553                                 dir_g_in_bits |= 0x00FF0000;
 554                                 dir_g_out_bits &= ~0x00FF0000;
 555                         }
 556                         if (arg & (1<<24)) {
 557                                 genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG,g24dir);
 558                                 dir_g_in_bits |= (1<<24);
 559                                 dir_g_out_bits &= ~(1<<24);
 560                         }
 561                         D(printk(KERN_INFO "gpio: SETINPUT on port G set "
 562                                  "genconfig to 0x%08lX "
 563                                  "in_bits: 0x%08lX "
 564                                  "out_bits: 0x%08lX\n",
 565                                  (unsigned long)genconfig_shadow,
 566                                  dir_g_in_bits, dir_g_out_bits));
 567                         *R_GEN_CONFIG = genconfig_shadow;
 568                         /* Must be a >120 ns delay before writing this again */
 569
 570                 }
 571                 local_irq_restore(flags);
 572                 return dir_g_in_bits;
 573         }
 574         return 0;
 575 } /* setget_input */
 576
 577 unsigned long inline setget_output(struct gpio_private *priv, unsigned long arg)
 578 {
 579         unsigned long flags;
 580         if (USE_PORTS(priv)) {
 581                 local_irq_save(flags);
 582                 *priv->dir = *priv->dir_shadow |=
 583                   ((unsigned char)arg & priv->changeable_dir);
 584                 local_irq_restore(flags);
 585                 return *priv->dir_shadow;
 586         } else if (priv->minor == GPIO_MINOR_G) {
 587                 /* We must fiddle with R_GEN_CONFIG to change dir */
 588                 local_irq_save(flags);
 589                 if (((arg & dir_g_out_bits) != arg) &&
 590                     (arg & changeable_dir_g)) {
 591                         /* Set bits in genconfig to set to output */
 592                         if (arg & (1<<0)) {
 593                                 genconfig_shadow |= IO_MASK(R_GEN_CONFIG,g0dir);
 594                                 dir_g_out_bits |= (1<<0);
 595                                 dir_g_in_bits &= ~(1<<0);
 596                         }
 597                         if ((arg & 0x0000FF00) == 0x0000FF00) {
 598                                 genconfig_shadow |= IO_MASK(R_GEN_CONFIG,g8_15dir);
 599                                 dir_g_out_bits |= 0x0000FF00;
 600                                 dir_g_in_bits &= ~0x0000FF00;
 601                         }
 602                         if ((arg & 0x00FF0000) == 0x00FF0000) {
 603                                 genconfig_shadow |= IO_MASK(R_GEN_CONFIG,g16_23dir);
 604                                 dir_g_out_bits |= 0x00FF0000;
 605                                 dir_g_in_bits &= ~0x00FF0000;
 606                         }
 607                         if (arg & (1<<24)) {
 608                                 genconfig_shadow |= IO_MASK(R_GEN_CONFIG,g24dir);
 609                                 dir_g_out_bits |= (1<<24);
 610                                 dir_g_in_bits &= ~(1<<24);
 611                         }
 612                         D(printk(KERN_INFO "gpio: SETOUTPUT on port G set "
 613                                  "genconfig to 0x%08lX "
 614                                  "in_bits: 0x%08lX "
 615                                  "out_bits: 0x%08lX\n",
 616                                  (unsigned long)genconfig_shadow,
 617                                  dir_g_in_bits, dir_g_out_bits));
 618                         *R_GEN_CONFIG = genconfig_shadow;
 619                         /* Must be a >120 ns delay before writing this again */
 620                 }
 621                 local_irq_restore(flags);
 622                 return dir_g_out_bits & 0x7FFFFFFF;
 623         }
 624         return 0;
 625 } /* setget_output */
 626
 627 static int
 628 gpio_leds_ioctl(unsigned int cmd, unsigned long arg);
 629
 630 static int
 631 gpio_ioctl(struct inode *inode, struct file *file,
 632            unsigned int cmd, unsigned long arg)
 633 {
 634         unsigned long flags;
 635         unsigned long val;
 636         int ret = 0;
 637
 638         struct gpio_private *priv = (struct gpio_private *)file->private_data;
 639         if (_IOC_TYPE(cmd) != ETRAXGPIO_IOCTYPE) {
 640                 return -EINVAL;
 641         }
 642
 643         spin_lock(&gpio_lock);
 644
 645         switch (_IOC_NR(cmd)) {
 646         case IO_READBITS: /* Use IO_READ_INBITS and IO_READ_OUTBITS instead */
 647                 // read the port
 648                 if (USE_PORTS(priv)) {
 649                         ret =  *priv->port;
 650                 } else if (priv->minor == GPIO_MINOR_G) {
 651                         ret =  (*R_PORT_G_DATA) & 0x7FFFFFFF;
 652                 }
 653                 break;
 654         case IO_SETBITS:
 655                 local_irq_save(flags);
 656                 // set changeable bits with a 1 in arg
 657                 if (USE_PORTS(priv)) {
 658                         *priv->port = *priv->shadow |=
 659                           ((unsigned char)arg & priv->changeable_bits);
 660                 } else if (priv->minor == GPIO_MINOR_G) {
 661                         *R_PORT_G_DATA = port_g_data_shadow |= (arg & dir_g_out_bits);
 662                 }
 663                 local_irq_restore(flags);
 664                 break;
 665         case IO_CLRBITS:
 666                 local_irq_save(flags);
 667                 // clear changeable bits with a 1 in arg
 668                 if (USE_PORTS(priv)) {
 669                         *priv->port = *priv->shadow &=
 670                          ~((unsigned char)arg & priv->changeable_bits);
 671                 } else if (priv->minor == GPIO_MINOR_G) {
 672                         *R_PORT_G_DATA = port_g_data_shadow &= ~((unsigned long)arg & dir_g_out_bits);
 673                 }
 674                 local_irq_restore(flags);
 675                 break;
 676         case IO_HIGHALARM:
 677                 // set alarm when bits with 1 in arg go high
 678                 priv->highalarm |= arg;
 679                 gpio_some_alarms = 1;
 680                 break;
 681         case IO_LOWALARM:
 682                 // set alarm when bits with 1 in arg go low
 683                 priv->lowalarm |= arg;
 684                 gpio_some_alarms = 1;
 685                 break;
 686         case IO_CLRALARM:
 687                 // clear alarm for bits with 1 in arg
 688                 priv->highalarm &= ~arg;
 689                 priv->lowalarm  &= ~arg;
 690                 {
 691                         /* Must update gpio_some_alarms */
 692                         struct gpio_private *p = alarmlist;
 693                         int some_alarms;
 694                         some_alarms = 0;
 695                         while (p) {
 696                                 if (p->highalarm | p->lowalarm) {
 697                                         some_alarms = 1;
 698                                         break;
 699                                 }
 700                                 p = p->next;
 701                         }
 702                         gpio_some_alarms = some_alarms;
 703                 }
 704                 break;
 705         case IO_READDIR: /* Use IO_SETGET_INPUT/OUTPUT instead! */
 706                 /* Read direction 0=input 1=output */
 707                 if (USE_PORTS(priv)) {
 708                         ret = *priv->dir_shadow;
 709                 } else if (priv->minor == GPIO_MINOR_G) {
 710                         /* Note: Some bits are both in and out,
 711                          * Those that are dual is set here as well.
 712                          */
 713                         ret = (dir_g_shadow | dir_g_out_bits) & 0x7FFFFFFF;
 714                 }
 715                 break;
 716         case IO_SETINPUT: /* Use IO_SETGET_INPUT instead! */
 717                 /* Set direction 0=unchanged 1=input,
 718                  * return mask with 1=input
 719                  */
 720                 ret = setget_input(priv, arg) & 0x7FFFFFFF;
 721                 break;
 722         case IO_SETOUTPUT: /* Use IO_SETGET_OUTPUT instead! */
 723                 /* Set direction 0=unchanged 1=output,
 724                  * return mask with 1=output
 725                  */
 726                 ret =  setget_output(priv, arg) & 0x7FFFFFFF;
 727                 break;
 728         case IO_SHUTDOWN:
 729                 SOFT_SHUTDOWN();
 730                 break;
 731         case IO_GET_PWR_BT:
 732 #if defined (CONFIG_ETRAX_SOFT_SHUTDOWN)
 733                 ret = (*R_PORT_G_DATA & ( 1 << CONFIG_ETRAX_POWERBUTTON_BIT));
 734 #else
 735                 ret = 0;
 736 #endif
 737                 break;
 738         case IO_CFG_WRITE_MODE:
 739                 priv->clk_mask = arg & 0xFF;
 740                 priv->data_mask = (arg >> 8) & 0xFF;
 741                 priv->write_msb = (arg >> 16) & 0x01;
 742                 /* Check if we're allowed to change the bits and
 743                  * the direction is correct
 744                  */
 745                 if (!((priv->clk_mask & priv->changeable_bits) &&
 746                       (priv->data_mask & priv->changeable_bits) &&
 747                       (priv->clk_mask & *priv->dir_shadow) &&
 748                       (priv->data_mask & *priv->dir_shadow)))
 749                 {
 750                         priv->clk_mask = 0;
 751                         priv->data_mask = 0;
 752                         ret = -EPERM;
 753                 }
 754                 break;
 755         case IO_READ_INBITS:
 756                 /* *arg is result of reading the input pins */
 757                 if (USE_PORTS(priv)) {
 758                         val = *priv->port;
 759                 } else if (priv->minor == GPIO_MINOR_G) {
 760                         val = *R_PORT_G_DATA;
 761                 }
 762                 if (copy_to_user((unsigned long*)arg, &val, sizeof(val)))
 763                         ret = -EFAULT;
 764                 break;
 765         case IO_READ_OUTBITS:
 766                  /* *arg is result of reading the output shadow */
 767                 if (USE_PORTS(priv)) {
 768                         val = *priv->shadow;
 769                 } else if (priv->minor == GPIO_MINOR_G) {
 770                         val = port_g_data_shadow;
 771                 }
 772                 if (copy_to_user((unsigned long*)arg, &val, sizeof(val)))
 773                         ret = -EFAULT;
 774                 break;
 775         case IO_SETGET_INPUT:
 776                 /* bits set in *arg is set to input,
 777                  * *arg updated with current input pins.
 778                  */
 779                 if (copy_from_user(&val, (unsigned long*)arg, sizeof(val)))
 780                 {
 781                         ret = -EFAULT;
 782                         break;
 783                 }
 784                 val = setget_input(priv, val);
 785                 if (copy_to_user((unsigned long*)arg, &val, sizeof(val)))
 786                         ret = -EFAULT;
 787                 break;
 788         case IO_SETGET_OUTPUT:
 789                 /* bits set in *arg is set to output,
 790                  * *arg updated with current output pins.
 791                  */
 792                 if (copy_from_user(&val, (unsigned long*)arg, sizeof(val)))
 793                 {
 794                         ret = -EFAULT;
 795                         break;
 796                 }
 797                 val = setget_output(priv, val);
 798                 if (copy_to_user((unsigned long*)arg, &val, sizeof(val)))
 799                         ret = -EFAULT;
 800                 break;
 801         default:
 802                 if (priv->minor == GPIO_MINOR_LEDS)
 803                         ret = gpio_leds_ioctl(cmd, arg);
 804                 else
 805                         ret = -EINVAL;
 806         } /* switch */
 807
 808         spin_unlock(&gpio_lock);
 809         return ret;
 810 }
 811
 812 static int
 813 gpio_leds_ioctl(unsigned int cmd, unsigned long arg)
 814 {
 815         unsigned char green;
 816         unsigned char red;
 817
 818         switch (_IOC_NR(cmd)) {
 819         case IO_LEDACTIVE_SET:
 820                 green = ((unsigned char) arg) & 1;
 821                 red   = (((unsigned char) arg) >> 1) & 1;
 822                 LED_ACTIVE_SET_G(green);
 823                 LED_ACTIVE_SET_R(red);
 824                 break;
 825
 826         case IO_LED_SETBIT:
 827                 LED_BIT_SET(arg);
 828                 break;
 829
 830         case IO_LED_CLRBIT:
 831                 LED_BIT_CLR(arg);
 832                 break;
 833
 834         default:
 835                 return -EINVAL;
 836         } /* switch */
 837
 838         return 0;
 839 }
 840
 841 struct file_operations gpio_fops = {
 842         .owner       = THIS_MODULE,
 843         .poll        = gpio_poll,
 844         .ioctl       = gpio_ioctl,
 845         .write       = gpio_write,
 846         .open        = gpio_open,
 847         .release     = gpio_release,
 848 };
 849
 850
 851 void ioif_watcher(const unsigned int gpio_in_available,
 852                   const unsigned int gpio_out_available,
 853                   const unsigned char pa_available,
 854                   const unsigned char pb_available)
 855 {
 856         unsigned long int flags;
 857         D(printk("gpio.c: ioif_watcher called\n"));
 858         D(printk("gpio.c: G in: 0x%08x G out: 0x%08x PA: 0x%02x PB: 0x%02x\n",
 859                  gpio_in_available, gpio_out_available, pa_available, pb_available));
 860
 861         spin_lock_irqsave(&gpio_lock, flags);
 862
 863         dir_g_in_bits = gpio_in_available;
 864         dir_g_out_bits = gpio_out_available;
 865
 866         /* Initialise the dir_g_shadow etc. depending on genconfig */
 867         /* 0=input 1=output */
 868         if (genconfig_shadow & IO_STATE(R_GEN_CONFIG, g0dir, out))
 869                 dir_g_shadow |= (1 << 0);
 870         if (genconfig_shadow & IO_STATE(R_GEN_CONFIG, g8_15dir, out))
 871                 dir_g_shadow |= 0x0000FF00;
 872         if (genconfig_shadow & IO_STATE(R_GEN_CONFIG, g16_23dir, out))
 873                 dir_g_shadow |= 0x00FF0000;
 874         if (genconfig_shadow & IO_STATE(R_GEN_CONFIG, g24dir, out))
 875                 dir_g_shadow |= (1 << 24);
 876
 877         changeable_dir_g = changeable_dir_g_mask;
 878         changeable_dir_g &= dir_g_out_bits;
 879         changeable_dir_g &= dir_g_in_bits;
 880         /* Correct the bits that can change direction */
 881         dir_g_out_bits &= ~changeable_dir_g;
 882         dir_g_out_bits |= dir_g_shadow;
 883         dir_g_in_bits &= ~changeable_dir_g;
 884         dir_g_in_bits |= (~dir_g_shadow & changeable_dir_g);
 885
 886         spin_unlock_irqrestore(&gpio_lock, flags);
 887
 888         printk(KERN_INFO "GPIO port G: in_bits: 0x%08lX out_bits: 0x%08lX val: %08lX\n",
 889                dir_g_in_bits, dir_g_out_bits, (unsigned long)*R_PORT_G_DATA);
 890         printk(KERN_INFO "GPIO port G: dir: %08lX changeable: %08lX\n",
 891                dir_g_shadow, changeable_dir_g);
 892 }
 893
 894 /* main driver initialization routine, called from mem.c */
 895
 896 static __init int
 897 gpio_init(void)
 898 {
 899         int res;
 900 #if defined (CONFIG_ETRAX_CSP0_LEDS)
 901         int i;
 902 #endif
 903         printk("gpio init\n");
 904
 905         /* do the formalities */
 906
 907         res = register_chrdev(GPIO_MAJOR, gpio_name, &gpio_fops);
 908         if (res < 0) {
 909                 printk(KERN_ERR "gpio: couldn't get a major number.\n");
 910                 return res;
 911         }
 912
 913         /* Clear all leds */
 914 #if defined (CONFIG_ETRAX_CSP0_LEDS) ||  defined (CONFIG_ETRAX_PA_LEDS) || defined (CONFIG_ETRAX_PB_LEDS)
 915         LED_NETWORK_SET(0);
 916         LED_ACTIVE_SET(0);
 917         LED_DISK_READ(0);
 918         LED_DISK_WRITE(0);
 919
 920 #if defined (CONFIG_ETRAX_CSP0_LEDS)
 921         for (i = 0; i < 32; i++) {
 922                 LED_BIT_SET(i);
 923         }
 924 #endif
 925
 926 #endif
 927         /* The I/O interface allocation watcher will be called when
 928          * registering it. */
 929         if (cris_io_interface_register_watcher(ioif_watcher)){
 930                 printk(KERN_WARNING "gpio_init: Failed to install IO if allocator watcher\n");
 931         }
 932
 933         printk(KERN_INFO "ETRAX 100LX GPIO driver v2.5, (c) 2001, 2002, 2003, 2004 Axis Communications AB\n");
 934         /* We call etrax_gpio_wake_up_check() from timer interrupt and
 935          * from cpu_idle() in kernel/process.c
 936          * The check in cpu_idle() reduces latency from ~15 ms to ~6 ms
 937          * in some tests.
 938          */
 939         if (request_irq(TIMER0_IRQ_NBR, gpio_poll_timer_interrupt,
 940                         IRQF_SHARED | IRQF_DISABLED,"gpio poll", NULL)) {
 941                 printk(KERN_CRIT "err: timer0 irq for gpio\n");
 942         }
 943         if (request_irq(PA_IRQ_NBR, gpio_pa_interrupt,
 944                         IRQF_SHARED | IRQF_DISABLED,"gpio PA", NULL)) {
 945                 printk(KERN_CRIT "err: PA irq for gpio\n");
 946         }
 947
 948
 949         return res;
 950 }
 951
 952 /* this makes sure that gpio_init is called during kernel boot */
 953
 954 module_init(gpio_init);