drivers/usb/misc/sisusbvga/sisusb.c

   1 /*
   2  * sisusb - usb kernel driver for SiS315(E) based USB2VGA dongles
   3  *
   4  * Main part
   5  *
   6  * Copyright (C) 2005 by Thomas Winischhofer, Vienna, Austria
   7  *
   8  * If distributed as part of the Linux kernel, this code is licensed under the
   9  * terms of the GPL v2.
  10  *
  11  * Otherwise, the following license terms apply:
  12  *
  13  * * Redistribution and use in source and binary forms, with or without
  14  * * modification, are permitted provided that the following conditions
  15  * * are met:
  16  * * 1) Redistributions of source code must retain the above copyright
  17  * *    notice, this list of conditions and the following disclaimer.
  18  * * 2) Redistributions in binary form must reproduce the above copyright
  19  * *    notice, this list of conditions and the following disclaimer in the
  20  * *    documentation and/or other materials provided with the distribution.
  21  * * 3) The name of the author may not be used to endorse or promote products
  22  * *    derived from this software without specific psisusbr written permission.
  23  * *
  24  * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESSED OR
  25  * * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  26  * * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  27  * * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  28  * * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  29  * * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  30  * * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  31  * * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  32  * * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  33  * * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  34  *
  35  * Author:      Thomas Winischhofer <thomas@winischhofer.net>
  36  *
  37  */
  38
  39 #include <linux/mutex.h>
  40 #include <linux/module.h>
  41 #include <linux/kernel.h>
  42 #include <linux/signal.h>
  43 #include <linux/errno.h>
  44 #include <linux/poll.h>
  45 #include <linux/init.h>
  46 #include <linux/slab.h>
  47 #include <linux/spinlock.h>
  48 #include <linux/kref.h>
  49 #include <linux/usb.h>
  50 #include <linux/smp_lock.h>
  51 #include <linux/vmalloc.h>
  52
  53 #include "sisusb.h"
  54 #include "sisusb_init.h"
  55
  56 #ifdef INCL_SISUSB_CON
  57 #include <linux/font.h>
  58 #endif
  59
  60 #define SISUSB_DONTSYNC
  61
  62 /* Forward declarations / clean-up routines */
  63
  64 #ifdef INCL_SISUSB_CON
  65 static int sisusb_first_vc = 0;
  66 static int sisusb_last_vc = 0;
  67 module_param_named(first, sisusb_first_vc, int, 0);
  68 module_param_named(last, sisusb_last_vc, int, 0);
  69 MODULE_PARM_DESC(first, "Number of first console to take over (1 - MAX_NR_CONSOLES)");
  70 MODULE_PARM_DESC(last, "Number of last console to take over (1 - MAX_NR_CONSOLES)");
  71 #endif
  72
  73 static struct usb_driver sisusb_driver;
  74
  75 static void
  76 sisusb_free_buffers(struct sisusb_usb_data *sisusb)
  77 {
  78         int i;
  79
  80         for (i = 0; i < NUMOBUFS; i++) {
  81                 if (sisusb->obuf[i]) {
  82                         usb_buffer_free(sisusb->sisusb_dev, sisusb->obufsize,
  83                                 sisusb->obuf[i], sisusb->transfer_dma_out[i]);
  84                         sisusb->obuf[i] = NULL;
  85                 }
  86         }
  87         if (sisusb->ibuf) {
  88                 usb_buffer_free(sisusb->sisusb_dev, sisusb->ibufsize,
  89                         sisusb->ibuf, sisusb->transfer_dma_in);
  90                 sisusb->ibuf = NULL;
  91         }
  92 }
  93
  94 static void
  95 sisusb_free_urbs(struct sisusb_usb_data *sisusb)
  96 {
  97         int i;
  98
  99         for (i = 0; i < NUMOBUFS; i++) {
 100                 usb_free_urb(sisusb->sisurbout[i]);
 101                 sisusb->sisurbout[i] = NULL;
 102         }
 103         usb_free_urb(sisusb->sisurbin);
 104         sisusb->sisurbin = NULL;
 105 }
 106
 107 /* Level 0: USB transport layer */
 108
 109 /* 1. out-bulks */
 110
 111 /* out-urb management */
 112
 113 /* Return 1 if all free, 0 otherwise */
 114 static int
 115 sisusb_all_free(struct sisusb_usb_data *sisusb)
 116 {
 117         int i;
 118
 119         for (i = 0; i < sisusb->numobufs; i++) {
 120
 121                 if (sisusb->urbstatus[i] & SU_URB_BUSY)
 122                         return 0;
 123
 124         }
 125
 126         return 1;
 127 }
 128
 129 /* Kill all busy URBs */
 130 static void
 131 sisusb_kill_all_busy(struct sisusb_usb_data *sisusb)
 132 {
 133         int i;
 134
 135         if (sisusb_all_free(sisusb))
 136                 return;
 137
 138         for (i = 0; i < sisusb->numobufs; i++) {
 139
 140                 if (sisusb->urbstatus[i] & SU_URB_BUSY)
 141                         usb_kill_urb(sisusb->sisurbout[i]);
 142
 143         }
 144 }
 145
 146 /* Return 1 if ok, 0 if error (not all complete within timeout) */
 147 static int
 148 sisusb_wait_all_out_complete(struct sisusb_usb_data *sisusb)
 149 {
 150         int timeout = 5 * HZ, i = 1;
 151
 152         wait_event_timeout(sisusb->wait_q,
 153                                 (i = sisusb_all_free(sisusb)),
 154                                  timeout);
 155
 156         return i;
 157 }
 158
 159 static int
 160 sisusb_outurb_available(struct sisusb_usb_data *sisusb)
 161 {
 162         int i;
 163
 164         for (i = 0; i < sisusb->numobufs; i++) {
 165
 166                 if ((sisusb->urbstatus[i] & (SU_URB_BUSY|SU_URB_ALLOC)) == 0)
 167                         return i;
 168
 169         }
 170
 171         return -1;
 172 }
 173
 174 static int
 175 sisusb_get_free_outbuf(struct sisusb_usb_data *sisusb)
 176 {
 177         int i, timeout = 5 * HZ;
 178
 179         wait_event_timeout(sisusb->wait_q,
 180                                 ((i = sisusb_outurb_available(sisusb)) >= 0),
 181                                 timeout);
 182
 183         return i;
 184 }
 185
 186 static int
 187 sisusb_alloc_outbuf(struct sisusb_usb_data *sisusb)
 188 {
 189         int i;
 190
 191         i = sisusb_outurb_available(sisusb);
 192
 193         if (i >= 0)
 194                 sisusb->urbstatus[i] |= SU_URB_ALLOC;
 195
 196         return i;
 197 }
 198
 199 static void
 200 sisusb_free_outbuf(struct sisusb_usb_data *sisusb, int index)
 201 {
 202         if ((index >= 0) && (index < sisusb->numobufs))
 203                 sisusb->urbstatus[index] &= ~SU_URB_ALLOC;
 204 }
 205
 206 /* completion callback */
 207
 208 static void
 209 sisusb_bulk_completeout(struct urb *urb)
 210 {
 211         struct sisusb_urb_context *context = urb->context;
 212         struct sisusb_usb_data *sisusb;
 213
 214         if (!context)
 215                 return;
 216
 217         sisusb = context->sisusb;
 218
 219         if (!sisusb || !sisusb->sisusb_dev || !sisusb->present)
 220                 return;
 221
 222 #ifndef SISUSB_DONTSYNC
 223         if (context->actual_length)
 224                 *(context->actual_length) += urb->actual_length;
 225 #endif
 226
 227         sisusb->urbstatus[context->urbindex] &= ~SU_URB_BUSY;
 228         wake_up(&sisusb->wait_q);
 229 }
 230
 231 static int
 232 sisusb_bulkout_msg(struct sisusb_usb_data *sisusb, int index, unsigned int pipe, void *data,
 233                 int len, int *actual_length, int timeout, unsigned int tflags,
 234                 dma_addr_t transfer_dma)
 235 {
 236         struct urb *urb = sisusb->sisurbout[index];
 237         int retval, byteswritten = 0;
 238
 239         /* Set up URB */
 240         urb->transfer_flags = 0;
 241
 242         usb_fill_bulk_urb(urb, sisusb->sisusb_dev, pipe, data, len,
 243                 sisusb_bulk_completeout, &sisusb->urbout_context[index]);
 244
 245         urb->transfer_flags |= tflags;
 246         urb->actual_length = 0;
 247
 248         if ((urb->transfer_dma = transfer_dma))
 249                 urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
 250
 251         /* Set up context */
 252         sisusb->urbout_context[index].actual_length = (timeout) ?
 253                                                 NULL : actual_length;
 254
 255         /* Declare this urb/buffer in use */
 256         sisusb->urbstatus[index] |= SU_URB_BUSY;
 257
 258         /* Submit URB */
 259         retval = usb_submit_urb(urb, GFP_ATOMIC);
 260
 261         /* If OK, and if timeout > 0, wait for completion */
 262         if ((retval == 0) && timeout) {
 263                 wait_event_timeout(sisusb->wait_q,
 264                                    (!(sisusb->urbstatus[index] & SU_URB_BUSY)),
 265                                    timeout);
 266                 if (sisusb->urbstatus[index] & SU_URB_BUSY) {
 267                         /* URB timed out... kill it and report error */
 268                         usb_kill_urb(urb);
 269                         retval = -ETIMEDOUT;
 270                 } else {
 271                         /* Otherwise, report urb status */
 272                         retval = urb->status;
 273                         byteswritten = urb->actual_length;
 274                 }
 275         }
 276
 277         if (actual_length)
 278                 *actual_length = byteswritten;
 279
 280         return retval;
 281 }
 282
 283 /* 2. in-bulks */
 284
 285 /* completion callback */
 286
 287 static void
 288 sisusb_bulk_completein(struct urb *urb)
 289 {
 290         struct sisusb_usb_data *sisusb = urb->context;
 291
 292         if (!sisusb || !sisusb->sisusb_dev || !sisusb->present)
 293                 return;
 294
 295         sisusb->completein = 1;
 296         wake_up(&sisusb->wait_q);
 297 }
 298
 299 static int
 300 sisusb_bulkin_msg(struct sisusb_usb_data *sisusb, unsigned int pipe, void *data, int len,
 301                 int *actual_length, int timeout, unsigned int tflags, dma_addr_t transfer_dma)
 302 {
 303         struct urb *urb = sisusb->sisurbin;
 304         int retval, readbytes = 0;
 305
 306         urb->transfer_flags = 0;
 307
 308         usb_fill_bulk_urb(urb, sisusb->sisusb_dev, pipe, data, len,
 309                         sisusb_bulk_completein, sisusb);
 310
 311         urb->transfer_flags |= tflags;
 312         urb->actual_length = 0;
 313
 314         if ((urb->transfer_dma = transfer_dma))
 315                 urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
 316
 317         sisusb->completein = 0;
 318         retval = usb_submit_urb(urb, GFP_ATOMIC);
 319         if (retval == 0) {
 320                 wait_event_timeout(sisusb->wait_q, sisusb->completein, timeout);
 321                 if (!sisusb->completein) {
 322                         /* URB timed out... kill it and report error */
 323                         usb_kill_urb(urb);
 324                         retval = -ETIMEDOUT;
 325                 } else {
 326                         /* URB completed within timout */
 327                         retval = urb->status;
 328                         readbytes = urb->actual_length;
 329                 }
 330         }
 331
 332         if (actual_length)
 333                 *actual_length = readbytes;
 334
 335         return retval;
 336 }
 337
 338
 339 /* Level 1:  */
 340
 341 /* Send a bulk message of variable size
 342  *
 343  * To copy the data from userspace, give pointer to "userbuffer",
 344  * to copy from (non-DMA) kernel memory, give "kernbuffer". If
 345  * both of these are NULL, it is assumed, that the transfer
 346  * buffer "sisusb->obuf[index]" is set up with the data to send.
 347  * Index is ignored if either kernbuffer or userbuffer is set.
 348  * If async is nonzero, URBs will be sent without waiting for
 349  * completion of the previous URB.
 350  *
 351  * (return 0 on success)
 352  */
 353
 354 static int sisusb_send_bulk_msg(struct sisusb_usb_data *sisusb, int ep, int len,
 355                 char *kernbuffer, const char __user *userbuffer, int index,
 356                 ssize_t *bytes_written, unsigned int tflags, int async)
 357 {
 358         int result = 0, retry, count = len;
 359         int passsize, thispass, transferred_len = 0;
 360         int fromuser = (userbuffer != NULL) ? 1 : 0;
 361         int fromkern = (kernbuffer != NULL) ? 1 : 0;
 362         unsigned int pipe;
 363         char *buffer;
 364
 365         (*bytes_written) = 0;
 366
 367         /* Sanity check */
 368         if (!sisusb || !sisusb->present || !sisusb->sisusb_dev)
 369                 return -ENODEV;
 370
 371         /* If we copy data from kernel or userspace, force the
 372          * allocation of a buffer/urb. If we have the data in
 373          * the transfer buffer[index] already, reuse the buffer/URB
 374          * if the length is > buffer size. (So, transmitting
 375          * large data amounts directly from the transfer buffer
 376          * treats the buffer as a ring buffer. However, we need
 377          * to sync in this case.)
 378          */
 379         if (fromuser || fromkern)
 380                 index = -1;
 381         else if (len > sisusb->obufsize)
 382                 async = 0;
 383
 384         pipe = usb_sndbulkpipe(sisusb->sisusb_dev, ep);
 385
 386         do {
 387                 passsize = thispass = (sisusb->obufsize < count) ?
 388                                                 sisusb->obufsize : count;
 389
 390                 if (index < 0)
 391                         index = sisusb_get_free_outbuf(sisusb);
 392
 393                 if (index < 0)
 394                         return -EIO;
 395
 396                 buffer = sisusb->obuf[index];
 397
 398                 if (fromuser) {
 399
 400                         if (copy_from_user(buffer, userbuffer, passsize))
 401                                 return -EFAULT;
 402
 403                         userbuffer += passsize;
 404
 405                 } else if (fromkern) {
 406
 407                         memcpy(buffer, kernbuffer, passsize);
 408                         kernbuffer += passsize;
 409
 410                 }
 411
 412                 retry = 5;
 413                 while (thispass) {
 414
 415                         if (!sisusb->sisusb_dev)
 416                                 return -ENODEV;
 417
 418                         result = sisusb_bulkout_msg(sisusb,
 419                                                 index,
 420                                                 pipe,
 421                                                 buffer,
 422                                                 thispass,
 423                                                 &transferred_len,
 424                                                 async ? 0 : 5 * HZ,
 425                                                 tflags,
 426                                                 sisusb->transfer_dma_out[index]);
 427
 428                         if (result == -ETIMEDOUT) {
 429
 430                                 /* Will not happen if async */
 431                                 if (!retry--)
 432                                         return -ETIME;
 433
 434                                 continue;
 435
 436                         } else if ((result == 0) && !async && transferred_len) {
 437
 438                                 thispass -= transferred_len;
 439                                 if (thispass) {
 440                                         if (sisusb->transfer_dma_out) {
 441                                                 /* If DMA, copy remaining
 442                                                  * to beginning of buffer
 443                                                  */
 444                                                 memcpy(buffer,
 445                                                        buffer + transferred_len,
 446                                                        thispass);
 447                                         } else {
 448                                                 /* If not DMA, simply increase
 449                                                  * the pointer
 450                                                  */
 451                                                 buffer += transferred_len;
 452                                         }
 453                                 }
 454
 455                         } else
 456                                 break;
 457                 };
 458
 459                 if (result)
 460                         return result;
 461
 462                 (*bytes_written) += passsize;
 463                 count            -= passsize;
 464
 465                 /* Force new allocation in next iteration */
 466                 if (fromuser || fromkern)
 467                         index = -1;
 468
 469         } while (count > 0);
 470
 471         if (async) {
 472 #ifdef SISUSB_DONTSYNC
 473                 (*bytes_written) = len;
 474                 /* Some URBs/buffers might be busy */
 475 #else
 476                 sisusb_wait_all_out_complete(sisusb);
 477                 (*bytes_written) = transferred_len;
 478                 /* All URBs and all buffers are available */
 479 #endif
 480         }
 481
 482         return ((*bytes_written) == len) ? 0 : -EIO;
 483 }
 484
 485 /* Receive a bulk message of variable size
 486  *
 487  * To copy the data to userspace, give pointer to "userbuffer",
 488  * to copy to kernel memory, give "kernbuffer". One of them
 489  * MUST be set. (There is no technique for letting the caller
 490  * read directly from the ibuf.)
 491  *
 492  */
 493
 494 static int sisusb_recv_bulk_msg(struct sisusb_usb_data *sisusb, int ep, int len,
 495                 void *kernbuffer, char __user *userbuffer, ssize_t *bytes_read,
 496                 unsigned int tflags)
 497 {
 498         int result = 0, retry, count = len;
 499         int bufsize, thispass, transferred_len;
 500         unsigned int pipe;
 501         char *buffer;
 502
 503         (*bytes_read) = 0;
 504
 505         /* Sanity check */
 506         if (!sisusb || !sisusb->present || !sisusb->sisusb_dev)
 507                 return -ENODEV;
 508
 509         pipe = usb_rcvbulkpipe(sisusb->sisusb_dev, ep);
 510         buffer = sisusb->ibuf;
 511         bufsize = sisusb->ibufsize;
 512
 513         retry = 5;
 514
 515 #ifdef SISUSB_DONTSYNC
 516         if (!(sisusb_wait_all_out_complete(sisusb)))
 517                 return -EIO;
 518 #endif
 519
 520         while (count > 0) {
 521
 522                 if (!sisusb->sisusb_dev)
 523                         return -ENODEV;
 524
 525                 thispass = (bufsize < count) ? bufsize : count;
 526
 527                 result = sisusb_bulkin_msg(sisusb,
 528                                            pipe,
 529                                            buffer,
 530                                            thispass,
 531                                            &transferred_len,
 532                                            5 * HZ,
 533                                            tflags,
 534                                            sisusb->transfer_dma_in);
 535
 536                 if (transferred_len)
 537                         thispass = transferred_len;
 538
 539                 else if (result == -ETIMEDOUT) {
 540
 541                         if (!retry--)
 542                                 return -ETIME;
 543
 544                         continue;
 545
 546                 } else
 547                         return -EIO;
 548
 549
 550                 if (thispass) {
 551
 552                         (*bytes_read) += thispass;
 553                         count         -= thispass;
 554
 555                         if (userbuffer) {
 556
 557                                 if (copy_to_user(userbuffer, buffer, thispass))
 558                                         return -EFAULT;
 559
 560                                 userbuffer += thispass;
 561
 562                         } else {
 563
 564                                 memcpy(kernbuffer, buffer, thispass);
 565                                 kernbuffer += thispass;
 566
 567                         }
 568
 569                 }
 570
 571         }
 572
 573         return ((*bytes_read) == len) ? 0 : -EIO;
 574 }
 575
 576 static int sisusb_send_packet(struct sisusb_usb_data *sisusb, int len,
 577                                                 struct sisusb_packet *packet)
 578 {
 579         int ret;
 580         ssize_t bytes_transferred = 0;
 581         __le32 tmp;
 582
 583         if (len == 6)
 584                 packet->data = 0;
 585
 586 #ifdef SISUSB_DONTSYNC
 587         if (!(sisusb_wait_all_out_complete(sisusb)))
 588                 return 1;
 589 #endif
 590
 591         /* Eventually correct endianness */
 592         SISUSB_CORRECT_ENDIANNESS_PACKET(packet);
 593
 594         /* 1. send the packet */
 595         ret = sisusb_send_bulk_msg(sisusb, SISUSB_EP_GFX_OUT, len,
 596                         (char *)packet, NULL, 0, &bytes_transferred, 0, 0);
 597
 598         if ((ret == 0) && (len == 6)) {
 599
 600                 /* 2. if packet len == 6, it means we read, so wait for 32bit
 601                  *    return value and write it to packet->data
 602                  */
 603                 ret = sisusb_recv_bulk_msg(sisusb, SISUSB_EP_GFX_IN, 4,
 604                                 (char *)&tmp, NULL, &bytes_transferred, 0);
 605
 606                 packet->data = le32_to_cpu(tmp);
 607         }
 608
 609         return ret;
 610 }
 611
 612 static int sisusb_send_bridge_packet(struct sisusb_usb_data *sisusb, int len,
 613                                         struct sisusb_packet *packet,
 614                                         unsigned int tflags)
 615 {
 616         int ret;
 617         ssize_t bytes_transferred = 0;
 618         __le32 tmp;
 619
 620         if (len == 6)
 621                 packet->data = 0;
 622
 623 #ifdef SISUSB_DONTSYNC
 624         if (!(sisusb_wait_all_out_complete(sisusb)))
 625                 return 1;
 626 #endif
 627
 628         /* Eventually correct endianness */
 629         SISUSB_CORRECT_ENDIANNESS_PACKET(packet);
 630
 631         /* 1. send the packet */
 632         ret = sisusb_send_bulk_msg(sisusb, SISUSB_EP_BRIDGE_OUT, len,
 633                         (char *)packet, NULL, 0, &bytes_transferred, tflags, 0);
 634
 635         if ((ret == 0) && (len == 6)) {
 636
 637                 /* 2. if packet len == 6, it means we read, so wait for 32bit
 638                  *    return value and write it to packet->data
 639                  */
 640                 ret = sisusb_recv_bulk_msg(sisusb, SISUSB_EP_BRIDGE_IN, 4,
 641                                 (char *)&tmp, NULL, &bytes_transferred, 0);
 642
 643                 packet->data = le32_to_cpu(tmp);
 644         }
 645
 646         return ret;
 647 }
 648
 649 /* access video memory and mmio (return 0 on success) */
 650
 651 /* Low level */
 652
 653 /* The following routines assume being used to transfer byte, word,
 654  * long etc.
 655  * This means that
 656  *   - the write routines expect "data" in machine endianness format.
 657  *     The data will be converted to leXX in sisusb_xxx_packet.
 658  *   - the read routines can expect read data in machine-endianess.
 659  */
 660
 661 static int sisusb_write_memio_byte(struct sisusb_usb_data *sisusb, int type,
 662                                                         u32 addr, u8 data)
 663 {
 664         struct sisusb_packet packet;
 665         int ret;
 666
 667         packet.header  = (1 << (addr & 3)) | (type << 6);
 668         packet.address = addr & ~3;
 669         packet.data    = data << ((addr & 3) << 3);
 670         ret = sisusb_send_packet(sisusb, 10, &packet);
 671         return ret;
 672 }
 673
 674 static int sisusb_write_memio_word(struct sisusb_usb_data *sisusb, int type,
 675                                                         u32 addr, u16 data)
 676 {
 677         struct sisusb_packet packet;
 678         int ret = 0;
 679
 680         packet.address = addr & ~3;
 681
 682         switch (addr & 3) {
 683                 case 0:
 684                         packet.header = (type << 6) | 0x0003;
 685                         packet.data   = (u32)data;
 686                         ret = sisusb_send_packet(sisusb, 10, &packet);
 687                         break;
 688                 case 1:
 689                         packet.header = (type << 6) | 0x0006;
 690                         packet.data   = (u32)data << 8;
 691                         ret = sisusb_send_packet(sisusb, 10, &packet);
 692                         break;
 693                 case 2:
 694                         packet.header = (type << 6) | 0x000c;
 695                         packet.data   = (u32)data << 16;
 696                         ret = sisusb_send_packet(sisusb, 10, &packet);
 697                         break;
 698                 case 3:
 699                         packet.header = (type << 6) | 0x0008;
 700                         packet.data   = (u32)data << 24;
 701                         ret = sisusb_send_packet(sisusb, 10, &packet);
 702                         packet.header = (type << 6) | 0x0001;
 703                         packet.address = (addr & ~3) + 4;
 704                         packet.data   = (u32)data >> 8;
 705                         ret |= sisusb_send_packet(sisusb, 10, &packet);
 706         }
 707
 708         return ret;
 709 }
 710
 711 static int sisusb_write_memio_24bit(struct sisusb_usb_data *sisusb, int type,
 712                                                         u32 addr, u32 data)
 713 {
 714         struct sisusb_packet packet;
 715         int ret = 0;
 716
 717         packet.address = addr & ~3;
 718
 719         switch (addr & 3) {
 720                 case 0:
 721                         packet.header  = (type << 6) | 0x0007;
 722                         packet.data    = data & 0x00ffffff;
 723                         ret = sisusb_send_packet(sisusb, 10, &packet);
 724                         break;
 725                 case 1:
 726                         packet.header  = (type << 6) | 0x000e;
 727                         packet.data    = data << 8;
 728                         ret = sisusb_send_packet(sisusb, 10, &packet);
 729                         break;
 730                 case 2:
 731                         packet.header  = (type << 6) | 0x000c;
 732                         packet.data    = data << 16;
 733                         ret = sisusb_send_packet(sisusb, 10, &packet);
 734                         packet.header  = (type << 6) | 0x0001;
 735                         packet.address = (addr & ~3) + 4;
 736                         packet.data    = (data >> 16) & 0x00ff;
 737                         ret |= sisusb_send_packet(sisusb, 10, &packet);
 738                         break;
 739                 case 3:
 740                         packet.header  = (type << 6) | 0x0008;
 741                         packet.data    = data << 24;
 742                         ret = sisusb_send_packet(sisusb, 10, &packet);
 743                         packet.header  = (type << 6) | 0x0003;
 744                         packet.address = (addr & ~3) + 4;
 745                         packet.data    = (data >> 8) & 0xffff;
 746                         ret |= sisusb_send_packet(sisusb, 10, &packet);
 747         }
 748
 749         return ret;
 750 }
 751
 752 static int sisusb_write_memio_long(struct sisusb_usb_data *sisusb, int type,
 753                                                         u32 addr, u32 data)
 754 {
 755         struct sisusb_packet packet;
 756         int ret = 0;
 757
 758         packet.address = addr & ~3;
 759
 760         switch (addr & 3) {
 761                 case 0:
 762                         packet.header  = (type << 6) | 0x000f;
 763                         packet.data    = data;
 764                         ret = sisusb_send_packet(sisusb, 10, &packet);
 765                         break;
 766                 case 1:
 767                         packet.header  = (type << 6) | 0x000e;
 768                         packet.data    = data << 8;
 769                         ret = sisusb_send_packet(sisusb, 10, &packet);
 770                         packet.header  = (type << 6) | 0x0001;
 771                         packet.address = (addr & ~3) + 4;
 772                         packet.data    = data >> 24;
 773                         ret |= sisusb_send_packet(sisusb, 10, &packet);
 774                         break;
 775                 case 2:
 776                         packet.header  = (type << 6) | 0x000c;
 777                         packet.data    = data << 16;
 778                         ret = sisusb_send_packet(sisusb, 10, &packet);
 779                         packet.header  = (type << 6) | 0x0003;
 780                         packet.address = (addr & ~3) + 4;
 781                         packet.data    = data >> 16;
 782                         ret |= sisusb_send_packet(sisusb, 10, &packet);
 783                         break;
 784                 case 3:
 785                         packet.header  = (type << 6) | 0x0008;
 786                         packet.data    = data << 24;
 787                         ret = sisusb_send_packet(sisusb, 10, &packet);
 788                         packet.header  = (type << 6) | 0x0007;
 789                         packet.address = (addr & ~3) + 4;
 790                         packet.data    = data >> 8;
 791                         ret |= sisusb_send_packet(sisusb, 10, &packet);
 792         }
 793
 794         return ret;
 795 }
 796
 797 /* The xxx_bulk routines copy a buffer of variable size. They treat the
 798  * buffer as chars, therefore lsb/msb has to be corrected if using the
 799  * byte/word/long/etc routines for speed-up
 800  *
 801  * If data is from userland, set "userbuffer" (and clear "kernbuffer"),
 802  * if data is in kernel space, set "kernbuffer" (and clear "userbuffer");
 803  * if neither "kernbuffer" nor "userbuffer" are given, it is assumed
 804  * that the data already is in the transfer buffer "sisusb->obuf[index]".
 805  */
 806
 807 static int sisusb_write_mem_bulk(struct sisusb_usb_data *sisusb, u32 addr,
 808                                 char *kernbuffer, int length,
 809                                 const char __user *userbuffer, int index,
 810                                 ssize_t *bytes_written)
 811 {
 812         struct sisusb_packet packet;
 813         int  ret = 0;
 814         static int msgcount = 0;
 815         u8   swap8, fromkern = kernbuffer ? 1 : 0;
 816         u16  swap16;
 817         u32  swap32, flag = (length >> 28) & 1;
 818         char buf[4];
 819
 820         /* if neither kernbuffer not userbuffer are given, assume
 821          * data in obuf
 822          */
 823         if (!fromkern && !userbuffer)
 824                 kernbuffer = sisusb->obuf[index];
 825
 826         (*bytes_written = 0);
 827
 828         length &= 0x00ffffff;
 829
 830         while (length) {
 831
 832             switch (length) {
 833
 834                 case 1:
 835                         if (userbuffer) {
 836                                 if (get_user(swap8, (u8 __user *)userbuffer))
 837                                         return -EFAULT;
 838                         } else
 839                                 swap8 = kernbuffer[0];
 840
 841                         ret = sisusb_write_memio_byte(sisusb,
 842                                                         SISUSB_TYPE_MEM,
 843                                                         addr, swap8);
 844
 845                         if (!ret)
 846                                 (*bytes_written)++;
 847
 848                         return ret;
 849
 850                 case 2:
 851                         if (userbuffer) {
 852                                 if (get_user(swap16, (u16 __user *)userbuffer))
 853                                         return -EFAULT;
 854                         } else
 855                                 swap16 = *((u16 *)kernbuffer);
 856
 857                         ret = sisusb_write_memio_word(sisusb,
 858                                                         SISUSB_TYPE_MEM,
 859                                                         addr,
 860                                                         swap16);
 861
 862                         if (!ret)
 863                                 (*bytes_written) += 2;
 864
 865                         return ret;
 866
 867                 case 3:
 868                         if (userbuffer) {
 869                                 if (copy_from_user(&buf, userbuffer, 3))
 870                                         return -EFAULT;
 871 #ifdef __BIG_ENDIAN
 872                                 swap32 = (buf[0] << 16) |
 873                                          (buf[1] <<  8) |
 874                                          buf[2];
 875 #else
 876                                 swap32 = (buf[2] << 16) |
 877                                          (buf[1] <<  8) |
 878                                          buf[0];
 879 #endif
 880                         } else
 881 #ifdef __BIG_ENDIAN
 882                                 swap32 = (kernbuffer[0] << 16) |
 883                                          (kernbuffer[1] <<  8) |
 884                                          kernbuffer[2];
 885 #else
 886                                 swap32 = (kernbuffer[2] << 16) |
 887                                          (kernbuffer[1] <<  8) |
 888                                          kernbuffer[0];
 889 #endif
 890
 891                         ret = sisusb_write_memio_24bit(sisusb,
 892                                                         SISUSB_TYPE_MEM,
 893                                                         addr,
 894                                                         swap32);
 895
 896                         if (!ret)
 897                                 (*bytes_written) += 3;
 898
 899                         return ret;
 900
 901                 case 4:
 902                         if (userbuffer) {
 903                                 if (get_user(swap32, (u32 __user *)userbuffer))
 904                                         return -EFAULT;
 905                         } else
 906                                 swap32 = *((u32 *)kernbuffer);
 907
 908                         ret = sisusb_write_memio_long(sisusb,
 909                                                         SISUSB_TYPE_MEM,
 910                                                         addr,
 911                                                         swap32);
 912                         if (!ret)
 913                                 (*bytes_written) += 4;
 914
 915                         return ret;
 916
 917                 default:
 918                         if ((length & ~3) > 0x10000) {
 919
 920                            packet.header  = 0x001f;
 921                            packet.address = 0x000001d4;
 922                            packet.data    = addr;
 923                            ret = sisusb_send_bridge_packet(sisusb, 10,
 924                                                                 &packet, 0);
 925                            packet.header  = 0x001f;
 926                            packet.address = 0x000001d0;
 927                            packet.data    = (length & ~3);
 928                            ret |= sisusb_send_bridge_packet(sisusb, 10,
 929                                                                 &packet, 0);
 930                            packet.header  = 0x001f;
 931                            packet.address = 0x000001c0;
 932                            packet.data    = flag | 0x16;
 933                            ret |= sisusb_send_bridge_packet(sisusb, 10,
 934                                                                 &packet, 0);
 935                            if (userbuffer) {
 936                                 ret |= sisusb_send_bulk_msg(sisusb,
 937                                                         SISUSB_EP_GFX_LBULK_OUT,
 938                                                         (length & ~3),
 939                                                         NULL, userbuffer, 0,
 940                                                         bytes_written, 0, 1);
 941                                 userbuffer += (*bytes_written);
 942                            } else if (fromkern) {
 943                                 ret |= sisusb_send_bulk_msg(sisusb,
 944                                                         SISUSB_EP_GFX_LBULK_OUT,
 945                                                         (length & ~3),
 946                                                         kernbuffer, NULL, 0,
 947                                                         bytes_written, 0, 1);
 948                                 kernbuffer += (*bytes_written);
 949                            } else {
 950                         ret |= sisusb_send_bulk_msg(sisusb,
 951                                                         SISUSB_EP_GFX_LBULK_OUT,
 952                                                         (length & ~3),
 953                                                         NULL, NULL, index,
 954                                                         bytes_written, 0, 1);
 955                                 kernbuffer += ((*bytes_written) &
 956                                                 (sisusb->obufsize-1));
 957                            }
 958
 959                         } else {
 960
 961                            packet.header  = 0x001f;
 962                            packet.address = 0x00000194;
 963                            packet.data    = addr;
 964                            ret = sisusb_send_bridge_packet(sisusb, 10,
 965                                                                 &packet, 0);
 966                            packet.header  = 0x001f;
 967                            packet.address = 0x00000190;
 968                            packet.data    = (length & ~3);
 969                            ret |= sisusb_send_bridge_packet(sisusb, 10,
 970                                                                 &packet, 0);
 971                            if (sisusb->flagb0 != 0x16) {
 972                                 packet.header  = 0x001f;
 973                                 packet.address = 0x00000180;
 974                                 packet.data    = flag | 0x16;
 975                                 ret |= sisusb_send_bridge_packet(sisusb, 10,
 976                                                                 &packet, 0);
 977                                 sisusb->flagb0 = 0x16;
 978                            }
 979                            if (userbuffer) {
 980                                 ret |= sisusb_send_bulk_msg(sisusb,
 981                                                         SISUSB_EP_GFX_BULK_OUT,
 982                                                         (length & ~3),
 983                                                         NULL, userbuffer, 0,
 984                                                         bytes_written, 0, 1);
 985                                 userbuffer += (*bytes_written);
 986                            } else if (fromkern) {
 987                                 ret |= sisusb_send_bulk_msg(sisusb,
 988                                                         SISUSB_EP_GFX_BULK_OUT,
 989                                                         (length & ~3),
 990                                                         kernbuffer, NULL, 0,
 991                                                         bytes_written, 0, 1);
 992                                 kernbuffer += (*bytes_written);
 993                            } else {
 994                                 ret |= sisusb_send_bulk_msg(sisusb,
 995                                                         SISUSB_EP_GFX_BULK_OUT,
 996                                                         (length & ~3),
 997                                                         NULL, NULL, index,
 998                                                         bytes_written, 0, 1);
 999                                 kernbuffer += ((*bytes_written) &
1000                                                 (sisusb->obufsize-1));
1001                            }
1002                         }
1003                         if (ret) {
1004                                 msgcount++;
1005                                 if (msgcount < 500)
1006                                         printk(KERN_ERR
1007                                                 "sisusbvga[%d]: Wrote %zd of "
1008                                                 "%d bytes, error %d\n",
1009                                                 sisusb->minor, *bytes_written,
1010                                                 length, ret);
1011                                 else if (msgcount == 500)
1012                                         printk(KERN_ERR
1013                                                 "sisusbvga[%d]: Too many errors"
1014                                                 ", logging stopped\n",
1015                                                 sisusb->minor);
1016                         }
1017                         addr += (*bytes_written);
1018                         length -= (*bytes_written);
1019             }
1020
1021             if (ret)
1022                 break;
1023
1024         }
1025
1026         return ret ? -EIO : 0;
1027 }
1028
1029 /* Remember: Read data in packet is in machine-endianess! So for
1030  * byte, word, 24bit, long no endian correction is necessary.
1031  */
1032
1033 static int sisusb_read_memio_byte(struct sisusb_usb_data *sisusb, int type,
1034                                                         u32 addr, u8 *data)
1035 {
1036         struct sisusb_packet packet;
1037         int ret;
1038
1039         CLEARPACKET(&packet);
1040         packet.header  = (1 << (addr & 3)) | (type << 6);
1041         packet.address = addr & ~3;
1042         ret = sisusb_send_packet(sisusb, 6, &packet);
1043         *data = (u8)(packet.data >> ((addr & 3) << 3));
1044         return ret;
1045 }
1046
1047 static int sisusb_read_memio_word(struct sisusb_usb_data *sisusb, int type,
1048                                                         u32 addr, u16 *data)
1049 {
1050         struct sisusb_packet packet;
1051         int ret = 0;
1052
1053         CLEARPACKET(&packet);
1054
1055         packet.address = addr & ~3;
1056
1057         switch (addr & 3) {
1058                 case 0:
1059                         packet.header = (type << 6) | 0x0003;
1060                         ret = sisusb_send_packet(sisusb, 6, &packet);
1061                         *data = (u16)(packet.data);
1062                         break;
1063                 case 1:
1064                         packet.header = (type << 6) | 0x0006;
1065                         ret = sisusb_send_packet(sisusb, 6, &packet);
1066                         *data = (u16)(packet.data >> 8);
1067                         break;
1068                 case 2:
1069                         packet.header = (type << 6) | 0x000c;
1070                         ret = sisusb_send_packet(sisusb, 6, &packet);
1071                         *data = (u16)(packet.data >> 16);
1072                         break;
1073                 case 3:
1074                         packet.header = (type << 6) | 0x0008;
1075                         ret = sisusb_send_packet(sisusb, 6, &packet);
1076                         *data = (u16)(packet.data >> 24);
1077                         packet.header = (type << 6) | 0x0001;
1078                         packet.address = (addr & ~3) + 4;
1079                         ret |= sisusb_send_packet(sisusb, 6, &packet);
1080                         *data |= (u16)(packet.data << 8);
1081         }
1082
1083         return ret;
1084 }
1085
1086 static int sisusb_read_memio_24bit(struct sisusb_usb_data *sisusb, int type,
1087                                                         u32 addr, u32 *data)
1088 {
1089         struct sisusb_packet packet;
1090         int ret = 0;
1091
1092         packet.address = addr & ~3;
1093
1094         switch (addr & 3) {
1095                 case 0:
1096                         packet.header  = (type << 6) | 0x0007;
1097                         ret = sisusb_send_packet(sisusb, 6, &packet);
1098                         *data = packet.data & 0x00ffffff;
1099                         break;
1100                 case 1:
1101                         packet.header  = (type << 6) | 0x000e;
1102                         ret = sisusb_send_packet(sisusb, 6, &packet);
1103                         *data = packet.data >> 8;
1104                         break;
1105                 case 2:
1106                         packet.header  = (type << 6) | 0x000c;
1107                         ret = sisusb_send_packet(sisusb, 6, &packet);
1108                         *data = packet.data >> 16;
1109                         packet.header  = (type << 6) | 0x0001;
1110                         packet.address = (addr & ~3) + 4;
1111                         ret |= sisusb_send_packet(sisusb, 6, &packet);
1112                         *data |= ((packet.data & 0xff) << 16);
1113                         break;
1114                 case 3:
1115                         packet.header  = (type << 6) | 0x0008;
1116                         ret = sisusb_send_packet(sisusb, 6, &packet);
1117                         *data = packet.data >> 24;
1118                         packet.header  = (type << 6) | 0x0003;
1119                         packet.address = (addr & ~3) + 4;
1120                         ret |= sisusb_send_packet(sisusb, 6, &packet);
1121                         *data |= ((packet.data & 0xffff) << 8);
1122         }
1123
1124         return ret;
1125 }
1126
1127 static int sisusb_read_memio_long(struct sisusb_usb_data *sisusb, int type,
1128                                                         u32 addr, u32 *data)
1129 {
1130         struct sisusb_packet packet;
1131         int ret = 0;
1132
1133         packet.address = addr & ~3;
1134
1135         switch (addr & 3) {
1136                 case 0:
1137                         packet.header  = (type << 6) | 0x000f;
1138                         ret = sisusb_send_packet(sisusb, 6, &packet);
1139                         *data = packet.data;
1140                         break;
1141                 case 1:
1142                         packet.header  = (type << 6) | 0x000e;
1143                         ret = sisusb_send_packet(sisusb, 6, &packet);
1144                         *data = packet.data >> 8;
1145                         packet.header  = (type << 6) | 0x0001;
1146                         packet.address = (addr & ~3) + 4;
1147                         ret |= sisusb_send_packet(sisusb, 6, &packet);
1148                         *data |= (packet.data << 24);
1149                         break;
1150                 case 2:
1151                         packet.header  = (type << 6) | 0x000c;
1152                         ret = sisusb_send_packet(sisusb, 6, &packet);
1153                         *data = packet.data >> 16;
1154                         packet.header  = (type << 6) | 0x0003;
1155                         packet.address = (addr & ~3) + 4;
1156                         ret |= sisusb_send_packet(sisusb, 6, &packet);
1157                         *data |= (packet.data << 16);
1158                         break;
1159                 case 3:
1160                         packet.header  = (type << 6) | 0x0008;
1161                         ret = sisusb_send_packet(sisusb, 6, &packet);
1162                         *data = packet.data >> 24;
1163                         packet.header  = (type << 6) | 0x0007;
1164                         packet.address = (addr & ~3) + 4;
1165                         ret |= sisusb_send_packet(sisusb, 6, &packet);
1166                         *data |= (packet.data << 8);
1167         }
1168
1169         return ret;
1170 }
1171
1172 static int sisusb_read_mem_bulk(struct sisusb_usb_data *sisusb, u32 addr,
1173                                 char *kernbuffer, int length,
1174                                 char __user *userbuffer, ssize_t *bytes_read)
1175 {
1176         int ret = 0;
1177         char buf[4];
1178         u16 swap16;
1179         u32 swap32;
1180
1181         (*bytes_read = 0);
1182
1183         length &= 0x00ffffff;
1184
1185         while (length) {
1186
1187             switch (length) {
1188
1189                 case 1:
1190
1191                         ret |= sisusb_read_memio_byte(sisusb, SISUSB_TYPE_MEM,
1192                                                                 addr, &buf[0]);
1193                         if (!ret) {
1194                                 (*bytes_read)++;
1195                                 if (userbuffer) {
1196                                         if (put_user(buf[0],
1197                                                 (u8 __user *)userbuffer)) {
1198                                                 return -EFAULT;
1199                                         }
1200                                 } else {
1201                                         kernbuffer[0] = buf[0];
1202                                 }
1203                         }
1204                         return ret;
1205
1206                 case 2:
1207                         ret |= sisusb_read_memio_word(sisusb, SISUSB_TYPE_MEM,
1208                                                                 addr, &swap16);
1209                         if (!ret) {
1210                                 (*bytes_read) += 2;
1211                                 if (userbuffer) {
1212                                         if (put_user(swap16,
1213                                                 (u16 __user *)userbuffer))
1214                                                 return -EFAULT;
1215                                 } else {
1216                                         *((u16 *)kernbuffer) = swap16;
1217                                 }
1218                         }
1219                         return ret;
1220
1221                 case 3:
1222                         ret |= sisusb_read_memio_24bit(sisusb, SISUSB_TYPE_MEM,
1223                                                                 addr, &swap32);
1224                         if (!ret) {
1225                                 (*bytes_read) += 3;
1226 #ifdef __BIG_ENDIAN
1227                                 buf[0] = (swap32 >> 16) & 0xff;
1228                                 buf[1] = (swap32 >> 8) & 0xff;
1229                                 buf[2] = swap32 & 0xff;
1230 #else
1231                                 buf[2] = (swap32 >> 16) & 0xff;
1232                                 buf[1] = (swap32 >> 8) & 0xff;
1233                                 buf[0] = swap32 & 0xff;
1234 #endif
1235                                 if (userbuffer) {
1236                                         if (copy_to_user(userbuffer, &buf[0], 3))
1237                                                 return -EFAULT;
1238                                 } else {
1239                                         kernbuffer[0] = buf[0];
1240                                         kernbuffer[1] = buf[1];
1241                                         kernbuffer[2] = buf[2];
1242                                 }
1243                         }
1244                         return ret;
1245
1246                 default:
1247                         ret |= sisusb_read_memio_long(sisusb, SISUSB_TYPE_MEM,
1248                                                                 addr, &swap32);
1249                         if (!ret) {
1250                                 (*bytes_read) += 4;
1251                                 if (userbuffer) {
1252                                         if (put_user(swap32,
1253                                                 (u32 __user *)userbuffer))
1254                                                 return -EFAULT;
1255
1256                                         userbuffer += 4;
1257                                 } else {
1258                                         *((u32 *)kernbuffer) = swap32;
1259                                         kernbuffer += 4;
1260                                 }
1261                                 addr += 4;
1262                                 length -= 4;
1263                         }
1264 #if 0           /* That does not work, as EP 2 is an OUT EP! */
1265                 default:
1266                         CLEARPACKET(&packet);
1267                         packet.header  = 0x001f;
1268                         packet.address = 0x000001a0;
1269                         packet.data    = 0x00000006;
1270                         ret |= sisusb_send_bridge_packet(sisusb, 10,
1271                                                                 &packet, 0);
1272                         packet.header  = 0x001f;
1273                         packet.address = 0x000001b0;
1274                         packet.data    = (length & ~3) | 0x40000000;
1275                         ret |= sisusb_send_bridge_packet(sisusb, 10,
1276                                                                 &packet, 0);
1277                         packet.header  = 0x001f;
1278                         packet.address = 0x000001b4;
1279                         packet.data    = addr;
1280                         ret |= sisusb_send_bridge_packet(sisusb, 10,
1281                                                                 &packet, 0);
1282                         packet.header  = 0x001f;
1283                         packet.address = 0x000001a4;
1284                         packet.data    = 0x00000001;
1285                         ret |= sisusb_send_bridge_packet(sisusb, 10,
1286                                                                 &packet, 0);
1287                         if (userbuffer) {
1288                                 ret |= sisusb_recv_bulk_msg(sisusb,
1289                                                         SISUSB_EP_GFX_BULK_IN,
1290                                                         (length & ~3),
1291                                                         NULL, userbuffer,
1292                                                         bytes_read, 0);
1293                                 if (!ret) userbuffer += (*bytes_read);
1294                         } else {
1295                                 ret |= sisusb_recv_bulk_msg(sisusb,
1296                                                         SISUSB_EP_GFX_BULK_IN,
1297                                                         (length & ~3),
1298                                                         kernbuffer, NULL,
1299                                                         bytes_read, 0);
1300                                 if (!ret) kernbuffer += (*bytes_read);
1301                         }
1302                         addr += (*bytes_read);
1303                         length -= (*bytes_read);
1304 #endif
1305             }
1306
1307             if (ret)
1308                 break;
1309         }
1310
1311         return ret;
1312 }
1313
1314 /* High level: Gfx (indexed) register access */
1315
1316 #ifdef INCL_SISUSB_CON
1317 int
1318 sisusb_setreg(struct sisusb_usb_data *sisusb, int port, u8 data)
1319 {
1320         return sisusb_write_memio_byte(sisusb, SISUSB_TYPE_IO, port, data);
1321 }
1322
1323 int
1324 sisusb_getreg(struct sisusb_usb_data *sisusb, int port, u8 *data)
1325 {
1326         return sisusb_read_memio_byte(sisusb, SISUSB_TYPE_IO, port, data);
1327 }
1328 #endif
1329
1330 int
1331 sisusb_setidxreg(struct sisusb_usb_data *sisusb, int port, u8 index, u8 data)
1332 {
1333         int ret;
1334         ret = sisusb_write_memio_byte(sisusb, SISUSB_TYPE_IO, port, index);
1335         ret |= sisusb_write_memio_byte(sisusb, SISUSB_TYPE_IO, port + 1, data);
1336         return ret;
1337 }
1338
1339 int
1340 sisusb_getidxreg(struct sisusb_usb_data *sisusb, int port, u8 index, u8 *data)
1341 {
1342         int ret;
1343         ret = sisusb_write_memio_byte(sisusb, SISUSB_TYPE_IO, port, index);
1344         ret |= sisusb_read_memio_byte(sisusb, SISUSB_TYPE_IO, port + 1, data);
1345         return ret;
1346 }
1347
1348 int
1349 sisusb_setidxregandor(struct sisusb_usb_data *sisusb, int port, u8 idx,
1350                                                         u8 myand, u8 myor)
1351 {
1352         int ret;
1353         u8 tmp;
1354
1355         ret = sisusb_write_memio_byte(sisusb, SISUSB_TYPE_IO, port, idx);
1356         ret |= sisusb_read_memio_byte(sisusb, SISUSB_TYPE_IO, port + 1, &tmp);
1357         tmp &= myand;
1358         tmp |= myor;
1359         ret |= sisusb_write_memio_byte(sisusb, SISUSB_TYPE_IO, port + 1, tmp);
1360         return ret;
1361 }
1362
1363 static int
1364 sisusb_setidxregmask(struct sisusb_usb_data *sisusb, int port, u8 idx,
1365                                                         u8 data, u8 mask)
1366 {
1367         int ret;
1368         u8 tmp;
1369         ret = sisusb_write_memio_byte(sisusb, SISUSB_TYPE_IO, port, idx);
1370         ret |= sisusb_read_memio_byte(sisusb, SISUSB_TYPE_IO, port + 1, &tmp);
1371         tmp &= ~(mask);
1372         tmp |= (data & mask);
1373         ret |= sisusb_write_memio_byte(sisusb, SISUSB_TYPE_IO, port + 1, tmp);
1374         return ret;
1375 }
1376
1377 int
1378 sisusb_setidxregor(struct sisusb_usb_data *sisusb, int port, u8 index, u8 myor)
1379 {
1380         return(sisusb_setidxregandor(sisusb, port, index, 0xff, myor));
1381 }
1382
1383 int
1384 sisusb_setidxregand(struct sisusb_usb_data *sisusb, int port, u8 idx, u8 myand)
1385 {
1386         return(sisusb_setidxregandor(sisusb, port, idx, myand, 0x00));
1387 }
1388
1389 /* Write/read video ram */
1390
1391 #ifdef INCL_SISUSB_CON
1392 int
1393 sisusb_writeb(struct sisusb_usb_data *sisusb, u32 adr, u8 data)
1394 {
1395         return(sisusb_write_memio_byte(sisusb, SISUSB_TYPE_MEM, adr, data));
1396 }
1397
1398 int
1399 sisusb_readb(struct sisusb_usb_data *sisusb, u32 adr, u8 *data)
1400 {
1401         return(sisusb_read_memio_byte(sisusb, SISUSB_TYPE_MEM, adr, data));
1402 }
1403
1404 #if 0
1405
1406 int
1407 sisusb_writew(struct sisusb_usb_data *sisusb, u32 adr, u16 data)
1408 {
1409         return(sisusb_write_memio_word(sisusb, SISUSB_TYPE_MEM, adr, data));
1410 }
1411
1412 int
1413 sisusb_readw(struct sisusb_usb_data *sisusb, u32 adr, u16 *data)
1414 {
1415         return(sisusb_read_memio_word(sisusb, SISUSB_TYPE_MEM, adr, data));
1416 }
1417
1418 #endif  /*  0  */
1419
1420 int
1421 sisusb_copy_memory(struct sisusb_usb_data *sisusb, char *src,
1422                         u32 dest, int length, size_t *bytes_written)
1423 {
1424         return(sisusb_write_mem_bulk(sisusb, dest, src, length, NULL, 0, bytes_written));
1425 }
1426
1427 #ifdef SISUSBENDIANTEST
1428 int
1429 sisusb_read_memory(struct sisusb_usb_data *sisusb, char *dest,
1430                         u32 src, int length, size_t *bytes_written)
1431 {
1432         return(sisusb_read_mem_bulk(sisusb, src, dest, length, NULL, bytes_written));
1433 }
1434 #endif
1435 #endif
1436
1437 #ifdef SISUSBENDIANTEST
1438 static void
1439 sisusb_testreadwrite(struct sisusb_usb_data *sisusb)
1440 {
1441     static char srcbuffer[] = { 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77 };
1442     char destbuffer[10];
1443     size_t dummy;
1444     int i,j;
1445
1446     sisusb_copy_memory(sisusb, srcbuffer, sisusb->vrambase, 7, &dummy);
1447
1448     for(i = 1; i <= 7; i++) {
1449         printk(KERN_DEBUG "sisusb: rwtest %d bytes\n", i);
1450         sisusb_read_memory(sisusb, destbuffer, sisusb->vrambase, i, &dummy);
1451         for(j = 0; j < i; j++) {
1452              printk(KERN_DEBUG "sisusb: rwtest read[%d] = %x\n", j, destbuffer[j]);
1453         }
1454     }
1455 }
1456 #endif
1457
1458 /* access pci config registers (reg numbers 0, 4, 8, etc) */
1459
1460 static int
1461 sisusb_write_pci_config(struct sisusb_usb_data *sisusb, int regnum, u32 data)
1462 {
1463         struct sisusb_packet packet;
1464         int ret;
1465
1466         packet.header = 0x008f;
1467         packet.address = regnum | 0x10000;
1468         packet.data = data;
1469         ret = sisusb_send_packet(sisusb, 10, &packet);
1470         return ret;
1471 }
1472
1473 static int
1474 sisusb_read_pci_config(struct sisusb_usb_data *sisusb, int regnum, u32 *data)
1475 {
1476         struct sisusb_packet packet;
1477         int ret;
1478
1479         packet.header = 0x008f;
1480         packet.address = (u32)regnum | 0x10000;
1481         ret = sisusb_send_packet(sisusb, 6, &packet);
1482         *data = packet.data;
1483         return ret;
1484 }
1485
1486 /* Clear video RAM */
1487
1488 static int
1489 sisusb_clear_vram(struct sisusb_usb_data *sisusb, u32 address, int length)
1490 {
1491         int ret, i;
1492         ssize_t j;
1493
1494         if (address < sisusb->vrambase)
1495                 return 1;
1496
1497         if (address >= sisusb->vrambase + sisusb->vramsize)
1498                 return 1;
1499
1500         if (address + length > sisusb->vrambase + sisusb->vramsize)
1501                 length = sisusb->vrambase + sisusb->vramsize - address;
1502
1503         if (length <= 0)
1504                 return 0;
1505
1506         /* allocate free buffer/urb and clear the buffer */
1507         if ((i = sisusb_alloc_outbuf(sisusb)) < 0)
1508                 return -EBUSY;
1509
1510         memset(sisusb->obuf[i], 0, sisusb->obufsize);
1511
1512         /* We can write a length > buffer size here. The buffer
1513          * data will simply be re-used (like a ring-buffer).
1514          */
1515         ret = sisusb_write_mem_bulk(sisusb, address, NULL, length, NULL, i, &j);
1516
1517         /* Free the buffer/urb */
1518         sisusb_free_outbuf(sisusb, i);
1519
1520         return ret;
1521 }
1522
1523 /* Initialize the graphics core (return 0 on success)
1524  * This resets the graphics hardware and puts it into
1525  * a defined mode (640x480@60Hz)
1526  */
1527
1528 #define GETREG(r,d)     sisusb_read_memio_byte(sisusb, SISUSB_TYPE_IO, r, d)
1529 #define SETREG(r,d)     sisusb_write_memio_byte(sisusb, SISUSB_TYPE_IO, r, d)
1530 #define SETIREG(r,i,d)  sisusb_setidxreg(sisusb, r, i, d)
1531 #define GETIREG(r,i,d)  sisusb_getidxreg(sisusb, r, i, d)
1532 #define SETIREGOR(r,i,o)        sisusb_setidxregor(sisusb, r, i, o)
1533 #define SETIREGAND(r,i,a)       sisusb_setidxregand(sisusb, r, i, a)
1534 #define SETIREGANDOR(r,i,a,o)   sisusb_setidxregandor(sisusb, r, i, a, o)
1535 #define READL(a,d)      sisusb_read_memio_long(sisusb, SISUSB_TYPE_MEM, a, d)
1536 #define WRITEL(a,d)     sisusb_write_memio_long(sisusb, SISUSB_TYPE_MEM, a, d)
1537 #define READB(a,d)      sisusb_read_memio_byte(sisusb, SISUSB_TYPE_MEM, a, d)
1538 #define WRITEB(a,d)     sisusb_write_memio_byte(sisusb, SISUSB_TYPE_MEM, a, d)
1539
1540 static int
1541 sisusb_triggersr16(struct sisusb_usb_data *sisusb, u8 ramtype)
1542 {
1543         int ret;
1544         u8 tmp8;
1545
1546         ret = GETIREG(SISSR, 0x16, &tmp8);
1547         if (ramtype <= 1) {
1548                 tmp8 &= 0x3f;
1549                 ret |= SETIREG(SISSR, 0x16, tmp8);
1550                 tmp8 |= 0x80;
1551                 ret |= SETIREG(SISSR, 0x16, tmp8);
1552         } else {
1553                 tmp8 |= 0xc0;
1554                 ret |= SETIREG(SISSR, 0x16, tmp8);
1555                 tmp8 &= 0x0f;
1556                 ret |= SETIREG(SISSR, 0x16, tmp8);
1557                 tmp8 |= 0x80;
1558                 ret |= SETIREG(SISSR, 0x16, tmp8);
1559                 tmp8 &= 0x0f;
1560                 ret |= SETIREG(SISSR, 0x16, tmp8);
1561                 tmp8 |= 0xd0;
1562                 ret |= SETIREG(SISSR, 0x16, tmp8);
1563                 tmp8 &= 0x0f;
1564                 ret |= SETIREG(SISSR, 0x16, tmp8);
1565                 tmp8 |= 0xa0;
1566                 ret |= SETIREG(SISSR, 0x16, tmp8);
1567         }
1568         return ret;
1569 }
1570
1571 static int
1572 sisusb_getbuswidth(struct sisusb_usb_data *sisusb, int *bw, int *chab)
1573 {
1574         int ret;
1575         u8  ramtype, done = 0;
1576         u32 t0, t1, t2, t3;
1577         u32 ramptr = SISUSB_PCI_MEMBASE;
1578
1579         ret = GETIREG(SISSR, 0x3a, &ramtype);
1580         ramtype &= 3;
1581
1582         ret |= SETIREG(SISSR, 0x13, 0x00);
1583
1584         if (ramtype <= 1) {
1585                 ret |= SETIREG(SISSR, 0x14, 0x12);
1586                 ret |= SETIREGAND(SISSR, 0x15, 0xef);
1587         } else {
1588                 ret |= SETIREG(SISSR, 0x14, 0x02);
1589         }
1590
1591         ret |= sisusb_triggersr16(sisusb, ramtype);
1592         ret |= WRITEL(ramptr +  0, 0x01234567);
1593         ret |= WRITEL(ramptr +  4, 0x456789ab);
1594         ret |= WRITEL(ramptr +  8, 0x89abcdef);
1595         ret |= WRITEL(ramptr + 12, 0xcdef0123);
1596         ret |= WRITEL(ramptr + 16, 0x55555555);
1597         ret |= WRITEL(ramptr + 20, 0x55555555);
1598         ret |= WRITEL(ramptr + 24, 0xffffffff);
1599         ret |= WRITEL(ramptr + 28, 0xffffffff);
1600         ret |= READL(ramptr +  0, &t0);
1601         ret |= READL(ramptr +  4, &t1);
1602         ret |= READL(ramptr +  8, &t2);
1603         ret |= READL(ramptr + 12, &t3);
1604
1605         if (ramtype <= 1) {
1606
1607                 *chab = 0; *bw = 64;
1608
1609                 if ((t3 != 0xcdef0123) || (t2 != 0x89abcdef)) {
1610                         if ((t1 == 0x456789ab) && (t0 == 0x01234567)) {
1611                                 *chab = 0; *bw = 64;
1612                                 ret |= SETIREGAND(SISSR, 0x14, 0xfd);
1613                         }
1614                 }
1615                 if ((t1 != 0x456789ab) || (t0 != 0x01234567)) {
1616                         *chab = 1; *bw = 64;
1617                         ret |= SETIREGANDOR(SISSR, 0x14, 0xfc,0x01);
1618
1619                         ret |= sisusb_triggersr16(sisusb, ramtype);
1620                         ret |= WRITEL(ramptr +  0, 0x89abcdef);
1621                         ret |= WRITEL(ramptr +  4, 0xcdef0123);
1622                         ret |= WRITEL(ramptr +  8, 0x55555555);
1623                         ret |= WRITEL(ramptr + 12, 0x55555555);
1624                         ret |= WRITEL(ramptr + 16, 0xaaaaaaaa);
1625                         ret |= WRITEL(ramptr + 20, 0xaaaaaaaa);
1626                         ret |= READL(ramptr +  4, &t1);
1627
1628                         if (t1 != 0xcdef0123) {
1629                                 *bw = 32;
1630                                 ret |= SETIREGOR(SISSR, 0x15, 0x10);
1631                         }
1632                 }
1633
1634         } else {
1635
1636                 *chab = 0; *bw = 64;    /* default: cha, bw = 64 */
1637
1638                 done = 0;
1639
1640                 if (t1 == 0x456789ab) {
1641                         if (t0 == 0x01234567) {
1642                                 *chab = 0; *bw = 64;
1643                                 done = 1;
1644                         }
1645                 } else {
1646                         if (t0 == 0x01234567) {
1647                                 *chab = 0; *bw = 32;
1648                                 ret |= SETIREG(SISSR, 0x14, 0x00);
1649                                 done = 1;
1650                         }
1651                 }
1652
1653                 if (!done) {
1654                         ret |= SETIREG(SISSR, 0x14, 0x03);
1655                         ret |= sisusb_triggersr16(sisusb, ramtype);
1656
1657                         ret |= WRITEL(ramptr +  0, 0x01234567);
1658                         ret |= WRITEL(ramptr +  4, 0x456789ab);
1659                         ret |= WRITEL(ramptr +  8, 0x89abcdef);
1660                         ret |= WRITEL(ramptr + 12, 0xcdef0123);
1661                         ret |= WRITEL(ramptr + 16, 0x55555555);
1662                         ret |= WRITEL(ramptr + 20, 0x55555555);
1663                         ret |= WRITEL(ramptr + 24, 0xffffffff);
1664                         ret |= WRITEL(ramptr + 28, 0xffffffff);
1665                         ret |= READL(ramptr +  0, &t0);
1666                         ret |= READL(ramptr +  4, &t1);
1667
1668                         if (t1 == 0x456789ab) {
1669                                 if (t0 == 0x01234567) {
1670                                         *chab = 1; *bw = 64;
1671                                         return ret;
1672                                 } /* else error */
1673                         } else {
1674                                 if (t0 == 0x01234567) {
1675                                         *chab = 1; *bw = 32;
1676                                         ret |= SETIREG(SISSR, 0x14, 0x01);
1677                                 } /* else error */
1678                         }
1679                 }
1680         }
1681         return ret;
1682 }
1683
1684 static int
1685 sisusb_verify_mclk(struct sisusb_usb_data *sisusb)
1686 {
1687         int ret = 0;
1688         u32 ramptr = SISUSB_PCI_MEMBASE;
1689         u8 tmp1, tmp2, i, j;
1690
1691         ret |= WRITEB(ramptr, 0xaa);
1692         ret |= WRITEB(ramptr + 16, 0x55);
1693         ret |= READB(ramptr, &tmp1);
1694         ret |= READB(ramptr + 16, &tmp2);
1695         if ((tmp1 != 0xaa) || (tmp2 != 0x55)) {
1696                 for (i = 0, j = 16; i < 2; i++, j += 16) {
1697                         ret |= GETIREG(SISSR, 0x21, &tmp1);
1698                         ret |= SETIREGAND(SISSR, 0x21, (tmp1 & 0xfb));
1699                         ret |= SETIREGOR(SISSR, 0x3c, 0x01);  /* not on 330 */
1700                         ret |= SETIREGAND(SISSR, 0x3c, 0xfe); /* not on 330 */
1701                         ret |= SETIREG(SISSR, 0x21, tmp1);
1702                         ret |= WRITEB(ramptr + 16 + j, j);
1703                         ret |= READB(ramptr + 16 + j, &tmp1);
1704                         if (tmp1 == j) {
1705                                 ret |= WRITEB(ramptr + j, j);
1706                                 break;
1707                         }
1708                 }
1709         }
1710         return ret;
1711 }
1712
1713 static int
1714 sisusb_set_rank(struct sisusb_usb_data *sisusb, int *iret, int index,
1715                         u8 rankno, u8 chab, const u8 dramtype[][5],
1716                         int bw)
1717 {
1718         int ret = 0, ranksize;
1719         u8 tmp;
1720
1721         *iret = 0;
1722
1723         if ((rankno == 2) && (dramtype[index][0] == 2))
1724                 return ret;
1725
1726         ranksize = dramtype[index][3] / 2 * bw / 32;
1727
1728         if ((ranksize * rankno) > 128)
1729                 return ret;
1730
1731         tmp = 0;
1732         while ((ranksize >>= 1) > 0) tmp += 0x10;
1733         tmp |= ((rankno - 1) << 2);
1734         tmp |= ((bw / 64) & 0x02);
1735         tmp |= (chab & 0x01);
1736
1737         ret = SETIREG(SISSR, 0x14, tmp);
1738         ret |= sisusb_triggersr16(sisusb, 0); /* sic! */
1739
1740         *iret = 1;
1741
1742         return ret;
1743 }
1744
1745 static int
1746 sisusb_check_rbc(struct sisusb_usb_data *sisusb, int *iret, u32 inc, int testn)
1747 {
1748         int ret = 0, i;
1749         u32 j, tmp;
1750
1751         *iret = 0;
1752
1753         for (i = 0, j = 0; i < testn; i++) {
1754                 ret |= WRITEL(sisusb->vrambase + j, j);
1755                 j += inc;
1756         }
1757
1758         for (i = 0, j = 0; i < testn; i++) {
1759                 ret |= READL(sisusb->vrambase + j, &tmp);
1760                 if (tmp != j) return ret;
1761                 j += inc;
1762         }
1763
1764         *iret = 1;
1765         return ret;
1766 }
1767
1768 static int
1769 sisusb_check_ranks(struct sisusb_usb_data *sisusb, int *iret, int rankno,
1770                                         int idx, int bw, const u8 rtype[][5])
1771 {
1772         int ret = 0, i, i2ret;
1773         u32 inc;
1774
1775         *iret = 0;
1776
1777         for (i = rankno; i >= 1; i--) {
1778                 inc = 1 << (rtype[idx][2] +
1779                             rtype[idx][1] +
1780                             rtype[idx][0] +
1781                             bw / 64 + i);
1782                 ret |= sisusb_check_rbc(sisusb, &i2ret, inc, 2);
1783                 if (!i2ret)
1784                         return ret;
1785         }
1786
1787         inc = 1 << (rtype[idx][2] + bw / 64 + 2);
1788         ret |= sisusb_check_rbc(sisusb, &i2ret, inc, 4);
1789         if (!i2ret)
1790                 return ret;
1791
1792         inc = 1 << (10 + bw / 64);
1793         ret |= sisusb_check_rbc(sisusb, &i2ret, inc, 2);
1794         if (!i2ret)
1795                 return ret;
1796
1797         *iret = 1;
1798         return ret;
1799 }
1800
1801 static int
1802 sisusb_get_sdram_size(struct sisusb_usb_data *sisusb, int *iret, int bw,
1803                                                                 int chab)
1804 {
1805         int ret = 0, i2ret = 0, i, j;
1806         static const u8 sdramtype[13][5] = {
1807                 { 2, 12, 9, 64, 0x35 },
1808                 { 1, 13, 9, 64, 0x44 },
1809                 { 2, 12, 8, 32, 0x31 },
1810                 { 2, 11, 9, 32, 0x25 },
1811                 { 1, 12, 9, 32, 0x34 },
1812                 { 1, 13, 8, 32, 0x40 },
1813                 { 2, 11, 8, 16, 0x21 },
1814                 { 1, 12, 8, 16, 0x30 },
1815                 { 1, 11, 9, 16, 0x24 },
1816                 { 1, 11, 8,  8, 0x20 },
1817                 { 2,  9, 8,  4, 0x01 },
1818                 { 1, 10, 8,  4, 0x10 },
1819                 { 1,  9, 8,  2, 0x00 }
1820         };
1821
1822         *iret = 1; /* error */
1823
1824         for (i = 0; i < 13; i++) {
1825                 ret |= SETIREGANDOR(SISSR, 0x13, 0x80, sdramtype[i][4]);
1826                 for (j = 2; j > 0; j--) {
1827                         ret |= sisusb_set_rank(sisusb, &i2ret, i, j,
1828                                                 chab, sdramtype, bw);
1829                         if (!i2ret)
1830                                 continue;
1831
1832                         ret |= sisusb_check_ranks(sisusb, &i2ret, j, i,
1833                                                 bw, sdramtype);
1834                         if (i2ret) {
1835                                 *iret = 0;      /* ram size found */
1836                                 return ret;
1837                         }
1838                 }
1839         }
1840
1841         return ret;
1842 }
1843
1844 static int
1845 sisusb_setup_screen(struct sisusb_usb_data *sisusb, int clrall, int drwfr)
1846 {
1847         int ret = 0;
1848         u32 address;
1849         int i, length, modex, modey, bpp;
1850
1851         modex = 640; modey = 480; bpp = 2;
1852
1853         address = sisusb->vrambase;     /* Clear video ram */
1854
1855         if (clrall)
1856                 length = sisusb->vramsize;
1857         else
1858                 length = modex * bpp * modey;
1859
1860         ret = sisusb_clear_vram(sisusb, address, length);
1861
1862         if (!ret && drwfr) {
1863                 for (i = 0; i < modex; i++) {
1864                         address = sisusb->vrambase + (i * bpp);
1865                         ret |= sisusb_write_memio_word(sisusb, SISUSB_TYPE_MEM,
1866                                                         address, 0xf100);
1867                         address += (modex * (modey-1) * bpp);
1868                         ret |= sisusb_write_memio_word(sisusb, SISUSB_TYPE_MEM,
1869                                                         address, 0xf100);
1870                 }
1871                 for (i = 0; i < modey; i++) {
1872                         address = sisusb->vrambase + ((i * modex) * bpp);
1873                         ret |= sisusb_write_memio_word(sisusb, SISUSB_TYPE_MEM,
1874                                                         address, 0xf100);
1875                         address += ((modex - 1) * bpp);
1876                         ret |= sisusb_write_memio_word(sisusb, SISUSB_TYPE_MEM,
1877                                                         address, 0xf100);
1878                 }
1879         }
1880
1881         return ret;
1882 }
1883
1884 static int
1885 sisusb_set_default_mode(struct sisusb_usb_data *sisusb, int touchengines)
1886 {
1887         int ret = 0, i, j, modex, modey, bpp, du;
1888         u8 sr31, cr63, tmp8;
1889         static const char attrdata[] = {
1890                 0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,
1891                 0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f,
1892                 0x01,0x00,0x00,0x00
1893         };
1894         static const char crtcrdata[] = {
1895                 0x5f,0x4f,0x50,0x82,0x54,0x80,0x0b,0x3e,
1896                 0x00,0x40,0x00,0x00,0x00,0x00,0x00,0x00,
1897                 0xea,0x8c,0xdf,0x28,0x40,0xe7,0x04,0xa3,
1898                 0xff
1899         };
1900         static const char grcdata[] = {
1901                 0x00,0x00,0x00,0x00,0x00,0x40,0x05,0x0f,
1902                 0xff
1903         };
1904         static const char crtcdata[] = {
1905                 0x5f,0x4f,0x4f,0x83,0x55,0x81,0x0b,0x3e,
1906                 0xe9,0x8b,0xdf,0xe8,0x0c,0x00,0x00,0x05,
1907                 0x00
1908         };
1909
1910         modex = 640; modey = 480; bpp = 2;
1911
1912         GETIREG(SISSR, 0x31, &sr31);
1913         GETIREG(SISCR, 0x63, &cr63);
1914         SETIREGOR(SISSR, 0x01, 0x20);
1915         SETIREG(SISCR, 0x63, cr63 & 0xbf);
1916         SETIREGOR(SISCR, 0x17, 0x80);
1917         SETIREGOR(SISSR, 0x1f, 0x04);
1918         SETIREGAND(SISSR, 0x07, 0xfb);
1919         SETIREG(SISSR, 0x00, 0x03);     /* seq */
1920         SETIREG(SISSR, 0x01, 0x21);
1921         SETIREG(SISSR, 0x02, 0x0f);
1922         SETIREG(SISSR, 0x03, 0x00);
1923         SETIREG(SISSR, 0x04, 0x0e);
1924         SETREG(SISMISCW, 0x23);         /* misc */
1925         for (i = 0; i <= 0x18; i++) {   /* crtc */
1926                 SETIREG(SISCR, i, crtcrdata[i]);
1927         }
1928         for (i = 0; i <= 0x13; i++) {   /* att */
1929                 GETREG(SISINPSTAT, &tmp8);
1930                 SETREG(SISAR, i);
1931                 SETREG(SISAR, attrdata[i]);
1932         }
1933         GETREG(SISINPSTAT, &tmp8);
1934         SETREG(SISAR, 0x14);
1935         SETREG(SISAR, 0x00);
1936         GETREG(SISINPSTAT, &tmp8);
1937         SETREG(SISAR, 0x20);
1938         GETREG(SISINPSTAT, &tmp8);
1939         for (i = 0; i <= 0x08; i++) {   /* grc */
1940                 SETIREG(SISGR, i, grcdata[i]);
1941         }
1942         SETIREGAND(SISGR, 0x05, 0xbf);
1943         for (i = 0x0A; i <= 0x0E; i++) {        /* clr ext */
1944                 SETIREG(SISSR, i, 0x00);
1945         }
1946         SETIREGAND(SISSR, 0x37, 0xfe);
1947         SETREG(SISMISCW, 0xef);         /* sync */
1948         SETIREG(SISCR, 0x11, 0x00);     /* crtc */
1949         for (j = 0x00, i = 0; i <= 7; i++, j++) {
1950                 SETIREG(SISCR, j, crtcdata[i]);
1951         }
1952         for (j = 0x10; i <= 10; i++, j++) {
1953                 SETIREG(SISCR, j, crtcdata[i]);
1954         }
1955         for (j = 0x15; i <= 12; i++, j++) {
1956                 SETIREG(SISCR, j, crtcdata[i]);
1957         }
1958         for (j = 0x0A; i <= 15; i++, j++) {
1959                 SETIREG(SISSR, j, crtcdata[i]);
1960         }
1961         SETIREG(SISSR, 0x0E, (crtcdata[16] & 0xE0));
1962         SETIREGANDOR(SISCR, 0x09, 0x5f, ((crtcdata[16] & 0x01) << 5));
1963         SETIREG(SISCR, 0x14, 0x4f);
1964         du = (modex / 16) * (bpp * 2);  /* offset/pitch */
1965         if (modex % 16) du += bpp;
1966         SETIREGANDOR(SISSR, 0x0e, 0xf0, ((du >> 8) & 0x0f));
1967         SETIREG(SISCR, 0x13, (du & 0xff));
1968         du <<= 5;
1969         tmp8 = du >> 8;
1970         if (du & 0xff) tmp8++;
1971         SETIREG(SISSR, 0x10, tmp8);
1972         SETIREG(SISSR, 0x31, 0x00);     /* VCLK */
1973         SETIREG(SISSR, 0x2b, 0x1b);
1974         SETIREG(SISSR, 0x2c, 0xe1);
1975         SETIREG(SISSR, 0x2d, 0x01);
1976         SETIREGAND(SISSR, 0x3d, 0xfe);  /* FIFO */
1977         SETIREG(SISSR, 0x08, 0xae);
1978         SETIREGAND(SISSR, 0x09, 0xf0);
1979         SETIREG(SISSR, 0x08, 0x34);
1980         SETIREGOR(SISSR, 0x3d, 0x01);
1981         SETIREGAND(SISSR, 0x1f, 0x3f);  /* mode regs */
1982         SETIREGANDOR(SISSR, 0x06, 0xc0, 0x0a);
1983         SETIREG(SISCR, 0x19, 0x00);
1984         SETIREGAND(SISCR, 0x1a, 0xfc);
1985         SETIREGAND(SISSR, 0x0f, 0xb7);
1986         SETIREGAND(SISSR, 0x31, 0xfb);
1987         SETIREGANDOR(SISSR, 0x21, 0x1f, 0xa0);
1988         SETIREGAND(SISSR, 0x32, 0xf3);
1989         SETIREGANDOR(SISSR, 0x07, 0xf8, 0x03);
1990         SETIREG(SISCR, 0x52, 0x6c);
1991
1992         SETIREG(SISCR, 0x0d, 0x00);     /* adjust frame */
1993         SETIREG(SISCR, 0x0c, 0x00);
1994         SETIREG(SISSR, 0x0d, 0x00);
1995         SETIREGAND(SISSR, 0x37, 0xfe);
1996
1997         SETIREG(SISCR, 0x32, 0x20);
1998         SETIREGAND(SISSR, 0x01, 0xdf);  /* enable display */
1999         SETIREG(SISCR, 0x63, (cr63 & 0xbf));
2000         SETIREG(SISSR, 0x31, (sr31 & 0xfb));
2001
2002         if (touchengines) {
2003                 SETIREG(SISSR, 0x20, 0xa1);     /* enable engines */
2004                 SETIREGOR(SISSR, 0x1e, 0x5a);
2005
2006                 SETIREG(SISSR, 0x26, 0x01);     /* disable cmdqueue */
2007                 SETIREG(SISSR, 0x27, 0x1f);
2008                 SETIREG(SISSR, 0x26, 0x00);
2009         }
2010
2011         SETIREG(SISCR, 0x34, 0x44);     /* we just set std mode #44 */
2012
2013         return ret;
2014 }
2015
2016 static int
2017 sisusb_init_gfxcore(struct sisusb_usb_data *sisusb)
2018 {
2019         int ret = 0, i, j, bw, chab, iret, retry = 3;
2020         u8 tmp8, ramtype;
2021         u32 tmp32;
2022         static const char mclktable[] = {
2023                 0x3b, 0x22, 0x01, 143,
2024                 0x3b, 0x22, 0x01, 143,
2025                 0x3b, 0x22, 0x01, 143,
2026                 0x3b, 0x22, 0x01, 143
2027         };
2028         static const char eclktable[] = {
2029                 0x3b, 0x22, 0x01, 143,
2030                 0x3b, 0x22, 0x01, 143,
2031                 0x3b, 0x22, 0x01, 143,
2032                 0x3b, 0x22, 0x01, 143
2033         };
2034         static const char ramtypetable1[] = {
2035                 0x00, 0x04, 0x60, 0x60,
2036                 0x0f, 0x0f, 0x1f, 0x1f,
2037                 0xba, 0xba, 0xba, 0xba,
2038                 0xa9, 0xa9, 0xac, 0xac,
2039                 0xa0, 0xa0, 0xa0, 0xa8,
2040                 0x00, 0x00, 0x02, 0x02,
2041                 0x30, 0x30, 0x40, 0x40
2042         };
2043         static const char ramtypetable2[] = {
2044                 0x77, 0x77, 0x44, 0x44,
2045                 0x77, 0x77, 0x44, 0x44,
2046                 0x00, 0x00, 0x00, 0x00,
2047                 0x5b, 0x5b, 0xab, 0xab,
2048                 0x00, 0x00, 0xf0, 0xf8
2049         };
2050
2051         while (retry--) {
2052
2053                 /* Enable VGA */
2054                 ret = GETREG(SISVGAEN, &tmp8);
2055                 ret |= SETREG(SISVGAEN, (tmp8 | 0x01));
2056
2057                 /* Enable GPU access to VRAM */
2058                 ret |= GETREG(SISMISCR, &tmp8);
2059                 ret |= SETREG(SISMISCW, (tmp8 | 0x01));
2060
2061                 if (ret) continue;
2062
2063                 /* Reset registers */
2064                 ret |= SETIREGAND(SISCR, 0x5b, 0xdf);
2065                 ret |= SETIREG(SISSR, 0x05, 0x86);
2066                 ret |= SETIREGOR(SISSR, 0x20, 0x01);
2067
2068                 ret |= SETREG(SISMISCW, 0x67);
2069
2070                 for (i = 0x06; i <= 0x1f; i++) {
2071                         ret |= SETIREG(SISSR, i, 0x00);
2072                 }
2073                 for (i = 0x21; i <= 0x27; i++) {
2074                         ret |= SETIREG(SISSR, i, 0x00);
2075                 }
2076                 for (i = 0x31; i <= 0x3d; i++) {
2077                         ret |= SETIREG(SISSR, i, 0x00);
2078                 }
2079                 for (i = 0x12; i <= 0x1b; i++) {
2080                         ret |= SETIREG(SISSR, i, 0x00);
2081                 }
2082                 for (i = 0x79; i <= 0x7c; i++) {
2083                         ret |= SETIREG(SISCR, i, 0x00);
2084                 }
2085
2086                 if (ret) continue;
2087
2088                 ret |= SETIREG(SISCR, 0x63, 0x80);
2089
2090                 ret |= GETIREG(SISSR, 0x3a, &ramtype);
2091                 ramtype &= 0x03;
2092
2093                 ret |= SETIREG(SISSR, 0x28, mclktable[ramtype * 4]);
2094                 ret |= SETIREG(SISSR, 0x29, mclktable[(ramtype * 4) + 1]);
2095                 ret |= SETIREG(SISSR, 0x2a, mclktable[(ramtype * 4) + 2]);
2096
2097                 ret |= SETIREG(SISSR, 0x2e, eclktable[ramtype * 4]);
2098                 ret |= SETIREG(SISSR, 0x2f, eclktable[(ramtype * 4) + 1]);
2099                 ret |= SETIREG(SISSR, 0x30, eclktable[(ramtype * 4) + 2]);
2100
2101                 ret |= SETIREG(SISSR, 0x07, 0x18);
2102                 ret |= SETIREG(SISSR, 0x11, 0x0f);
2103
2104                 if (ret) continue;
2105
2106                 for (i = 0x15, j = 0; i <= 0x1b; i++, j++) {
2107                         ret |= SETIREG(SISSR, i, ramtypetable1[(j*4) + ramtype]);
2108                 }
2109                 for (i = 0x40, j = 0; i <= 0x44; i++, j++) {
2110                         ret |= SETIREG(SISCR, i, ramtypetable2[(j*4) + ramtype]);
2111                 }
2112
2113                 ret |= SETIREG(SISCR, 0x49, 0xaa);
2114
2115                 ret |= SETIREG(SISSR, 0x1f, 0x00);
2116                 ret |= SETIREG(SISSR, 0x20, 0xa0);
2117                 ret |= SETIREG(SISSR, 0x23, 0xf6);
2118                 ret |= SETIREG(SISSR, 0x24, 0x0d);
2119                 ret |= SETIREG(SISSR, 0x25, 0x33);
2120
2121                 ret |= SETIREG(SISSR, 0x11, 0x0f);
2122
2123                 ret |= SETIREGOR(SISPART1, 0x2f, 0x01);
2124
2125                 ret |= SETIREGAND(SISCAP, 0x3f, 0xef);
2126
2127                 if (ret) continue;
2128
2129                 ret |= SETIREG(SISPART1, 0x00, 0x00);
2130
2131                 ret |= GETIREG(SISSR, 0x13, &tmp8);
2132                 tmp8 >>= 4;
2133
2134                 ret |= SETIREG(SISPART1, 0x02, 0x00);
2135                 ret |= SETIREG(SISPART1, 0x2e, 0x08);
2136
2137                 ret |= sisusb_read_pci_config(sisusb, 0x50, &tmp32);
2138                 tmp32 &= 0x00f00000;
2139                 tmp8 = (tmp32 == 0x100000) ? 0x33 : 0x03;
2140                 ret |= SETIREG(SISSR, 0x25, tmp8);
2141                 tmp8 = (tmp32 == 0x100000) ? 0xaa : 0x88;
2142                 ret |= SETIREG(SISCR, 0x49, tmp8);
2143
2144                 ret |= SETIREG(SISSR, 0x27, 0x1f);
2145                 ret |= SETIREG(SISSR, 0x31, 0x00);
2146                 ret |= SETIREG(SISSR, 0x32, 0x11);
2147                 ret |= SETIREG(SISSR, 0x33, 0x00);
2148
2149                 if (ret) continue;
2150
2151                 ret |= SETIREG(SISCR, 0x83, 0x00);
2152
2153                 ret |= sisusb_set_default_mode(sisusb, 0);
2154
2155                 ret |= SETIREGAND(SISSR, 0x21, 0xdf);
2156                 ret |= SETIREGOR(SISSR, 0x01, 0x20);
2157                 ret |= SETIREGOR(SISSR, 0x16, 0x0f);
2158
2159                 ret |= sisusb_triggersr16(sisusb, ramtype);
2160
2161                 /* Disable refresh */
2162                 ret |= SETIREGAND(SISSR, 0x17, 0xf8);
2163                 ret |= SETIREGOR(SISSR, 0x19, 0x03);
2164
2165                 ret |= sisusb_getbuswidth(sisusb, &bw, &chab);
2166                 ret |= sisusb_verify_mclk(sisusb);
2167
2168                 if (ramtype <= 1) {
2169                         ret |= sisusb_get_sdram_size(sisusb, &iret, bw, chab);
2170                         if (iret) {
2171                                 printk(KERN_ERR "sisusbvga[%d]: RAM size "
2172                                         "detection failed, "
2173                                         "assuming 8MB video RAM\n",
2174                                         sisusb->minor);
2175                                 ret |= SETIREG(SISSR,0x14,0x31);
2176                                 /* TODO */
2177                         }
2178                 } else {
2179                         printk(KERN_ERR "sisusbvga[%d]: DDR RAM device found, "
2180                                         "assuming 8MB video RAM\n",
2181                                         sisusb->minor);
2182                         ret |= SETIREG(SISSR,0x14,0x31);
2183                         /* *** TODO *** */
2184                 }
2185
2186                 /* Enable refresh */
2187                 ret |= SETIREG(SISSR, 0x16, ramtypetable1[4 + ramtype]);
2188                 ret |= SETIREG(SISSR, 0x17, ramtypetable1[8 + ramtype]);
2189                 ret |= SETIREG(SISSR, 0x19, ramtypetable1[16 + ramtype]);
2190
2191                 ret |= SETIREGOR(SISSR, 0x21, 0x20);
2192
2193                 ret |= SETIREG(SISSR, 0x22, 0xfb);
2194                 ret |= SETIREG(SISSR, 0x21, 0xa5);
2195
2196                 if (ret == 0)
2197                         break;
2198         }
2199
2200         return ret;
2201 }
2202
2203 #undef SETREG
2204 #undef GETREG
2205 #undef SETIREG
2206 #undef GETIREG
2207 #undef SETIREGOR
2208 #undef SETIREGAND
2209 #undef SETIREGANDOR
2210 #undef READL
2211 #undef WRITEL
2212
2213 static void
2214 sisusb_get_ramconfig(struct sisusb_usb_data *sisusb)
2215 {
2216         u8 tmp8, tmp82, ramtype;
2217         int bw = 0;
2218         char *ramtypetext1 = NULL;
2219         const char *ramtypetext2[] = {  "SDR SDRAM", "SDR SGRAM",
2220                                         "DDR SDRAM", "DDR SGRAM" };
2221         static const int busSDR[4]  = {64, 64, 128, 128};
2222         static const int busDDR[4]  = {32, 32,  64,  64};
2223         static const int busDDRA[4] = {64+32, 64+32 , (64+32)*2, (64+32)*2};
2224
2225         sisusb_getidxreg(sisusb, SISSR, 0x14, &tmp8);
2226         sisusb_getidxreg(sisusb, SISSR, 0x15, &tmp82);
2227         sisusb_getidxreg(sisusb, SISSR, 0x3a, &ramtype);
2228         sisusb->vramsize = (1 << ((tmp8 & 0xf0) >> 4)) * 1024 * 1024;
2229         ramtype &= 0x03;
2230         switch ((tmp8 >> 2) & 0x03) {
2231         case 0: ramtypetext1 = "1 ch/1 r";
2232                 if (tmp82 & 0x10) {
2233                         bw = 32;
2234                 } else {
2235                         bw = busSDR[(tmp8 & 0x03)];
2236                 }
2237                 break;
2238         case 1: ramtypetext1 = "1 ch/2 r";
2239                 sisusb->vramsize <<= 1;
2240                 bw = busSDR[(tmp8 & 0x03)];
2241                 break;
2242         case 2: ramtypetext1 = "asymmeric";
2243                 sisusb->vramsize += sisusb->vramsize/2;
2244                 bw = busDDRA[(tmp8 & 0x03)];
2245                 break;
2246         case 3: ramtypetext1 = "2 channel";
2247                 sisusb->vramsize <<= 1;
2248                 bw = busDDR[(tmp8 & 0x03)];
2249                 break;
2250         }
2251
2252         printk(KERN_INFO "sisusbvga[%d]: %dMB %s %s, bus width %d\n",
2253                         sisusb->minor, (sisusb->vramsize >> 20), ramtypetext1,
2254                         ramtypetext2[ramtype], bw);
2255 }
2256
2257 static int
2258 sisusb_do_init_gfxdevice(struct sisusb_usb_data *sisusb)
2259 {
2260         struct sisusb_packet packet;
2261         int ret;
2262         u32 tmp32;
2263
2264         /* Do some magic */
2265         packet.header  = 0x001f;
2266         packet.address = 0x00000324;
2267         packet.data    = 0x00000004;
2268         ret = sisusb_send_bridge_packet(sisusb, 10, &packet, 0);
2269
2270         packet.header  = 0x001f;
2271         packet.address = 0x00000364;
2272         packet.data    = 0x00000004;
2273         ret |= sisusb_send_bridge_packet(sisusb, 10, &packet, 0);
2274
2275         packet.header  = 0x001f;
2276         packet.address = 0x00000384;
2277         packet.data    = 0x00000004;
2278         ret |= sisusb_send_bridge_packet(sisusb, 10, &packet, 0);
2279
2280         packet.header  = 0x001f;
2281         packet.address = 0x00000100;
2282         packet.data    = 0x00000700;
2283         ret |= sisusb_send_bridge_packet(sisusb, 10, &packet, 0);
2284
2285         packet.header  = 0x000f;
2286         packet.address = 0x00000004;
2287         ret |= sisusb_send_bridge_packet(sisusb, 6, &packet, 0);
2288         packet.data |= 0x17;
2289         ret |= sisusb_send_bridge_packet(sisusb, 10, &packet, 0);
2290
2291         /* Init BAR 0 (VRAM) */
2292         ret |= sisusb_read_pci_config(sisusb, 0x10, &tmp32);
2293         ret |= sisusb_write_pci_config(sisusb, 0x10, 0xfffffff0);
2294         ret |= sisusb_read_pci_config(sisusb, 0x10, &tmp32);
2295         tmp32 &= 0x0f;
2296         tmp32 |= SISUSB_PCI_MEMBASE;
2297         ret |= sisusb_write_pci_config(sisusb, 0x10, tmp32);
2298
2299         /* Init BAR 1 (MMIO) */
2300         ret |= sisusb_read_pci_config(sisusb, 0x14, &tmp32);
2301         ret |= sisusb_write_pci_config(sisusb, 0x14, 0xfffffff0);
2302         ret |= sisusb_read_pci_config(sisusb, 0x14, &tmp32);
2303         tmp32 &= 0x0f;
2304         tmp32 |= SISUSB_PCI_MMIOBASE;
2305         ret |= sisusb_write_pci_config(sisusb, 0x14, tmp32);
2306
2307         /* Init BAR 2 (i/o ports) */
2308         ret |= sisusb_read_pci_config(sisusb, 0x18, &tmp32);
2309         ret |= sisusb_write_pci_config(sisusb, 0x18, 0xfffffff0);
2310         ret |= sisusb_read_pci_config(sisusb, 0x18, &tmp32);
2311         tmp32 &= 0x0f;
2312         tmp32 |= SISUSB_PCI_IOPORTBASE;
2313         ret |= sisusb_write_pci_config(sisusb, 0x18, tmp32);
2314
2315         /* Enable memory and i/o access */
2316         ret |= sisusb_read_pci_config(sisusb, 0x04, &tmp32);
2317         tmp32 |= 0x3;
2318         ret |= sisusb_write_pci_config(sisusb, 0x04, tmp32);
2319
2320         if (ret == 0) {
2321                 /* Some further magic */
2322                 packet.header  = 0x001f;
2323                 packet.address = 0x00000050;
2324                 packet.data    = 0x000000ff;
2325                 ret |= sisusb_send_bridge_packet(sisusb, 10, &packet, 0);
2326         }
2327
2328         return ret;
2329 }
2330
2331 /* Initialize the graphics device (return 0 on success)
2332  * This initializes the net2280 as well as the PCI registers
2333  * of the graphics board.
2334  */
2335
2336 static int
2337 sisusb_init_gfxdevice(struct sisusb_usb_data *sisusb, int initscreen)
2338 {
2339         int ret = 0, test = 0;
2340         u32 tmp32;
2341
2342         if (sisusb->devinit == 1) {
2343                 /* Read PCI BARs and see if they have been set up */
2344                 ret |= sisusb_read_pci_config(sisusb, 0x10, &tmp32);
2345                 if (ret) return ret;
2346                 if ((tmp32 & 0xfffffff0) == SISUSB_PCI_MEMBASE) test++;
2347
2348                 ret |= sisusb_read_pci_config(sisusb, 0x14, &tmp32);
2349                 if (ret) return ret;
2350                 if ((tmp32 & 0xfffffff0) == SISUSB_PCI_MMIOBASE) test++;
2351
2352                 ret |= sisusb_read_pci_config(sisusb, 0x18, &tmp32);
2353                 if (ret) return ret;
2354                 if ((tmp32 & 0xfffffff0) == SISUSB_PCI_IOPORTBASE) test++;
2355         }
2356
2357         /* No? So reset the device */
2358         if ((sisusb->devinit == 0) || (test != 3)) {
2359
2360                 ret |= sisusb_do_init_gfxdevice(sisusb);
2361
2362                 if (ret == 0)
2363                         sisusb->devinit = 1;
2364
2365         }
2366
2367         if (sisusb->devinit) {
2368                 /* Initialize the graphics core */
2369                 if (sisusb_init_gfxcore(sisusb) == 0) {
2370                         sisusb->gfxinit = 1;
2371                         sisusb_get_ramconfig(sisusb);
2372                         ret |= sisusb_set_default_mode(sisusb, 1);
2373                         ret |= sisusb_setup_screen(sisusb, 1, initscreen);
2374                 }
2375         }
2376
2377         return ret;
2378 }
2379
2380
2381 #ifdef INCL_SISUSB_CON
2382
2383 /* Set up default text mode:
2384    - Set text mode (0x03)
2385    - Upload default font
2386    - Upload user font (if available)
2387 */
2388
2389 int
2390 sisusb_reset_text_mode(struct sisusb_usb_data *sisusb, int init)
2391 {
2392         int ret = 0, slot = sisusb->font_slot, i;
2393         const struct font_desc *myfont;
2394         u8 *tempbuf;
2395         u16 *tempbufb;
2396         size_t written;
2397         static const char bootstring[] = "SiSUSB VGA text console, (C) 2005 Thomas Winischhofer.";
2398         static const char bootlogo[] = "(o_ //\\ V_/_";
2399
2400         /* sisusb->lock is down */
2401
2402         if (!sisusb->SiS_Pr)
2403                 return 1;
2404
2405         sisusb->SiS_Pr->IOAddress = SISUSB_PCI_IOPORTBASE + 0x30;
2406         sisusb->SiS_Pr->sisusb = (void *)sisusb;
2407
2408         /* Set mode 0x03 */
2409         SiSUSBSetMode(sisusb->SiS_Pr, 0x03);
2410
2411         if (!(myfont = find_font("VGA8x16")))
2412                 return 1;
2413
2414         if (!(tempbuf = vmalloc(8192)))
2415                 return 1;
2416
2417         for (i = 0; i < 256; i++)
2418                 memcpy(tempbuf + (i * 32), myfont->data + (i * 16), 16);
2419
2420         /* Upload default font */
2421         ret = sisusbcon_do_font_op(sisusb, 1, 0, tempbuf, 8192, 0, 1, NULL, 16, 0);
2422
2423         vfree(tempbuf);
2424
2425         /* Upload user font (and reset current slot) */
2426         if (sisusb->font_backup) {
2427                 ret |= sisusbcon_do_font_op(sisusb, 1, 2, sisusb->font_backup,
2428                                 8192, sisusb->font_backup_512, 1, NULL,
2429                                 sisusb->font_backup_height, 0);
2430                 if (slot != 2)
2431                         sisusbcon_do_font_op(sisusb, 1, 0, NULL, 0, 0, 1,
2432                                         NULL, 16, 0);
2433         }
2434
2435         if (init && !sisusb->scrbuf) {
2436
2437                 if ((tempbuf = vmalloc(8192))) {
2438
2439                         i = 4096;
2440                         tempbufb = (u16 *)tempbuf;
2441                         while (i--)
2442                                 *(tempbufb++) = 0x0720;
2443
2444                         i = 0;
2445                         tempbufb = (u16 *)tempbuf;
2446                         while (bootlogo[i]) {
2447                                 *(tempbufb++) = 0x0700 | bootlogo[i++];
2448                                 if (!(i % 4))
2449                                         tempbufb += 76;
2450                         }
2451
2452                         i = 0;
2453                         tempbufb = (u16 *)tempbuf + 6;
2454                         while (bootstring[i])
2455                                 *(tempbufb++) = 0x0700 | bootstring[i++];
2456
2457                         ret |= sisusb_copy_memory(sisusb, tempbuf,
2458                                 sisusb->vrambase, 8192, &written);
2459
2460                         vfree(tempbuf);
2461
2462                 }
2463
2464         } else if (sisusb->scrbuf) {
2465
2466                 ret |= sisusb_copy_memory(sisusb, (char *)sisusb->scrbuf,
2467                                 sisusb->vrambase, sisusb->scrbuf_size, &written);
2468
2469         }
2470
2471         if (sisusb->sisusb_cursor_size_from >= 0 &&
2472             sisusb->sisusb_cursor_size_to >= 0) {
2473                 sisusb_setidxreg(sisusb, SISCR, 0x0a,
2474                                 sisusb->sisusb_cursor_size_from);
2475                 sisusb_setidxregandor(sisusb, SISCR, 0x0b, 0xe0,
2476                                 sisusb->sisusb_cursor_size_to);
2477         } else {
2478                 sisusb_setidxreg(sisusb, SISCR, 0x0a, 0x2d);
2479                 sisusb_setidxreg(sisusb, SISCR, 0x0b, 0x0e);
2480                 sisusb->sisusb_cursor_size_to = -1;
2481         }
2482
2483         slot = sisusb->sisusb_cursor_loc;
2484         if(slot < 0) slot = 0;
2485
2486         sisusb->sisusb_cursor_loc = -1;
2487         sisusb->bad_cursor_pos = 1;
2488
2489         sisusb_set_cursor(sisusb, slot);
2490
2491         sisusb_setidxreg(sisusb, SISCR, 0x0c, (sisusb->cur_start_addr >> 8));
2492         sisusb_setidxreg(sisusb, SISCR, 0x0d, (sisusb->cur_start_addr & 0xff));
2493
2494         sisusb->textmodedestroyed = 0;
2495
2496         /* sisusb->lock is down */
2497
2498         return ret;
2499 }
2500
2501 #endif
2502
2503 /* fops */
2504
2505 static int
2506 sisusb_open(struct inode *inode, struct file *file)
2507 {
2508         struct sisusb_usb_data *sisusb;
2509         struct usb_interface *interface;
2510         int subminor = iminor(inode);
2511
2512         if (!(interface = usb_find_interface(&sisusb_driver, subminor))) {
2513                 printk(KERN_ERR "sisusb[%d]: Failed to find interface\n",
2514                                 subminor);
2515                 return -ENODEV;
2516         }
2517
2518         if (!(sisusb = usb_get_intfdata(interface)))
2519                 return -ENODEV;
2520
2521         mutex_lock(&sisusb->lock);
2522
2523         if (!sisusb->present || !sisusb->ready) {
2524                 mutex_unlock(&sisusb->lock);
2525                 return -ENODEV;
2526         }
2527
2528         if (sisusb->isopen) {
2529                 mutex_unlock(&sisusb->lock);
2530                 return -EBUSY;
2531         }
2532
2533         if (!sisusb->devinit) {
2534                 if (sisusb->sisusb_dev->speed == USB_SPEED_HIGH) {
2535                         if (sisusb_init_gfxdevice(sisusb, 0)) {
2536                                 mutex_unlock(&sisusb->lock);
2537                                 printk(KERN_ERR
2538                                         "sisusbvga[%d]: Failed to initialize "
2539                                         "device\n",
2540                                         sisusb->minor);
2541                                 return -EIO;
2542                         }
2543                 } else {
2544                         mutex_unlock(&sisusb->lock);
2545                         printk(KERN_ERR
2546                                 "sisusbvga[%d]: Device not attached to "
2547                                 "USB 2.0 hub\n",
2548                                 sisusb->minor);
2549                         return -EIO;
2550                 }
2551         }
2552
2553         /* Increment usage count for our sisusb */
2554         kref_get(&sisusb->kref);
2555
2556         sisusb->isopen = 1;
2557
2558         file->private_data = sisusb;
2559
2560         mutex_unlock(&sisusb->lock);
2561
2562         return 0;
2563 }
2564
2565 void
2566 sisusb_delete(struct kref *kref)
2567 {
2568         struct sisusb_usb_data *sisusb = to_sisusb_dev(kref);
2569
2570         if (!sisusb)
2571                 return;
2572
2573         if (sisusb->sisusb_dev)
2574                 usb_put_dev(sisusb->sisusb_dev);
2575
2576         sisusb->sisusb_dev = NULL;
2577         sisusb_free_buffers(sisusb);
2578         sisusb_free_urbs(sisusb);
2579 #ifdef INCL_SISUSB_CON
2580         kfree(sisusb->SiS_Pr);
2581 #endif
2582         kfree(sisusb);
2583 }
2584
2585 static int
2586 sisusb_release(struct inode *inode, struct file *file)
2587 {
2588         struct sisusb_usb_data *sisusb;
2589         int myminor;
2590
2591         if (!(sisusb = (struct sisusb_usb_data *)file->private_data))
2592                 return -ENODEV;
2593
2594         mutex_lock(&sisusb->lock);
2595
2596         if (sisusb->present) {
2597                 /* Wait for all URBs to finish if device still present */
2598                 if (!sisusb_wait_all_out_complete(sisusb))
2599                         sisusb_kill_all_busy(sisusb);
2600         }
2601
2602         myminor = sisusb->minor;
2603
2604         sisusb->isopen = 0;
2605         file->private_data = NULL;
2606
2607         mutex_unlock(&sisusb->lock);
2608
2609         /* decrement the usage count on our device */
2610         kref_put(&sisusb->kref, sisusb_delete);
2611
2612         return 0;
2613 }
2614
2615 static ssize_t
2616 sisusb_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
2617 {
2618         struct sisusb_usb_data *sisusb;
2619         ssize_t bytes_read = 0;
2620         int errno = 0;
2621         u8 buf8;
2622         u16 buf16;
2623         u32 buf32, address;
2624
2625         if (!(sisusb = (struct sisusb_usb_data *)file->private_data))
2626                 return -ENODEV;
2627
2628         mutex_lock(&sisusb->lock);
2629
2630         /* Sanity check */
2631         if (!sisusb->present || !sisusb->ready || !sisusb->sisusb_dev) {
2632                 mutex_unlock(&sisusb->lock);
2633                 return -ENODEV;
2634         }
2635
2636         if ((*ppos) >= SISUSB_PCI_PSEUDO_IOPORTBASE &&
2637             (*ppos) <  SISUSB_PCI_PSEUDO_IOPORTBASE + 128) {
2638
2639                 address = (*ppos) -
2640                         SISUSB_PCI_PSEUDO_IOPORTBASE +
2641                         SISUSB_PCI_IOPORTBASE;
2642
2643                 /* Read i/o ports
2644                  * Byte, word and long(32) can be read. As this
2645                  * emulates inX instructions, the data returned is
2646                  * in machine-endianness.
2647                  */
2648                 switch (count) {
2649
2650                         case 1:
2651                                 if (sisusb_read_memio_byte(sisusb,
2652                                                         SISUSB_TYPE_IO,
2653                                                         address, &buf8))
2654                                         errno = -EIO;
2655                                 else if (put_user(buf8, (u8 __user *)buffer))
2656                                         errno = -EFAULT;
2657                                 else
2658                                         bytes_read = 1;
2659
2660                                 break;
2661
2662                         case 2:
2663                                 if (sisusb_read_memio_word(sisusb,
2664                                                         SISUSB_TYPE_IO,
2665                                                         address, &buf16))
2666                                         errno = -EIO;
2667                                 else if (put_user(buf16, (u16 __user *)buffer))
2668                                         errno = -EFAULT;
2669                                 else
2670                                         bytes_read = 2;
2671
2672                                 break;
2673
2674                         case 4:
2675                                 if (sisusb_read_memio_long(sisusb,
2676                                                         SISUSB_TYPE_IO,
2677                                                         address, &buf32))
2678                                         errno = -EIO;
2679                                 else if (put_user(buf32, (u32 __user *)buffer))
2680                                         errno = -EFAULT;
2681                                 else
2682                                         bytes_read = 4;
2683
2684                                 break;
2685
2686                         default:
2687                                 errno = -EIO;
2688
2689                 }
2690
2691         } else if ((*ppos) >= SISUSB_PCI_PSEUDO_MEMBASE &&
2692                    (*ppos) <  SISUSB_PCI_PSEUDO_MEMBASE + sisusb->vramsize) {
2693
2694                 address = (*ppos) -
2695                         SISUSB_PCI_PSEUDO_MEMBASE +
2696                         SISUSB_PCI_MEMBASE;
2697
2698                 /* Read video ram
2699                  * Remember: Data delivered is never endian-corrected
2700                  */
2701                 errno = sisusb_read_mem_bulk(sisusb, address,
2702                                         NULL, count, buffer, &bytes_read);
2703
2704                 if (bytes_read)
2705                         errno = bytes_read;
2706
2707         } else  if ((*ppos) >= SISUSB_PCI_PSEUDO_MMIOBASE &&
2708                     (*ppos) <  SISUSB_PCI_PSEUDO_MMIOBASE + SISUSB_PCI_MMIOSIZE) {
2709
2710                 address = (*ppos) -
2711                         SISUSB_PCI_PSEUDO_MMIOBASE +
2712                         SISUSB_PCI_MMIOBASE;
2713
2714                 /* Read MMIO
2715                  * Remember: Data delivered is never endian-corrected
2716                  */
2717                 errno = sisusb_read_mem_bulk(sisusb, address,
2718                                         NULL, count, buffer, &bytes_read);
2719
2720                 if (bytes_read)
2721                         errno = bytes_read;
2722
2723         } else  if ((*ppos) >= SISUSB_PCI_PSEUDO_PCIBASE &&
2724                     (*ppos) <= SISUSB_PCI_PSEUDO_PCIBASE + 0x5c) {
2725
2726                 if (count != 4) {
2727                         mutex_unlock(&sisusb->lock);
2728                         return -EINVAL;
2729                 }
2730
2731                 address = (*ppos) - SISUSB_PCI_PSEUDO_PCIBASE;
2732
2733                 /* Read PCI config register
2734                  * Return value delivered in machine endianness.
2735                  */
2736                 if (sisusb_read_pci_config(sisusb, address, &buf32))
2737                         errno = -EIO;
2738                 else if (put_user(buf32, (u32 __user *)buffer))
2739                         errno = -EFAULT;
2740                 else
2741                         bytes_read = 4;
2742
2743         } else {
2744
2745                 errno = -EBADFD;
2746
2747         }
2748
2749         (*ppos) += bytes_read;
2750
2751         mutex_unlock(&sisusb->lock);
2752
2753         return errno ? errno : bytes_read;
2754 }
2755
2756 static ssize_t
2757 sisusb_write(struct file *file, const char __user *buffer, size_t count,
2758                                                                 loff_t *ppos)
2759 {
2760         struct sisusb_usb_data *sisusb;
2761         int errno = 0;
2762         ssize_t bytes_written = 0;
2763         u8 buf8;
2764         u16 buf16;
2765         u32 buf32, address;
2766
2767         if (!(sisusb = (struct sisusb_usb_data *)file->private_data))
2768                 return -ENODEV;
2769
2770         mutex_lock(&sisusb->lock);
2771
2772         /* Sanity check */
2773         if (!sisusb->present || !sisusb->ready || !sisusb->sisusb_dev) {
2774                 mutex_unlock(&sisusb->lock);
2775                 return -ENODEV;
2776         }
2777
2778         if ((*ppos) >= SISUSB_PCI_PSEUDO_IOPORTBASE &&
2779             (*ppos) <  SISUSB_PCI_PSEUDO_IOPORTBASE + 128) {
2780
2781                 address = (*ppos) -
2782                         SISUSB_PCI_PSEUDO_IOPORTBASE +
2783                         SISUSB_PCI_IOPORTBASE;
2784
2785                 /* Write i/o ports
2786                  * Byte, word and long(32) can be written. As this
2787                  * emulates outX instructions, the data is expected
2788                  * in machine-endianness.
2789                  */
2790                 switch (count) {
2791
2792                         case 1:
2793                                 if (get_user(buf8, (u8 __user *)buffer))
2794                                         errno = -EFAULT;
2795                                 else if (sisusb_write_memio_byte(sisusb,
2796                                                         SISUSB_TYPE_IO,
2797                                                         address, buf8))
2798                                         errno = -EIO;
2799                                 else
2800                                         bytes_written = 1;
2801
2802                                 break;
2803
2804                         case 2:
2805                                 if (get_user(buf16, (u16 __user *)buffer))
2806                                         errno = -EFAULT;
2807                                 else if (sisusb_write_memio_word(sisusb,
2808                                                         SISUSB_TYPE_IO,
2809                                                         address, buf16))
2810                                         errno = -EIO;
2811                                 else
2812                                         bytes_written = 2;
2813
2814                                 break;
2815
2816                         case 4:
2817                                 if (get_user(buf32, (u32 __user *)buffer))
2818                                         errno = -EFAULT;
2819                                 else if (sisusb_write_memio_long(sisusb,
2820                                                         SISUSB_TYPE_IO,
2821                                                         address, buf32))
2822                                         errno = -EIO;
2823                                 else
2824                                         bytes_written = 4;
2825
2826                                 break;
2827
2828                         default:
2829                                 errno = -EIO;
2830                 }
2831
2832         } else if ((*ppos) >= SISUSB_PCI_PSEUDO_MEMBASE &&
2833                    (*ppos) <  SISUSB_PCI_PSEUDO_MEMBASE + sisusb->vramsize) {
2834
2835                 address = (*ppos) -
2836                         SISUSB_PCI_PSEUDO_MEMBASE +
2837                         SISUSB_PCI_MEMBASE;
2838
2839                 /* Write video ram.
2840                  * Buffer is copied 1:1, therefore, on big-endian
2841                  * machines, the data must be swapped by userland
2842                  * in advance (if applicable; no swapping in 8bpp
2843                  * mode or if YUV data is being transferred).
2844                  */
2845                 errno = sisusb_write_mem_bulk(sisusb, address, NULL,
2846                                         count, buffer, 0, &bytes_written);
2847
2848                 if (bytes_written)
2849                         errno = bytes_written;
2850
2851         } else  if ((*ppos) >= SISUSB_PCI_PSEUDO_MMIOBASE &&
2852                     (*ppos) <  SISUSB_PCI_PSEUDO_MMIOBASE + SISUSB_PCI_MMIOSIZE) {
2853
2854                 address = (*ppos) -
2855                         SISUSB_PCI_PSEUDO_MMIOBASE +
2856                         SISUSB_PCI_MMIOBASE;
2857
2858                 /* Write MMIO.
2859                  * Buffer is copied 1:1, therefore, on big-endian
2860                  * machines, the data must be swapped by userland
2861                  * in advance.
2862                  */
2863                 errno = sisusb_write_mem_bulk(sisusb, address, NULL,
2864                                         count, buffer, 0, &bytes_written);
2865
2866                 if (bytes_written)
2867                         errno = bytes_written;
2868
2869         } else  if ((*ppos) >= SISUSB_PCI_PSEUDO_PCIBASE &&
2870                     (*ppos) <= SISUSB_PCI_PSEUDO_PCIBASE + SISUSB_PCI_PCONFSIZE) {
2871
2872                 if (count != 4) {
2873                         mutex_unlock(&sisusb->lock);
2874                         return -EINVAL;
2875                 }
2876
2877                 address = (*ppos) - SISUSB_PCI_PSEUDO_PCIBASE;
2878
2879                 /* Write PCI config register.
2880                  * Given value expected in machine endianness.
2881                  */
2882                 if (get_user(buf32, (u32 __user *)buffer))
2883                         errno = -EFAULT;
2884                 else if (sisusb_write_pci_config(sisusb, address, buf32))
2885                         errno = -EIO;
2886                 else
2887                         bytes_written = 4;
2888
2889
2890         } else {
2891
2892                 /* Error */
2893                 errno = -EBADFD;
2894
2895         }
2896
2897         (*ppos) += bytes_written;
2898
2899         mutex_unlock(&sisusb->lock);
2900
2901         return errno ? errno : bytes_written;
2902 }
2903
2904 static loff_t
2905 sisusb_lseek(struct file *file, loff_t offset, int orig)
2906 {
2907         struct sisusb_usb_data *sisusb;
2908         loff_t ret;
2909
2910         if (!(sisusb = (struct sisusb_usb_data *)file->private_data))
2911                 return -ENODEV;
2912
2913         mutex_lock(&sisusb->lock);
2914
2915         /* Sanity check */
2916         if (!sisusb->present || !sisusb->ready || !sisusb->sisusb_dev) {
2917                 mutex_unlock(&sisusb->lock);
2918                 return -ENODEV;
2919         }
2920
2921         switch (orig) {
2922                 case 0:
2923                         file->f_pos = offset;
2924                         ret = file->f_pos;
2925                         /* never negative, no force_successful_syscall needed */
2926                         break;
2927                 case 1:
2928                         file->f_pos += offset;
2929                         ret = file->f_pos;
2930                         /* never negative, no force_successful_syscall needed */
2931                         break;
2932                 default:
2933                         /* seeking relative to "end of file" is not supported */
2934                         ret = -EINVAL;
2935         }
2936
2937         mutex_unlock(&sisusb->lock);
2938         return ret;
2939 }
2940
2941 static int
2942 sisusb_handle_command(struct sisusb_usb_data *sisusb, struct sisusb_command *y,
2943                                                         unsigned long arg)
2944 {
2945         int     retval, port, length;
2946         u32     address;
2947
2948         /* All our commands require the device
2949          * to be initialized.
2950          */
2951         if (!sisusb->devinit)
2952                 return -ENODEV;
2953
2954         port = y->data3 -
2955                 SISUSB_PCI_PSEUDO_IOPORTBASE +
2956                 SISUSB_PCI_IOPORTBASE;
2957
2958         switch (y->operation) {
2959                 case SUCMD_GET:
2960                         retval = sisusb_getidxreg(sisusb, port,
2961                                                          y->data0, &y->data1);
2962                         if (!retval) {
2963                                 if (copy_to_user((void __user *)arg, y,
2964                                                         sizeof(*y)))
2965                                         retval = -EFAULT;
2966                         }
2967                         break;
2968
2969                 case SUCMD_SET:
2970                         retval = sisusb_setidxreg(sisusb, port,
2971                                                 y->data0, y->data1);
2972                         break;
2973
2974                 case SUCMD_SETOR:
2975                         retval = sisusb_setidxregor(sisusb, port,
2976                                                 y->data0, y->data1);
2977                         break;
2978
2979                 case SUCMD_SETAND:
2980                         retval = sisusb_setidxregand(sisusb, port,
2981                                                 y->data0, y->data1);
2982                         break;
2983
2984                 case SUCMD_SETANDOR:
2985                         retval = sisusb_setidxregandor(sisusb, port,
2986                                                 y->data0, y->data1, y->data2);
2987                         break;
2988
2989                 case SUCMD_SETMASK:
2990                         retval = sisusb_setidxregmask(sisusb, port,
2991                                                 y->data0, y->data1, y->data2);
2992                         break;
2993
2994                 case SUCMD_CLRSCR:
2995                         /* Gfx core must be initialized */
2996                         if (!sisusb->gfxinit)
2997                                 return -ENODEV;
2998
2999                         length = (y->data0 << 16) | (y->data1 << 8) | y->data2;
3000                         address = y->data3 -
3001                                 SISUSB_PCI_PSEUDO_MEMBASE +
3002                                 SISUSB_PCI_MEMBASE;
3003                         retval = sisusb_clear_vram(sisusb, address, length);
3004                         break;
3005
3006                 case SUCMD_HANDLETEXTMODE:
3007                         retval = 0;
3008 #ifdef INCL_SISUSB_CON
3009                         /* Gfx core must be initialized, SiS_Pr must exist */
3010                         if (!sisusb->gfxinit || !sisusb->SiS_Pr)
3011                                 return -ENODEV;
3012
3013                         switch (y->data0) {
3014                         case 0:
3015                                 retval = sisusb_reset_text_mode(sisusb, 0);
3016                                 break;
3017                         case 1:
3018                                 sisusb->textmodedestroyed = 1;
3019                                 break;
3020                         }
3021 #endif
3022                         break;
3023
3024 #ifdef INCL_SISUSB_CON
3025                 case SUCMD_SETMODE:
3026                         /* Gfx core must be initialized, SiS_Pr must exist */
3027                         if (!sisusb->gfxinit || !sisusb->SiS_Pr)
3028                                 return -ENODEV;
3029
3030                         retval = 0;
3031
3032                         sisusb->SiS_Pr->IOAddress = SISUSB_PCI_IOPORTBASE + 0x30;
3033                         sisusb->SiS_Pr->sisusb = (void *)sisusb;
3034
3035                         if (SiSUSBSetMode(sisusb->SiS_Pr, y->data3))
3036                                 retval = -EINVAL;
3037
3038                         break;
3039
3040                 case SUCMD_SETVESAMODE:
3041                         /* Gfx core must be initialized, SiS_Pr must exist */
3042                         if (!sisusb->gfxinit || !sisusb->SiS_Pr)
3043                                 return -ENODEV;
3044
3045                         retval = 0;
3046
3047                         sisusb->SiS_Pr->IOAddress = SISUSB_PCI_IOPORTBASE + 0x30;
3048                         sisusb->SiS_Pr->sisusb = (void *)sisusb;
3049
3050                         if (SiSUSBSetVESAMode(sisusb->SiS_Pr, y->data3))
3051                                 retval = -EINVAL;
3052
3053                         break;
3054 #endif
3055
3056                 default:
3057                         retval = -EINVAL;
3058         }
3059
3060         if (retval > 0)
3061                 retval = -EIO;
3062
3063         return retval;
3064 }
3065
3066 static int
3067 sisusb_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
3068                                                         unsigned long arg)
3069 {
3070         struct sisusb_usb_data *sisusb;
3071         struct sisusb_info x;
3072         struct sisusb_command y;
3073         int     retval = 0;
3074         u32 __user *argp = (u32 __user *)arg;
3075
3076         if (!(sisusb = (struct sisusb_usb_data *)file->private_data))
3077                 return -ENODEV;
3078
3079         mutex_lock(&sisusb->lock);
3080
3081         /* Sanity check */
3082         if (!sisusb->present || !sisusb->ready || !sisusb->sisusb_dev) {
3083                 retval = -ENODEV;
3084                 goto err_out;
3085         }
3086
3087         switch (cmd) {
3088
3089                 case SISUSB_GET_CONFIG_SIZE:
3090
3091                         if (put_user(sizeof(x), argp))
3092                                 retval = -EFAULT;
3093
3094                         break;
3095
3096                 case SISUSB_GET_CONFIG:
3097
3098                         x.sisusb_id         = SISUSB_ID;
3099                         x.sisusb_version    = SISUSB_VERSION;
3100                         x.sisusb_revision   = SISUSB_REVISION;
3101                         x.sisusb_patchlevel = SISUSB_PATCHLEVEL;
3102                         x.sisusb_gfxinit    = sisusb->gfxinit;
3103                         x.sisusb_vrambase   = SISUSB_PCI_PSEUDO_MEMBASE;
3104                         x.sisusb_mmiobase   = SISUSB_PCI_PSEUDO_MMIOBASE;
3105                         x.sisusb_iobase     = SISUSB_PCI_PSEUDO_IOPORTBASE;
3106                         x.sisusb_pcibase    = SISUSB_PCI_PSEUDO_PCIBASE;
3107                         x.sisusb_vramsize   = sisusb->vramsize;
3108                         x.sisusb_minor      = sisusb->minor;
3109                         x.sisusb_fbdevactive= 0;
3110 #ifdef INCL_SISUSB_CON
3111                         x.sisusb_conactive  = sisusb->haveconsole ? 1 : 0;
3112 #else
3113                         x.sisusb_conactive  = 0;
3114 #endif
3115
3116                         if (copy_to_user((void __user *)arg, &x, sizeof(x)))
3117                                 retval = -EFAULT;
3118
3119                         break;
3120
3121                 case SISUSB_COMMAND:
3122
3123                         if (copy_from_user(&y, (void __user *)arg, sizeof(y)))
3124                                 retval = -EFAULT;
3125                         else
3126                                 retval = sisusb_handle_command(sisusb, &y, arg);
3127
3128                         break;
3129
3130                 default:
3131                         retval = -ENOTTY;
3132                         break;
3133         }
3134
3135 err_out:
3136         mutex_unlock(&sisusb->lock);
3137         return retval;
3138 }
3139
3140 #ifdef SISUSB_NEW_CONFIG_COMPAT
3141 static long
3142 sisusb_compat_ioctl(struct file *f, unsigned int cmd, unsigned long arg)
3143 {
3144         long retval;
3145
3146         switch (cmd) {
3147                 case SISUSB_GET_CONFIG_SIZE:
3148                 case SISUSB_GET_CONFIG:
3149                 case SISUSB_COMMAND:
3150                         lock_kernel();
3151                         retval = sisusb_ioctl(f->f_path.dentry->d_inode, f, cmd, arg);
3152                         unlock_kernel();
3153                         return retval;
3154
3155                 default:
3156                         return -ENOIOCTLCMD;
3157         }
3158 }
3159 #endif
3160
3161 static const struct file_operations usb_sisusb_fops = {
3162         .owner =        THIS_MODULE,
3163         .open =         sisusb_open,
3164         .release =      sisusb_release,
3165         .read =         sisusb_read,
3166         .write =        sisusb_write,
3167         .llseek =       sisusb_lseek,
3168 #ifdef SISUSB_NEW_CONFIG_COMPAT
3169         .compat_ioctl = sisusb_compat_ioctl,
3170 #endif
3171         .ioctl =        sisusb_ioctl
3172 };
3173
3174 static struct usb_class_driver usb_sisusb_class = {
3175         .name =         "sisusbvga%d",
3176         .fops =         &usb_sisusb_fops,
3177         .minor_base =   SISUSB_MINOR
3178 };
3179
3180 static int sisusb_probe(struct usb_interface *intf,
3181                         const struct usb_device_id *id)
3182 {
3183         struct usb_device *dev = interface_to_usbdev(intf);
3184         struct sisusb_usb_data *sisusb;
3185         int retval = 0, i;
3186         const char *memfail =
3187                 KERN_ERR
3188                 "sisusbvga[%d]: Failed to allocate memory for %s buffer\n";
3189
3190         printk(KERN_INFO "sisusb: USB2VGA dongle found at address %d\n",
3191                 dev->devnum);
3192
3193         /* Allocate memory for our private */
3194         if (!(sisusb = kzalloc(sizeof(*sisusb), GFP_KERNEL))) {
3195                 printk(KERN_ERR
3196                         "sisusb: Failed to allocate memory for private data\n");
3197                 return -ENOMEM;
3198         }
3199         kref_init(&sisusb->kref);
3200
3201         mutex_init(&(sisusb->lock));
3202
3203         /* Register device */
3204         if ((retval = usb_register_dev(intf, &usb_sisusb_class))) {
3205                 printk(KERN_ERR
3206                         "sisusb: Failed to get a minor for device %d\n",
3207                         dev->devnum);
3208                 retval = -ENODEV;
3209                 goto error_1;
3210         }
3211
3212         sisusb->sisusb_dev = dev;
3213         sisusb->minor      = intf->minor;
3214         sisusb->vrambase   = SISUSB_PCI_MEMBASE;
3215         sisusb->mmiobase   = SISUSB_PCI_MMIOBASE;
3216         sisusb->mmiosize   = SISUSB_PCI_MMIOSIZE;
3217         sisusb->ioportbase = SISUSB_PCI_IOPORTBASE;
3218         /* Everything else is zero */
3219
3220         /* Allocate buffers */
3221         sisusb->ibufsize = SISUSB_IBUF_SIZE;
3222         if (!(sisusb->ibuf = usb_buffer_alloc(dev, SISUSB_IBUF_SIZE,
3223                                         GFP_KERNEL, &sisusb->transfer_dma_in))) {
3224                 printk(memfail, "input", sisusb->minor);
3225                 retval = -ENOMEM;
3226                 goto error_2;
3227         }
3228
3229         sisusb->numobufs = 0;
3230         sisusb->obufsize = SISUSB_OBUF_SIZE;
3231         for (i = 0; i < NUMOBUFS; i++) {
3232                 if (!(sisusb->obuf[i] = usb_buffer_alloc(dev, SISUSB_OBUF_SIZE,
3233                                         GFP_KERNEL,
3234                                         &sisusb->transfer_dma_out[i]))) {
3235                         if (i == 0) {
3236                                 printk(memfail, "output", sisusb->minor);
3237                                 retval = -ENOMEM;
3238                                 goto error_3;
3239                         }
3240                         break;
3241                 } else
3242                         sisusb->numobufs++;
3243
3244         }
3245
3246         /* Allocate URBs */
3247         if (!(sisusb->sisurbin = usb_alloc_urb(0, GFP_KERNEL))) {
3248                 printk(KERN_ERR
3249                         "sisusbvga[%d]: Failed to allocate URBs\n",
3250                         sisusb->minor);
3251                 retval = -ENOMEM;
3252                 goto error_3;
3253         }
3254         sisusb->completein = 1;
3255
3256         for (i = 0; i < sisusb->numobufs; i++) {
3257                 if (!(sisusb->sisurbout[i] = usb_alloc_urb(0, GFP_KERNEL))) {
3258                         printk(KERN_ERR
3259                                 "sisusbvga[%d]: Failed to allocate URBs\n",
3260                                 sisusb->minor);
3261                         retval = -ENOMEM;
3262                         goto error_4;
3263                 }
3264                 sisusb->urbout_context[i].sisusb = (void *)sisusb;
3265                 sisusb->urbout_context[i].urbindex = i;
3266                 sisusb->urbstatus[i] = 0;
3267         }
3268
3269         printk(KERN_INFO "sisusbvga[%d]: Allocated %d output buffers\n",
3270                                         sisusb->minor, sisusb->numobufs);
3271
3272 #ifdef INCL_SISUSB_CON
3273         /* Allocate our SiS_Pr */
3274         if (!(sisusb->SiS_Pr = kmalloc(sizeof(struct SiS_Private), GFP_KERNEL))) {
3275                 printk(KERN_ERR
3276                         "sisusbvga[%d]: Failed to allocate SiS_Pr\n",
3277                         sisusb->minor);
3278         }
3279 #endif
3280
3281         /* Do remaining init stuff */
3282
3283         init_waitqueue_head(&sisusb->wait_q);
3284
3285         usb_set_intfdata(intf, sisusb);
3286
3287         usb_get_dev(sisusb->sisusb_dev);
3288
3289         sisusb->present = 1;
3290
3291 #ifdef SISUSB_OLD_CONFIG_COMPAT
3292         {
3293         int ret;
3294         /* Our ioctls are all "32/64bit compatible" */
3295         ret =  register_ioctl32_conversion(SISUSB_GET_CONFIG_SIZE, NULL);
3296         ret |= register_ioctl32_conversion(SISUSB_GET_CONFIG,      NULL);
3297         ret |= register_ioctl32_conversion(SISUSB_COMMAND,         NULL);
3298         if (ret)
3299                 printk(KERN_ERR
3300                         "sisusbvga[%d]: Error registering ioctl32 "
3301                         "translations\n",
3302                         sisusb->minor);
3303         else
3304                 sisusb->ioctl32registered = 1;
3305         }
3306 #endif
3307
3308         if (dev->speed == USB_SPEED_HIGH) {
3309                 int initscreen = 1;
3310 #ifdef INCL_SISUSB_CON
3311                 if (sisusb_first_vc > 0 &&
3312                     sisusb_last_vc > 0 &&
3313                     sisusb_first_vc <= sisusb_last_vc &&
3314                     sisusb_last_vc <= MAX_NR_CONSOLES)
3315                         initscreen = 0;
3316 #endif
3317                 if (sisusb_init_gfxdevice(sisusb, initscreen))
3318                         printk(KERN_ERR
3319                                 "sisusbvga[%d]: Failed to early "
3320                                 "initialize device\n",
3321                                 sisusb->minor);
3322
3323         } else
3324                 printk(KERN_INFO
3325                         "sisusbvga[%d]: Not attached to USB 2.0 hub, "
3326                         "deferring init\n",
3327                         sisusb->minor);
3328
3329         sisusb->ready = 1;
3330
3331 #ifdef SISUSBENDIANTEST
3332         printk(KERN_DEBUG "sisusb: *** RWTEST ***\n");
3333         sisusb_testreadwrite(sisusb);
3334         printk(KERN_DEBUG "sisusb: *** RWTEST END ***\n");
3335 #endif
3336
3337 #ifdef INCL_SISUSB_CON
3338         sisusb_console_init(sisusb, sisusb_first_vc, sisusb_last_vc);
3339 #endif
3340
3341         return 0;
3342
3343 error_4:
3344         sisusb_free_urbs(sisusb);
3345 error_3:
3346         sisusb_free_buffers(sisusb);
3347 error_2:
3348         usb_deregister_dev(intf, &usb_sisusb_class);
3349 error_1:
3350         kfree(sisusb);
3351         return retval;
3352 }
3353
3354 static void sisusb_disconnect(struct usb_interface *intf)
3355 {
3356         struct sisusb_usb_data *sisusb;
3357         int minor;
3358
3359         /* This should *not* happen */
3360         if (!(sisusb = usb_get_intfdata(intf)))
3361                 return;
3362
3363 #ifdef INCL_SISUSB_CON
3364         sisusb_console_exit(sisusb);
3365 #endif
3366
3367         minor = sisusb->minor;
3368
3369         usb_deregister_dev(intf, &usb_sisusb_class);
3370
3371         mutex_lock(&sisusb->lock);
3372
3373         /* Wait for all URBs to complete and kill them in case (MUST do) */
3374         if (!sisusb_wait_all_out_complete(sisusb))
3375                 sisusb_kill_all_busy(sisusb);
3376
3377         usb_set_intfdata(intf, NULL);
3378
3379 #ifdef SISUSB_OLD_CONFIG_COMPAT
3380         if (sisusb->ioctl32registered) {
3381                 int ret;
3382                 sisusb->ioctl32registered = 0;
3383                 ret =  unregister_ioctl32_conversion(SISUSB_GET_CONFIG_SIZE);
3384                 ret |= unregister_ioctl32_conversion(SISUSB_GET_CONFIG);
3385                 ret |= unregister_ioctl32_conversion(SISUSB_COMMAND);
3386                 if (ret) {
3387                         printk(KERN_ERR
3388                                 "sisusbvga[%d]: Error unregistering "
3389                                 "ioctl32 translations\n",
3390                                 minor);
3391                 }
3392         }
3393 #endif
3394
3395         sisusb->present = 0;
3396         sisusb->ready = 0;
3397
3398         mutex_unlock(&sisusb->lock);
3399
3400         /* decrement our usage count */
3401         kref_put(&sisusb->kref, sisusb_delete);
3402
3403         printk(KERN_INFO "sisusbvga[%d]: Disconnected\n", minor);
3404 }
3405
3406 static struct usb_device_id sisusb_table [] = {
3407         { USB_DEVICE(0x0711, 0x0550) },
3408         { USB_DEVICE(0x0711, 0x0900) },
3409         { USB_DEVICE(0x0711, 0x0901) },
3410         { USB_DEVICE(0x0711, 0x0902) },
3411         { USB_DEVICE(0x182d, 0x021c) },
3412         { USB_DEVICE(0x182d, 0x0269) },
3413         { }
3414 };
3415
3416 MODULE_DEVICE_TABLE (usb, sisusb_table);
3417
3418 static struct usb_driver sisusb_driver = {
3419         .name =         "sisusb",
3420         .probe =        sisusb_probe,
3421         .disconnect =   sisusb_disconnect,
3422         .id_table =     sisusb_table,
3423 };
3424
3425 static int __init usb_sisusb_init(void)
3426 {
3427         int retval;
3428
3429 #ifdef INCL_SISUSB_CON
3430         sisusb_init_concode();
3431 #endif
3432
3433         if (!(retval = usb_register(&sisusb_driver))) {
3434
3435                 printk(KERN_INFO "sisusb: Driver version %d.%d.%d\n",
3436                         SISUSB_VERSION, SISUSB_REVISION, SISUSB_PATCHLEVEL);
3437                 printk(KERN_INFO
3438                         "sisusb: Copyright (C) 2005 Thomas Winischhofer\n");
3439
3440         }
3441
3442         return retval;
3443 }
3444
3445 static void __exit usb_sisusb_exit(void)
3446 {
3447         usb_deregister(&sisusb_driver);
3448 }
3449
3450 module_init(usb_sisusb_init);
3451 module_exit(usb_sisusb_exit);
3452
3453 MODULE_AUTHOR("Thomas Winischhofer <thomas@winischhofer.net>");
3454 MODULE_DESCRIPTION("sisusbvga - Driver for Net2280/SiS315-based USB2VGA dongles");
3455 MODULE_LICENSE("GPL");
3456