git.oblomov.eu Git - linux-2.6/blob - drivers/macintosh/adb.c

   1 /*
   2  * Device driver for the Apple Desktop Bus
   3  * and the /dev/adb device on macintoshes.
   4  *
   5  * Copyright (C) 1996 Paul Mackerras.
   6  *
   7  * Modified to declare controllers as structures, added
   8  * client notification of bus reset and handles PowerBook
   9  * sleep, by Benjamin Herrenschmidt.
  10  *
  11  * To do:
  12  *
  13  * - /sys/bus/adb to list the devices and infos
  14  * - more /dev/adb to allow userland to receive the
  15  *   flow of auto-polling datas from a given device.
  16  * - move bus probe to a kernel thread
  17  */
  18
  19 #include <linux/config.h>
  20 #include <linux/types.h>
  21 #include <linux/errno.h>
  22 #include <linux/kernel.h>
  23 #include <linux/slab.h>
  24 #include <linux/module.h>
  25 #include <linux/fs.h>
  26 #include <linux/mm.h>
  27 #include <linux/sched.h>
  28 #include <linux/smp_lock.h>
  29 #include <linux/adb.h>
  30 #include <linux/cuda.h>
  31 #include <linux/pmu.h>
  32 #include <linux/notifier.h>
  33 #include <linux/wait.h>
  34 #include <linux/init.h>
  35 #include <linux/delay.h>
  36 #include <linux/spinlock.h>
  37 #include <linux/completion.h>
  38 #include <linux/device.h>
  39 #include <linux/devfs_fs_kernel.h>
  40
  41 #include <asm/uaccess.h>
  42 #include <asm/semaphore.h>
  43 #ifdef CONFIG_PPC
  44 #include <asm/prom.h>
  45 #endif
  46
  47
  48 EXPORT_SYMBOL(adb_controller);
  49 EXPORT_SYMBOL(adb_client_list);
  50
  51 extern struct adb_driver via_macii_driver;
  52 extern struct adb_driver via_maciisi_driver;
  53 extern struct adb_driver via_cuda_driver;
  54 extern struct adb_driver adb_iop_driver;
  55 extern struct adb_driver via_pmu_driver;
  56 extern struct adb_driver macio_adb_driver;
  57
  58 static struct adb_driver *adb_driver_list[] = {
  59 #ifdef CONFIG_ADB_MACII
  60         &via_macii_driver,
  61 #endif
  62 #ifdef CONFIG_ADB_MACIISI
  63         &via_maciisi_driver,
  64 #endif
  65 #ifdef CONFIG_ADB_CUDA
  66         &via_cuda_driver,
  67 #endif
  68 #ifdef CONFIG_ADB_IOP
  69         &adb_iop_driver,
  70 #endif
  71 #if defined(CONFIG_ADB_PMU) || defined(CONFIG_ADB_PMU68K)
  72         &via_pmu_driver,
  73 #endif
  74 #ifdef CONFIG_ADB_MACIO
  75         &macio_adb_driver,
  76 #endif
  77         NULL
  78 };
  79
  80 static struct class_simple *adb_dev_class;
  81
  82 struct adb_driver *adb_controller;
  83 struct notifier_block *adb_client_list = NULL;
  84 static int adb_got_sleep;
  85 static int adb_inited;
  86 static pid_t adb_probe_task_pid;
  87 static DECLARE_MUTEX(adb_probe_mutex);
  88 static struct completion adb_probe_task_comp;
  89 static int sleepy_trackpad;
  90 static int autopoll_devs;
  91 int __adb_probe_sync;
  92
  93 #ifdef CONFIG_PMAC_PBOOK
  94 static int adb_notify_sleep(struct pmu_sleep_notifier *self, int when);
  95 static struct pmu_sleep_notifier adb_sleep_notifier = {
  96         adb_notify_sleep,
  97         SLEEP_LEVEL_ADB,
  98 };
  99 #endif
 100
 101 static int adb_scan_bus(void);
 102 static int do_adb_reset_bus(void);
 103 static void adbdev_init(void);
 104 static int try_handler_change(int, int);
 105
 106 static struct adb_handler {
 107         void (*handler)(unsigned char *, int, struct pt_regs *, int);
 108         int original_address;
 109         int handler_id;
 110         int busy;
 111 } adb_handler[16];
 112
 113 /*
 114  * The adb_handler_sem mutex protects all accesses to the original_address
 115  * and handler_id fields of adb_handler[i] for all i, and changes to the
 116  * handler field.
 117  * Accesses to the handler field are protected by the adb_handler_lock
 118  * rwlock.  It is held across all calls to any handler, so that by the
 119  * time adb_unregister returns, we know that the old handler isn't being
 120  * called.
 121  */
 122 static DECLARE_MUTEX(adb_handler_sem);
 123 static DEFINE_RWLOCK(adb_handler_lock);
 124
 125 #if 0
 126 static void printADBreply(struct adb_request *req)
 127 {
 128         int i;
 129
 130         printk("adb reply (%d)", req->reply_len);
 131         for(i = 0; i < req->reply_len; i++)
 132                 printk(" %x", req->reply[i]);
 133         printk("\n");
 134
 135 }
 136 #endif
 137
 138
 139 static __inline__ void adb_wait_ms(unsigned int ms)
 140 {
 141         if (current->pid && adb_probe_task_pid &&
 142           adb_probe_task_pid == current->pid)
 143                 msleep(ms);
 144         else
 145                 mdelay(ms);
 146 }
 147
 148 static int adb_scan_bus(void)
 149 {
 150         int i, highFree=0, noMovement;
 151         int devmask = 0;
 152         struct adb_request req;
 153
 154         /* assumes adb_handler[] is all zeroes at this point */
 155         for (i = 1; i < 16; i++) {
 156                 /* see if there is anything at address i */
 157                 adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
 158                             (i << 4) | 0xf);
 159                 if (req.reply_len > 1)
 160                         /* one or more devices at this address */
 161                         adb_handler[i].original_address = i;
 162                 else if (i > highFree)
 163                         highFree = i;
 164         }
 165
 166         /* Note we reset noMovement to 0 each time we move a device */
 167         for (noMovement = 1; noMovement < 2 && highFree > 0; noMovement++) {
 168                 for (i = 1; i < 16; i++) {
 169                         if (adb_handler[i].original_address == 0)
 170                                 continue;
 171                         /*
 172                          * Send a "talk register 3" command to address i
 173                          * to provoke a collision if there is more than
 174                          * one device at this address.
 175                          */
 176                         adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
 177                                     (i << 4) | 0xf);
 178                         /*
 179                          * Move the device(s) which didn't detect a
 180                          * collision to address `highFree'.  Hopefully
 181                          * this only moves one device.
 182                          */
 183                         adb_request(&req, NULL, ADBREQ_SYNC, 3,
 184                                     (i<< 4) | 0xb, (highFree | 0x60), 0xfe);
 185                         /*
 186                          * See if anybody actually moved. This is suggested
 187                          * by HW TechNote 01:
 188                          *
 189                          * http://developer.apple.com/technotes/hw/hw_01.html
 190                          */
 191                         adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
 192                                     (highFree << 4) | 0xf);
 193                         if (req.reply_len <= 1) continue;
 194                         /*
 195                          * Test whether there are any device(s) left
 196                          * at address i.
 197                          */
 198                         adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
 199                                     (i << 4) | 0xf);
 200                         if (req.reply_len > 1) {
 201                                 /*
 202                                  * There are still one or more devices
 203                                  * left at address i.  Register the one(s)
 204                                  * we moved to `highFree', and find a new
 205                                  * value for highFree.
 206                                  */
 207                                 adb_handler[highFree].original_address =
 208                                         adb_handler[i].original_address;
 209                                 while (highFree > 0 &&
 210                                        adb_handler[highFree].original_address)
 211                                         highFree--;
 212                                 if (highFree <= 0)
 213                                         break;
 214
 215                                 noMovement = 0;
 216                         }
 217                         else {
 218                                 /*
 219                                  * No devices left at address i; move the
 220                                  * one(s) we moved to `highFree' back to i.
 221                                  */
 222                                 adb_request(&req, NULL, ADBREQ_SYNC, 3,
 223                                             (highFree << 4) | 0xb,
 224                                             (i | 0x60), 0xfe);
 225                         }
 226                 }
 227         }
 228
 229         /* Now fill in the handler_id field of the adb_handler entries. */
 230         printk(KERN_DEBUG "adb devices:");
 231         for (i = 1; i < 16; i++) {
 232                 if (adb_handler[i].original_address == 0)
 233                         continue;
 234                 adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
 235                             (i << 4) | 0xf);
 236                 adb_handler[i].handler_id = req.reply[2];
 237                 printk(" [%d]: %d %x", i, adb_handler[i].original_address,
 238                        adb_handler[i].handler_id);
 239                 devmask |= 1 << i;
 240         }
 241         printk("\n");
 242         return devmask;
 243 }
 244
 245 /*
 246  * This kernel task handles ADB probing. It dies once probing is
 247  * completed.
 248  */
 249 static int
 250 adb_probe_task(void *x)
 251 {
 252         sigset_t blocked;
 253
 254         strcpy(current->comm, "kadbprobe");
 255
 256         sigfillset(&blocked);
 257         sigprocmask(SIG_BLOCK, &blocked, NULL);
 258         flush_signals(current);
 259
 260         printk(KERN_INFO "adb: starting probe task...\n");
 261         do_adb_reset_bus();
 262         printk(KERN_INFO "adb: finished probe task...\n");
 263
 264         adb_probe_task_pid = 0;
 265         up(&adb_probe_mutex);
 266
 267         return 0;
 268 }
 269
 270 static void
 271 __adb_probe_task(void *data)
 272 {
 273         adb_probe_task_pid = kernel_thread(adb_probe_task, NULL, SIGCHLD | CLONE_KERNEL);
 274 }
 275
 276 static DECLARE_WORK(adb_reset_work, __adb_probe_task, NULL);
 277
 278 int
 279 adb_reset_bus(void)
 280 {
 281         if (__adb_probe_sync) {
 282                 do_adb_reset_bus();
 283                 return 0;
 284         }
 285
 286         down(&adb_probe_mutex);
 287         schedule_work(&adb_reset_work);
 288         return 0;
 289 }
 290
 291 int __init adb_init(void)
 292 {
 293         struct adb_driver *driver;
 294         int i;
 295
 296 #ifdef CONFIG_PPC32
 297         if ( (_machine != _MACH_chrp) && (_machine != _MACH_Pmac) )
 298                 return 0;
 299 #endif
 300 #ifdef CONFIG_MAC
 301         if (!MACH_IS_MAC)
 302                 return 0;
 303 #endif
 304
 305         /* xmon may do early-init */
 306         if (adb_inited)
 307                 return 0;
 308         adb_inited = 1;
 309
 310         adb_controller = NULL;
 311
 312         i = 0;
 313         while ((driver = adb_driver_list[i++]) != NULL) {
 314                 if (!driver->probe()) {
 315                         adb_controller = driver;
 316                         break;
 317                 }
 318         }
 319         if ((adb_controller == NULL) || adb_controller->init()) {
 320                 printk(KERN_WARNING "Warning: no ADB interface detected\n");
 321                 adb_controller = NULL;
 322         } else {
 323 #ifdef CONFIG_PMAC_PBOOK
 324                 pmu_register_sleep_notifier(&adb_sleep_notifier);
 325 #endif /* CONFIG_PMAC_PBOOK */
 326 #ifdef CONFIG_PPC
 327                 if (machine_is_compatible("AAPL,PowerBook1998") ||
 328                         machine_is_compatible("PowerBook1,1"))
 329                         sleepy_trackpad = 1;
 330 #endif /* CONFIG_PPC */
 331                 init_completion(&adb_probe_task_comp);
 332                 adbdev_init();
 333                 adb_reset_bus();
 334         }
 335         return 0;
 336 }
 337
 338 __initcall(adb_init);
 339
 340 #ifdef CONFIG_PMAC_PBOOK
 341 /*
 342  * notify clients before sleep and reset bus afterwards
 343  */
 344 int
 345 adb_notify_sleep(struct pmu_sleep_notifier *self, int when)
 346 {
 347         int ret;
 348
 349         switch (when) {
 350         case PBOOK_SLEEP_REQUEST:
 351                 adb_got_sleep = 1;
 352                 /* We need to get a lock on the probe thread */
 353                 down(&adb_probe_mutex);
 354                 /* Stop autopoll */
 355                 if (adb_controller->autopoll)
 356                         adb_controller->autopoll(0);
 357                 ret = notifier_call_chain(&adb_client_list, ADB_MSG_POWERDOWN, NULL);
 358                 if (ret & NOTIFY_STOP_MASK) {
 359                         up(&adb_probe_mutex);
 360                         return PBOOK_SLEEP_REFUSE;
 361                 }
 362                 break;
 363         case PBOOK_SLEEP_REJECT:
 364                 if (adb_got_sleep) {
 365                         adb_got_sleep = 0;
 366                         up(&adb_probe_mutex);
 367                         adb_reset_bus();
 368                 }
 369                 break;
 370
 371         case PBOOK_SLEEP_NOW:
 372                 break;
 373         case PBOOK_WAKE:
 374                 adb_got_sleep = 0;
 375                 up(&adb_probe_mutex);
 376                 adb_reset_bus();
 377                 break;
 378         }
 379         return PBOOK_SLEEP_OK;
 380 }
 381 #endif /* CONFIG_PMAC_PBOOK */
 382
 383 static int
 384 do_adb_reset_bus(void)
 385 {
 386         int ret, nret;
 387
 388         if (adb_controller == NULL)
 389                 return -ENXIO;
 390
 391         if (adb_controller->autopoll)
 392                 adb_controller->autopoll(0);
 393
 394         nret = notifier_call_chain(&adb_client_list, ADB_MSG_PRE_RESET, NULL);
 395         if (nret & NOTIFY_STOP_MASK) {
 396                 if (adb_controller->autopoll)
 397                         adb_controller->autopoll(autopoll_devs);
 398                 return -EBUSY;
 399         }
 400
 401         if (sleepy_trackpad) {
 402                 /* Let the trackpad settle down */
 403                 adb_wait_ms(500);
 404         }
 405
 406         down(&adb_handler_sem);
 407         write_lock_irq(&adb_handler_lock);
 408         memset(adb_handler, 0, sizeof(adb_handler));
 409         write_unlock_irq(&adb_handler_lock);
 410
 411         /* That one is still a bit synchronous, oh well... */
 412         if (adb_controller->reset_bus)
 413                 ret = adb_controller->reset_bus();
 414         else
 415                 ret = 0;
 416
 417         if (sleepy_trackpad) {
 418                 /* Let the trackpad settle down */
 419                 adb_wait_ms(1500);
 420         }
 421
 422         if (!ret) {
 423                 autopoll_devs = adb_scan_bus();
 424                 if (adb_controller->autopoll)
 425                         adb_controller->autopoll(autopoll_devs);
 426         }
 427         up(&adb_handler_sem);
 428
 429         nret = notifier_call_chain(&adb_client_list, ADB_MSG_POST_RESET, NULL);
 430         if (nret & NOTIFY_STOP_MASK)
 431                 return -EBUSY;
 432
 433         return ret;
 434 }
 435
 436 void
 437 adb_poll(void)
 438 {
 439         if ((adb_controller == NULL)||(adb_controller->poll == NULL))
 440                 return;
 441         adb_controller->poll();
 442 }
 443
 444 static void
 445 adb_probe_wakeup(struct adb_request *req)
 446 {
 447         complete(&adb_probe_task_comp);
 448 }
 449
 450 /* Static request used during probe */
 451 static struct adb_request adb_sreq;
 452 static unsigned long adb_sreq_lock; // Use semaphore ! */
 453
 454 int
 455 adb_request(struct adb_request *req, void (*done)(struct adb_request *),
 456             int flags, int nbytes, ...)
 457 {
 458         va_list list;
 459         int i, use_sreq;
 460         int rc;
 461
 462         if ((adb_controller == NULL) || (adb_controller->send_request == NULL))
 463                 return -ENXIO;
 464         if (nbytes < 1)
 465                 return -EINVAL;
 466         if (req == NULL && (flags & ADBREQ_NOSEND))
 467                 return -EINVAL;
 468
 469         if (req == NULL) {
 470                 if (test_and_set_bit(0,&adb_sreq_lock)) {
 471                         printk("adb.c: Warning: contention on static request !\n");
 472                         return -EPERM;
 473                 }
 474                 req = &adb_sreq;
 475                 flags |= ADBREQ_SYNC;
 476                 use_sreq = 1;
 477         } else
 478                 use_sreq = 0;
 479         req->nbytes = nbytes+1;
 480         req->done = done;
 481         req->reply_expected = flags & ADBREQ_REPLY;
 482         req->data[0] = ADB_PACKET;
 483         va_start(list, nbytes);
 484         for (i = 0; i < nbytes; ++i)
 485                 req->data[i+1] = va_arg(list, int);
 486         va_end(list);
 487
 488         if (flags & ADBREQ_NOSEND)
 489                 return 0;
 490
 491         /* Synchronous requests send from the probe thread cause it to
 492          * block. Beware that the "done" callback will be overriden !
 493          */
 494         if ((flags & ADBREQ_SYNC) &&
 495             (current->pid && adb_probe_task_pid &&
 496             adb_probe_task_pid == current->pid)) {
 497                 req->done = adb_probe_wakeup;
 498                 rc = adb_controller->send_request(req, 0);
 499                 if (rc || req->complete)
 500                         goto bail;
 501                 wait_for_completion(&adb_probe_task_comp);
 502                 rc = 0;
 503                 goto bail;
 504         }
 505
 506         rc = adb_controller->send_request(req, flags & ADBREQ_SYNC);
 507 bail:
 508         if (use_sreq)
 509                 clear_bit(0, &adb_sreq_lock);
 510
 511         return rc;
 512 }
 513
 514  /* Ultimately this should return the number of devices with
 515     the given default id.
 516     And it does it now ! Note: changed behaviour: This function
 517     will now register if default_id _and_ handler_id both match
 518     but handler_id can be left to 0 to match with default_id only.
 519     When handler_id is set, this function will try to adjust
 520     the handler_id id it doesn't match. */
 521 int
 522 adb_register(int default_id, int handler_id, struct adb_ids *ids,
 523              void (*handler)(unsigned char *, int, struct pt_regs *, int))
 524 {
 525         int i;
 526
 527         down(&adb_handler_sem);
 528         ids->nids = 0;
 529         for (i = 1; i < 16; i++) {
 530                 if ((adb_handler[i].original_address == default_id) &&
 531                     (!handler_id || (handler_id == adb_handler[i].handler_id) ||
 532                     try_handler_change(i, handler_id))) {
 533                         if (adb_handler[i].handler != 0) {
 534                                 printk(KERN_ERR
 535                                        "Two handlers for ADB device %d\n",
 536                                        default_id);
 537                                 continue;
 538                         }
 539                         write_lock_irq(&adb_handler_lock);
 540                         adb_handler[i].handler = handler;
 541                         write_unlock_irq(&adb_handler_lock);
 542                         ids->id[ids->nids++] = i;
 543                 }
 544         }
 545         up(&adb_handler_sem);
 546         return ids->nids;
 547 }
 548
 549 int
 550 adb_unregister(int index)
 551 {
 552         int ret = -ENODEV;
 553
 554         down(&adb_handler_sem);
 555         write_lock_irq(&adb_handler_lock);
 556         if (adb_handler[index].handler) {
 557                 while(adb_handler[index].busy) {
 558                         write_unlock_irq(&adb_handler_lock);
 559                         yield();
 560                         write_lock_irq(&adb_handler_lock);
 561                 }
 562                 ret = 0;
 563                 adb_handler[index].handler = NULL;
 564         }
 565         write_unlock_irq(&adb_handler_lock);
 566         up(&adb_handler_sem);
 567         return ret;
 568 }
 569
 570 void
 571 adb_input(unsigned char *buf, int nb, struct pt_regs *regs, int autopoll)
 572 {
 573         int i, id;
 574         static int dump_adb_input = 0;
 575         unsigned long flags;
 576
 577         void (*handler)(unsigned char *, int, struct pt_regs *, int);
 578
 579         /* We skip keystrokes and mouse moves when the sleep process
 580          * has been started. We stop autopoll, but this is another security
 581          */
 582         if (adb_got_sleep)
 583                 return;
 584
 585         id = buf[0] >> 4;
 586         if (dump_adb_input) {
 587                 printk(KERN_INFO "adb packet: ");
 588                 for (i = 0; i < nb; ++i)
 589                         printk(" %x", buf[i]);
 590                 printk(", id = %d\n", id);
 591         }
 592         write_lock_irqsave(&adb_handler_lock, flags);
 593         handler = adb_handler[id].handler;
 594         if (handler != NULL)
 595                 adb_handler[id].busy = 1;
 596         write_unlock_irqrestore(&adb_handler_lock, flags);
 597         if (handler != NULL) {
 598                 (*handler)(buf, nb, regs, autopoll);
 599                 wmb();
 600                 adb_handler[id].busy = 0;
 601         }
 602
 603 }
 604
 605 /* Try to change handler to new_id. Will return 1 if successful. */
 606 static int try_handler_change(int address, int new_id)
 607 {
 608         struct adb_request req;
 609
 610         if (adb_handler[address].handler_id == new_id)
 611             return 1;
 612         adb_request(&req, NULL, ADBREQ_SYNC, 3,
 613             ADB_WRITEREG(address, 3), address | 0x20, new_id);
 614         adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
 615             ADB_READREG(address, 3));
 616         if (req.reply_len < 2)
 617             return 0;
 618         if (req.reply[2] != new_id)
 619             return 0;
 620         adb_handler[address].handler_id = req.reply[2];
 621
 622         return 1;
 623 }
 624
 625 int
 626 adb_try_handler_change(int address, int new_id)
 627 {
 628         int ret;
 629
 630         down(&adb_handler_sem);
 631         ret = try_handler_change(address, new_id);
 632         up(&adb_handler_sem);
 633         return ret;
 634 }
 635
 636 int
 637 adb_get_infos(int address, int *original_address, int *handler_id)
 638 {
 639         down(&adb_handler_sem);
 640         *original_address = adb_handler[address].original_address;
 641         *handler_id = adb_handler[address].handler_id;
 642         up(&adb_handler_sem);
 643
 644         return (*original_address != 0);
 645 }
 646
 647
 648 /*
 649  * /dev/adb device driver.
 650  */
 651
 652 #define ADB_MAJOR       56      /* major number for /dev/adb */
 653
 654 struct adbdev_state {
 655         spinlock_t      lock;
 656         atomic_t        n_pending;
 657         struct adb_request *completed;
 658         wait_queue_head_t wait_queue;
 659         int             inuse;
 660 };
 661
 662 static void adb_write_done(struct adb_request *req)
 663 {
 664         struct adbdev_state *state = (struct adbdev_state *) req->arg;
 665         unsigned long flags;
 666
 667         if (!req->complete) {
 668                 req->reply_len = 0;
 669                 req->complete = 1;
 670         }
 671         spin_lock_irqsave(&state->lock, flags);
 672         atomic_dec(&state->n_pending);
 673         if (!state->inuse) {
 674                 kfree(req);
 675                 if (atomic_read(&state->n_pending) == 0) {
 676                         spin_unlock_irqrestore(&state->lock, flags);
 677                         kfree(state);
 678                         return;
 679                 }
 680         } else {
 681                 struct adb_request **ap = &state->completed;
 682                 while (*ap != NULL)
 683                         ap = &(*ap)->next;
 684                 req->next = NULL;
 685                 *ap = req;
 686                 wake_up_interruptible(&state->wait_queue);
 687         }
 688         spin_unlock_irqrestore(&state->lock, flags);
 689 }
 690
 691 static int
 692 do_adb_query(struct adb_request *req)
 693 {
 694         int     ret = -EINVAL;
 695
 696         switch(req->data[1])
 697         {
 698         case ADB_QUERY_GETDEVINFO:
 699                 if (req->nbytes < 3)
 700                         break;
 701                 down(&adb_handler_sem);
 702                 req->reply[0] = adb_handler[req->data[2]].original_address;
 703                 req->reply[1] = adb_handler[req->data[2]].handler_id;
 704                 up(&adb_handler_sem);
 705                 req->complete = 1;
 706                 req->reply_len = 2;
 707                 adb_write_done(req);
 708                 ret = 0;
 709                 break;
 710         }
 711         return ret;
 712 }
 713
 714 static int adb_open(struct inode *inode, struct file *file)
 715 {
 716         struct adbdev_state *state;
 717
 718         if (iminor(inode) > 0 || adb_controller == NULL)
 719                 return -ENXIO;
 720         state = kmalloc(sizeof(struct adbdev_state), GFP_KERNEL);
 721         if (state == 0)
 722                 return -ENOMEM;
 723         file->private_data = state;
 724         spin_lock_init(&state->lock);
 725         atomic_set(&state->n_pending, 0);
 726         state->completed = NULL;
 727         init_waitqueue_head(&state->wait_queue);
 728         state->inuse = 1;
 729
 730         return 0;
 731 }
 732
 733 static int adb_release(struct inode *inode, struct file *file)
 734 {
 735         struct adbdev_state *state = file->private_data;
 736         unsigned long flags;
 737
 738         lock_kernel();
 739         if (state) {
 740                 file->private_data = NULL;
 741                 spin_lock_irqsave(&state->lock, flags);
 742                 if (atomic_read(&state->n_pending) == 0
 743                     && state->completed == NULL) {
 744                         spin_unlock_irqrestore(&state->lock, flags);
 745                         kfree(state);
 746                 } else {
 747                         state->inuse = 0;
 748                         spin_unlock_irqrestore(&state->lock, flags);
 749                 }
 750         }
 751         unlock_kernel();
 752         return 0;
 753 }
 754
 755 static ssize_t adb_read(struct file *file, char __user *buf,
 756                         size_t count, loff_t *ppos)
 757 {
 758         int ret = 0;
 759         struct adbdev_state *state = file->private_data;
 760         struct adb_request *req;
 761         wait_queue_t wait = __WAITQUEUE_INITIALIZER(wait,current);
 762         unsigned long flags;
 763
 764         if (count < 2)
 765                 return -EINVAL;
 766         if (count > sizeof(req->reply))
 767                 count = sizeof(req->reply);
 768         if (!access_ok(VERIFY_WRITE, buf, count))
 769                 return -EFAULT;
 770
 771         req = NULL;
 772         spin_lock_irqsave(&state->lock, flags);
 773         add_wait_queue(&state->wait_queue, &wait);
 774         current->state = TASK_INTERRUPTIBLE;
 775
 776         for (;;) {
 777                 req = state->completed;
 778                 if (req != NULL)
 779                         state->completed = req->next;
 780                 else if (atomic_read(&state->n_pending) == 0)
 781                         ret = -EIO;
 782                 if (req != NULL || ret != 0)
 783                         break;
 784
 785                 if (file->f_flags & O_NONBLOCK) {
 786                         ret = -EAGAIN;
 787                         break;
 788                 }
 789                 if (signal_pending(current)) {
 790                         ret = -ERESTARTSYS;
 791                         break;
 792                 }
 793                 spin_unlock_irqrestore(&state->lock, flags);
 794                 schedule();
 795                 spin_lock_irqsave(&state->lock, flags);
 796         }
 797
 798         current->state = TASK_RUNNING;
 799         remove_wait_queue(&state->wait_queue, &wait);
 800         spin_unlock_irqrestore(&state->lock, flags);
 801
 802         if (ret)
 803                 return ret;
 804
 805         ret = req->reply_len;
 806         if (ret > count)
 807                 ret = count;
 808         if (ret > 0 && copy_to_user(buf, req->reply, ret))
 809                 ret = -EFAULT;
 810
 811         kfree(req);
 812         return ret;
 813 }
 814
 815 static ssize_t adb_write(struct file *file, const char __user *buf,
 816                          size_t count, loff_t *ppos)
 817 {
 818         int ret/*, i*/;
 819         struct adbdev_state *state = file->private_data;
 820         struct adb_request *req;
 821
 822         if (count < 2 || count > sizeof(req->data))
 823                 return -EINVAL;
 824         if (adb_controller == NULL)
 825                 return -ENXIO;
 826         if (!access_ok(VERIFY_READ, buf, count))
 827                 return -EFAULT;
 828
 829         req = (struct adb_request *) kmalloc(sizeof(struct adb_request),
 830                                              GFP_KERNEL);
 831         if (req == NULL)
 832                 return -ENOMEM;
 833
 834         req->nbytes = count;
 835         req->done = adb_write_done;
 836         req->arg = (void *) state;
 837         req->complete = 0;
 838
 839         ret = -EFAULT;
 840         if (copy_from_user(req->data, buf, count))
 841                 goto out;
 842
 843         atomic_inc(&state->n_pending);
 844
 845         /* If a probe is in progress or we are sleeping, wait for it to complete */
 846         down(&adb_probe_mutex);
 847
 848         /* Queries are special requests sent to the ADB driver itself */
 849         if (req->data[0] == ADB_QUERY) {
 850                 if (count > 1)
 851                         ret = do_adb_query(req);
 852                 else
 853                         ret = -EINVAL;
 854                 up(&adb_probe_mutex);
 855         }
 856         /* Special case for ADB_BUSRESET request, all others are sent to
 857            the controller */
 858         else if ((req->data[0] == ADB_PACKET)&&(count > 1)
 859                 &&(req->data[1] == ADB_BUSRESET)) {
 860                 ret = do_adb_reset_bus();
 861                 up(&adb_probe_mutex);
 862                 atomic_dec(&state->n_pending);
 863                 if (ret == 0)
 864                         ret = count;
 865                 goto out;
 866         } else {
 867                 req->reply_expected = ((req->data[1] & 0xc) == 0xc);
 868                 if (adb_controller && adb_controller->send_request)
 869                         ret = adb_controller->send_request(req, 0);
 870                 else
 871                         ret = -ENXIO;
 872                 up(&adb_probe_mutex);
 873         }
 874
 875         if (ret != 0) {
 876                 atomic_dec(&state->n_pending);
 877                 goto out;
 878         }
 879         return count;
 880
 881 out:
 882         kfree(req);
 883         return ret;
 884 }
 885
 886 static struct file_operations adb_fops = {
 887         .owner          = THIS_MODULE,
 888         .llseek         = no_llseek,
 889         .read           = adb_read,
 890         .write          = adb_write,
 891         .open           = adb_open,
 892         .release        = adb_release,
 893 };
 894
 895 static void
 896 adbdev_init(void)
 897 {
 898         if (register_chrdev(ADB_MAJOR, "adb", &adb_fops)) {
 899                 printk(KERN_ERR "adb: unable to get major %d\n", ADB_MAJOR);
 900                 return;
 901         }
 902
 903         devfs_mk_cdev(MKDEV(ADB_MAJOR, 0), S_IFCHR | S_IRUSR | S_IWUSR, "adb");
 904
 905         adb_dev_class = class_simple_create(THIS_MODULE, "adb");
 906         if (IS_ERR(adb_dev_class)) {
 907                 return;
 908         }
 909         class_simple_device_add(adb_dev_class, MKDEV(ADB_MAJOR, 0), NULL, "adb");
 910 }