release/src-rt-6.x/linux/linux-2.6/drivers/char/snsc.c

   1 /*
   2  * SN Platform system controller communication support
   3  *
   4  * This file is subject to the terms and conditions of the GNU General Public
   5  * License.  See the file "COPYING" in the main directory of this archive
   6  * for more details.
   7  *
   8  * Copyright (C) 2004, 2006 Silicon Graphics, Inc. All rights reserved.
   9  */
  10
  11 /*
  12  * System controller communication driver
  13  *
  14  * This driver allows a user process to communicate with the system
  15  * controller (a.k.a. "IRouter") network in an SGI SN system.
  16  */
  17
  18 #include <linux/interrupt.h>
  19 #include <linux/sched.h>
  20 #include <linux/device.h>
  21 #include <linux/poll.h>
  22 #include <linux/module.h>
  23 #include <linux/slab.h>
  24 #include <asm/sn/io.h>
  25 #include <asm/sn/sn_sal.h>
  26 #include <asm/sn/module.h>
  27 #include <asm/sn/geo.h>
  28 #include <asm/sn/nodepda.h>
  29 #include "snsc.h"
  30
  31 #define SYSCTL_BASENAME "snsc"
  32
  33 #define SCDRV_BUFSZ     2048
  34 #define SCDRV_TIMEOUT   1000
  35
  36 static irqreturn_t
  37 scdrv_interrupt(int irq, void *subch_data)
  38 {
  39         struct subch_data_s *sd = subch_data;
  40         unsigned long flags;
  41         int status;
  42
  43         spin_lock_irqsave(&sd->sd_rlock, flags);
  44         spin_lock(&sd->sd_wlock);
  45         status = ia64_sn_irtr_intr(sd->sd_nasid, sd->sd_subch);
  46
  47         if (status > 0) {
  48                 if (status & SAL_IROUTER_INTR_RECV) {
  49                         wake_up(&sd->sd_rq);
  50                 }
  51                 if (status & SAL_IROUTER_INTR_XMIT) {
  52                         ia64_sn_irtr_intr_disable
  53                             (sd->sd_nasid, sd->sd_subch,
  54                              SAL_IROUTER_INTR_XMIT);
  55                         wake_up(&sd->sd_wq);
  56                 }
  57         }
  58         spin_unlock(&sd->sd_wlock);
  59         spin_unlock_irqrestore(&sd->sd_rlock, flags);
  60         return IRQ_HANDLED;
  61 }
  62
  63 /*
  64  * scdrv_open
  65  *
  66  * Reserve a subchannel for system controller communication.
  67  */
  68
  69 static int
  70 scdrv_open(struct inode *inode, struct file *file)
  71 {
  72         struct sysctl_data_s *scd;
  73         struct subch_data_s *sd;
  74         int rv;
  75
  76         /* look up device info for this device file */
  77         scd = container_of(inode->i_cdev, struct sysctl_data_s, scd_cdev);
  78
  79         /* allocate memory for subchannel data */
  80         sd = kzalloc(sizeof (struct subch_data_s), GFP_KERNEL);
  81         if (sd == NULL) {
  82                 printk("%s: couldn't allocate subchannel data\n",
  83                        __FUNCTION__);
  84                 return -ENOMEM;
  85         }
  86
  87         /* initialize subch_data_s fields */
  88         sd->sd_nasid = scd->scd_nasid;
  89         sd->sd_subch = ia64_sn_irtr_open(scd->scd_nasid);
  90
  91         if (sd->sd_subch < 0) {
  92                 kfree(sd);
  93                 printk("%s: couldn't allocate subchannel\n", __FUNCTION__);
  94                 return -EBUSY;
  95         }
  96
  97         spin_lock_init(&sd->sd_rlock);
  98         spin_lock_init(&sd->sd_wlock);
  99         init_waitqueue_head(&sd->sd_rq);
 100         init_waitqueue_head(&sd->sd_wq);
 101         sema_init(&sd->sd_rbs, 1);
 102         sema_init(&sd->sd_wbs, 1);
 103
 104         file->private_data = sd;
 105
 106         /* hook this subchannel up to the system controller interrupt */
 107         rv = request_irq(SGI_UART_VECTOR, scdrv_interrupt,
 108                          IRQF_SHARED | IRQF_DISABLED,
 109                          SYSCTL_BASENAME, sd);
 110         if (rv) {
 111                 ia64_sn_irtr_close(sd->sd_nasid, sd->sd_subch);
 112                 kfree(sd);
 113                 printk("%s: irq request failed (%d)\n", __FUNCTION__, rv);
 114                 return -EBUSY;
 115         }
 116
 117         return 0;
 118 }
 119
 120 /*
 121  * scdrv_release
 122  *
 123  * Release a previously-reserved subchannel.
 124  */
 125
 126 static int
 127 scdrv_release(struct inode *inode, struct file *file)
 128 {
 129         struct subch_data_s *sd = (struct subch_data_s *) file->private_data;
 130         int rv;
 131
 132         /* free the interrupt */
 133         free_irq(SGI_UART_VECTOR, sd);
 134
 135         /* ask SAL to close the subchannel */
 136         rv = ia64_sn_irtr_close(sd->sd_nasid, sd->sd_subch);
 137
 138         kfree(sd);
 139         return rv;
 140 }
 141
 142 /*
 143  * scdrv_read
 144  *
 145  * Called to read bytes from the open IRouter pipe.
 146  *
 147  */
 148
 149 static inline int
 150 read_status_check(struct subch_data_s *sd, int *len)
 151 {
 152         return ia64_sn_irtr_recv(sd->sd_nasid, sd->sd_subch, sd->sd_rb, len);
 153 }
 154
 155 static ssize_t
 156 scdrv_read(struct file *file, char __user *buf, size_t count, loff_t *f_pos)
 157 {
 158         int status;
 159         int len;
 160         unsigned long flags;
 161         struct subch_data_s *sd = (struct subch_data_s *) file->private_data;
 162
 163         /* try to get control of the read buffer */
 164         if (down_trylock(&sd->sd_rbs)) {
 165                 /* somebody else has it now;
 166                  * if we're non-blocking, then exit...
 167                  */
 168                 if (file->f_flags & O_NONBLOCK) {
 169                         return -EAGAIN;
 170                 }
 171                 /* ...or if we want to block, then do so here */
 172                 if (down_interruptible(&sd->sd_rbs)) {
 173                         /* something went wrong with wait */
 174                         return -ERESTARTSYS;
 175                 }
 176         }
 177
 178         /* anything to read? */
 179         len = CHUNKSIZE;
 180         spin_lock_irqsave(&sd->sd_rlock, flags);
 181         status = read_status_check(sd, &len);
 182
 183         /* if not, and we're blocking I/O, loop */
 184         while (status < 0) {
 185                 DECLARE_WAITQUEUE(wait, current);
 186
 187                 if (file->f_flags & O_NONBLOCK) {
 188                         spin_unlock_irqrestore(&sd->sd_rlock, flags);
 189                         up(&sd->sd_rbs);
 190                         return -EAGAIN;
 191                 }
 192
 193                 len = CHUNKSIZE;
 194                 set_current_state(TASK_INTERRUPTIBLE);
 195                 add_wait_queue(&sd->sd_rq, &wait);
 196                 spin_unlock_irqrestore(&sd->sd_rlock, flags);
 197
 198                 schedule_timeout(SCDRV_TIMEOUT);
 199
 200                 remove_wait_queue(&sd->sd_rq, &wait);
 201                 if (signal_pending(current)) {
 202                         /* wait was interrupted */
 203                         up(&sd->sd_rbs);
 204                         return -ERESTARTSYS;
 205                 }
 206
 207                 spin_lock_irqsave(&sd->sd_rlock, flags);
 208                 status = read_status_check(sd, &len);
 209         }
 210         spin_unlock_irqrestore(&sd->sd_rlock, flags);
 211
 212         if (len > 0) {
 213                 /* we read something in the last read_status_check(); copy
 214                  * it out to user space
 215                  */
 216                 if (count < len) {
 217                         pr_debug("%s: only accepting %d of %d bytes\n",
 218                                  __FUNCTION__, (int) count, len);
 219                 }
 220                 len = min((int) count, len);
 221                 if (copy_to_user(buf, sd->sd_rb, len))
 222                         len = -EFAULT;
 223         }
 224
 225         /* release the read buffer and wake anyone who might be
 226          * waiting for it
 227          */
 228         up(&sd->sd_rbs);
 229
 230         /* return the number of characters read in */
 231         return len;
 232 }
 233
 234 /*
 235  * scdrv_write
 236  *
 237  * Writes a chunk of an IRouter packet (or other system controller data)
 238  * to the system controller.
 239  *
 240  */
 241 static inline int
 242 write_status_check(struct subch_data_s *sd, int count)
 243 {
 244         return ia64_sn_irtr_send(sd->sd_nasid, sd->sd_subch, sd->sd_wb, count);
 245 }
 246
 247 static ssize_t
 248 scdrv_write(struct file *file, const char __user *buf,
 249             size_t count, loff_t *f_pos)
 250 {
 251         unsigned long flags;
 252         int status;
 253         struct subch_data_s *sd = (struct subch_data_s *) file->private_data;
 254
 255         /* try to get control of the write buffer */
 256         if (down_trylock(&sd->sd_wbs)) {
 257                 /* somebody else has it now;
 258                  * if we're non-blocking, then exit...
 259                  */
 260                 if (file->f_flags & O_NONBLOCK) {
 261                         return -EAGAIN;
 262                 }
 263                 /* ...or if we want to block, then do so here */
 264                 if (down_interruptible(&sd->sd_wbs)) {
 265                         /* something went wrong with wait */
 266                         return -ERESTARTSYS;
 267                 }
 268         }
 269
 270         count = min((int) count, CHUNKSIZE);
 271         if (copy_from_user(sd->sd_wb, buf, count)) {
 272                 up(&sd->sd_wbs);
 273                 return -EFAULT;
 274         }
 275
 276         /* try to send the buffer */
 277         spin_lock_irqsave(&sd->sd_wlock, flags);
 278         status = write_status_check(sd, count);
 279
 280         /* if we failed, and we want to block, then loop */
 281         while (status <= 0) {
 282                 DECLARE_WAITQUEUE(wait, current);
 283
 284                 if (file->f_flags & O_NONBLOCK) {
 285                         spin_unlock(&sd->sd_wlock);
 286                         up(&sd->sd_wbs);
 287                         return -EAGAIN;
 288                 }
 289
 290                 set_current_state(TASK_INTERRUPTIBLE);
 291                 add_wait_queue(&sd->sd_wq, &wait);
 292                 spin_unlock_irqrestore(&sd->sd_wlock, flags);
 293
 294                 schedule_timeout(SCDRV_TIMEOUT);
 295
 296                 remove_wait_queue(&sd->sd_wq, &wait);
 297                 if (signal_pending(current)) {
 298                         /* wait was interrupted */
 299                         up(&sd->sd_wbs);
 300                         return -ERESTARTSYS;
 301                 }
 302
 303                 spin_lock_irqsave(&sd->sd_wlock, flags);
 304                 status = write_status_check(sd, count);
 305         }
 306         spin_unlock_irqrestore(&sd->sd_wlock, flags);
 307
 308         /* release the write buffer and wake anyone who's waiting for it */
 309         up(&sd->sd_wbs);
 310
 311         /* return the number of characters accepted (should be the complete
 312          * "chunk" as requested)
 313          */
 314         if ((status >= 0) && (status < count)) {
 315                 pr_debug("Didn't accept the full chunk; %d of %d\n",
 316                          status, (int) count);
 317         }
 318         return status;
 319 }
 320
 321 static unsigned int
 322 scdrv_poll(struct file *file, struct poll_table_struct *wait)
 323 {
 324         unsigned int mask = 0;
 325         int status = 0;
 326         struct subch_data_s *sd = (struct subch_data_s *) file->private_data;
 327         unsigned long flags;
 328
 329         poll_wait(file, &sd->sd_rq, wait);
 330         poll_wait(file, &sd->sd_wq, wait);
 331
 332         spin_lock_irqsave(&sd->sd_rlock, flags);
 333         spin_lock(&sd->sd_wlock);
 334         status = ia64_sn_irtr_intr(sd->sd_nasid, sd->sd_subch);
 335         spin_unlock(&sd->sd_wlock);
 336         spin_unlock_irqrestore(&sd->sd_rlock, flags);
 337
 338         if (status > 0) {
 339                 if (status & SAL_IROUTER_INTR_RECV) {
 340                         mask |= POLLIN | POLLRDNORM;
 341                 }
 342                 if (status & SAL_IROUTER_INTR_XMIT) {
 343                         mask |= POLLOUT | POLLWRNORM;
 344                 }
 345         }
 346
 347         return mask;
 348 }
 349
 350 static const struct file_operations scdrv_fops = {
 351         .owner =        THIS_MODULE,
 352         .read =         scdrv_read,
 353         .write =        scdrv_write,
 354         .poll =         scdrv_poll,
 355         .open =         scdrv_open,
 356         .release =      scdrv_release,
 357 };
 358
 359 static struct class *snsc_class;
 360
 361 /*
 362  * scdrv_init
 363  *
 364  * Called at boot time to initialize the system controller communication
 365  * facility.
 366  */
 367 int __init
 368 scdrv_init(void)
 369 {
 370         geoid_t geoid;
 371         cnodeid_t cnode;
 372         char devname[32];
 373         char *devnamep;
 374         struct sysctl_data_s *scd;
 375         void *salbuf;
 376         dev_t first_dev, dev;
 377         nasid_t event_nasid;
 378
 379         if (!ia64_platform_is("sn2"))
 380                 return -ENODEV;
 381
 382         event_nasid = ia64_sn_get_console_nasid();
 383
 384         if (alloc_chrdev_region(&first_dev, 0, num_cnodes,
 385                                 SYSCTL_BASENAME) < 0) {
 386                 printk("%s: failed to register SN system controller device\n",
 387                        __FUNCTION__);
 388                 return -ENODEV;
 389         }
 390         snsc_class = class_create(THIS_MODULE, SYSCTL_BASENAME);
 391
 392         for (cnode = 0; cnode < num_cnodes; cnode++) {
 393                         geoid = cnodeid_get_geoid(cnode);
 394                         devnamep = devname;
 395                         format_module_id(devnamep, geo_module(geoid),
 396                                          MODULE_FORMAT_BRIEF);
 397                         devnamep = devname + strlen(devname);
 398                         sprintf(devnamep, "^%d#%d", geo_slot(geoid),
 399                                 geo_slab(geoid));
 400
 401                         /* allocate sysctl device data */
 402                         scd = kzalloc(sizeof (struct sysctl_data_s),
 403                                       GFP_KERNEL);
 404                         if (!scd) {
 405                                 printk("%s: failed to allocate device info"
 406                                        "for %s/%s\n", __FUNCTION__,
 407                                        SYSCTL_BASENAME, devname);
 408                                 continue;
 409                         }
 410
 411                         /* initialize sysctl device data fields */
 412                         scd->scd_nasid = cnodeid_to_nasid(cnode);
 413                         if (!(salbuf = kmalloc(SCDRV_BUFSZ, GFP_KERNEL))) {
 414                                 printk("%s: failed to allocate driver buffer"
 415                                        "(%s%s)\n", __FUNCTION__,
 416                                        SYSCTL_BASENAME, devname);
 417                                 kfree(scd);
 418                                 continue;
 419                         }
 420
 421                         if (ia64_sn_irtr_init(scd->scd_nasid, salbuf,
 422                                               SCDRV_BUFSZ) < 0) {
 423                                 printk
 424                                     ("%s: failed to initialize SAL for"
 425                                      " system controller communication"
 426                                      " (%s/%s): outdated PROM?\n",
 427                                      __FUNCTION__, SYSCTL_BASENAME, devname);
 428                                 kfree(scd);
 429                                 kfree(salbuf);
 430                                 continue;
 431                         }
 432
 433                         dev = first_dev + cnode;
 434                         cdev_init(&scd->scd_cdev, &scdrv_fops);
 435                         if (cdev_add(&scd->scd_cdev, dev, 1)) {
 436                                 printk("%s: failed to register system"
 437                                        " controller device (%s%s)\n",
 438                                        __FUNCTION__, SYSCTL_BASENAME, devname);
 439                                 kfree(scd);
 440                                 kfree(salbuf);
 441                                 continue;
 442                         }
 443
 444                         class_device_create(snsc_class, NULL, dev, NULL,
 445                                                 "%s", devname);
 446
 447                         ia64_sn_irtr_intr_enable(scd->scd_nasid,
 448                                                  0 /*ignored */ ,
 449                                                  SAL_IROUTER_INTR_RECV);
 450
 451                         /* on the console nasid, prepare to receive
 452                          * system controller environmental events
 453                          */
 454                         if(scd->scd_nasid == event_nasid) {
 455                                 scdrv_event_init(scd);
 456                         }
 457         }
 458         return 0;
 459 }
 460
 461 module_init(scdrv_init);