git.oblomov.eu Git - linux-2.6/blob - drivers/video/amifb.c

   1 /*
   2  * linux/drivers/video/amifb.c -- Amiga builtin chipset frame buffer device
   3  *
   4  *    Copyright (C) 1995-2003 Geert Uytterhoeven
   5  *
   6  *          with work by Roman Zippel
   7  *
   8  *
   9  * This file is based on the Atari frame buffer device (atafb.c):
  10  *
  11  *    Copyright (C) 1994 Martin Schaller
  12  *                       Roman Hodek
  13  *
  14  *          with work by Andreas Schwab
  15  *                       Guenther Kelleter
  16  *
  17  * and on the original Amiga console driver (amicon.c):
  18  *
  19  *    Copyright (C) 1993 Hamish Macdonald
  20  *                       Greg Harp
  21  *    Copyright (C) 1994 David Carter [carter@compsci.bristol.ac.uk]
  22  *
  23  *          with work by William Rucklidge (wjr@cs.cornell.edu)
  24  *                       Geert Uytterhoeven
  25  *                       Jes Sorensen (jds@kom.auc.dk)
  26  *
  27  *
  28  * History:
  29  *
  30  *   - 24 Jul 96: Copper generates now vblank interrupt and
  31  *                VESA Power Saving Protocol is fully implemented
  32  *   - 14 Jul 96: Rework and hopefully last ECS bugs fixed
  33  *   -  7 Mar 96: Hardware sprite support by Roman Zippel
  34  *   - 18 Feb 96: OCS and ECS support by Roman Zippel
  35  *                Hardware functions completely rewritten
  36  *   -  2 Dec 95: AGA version by Geert Uytterhoeven
  37  *
  38  * This file is subject to the terms and conditions of the GNU General Public
  39  * License. See the file COPYING in the main directory of this archive
  40  * for more details.
  41  */
  42
  43 #include <linux/module.h>
  44 #include <linux/kernel.h>
  45 #include <linux/errno.h>
  46 #include <linux/string.h>
  47 #include <linux/mm.h>
  48 #include <linux/slab.h>
  49 #include <linux/delay.h>
  50 #include <linux/interrupt.h>
  51 #include <linux/fb.h>
  52 #include <linux/init.h>
  53 #include <linux/ioport.h>
  54
  55 #include <linux/uaccess.h>
  56 #include <asm/system.h>
  57 #include <asm/irq.h>
  58 #include <asm/amigahw.h>
  59 #include <asm/amigaints.h>
  60 #include <asm/setup.h>
  61
  62 #include "c2p.h"
  63
  64
  65 #define DEBUG
  66
  67 #if !defined(CONFIG_FB_AMIGA_OCS) && !defined(CONFIG_FB_AMIGA_ECS) && !defined(CONFIG_FB_AMIGA_AGA)
  68 #define CONFIG_FB_AMIGA_OCS   /* define at least one fb driver, this will change later */
  69 #endif
  70
  71 #if !defined(CONFIG_FB_AMIGA_OCS)
  72 #  define IS_OCS (0)
  73 #elif defined(CONFIG_FB_AMIGA_ECS) || defined(CONFIG_FB_AMIGA_AGA)
  74 #  define IS_OCS (chipset == TAG_OCS)
  75 #else
  76 #  define CONFIG_FB_AMIGA_OCS_ONLY
  77 #  define IS_OCS (1)
  78 #endif
  79
  80 #if !defined(CONFIG_FB_AMIGA_ECS)
  81 #  define IS_ECS (0)
  82 #elif defined(CONFIG_FB_AMIGA_OCS) || defined(CONFIG_FB_AMIGA_AGA)
  83 #  define IS_ECS (chipset == TAG_ECS)
  84 #else
  85 #  define CONFIG_FB_AMIGA_ECS_ONLY
  86 #  define IS_ECS (1)
  87 #endif
  88
  89 #if !defined(CONFIG_FB_AMIGA_AGA)
  90 #  define IS_AGA (0)
  91 #elif defined(CONFIG_FB_AMIGA_OCS) || defined(CONFIG_FB_AMIGA_ECS)
  92 #  define IS_AGA (chipset == TAG_AGA)
  93 #else
  94 #  define CONFIG_FB_AMIGA_AGA_ONLY
  95 #  define IS_AGA (1)
  96 #endif
  97
  98 #ifdef DEBUG
  99 #  define DPRINTK(fmt, args...) printk(KERN_DEBUG "%s: " fmt, __func__ , ## args)
 100 #else
 101 #  define DPRINTK(fmt, args...)
 102 #endif
 103
 104 /*******************************************************************************
 105
 106
 107    Generic video timings
 108    ---------------------
 109
 110    Timings used by the frame buffer interface:
 111
 112    +----------+---------------------------------------------+----------+-------+
 113    |          |                ^                            |          |       |
 114    |          |                |upper_margin                |          |       |
 115    |          |                v                            |          |       |
 116    +----------###############################################----------+-------+
 117    |          #                ^                            #          |       |
 118    |          #                |                            #          |       |
 119    |          #                |                            #          |       |
 120    |          #                |                            #          |       |
 121    |   left   #                |                            #  right   | hsync |
 122    |  margin  #                |       xres                 #  margin  |  len  |
 123    |<-------->#<---------------+--------------------------->#<-------->|<----->|
 124    |          #                |                            #          |       |
 125    |          #                |                            #          |       |
 126    |          #                |                            #          |       |
 127    |          #                |yres                        #          |       |
 128    |          #                |                            #          |       |
 129    |          #                |                            #          |       |
 130    |          #                |                            #          |       |
 131    |          #                |                            #          |       |
 132    |          #                |                            #          |       |
 133    |          #                |                            #          |       |
 134    |          #                |                            #          |       |
 135    |          #                |                            #          |       |
 136    |          #                v                            #          |       |
 137    +----------###############################################----------+-------+
 138    |          |                ^                            |          |       |
 139    |          |                |lower_margin                |          |       |
 140    |          |                v                            |          |       |
 141    +----------+---------------------------------------------+----------+-------+
 142    |          |                ^                            |          |       |
 143    |          |                |vsync_len                   |          |       |
 144    |          |                v                            |          |       |
 145    +----------+---------------------------------------------+----------+-------+
 146
 147
 148    Amiga video timings
 149    -------------------
 150
 151    The Amiga native chipsets uses another timing scheme:
 152
 153       - hsstrt:   Start of horizontal synchronization pulse
 154       - hsstop:   End of horizontal synchronization pulse
 155       - htotal:   Last value on the line (i.e. line length = htotal+1)
 156       - vsstrt:   Start of vertical synchronization pulse
 157       - vsstop:   End of vertical synchronization pulse
 158       - vtotal:   Last line value (i.e. number of lines = vtotal+1)
 159       - hcenter:  Start of vertical retrace for interlace
 160
 161    You can specify the blanking timings independently. Currently I just set
 162    them equal to the respective synchronization values:
 163
 164       - hbstrt:   Start of horizontal blank
 165       - hbstop:   End of horizontal blank
 166       - vbstrt:   Start of vertical blank
 167       - vbstop:   End of vertical blank
 168
 169    Horizontal values are in color clock cycles (280 ns), vertical values are in
 170    scanlines.
 171
 172    (0, 0) is somewhere in the upper-left corner :-)
 173
 174
 175    Amiga visible window definitions
 176    --------------------------------
 177
 178    Currently I only have values for AGA, SHRES (28 MHz dotclock). Feel free to
 179    make corrections and/or additions.
 180
 181    Within the above synchronization specifications, the visible window is
 182    defined by the following parameters (actual register resolutions may be
 183    different; all horizontal values are normalized with respect to the pixel
 184    clock):
 185
 186       - diwstrt_h:   Horizontal start of the visible window
 187       - diwstop_h:   Horizontal stop+1(*) of the visible window
 188       - diwstrt_v:   Vertical start of the visible window
 189       - diwstop_v:   Vertical stop of the visible window
 190       - ddfstrt:     Horizontal start of display DMA
 191       - ddfstop:     Horizontal stop of display DMA
 192       - hscroll:     Horizontal display output delay
 193
 194    Sprite positioning:
 195
 196       - sprstrt_h:   Horizontal start-4 of sprite
 197       - sprstrt_v:   Vertical start of sprite
 198
 199    (*) Even Commodore did it wrong in the AGA monitor drivers by not adding 1.
 200
 201    Horizontal values are in dotclock cycles (35 ns), vertical values are in
 202    scanlines.
 203
 204    (0, 0) is somewhere in the upper-left corner :-)
 205
 206
 207    Dependencies (AGA, SHRES (35 ns dotclock))
 208    -------------------------------------------
 209
 210    Since there are much more parameters for the Amiga display than for the
 211    frame buffer interface, there must be some dependencies among the Amiga
 212    display parameters. Here's what I found out:
 213
 214       - ddfstrt and ddfstop are best aligned to 64 pixels.
 215       - the chipset needs 64+4 horizontal pixels after the DMA start before the
 216         first pixel is output, so diwstrt_h = ddfstrt+64+4 if you want to
 217         display the first pixel on the line too. Increase diwstrt_h for virtual
 218         screen panning.
 219       - the display DMA always fetches 64 pixels at a time (fmode = 3).
 220       - ddfstop is ddfstrt+#pixels-64.
 221       - diwstop_h = diwstrt_h+xres+1. Because of the additional 1 this can be 1
 222         more than htotal.
 223       - hscroll simply adds a delay to the display output. Smooth horizontal
 224         panning needs an extra 64 pixels on the left to prefetch the pixels that
 225         `fall off' on the left.
 226       - if ddfstrt < 192, the sprite DMA cycles are all stolen by the bitplane
 227         DMA, so it's best to make the DMA start as late as possible.
 228       - you really don't want to make ddfstrt < 128, since this will steal DMA
 229         cycles from the other DMA channels (audio, floppy and Chip RAM refresh).
 230       - I make diwstop_h and diwstop_v as large as possible.
 231
 232    General dependencies
 233    --------------------
 234
 235       - all values are SHRES pixel (35ns)
 236
 237                   table 1:fetchstart  table 2:prefetch    table 3:fetchsize
 238                   ------------------  ----------------    -----------------
 239    Pixclock     # SHRES|HIRES|LORES # SHRES|HIRES|LORES # SHRES|HIRES|LORES
 240    -------------#------+-----+------#------+-----+------#------+-----+------
 241    Bus width 1x #   16 |  32 |  64  #   16 |  32 |  64  #   64 |  64 |  64
 242    Bus width 2x #   32 |  64 | 128  #   32 |  64 |  64  #   64 |  64 | 128
 243    Bus width 4x #   64 | 128 | 256  #   64 |  64 |  64  #   64 | 128 | 256
 244
 245       - chipset needs 4 pixels before the first pixel is output
 246       - ddfstrt must be aligned to fetchstart (table 1)
 247       - chipset needs also prefetch (table 2) to get first pixel data, so
 248         ddfstrt = ((diwstrt_h-4) & -fetchstart) - prefetch
 249       - for horizontal panning decrease diwstrt_h
 250       - the length of a fetchline must be aligned to fetchsize (table 3)
 251       - if fetchstart is smaller than fetchsize, then ddfstrt can a little bit
 252         moved to optimize use of dma (useful for OCS/ECS overscan displays)
 253       - ddfstop is ddfstrt+ddfsize-fetchsize
 254       - If C= didn't change anything for AGA, then at following positions the
 255         dma bus is already used:
 256         ddfstrt <  48 -> memory refresh
 257                 <  96 -> disk dma
 258                 < 160 -> audio dma
 259                 < 192 -> sprite 0 dma
 260                 < 416 -> sprite dma (32 per sprite)
 261       - in accordance with the hardware reference manual a hardware stop is at
 262         192, but AGA (ECS?) can go below this.
 263
 264    DMA priorities
 265    --------------
 266
 267    Since there are limits on the earliest start value for display DMA and the
 268    display of sprites, I use the following policy on horizontal panning and
 269    the hardware cursor:
 270
 271       - if you want to start display DMA too early, you lose the ability to
 272         do smooth horizontal panning (xpanstep 1 -> 64).
 273       - if you want to go even further, you lose the hardware cursor too.
 274
 275    IMHO a hardware cursor is more important for X than horizontal scrolling,
 276    so that's my motivation.
 277
 278
 279    Implementation
 280    --------------
 281
 282    ami_decode_var() converts the frame buffer values to the Amiga values. It's
 283    just a `straightforward' implementation of the above rules.
 284
 285
 286    Standard VGA timings
 287    --------------------
 288
 289                xres  yres    left  right  upper  lower    hsync    vsync
 290                ----  ----    ----  -----  -----  -----    -----    -----
 291       80x25     720   400      27     45     35     12      108        2
 292       80x30     720   480      27     45     30      9      108        2
 293
 294    These were taken from a XFree86 configuration file, recalculated for a 28 MHz
 295    dotclock (Amigas don't have a 25 MHz dotclock) and converted to frame buffer
 296    generic timings.
 297
 298    As a comparison, graphics/monitor.h suggests the following:
 299
 300                xres  yres    left  right  upper  lower    hsync    vsync
 301                ----  ----    ----  -----  -----  -----    -----    -----
 302
 303       VGA       640   480      52    112     24     19    112 -      2 +
 304       VGA70     640   400      52    112     27     21    112 -      2 -
 305
 306
 307    Sync polarities
 308    ---------------
 309
 310       VSYNC    HSYNC    Vertical size    Vertical total
 311       -----    -----    -------------    --------------
 312         +        +           Reserved          Reserved
 313         +        -                400               414
 314         -        +                350               362
 315         -        -                480               496
 316
 317    Source: CL-GD542X Technical Reference Manual, Cirrus Logic, Oct 1992
 318
 319
 320    Broadcast video timings
 321    -----------------------
 322
 323    According to the CCIR and RETMA specifications, we have the following values:
 324
 325    CCIR -> PAL
 326    -----------
 327
 328       - a scanline is 64 µs long, of which 52.48 µs are visible. This is about
 329         736 visible 70 ns pixels per line.
 330       - we have 625 scanlines, of which 575 are visible (interlaced); after
 331         rounding this becomes 576.
 332
 333    RETMA -> NTSC
 334    -------------
 335
 336       - a scanline is 63.5 µs long, of which 53.5 µs are visible.  This is about
 337         736 visible 70 ns pixels per line.
 338       - we have 525 scanlines, of which 485 are visible (interlaced); after
 339         rounding this becomes 484.
 340
 341    Thus if you want a PAL compatible display, you have to do the following:
 342
 343       - set the FB_SYNC_BROADCAST flag to indicate that standard broadcast
 344         timings are to be used.
 345       - make sure upper_margin+yres+lower_margin+vsync_len = 625 for an
 346         interlaced, 312 for a non-interlaced and 156 for a doublescanned
 347         display.
 348       - make sure left_margin+xres+right_margin+hsync_len = 1816 for a SHRES,
 349         908 for a HIRES and 454 for a LORES display.
 350       - the left visible part begins at 360 (SHRES; HIRES:180, LORES:90),
 351         left_margin+2*hsync_len must be greater or equal.
 352       - the upper visible part begins at 48 (interlaced; non-interlaced:24,
 353         doublescanned:12), upper_margin+2*vsync_len must be greater or equal.
 354       - ami_encode_var() calculates margins with a hsync of 5320 ns and a vsync
 355         of 4 scanlines
 356
 357    The settings for a NTSC compatible display are straightforward.
 358
 359    Note that in a strict sense the PAL and NTSC standards only define the
 360    encoding of the color part (chrominance) of the video signal and don't say
 361    anything about horizontal/vertical synchronization nor refresh rates.
 362
 363
 364                                                             -- Geert --
 365
 366 *******************************************************************************/
 367
 368
 369         /*
 370          * Custom Chipset Definitions
 371          */
 372
 373 #define CUSTOM_OFS(fld) ((long)&((struct CUSTOM*)0)->fld)
 374
 375         /*
 376          * BPLCON0 -- Bitplane Control Register 0
 377          */
 378
 379 #define BPC0_HIRES      (0x8000)
 380 #define BPC0_BPU2       (0x4000) /* Bit plane used count */
 381 #define BPC0_BPU1       (0x2000)
 382 #define BPC0_BPU0       (0x1000)
 383 #define BPC0_HAM        (0x0800) /* HAM mode */
 384 #define BPC0_DPF        (0x0400) /* Double playfield */
 385 #define BPC0_COLOR      (0x0200) /* Enable colorburst */
 386 #define BPC0_GAUD       (0x0100) /* Genlock audio enable */
 387 #define BPC0_UHRES      (0x0080) /* Ultrahi res enable */
 388 #define BPC0_SHRES      (0x0040) /* Super hi res mode */
 389 #define BPC0_BYPASS     (0x0020) /* Bypass LUT - AGA */
 390 #define BPC0_BPU3       (0x0010) /* AGA */
 391 #define BPC0_LPEN       (0x0008) /* Light pen enable */
 392 #define BPC0_LACE       (0x0004) /* Interlace */
 393 #define BPC0_ERSY       (0x0002) /* External resync */
 394 #define BPC0_ECSENA     (0x0001) /* ECS enable */
 395
 396         /*
 397          * BPLCON2 -- Bitplane Control Register 2
 398          */
 399
 400 #define BPC2_ZDBPSEL2   (0x4000) /* Bitplane to be used for ZD - AGA */
 401 #define BPC2_ZDBPSEL1   (0x2000)
 402 #define BPC2_ZDBPSEL0   (0x1000)
 403 #define BPC2_ZDBPEN     (0x0800) /* Enable ZD with ZDBPSELx - AGA */
 404 #define BPC2_ZDCTEN     (0x0400) /* Enable ZD with palette bit #31 - AGA */
 405 #define BPC2_KILLEHB    (0x0200) /* Kill EHB mode - AGA */
 406 #define BPC2_RDRAM      (0x0100) /* Color table accesses read, not write - AGA */
 407 #define BPC2_SOGEN      (0x0080) /* SOG output pin high - AGA */
 408 #define BPC2_PF2PRI     (0x0040) /* PF2 priority over PF1 */
 409 #define BPC2_PF2P2      (0x0020) /* PF2 priority wrt sprites */
 410 #define BPC2_PF2P1      (0x0010)
 411 #define BPC2_PF2P0      (0x0008)
 412 #define BPC2_PF1P2      (0x0004) /* ditto PF1 */
 413 #define BPC2_PF1P1      (0x0002)
 414 #define BPC2_PF1P0      (0x0001)
 415
 416         /*
 417          * BPLCON3 -- Bitplane Control Register 3 (AGA)
 418          */
 419
 420 #define BPC3_BANK2      (0x8000) /* Bits to select color register bank */
 421 #define BPC3_BANK1      (0x4000)
 422 #define BPC3_BANK0      (0x2000)
 423 #define BPC3_PF2OF2     (0x1000) /* Bits for color table offset when PF2 */
 424 #define BPC3_PF2OF1     (0x0800)
 425 #define BPC3_PF2OF0     (0x0400)
 426 #define BPC3_LOCT       (0x0200) /* Color register writes go to low bits */
 427 #define BPC3_SPRES1     (0x0080) /* Sprite resolution bits */
 428 #define BPC3_SPRES0     (0x0040)
 429 #define BPC3_BRDRBLNK   (0x0020) /* Border blanked? */
 430 #define BPC3_BRDRTRAN   (0x0010) /* Border transparent? */
 431 #define BPC3_ZDCLKEN    (0x0004) /* ZD pin is 14 MHz (HIRES) clock output */
 432 #define BPC3_BRDRSPRT   (0x0002) /* Sprites in border? */
 433 #define BPC3_EXTBLKEN   (0x0001) /* BLANK programmable */
 434
 435         /*
 436          * BPLCON4 -- Bitplane Control Register 4 (AGA)
 437          */
 438
 439 #define BPC4_BPLAM7     (0x8000) /* bitplane color XOR field */
 440 #define BPC4_BPLAM6     (0x4000)
 441 #define BPC4_BPLAM5     (0x2000)
 442 #define BPC4_BPLAM4     (0x1000)
 443 #define BPC4_BPLAM3     (0x0800)
 444 #define BPC4_BPLAM2     (0x0400)
 445 #define BPC4_BPLAM1     (0x0200)
 446 #define BPC4_BPLAM0     (0x0100)
 447 #define BPC4_ESPRM7     (0x0080) /* 4 high bits for even sprite colors */
 448 #define BPC4_ESPRM6     (0x0040)
 449 #define BPC4_ESPRM5     (0x0020)
 450 #define BPC4_ESPRM4     (0x0010)
 451 #define BPC4_OSPRM7     (0x0008) /* 4 high bits for odd sprite colors */
 452 #define BPC4_OSPRM6     (0x0004)
 453 #define BPC4_OSPRM5     (0x0002)
 454 #define BPC4_OSPRM4     (0x0001)
 455
 456         /*
 457          * BEAMCON0 -- Beam Control Register
 458          */
 459
 460 #define BMC0_HARDDIS    (0x4000) /* Disable hardware limits */
 461 #define BMC0_LPENDIS    (0x2000) /* Disable light pen latch */
 462 #define BMC0_VARVBEN    (0x1000) /* Enable variable vertical blank */
 463 #define BMC0_LOLDIS     (0x0800) /* Disable long/short line toggle */
 464 #define BMC0_CSCBEN     (0x0400) /* Composite sync/blank */
 465 #define BMC0_VARVSYEN   (0x0200) /* Enable variable vertical sync */
 466 #define BMC0_VARHSYEN   (0x0100) /* Enable variable horizontal sync */
 467 #define BMC0_VARBEAMEN  (0x0080) /* Enable variable beam counters */
 468 #define BMC0_DUAL       (0x0040) /* Enable alternate horizontal beam counter */
 469 #define BMC0_PAL        (0x0020) /* Set decodes for PAL */
 470 #define BMC0_VARCSYEN   (0x0010) /* Enable variable composite sync */
 471 #define BMC0_BLANKEN    (0x0008) /* Blank enable (no longer used on AGA) */
 472 #define BMC0_CSYTRUE    (0x0004) /* CSY polarity */
 473 #define BMC0_VSYTRUE    (0x0002) /* VSY polarity */
 474 #define BMC0_HSYTRUE    (0x0001) /* HSY polarity */
 475
 476
 477         /*
 478          * FMODE -- Fetch Mode Control Register (AGA)
 479          */
 480
 481 #define FMODE_SSCAN2    (0x8000) /* Sprite scan-doubling */
 482 #define FMODE_BSCAN2    (0x4000) /* Use PF2 modulus every other line */
 483 #define FMODE_SPAGEM    (0x0008) /* Sprite page mode */
 484 #define FMODE_SPR32     (0x0004) /* Sprite 32 bit fetch */
 485 #define FMODE_BPAGEM    (0x0002) /* Bitplane page mode */
 486 #define FMODE_BPL32     (0x0001) /* Bitplane 32 bit fetch */
 487
 488         /*
 489          * Tags used to indicate a specific Pixel Clock
 490          *
 491          * clk_shift is the shift value to get the timings in 35 ns units
 492          */
 493
 494 enum { TAG_SHRES, TAG_HIRES, TAG_LORES };
 495
 496         /*
 497          * Tags used to indicate the specific chipset
 498          */
 499
 500 enum { TAG_OCS, TAG_ECS, TAG_AGA };
 501
 502         /*
 503          * Tags used to indicate the memory bandwidth
 504          */
 505
 506 enum { TAG_FMODE_1, TAG_FMODE_2, TAG_FMODE_4 };
 507
 508
 509         /*
 510          * Clock Definitions, Maximum Display Depth
 511          *
 512          * These depend on the E-Clock or the Chipset, so they are filled in
 513          * dynamically
 514          */
 515
 516 static u_long pixclock[3];      /* SHRES/HIRES/LORES: index = clk_shift */
 517 static u_short maxdepth[3];     /* SHRES/HIRES/LORES: index = clk_shift */
 518 static u_short maxfmode, chipset;
 519
 520
 521         /*
 522          * Broadcast Video Timings
 523          *
 524          * Horizontal values are in 35 ns (SHRES) units
 525          * Vertical values are in interlaced scanlines
 526          */
 527
 528 #define PAL_DIWSTRT_H   (360)   /* PAL Window Limits */
 529 #define PAL_DIWSTRT_V   (48)
 530 #define PAL_HTOTAL      (1816)
 531 #define PAL_VTOTAL      (625)
 532
 533 #define NTSC_DIWSTRT_H  (360)   /* NTSC Window Limits */
 534 #define NTSC_DIWSTRT_V  (40)
 535 #define NTSC_HTOTAL     (1816)
 536 #define NTSC_VTOTAL     (525)
 537
 538
 539         /*
 540          * Various macros
 541          */
 542
 543 #define up2(v)          (((v)+1) & -2)
 544 #define down2(v)        ((v) & -2)
 545 #define div2(v)         ((v)>>1)
 546 #define mod2(v)         ((v) & 1)
 547
 548 #define up4(v)          (((v)+3) & -4)
 549 #define down4(v)        ((v) & -4)
 550 #define mul4(v)         ((v)<<2)
 551 #define div4(v)         ((v)>>2)
 552 #define mod4(v)         ((v) & 3)
 553
 554 #define up8(v)          (((v)+7) & -8)
 555 #define down8(v)        ((v) & -8)
 556 #define div8(v)         ((v)>>3)
 557 #define mod8(v)         ((v) & 7)
 558
 559 #define up16(v)         (((v)+15) & -16)
 560 #define down16(v)       ((v) & -16)
 561 #define div16(v)        ((v)>>4)
 562 #define mod16(v)        ((v) & 15)
 563
 564 #define up32(v)         (((v)+31) & -32)
 565 #define down32(v)       ((v) & -32)
 566 #define div32(v)        ((v)>>5)
 567 #define mod32(v)        ((v) & 31)
 568
 569 #define up64(v)         (((v)+63) & -64)
 570 #define down64(v)       ((v) & -64)
 571 #define div64(v)        ((v)>>6)
 572 #define mod64(v)        ((v) & 63)
 573
 574 #define upx(x,v)        (((v)+(x)-1) & -(x))
 575 #define downx(x,v)      ((v) & -(x))
 576 #define modx(x,v)       ((v) & ((x)-1))
 577
 578 /* if x1 is not a constant, this macro won't make real sense :-) */
 579 #ifdef __mc68000__
 580 #define DIVUL(x1, x2) ({int res; asm("divul %1,%2,%3": "=d" (res): \
 581         "d" (x2), "d" ((long)((x1)/0x100000000ULL)), "0" ((long)(x1))); res;})
 582 #else
 583 /* We know a bit about the numbers, so we can do it this way */
 584 #define DIVUL(x1, x2) ((((long)((unsigned long long)x1 >> 8) / x2) << 8) + \
 585         ((((long)((unsigned long long)x1 >> 8) % x2) << 8) / x2))
 586 #endif
 587
 588 #define highw(x)        ((u_long)(x)>>16 & 0xffff)
 589 #define loww(x)         ((u_long)(x) & 0xffff)
 590
 591 #define custom          amiga_custom
 592
 593 #define VBlankOn()      custom.intena = IF_SETCLR|IF_COPER
 594 #define VBlankOff()     custom.intena = IF_COPER
 595
 596
 597         /*
 598          * Chip RAM we reserve for the Frame Buffer
 599          *
 600          * This defines the Maximum Virtual Screen Size
 601          * (Setable per kernel options?)
 602          */
 603
 604 #define VIDEOMEMSIZE_AGA_2M     (1310720) /* AGA (2MB) : max 1280*1024*256  */
 605 #define VIDEOMEMSIZE_AGA_1M     (786432)  /* AGA (1MB) : max 1024*768*256   */
 606 #define VIDEOMEMSIZE_ECS_2M     (655360)  /* ECS (2MB) : max 1280*1024*16   */
 607 #define VIDEOMEMSIZE_ECS_1M     (393216)  /* ECS (1MB) : max 1024*768*16    */
 608 #define VIDEOMEMSIZE_OCS        (262144)  /* OCS       : max ca. 800*600*16 */
 609
 610 #define SPRITEMEMSIZE           (64*64/4) /* max 64*64*4 */
 611 #define DUMMYSPRITEMEMSIZE      (8)
 612 static u_long spritememory;
 613
 614 #define CHIPRAM_SAFETY_LIMIT    (16384)
 615
 616 static u_long videomemory;
 617
 618         /*
 619          * This is the earliest allowed start of fetching display data.
 620          * Only if you really want no hardware cursor and audio,
 621          * set this to 128, but let it better at 192
 622          */
 623
 624 static u_long min_fstrt = 192;
 625
 626 #define assignchunk(name, type, ptr, size) \
 627 { \
 628         (name) = (type)(ptr); \
 629         ptr += size; \
 630 }
 631
 632
 633         /*
 634          * Copper Instructions
 635          */
 636
 637 #define CMOVE(val, reg)         (CUSTOM_OFS(reg)<<16 | (val))
 638 #define CMOVE2(val, reg)        ((CUSTOM_OFS(reg)+2)<<16 | (val))
 639 #define CWAIT(x, y)             (((y) & 0x1fe)<<23 | ((x) & 0x7f0)<<13 | 0x0001fffe)
 640 #define CEND                    (0xfffffffe)
 641
 642
 643 typedef union {
 644         u_long l;
 645         u_short w[2];
 646 } copins;
 647
 648 static struct copdisplay {
 649         copins *init;
 650         copins *wait;
 651         copins *list[2][2];
 652         copins *rebuild[2];
 653 } copdisplay;
 654
 655 static u_short currentcop = 0;
 656
 657         /*
 658          * Hardware Cursor API Definitions
 659          * These used to be in linux/fb.h, but were preliminary and used by
 660          * amifb only anyway
 661          */
 662
 663 #define FBIOGET_FCURSORINFO     0x4607
 664 #define FBIOGET_VCURSORINFO     0x4608
 665 #define FBIOPUT_VCURSORINFO     0x4609
 666 #define FBIOGET_CURSORSTATE     0x460A
 667 #define FBIOPUT_CURSORSTATE     0x460B
 668
 669
 670 struct fb_fix_cursorinfo {
 671         __u16 crsr_width;               /* width and height of the cursor in */
 672         __u16 crsr_height;              /* pixels (zero if no cursor)   */
 673         __u16 crsr_xsize;               /* cursor size in display pixels */
 674         __u16 crsr_ysize;
 675         __u16 crsr_color1;              /* colormap entry for cursor color1 */
 676         __u16 crsr_color2;              /* colormap entry for cursor color2 */
 677 };
 678
 679 struct fb_var_cursorinfo {
 680         __u16 width;
 681         __u16 height;
 682         __u16 xspot;
 683         __u16 yspot;
 684         __u8 data[1];                   /* field with [height][width]        */
 685 };
 686
 687 struct fb_cursorstate {
 688         __s16 xoffset;
 689         __s16 yoffset;
 690         __u16 mode;
 691 };
 692
 693 #define FB_CURSOR_OFF           0
 694 #define FB_CURSOR_ON            1
 695 #define FB_CURSOR_FLASH         2
 696
 697
 698         /*
 699          * Hardware Cursor
 700          */
 701
 702 static int cursorrate = 20;     /* Number of frames/flash toggle */
 703 static u_short cursorstate = -1;
 704 static u_short cursormode = FB_CURSOR_OFF;
 705
 706 static u_short *lofsprite, *shfsprite, *dummysprite;
 707
 708         /*
 709          * Current Video Mode
 710          */
 711
 712 static struct amifb_par {
 713
 714         /* General Values */
 715
 716         int xres;               /* vmode */
 717         int yres;               /* vmode */
 718         int vxres;              /* vmode */
 719         int vyres;              /* vmode */
 720         int xoffset;            /* vmode */
 721         int yoffset;            /* vmode */
 722         u_short bpp;            /* vmode */
 723         u_short clk_shift;      /* vmode */
 724         u_short line_shift;     /* vmode */
 725         int vmode;              /* vmode */
 726         u_short diwstrt_h;      /* vmode */
 727         u_short diwstop_h;      /* vmode */
 728         u_short diwstrt_v;      /* vmode */
 729         u_short diwstop_v;      /* vmode */
 730         u_long next_line;       /* modulo for next line */
 731         u_long next_plane;      /* modulo for next plane */
 732
 733         /* Cursor Values */
 734
 735         struct {
 736                 short crsr_x;   /* movecursor */
 737                 short crsr_y;   /* movecursor */
 738                 short spot_x;
 739                 short spot_y;
 740                 u_short height;
 741                 u_short width;
 742                 u_short fmode;
 743         } crsr;
 744
 745         /* OCS Hardware Registers */
 746
 747         u_long bplpt0;          /* vmode, pan (Note: physical address) */
 748         u_long bplpt0wrap;      /* vmode, pan (Note: physical address) */
 749         u_short ddfstrt;
 750         u_short ddfstop;
 751         u_short bpl1mod;
 752         u_short bpl2mod;
 753         u_short bplcon0;        /* vmode */
 754         u_short bplcon1;        /* vmode */
 755         u_short htotal;         /* vmode */
 756         u_short vtotal;         /* vmode */
 757
 758         /* Additional ECS Hardware Registers */
 759
 760         u_short bplcon3;        /* vmode */
 761         u_short beamcon0;       /* vmode */
 762         u_short hsstrt;         /* vmode */
 763         u_short hsstop;         /* vmode */
 764         u_short hbstrt;         /* vmode */
 765         u_short hbstop;         /* vmode */
 766         u_short vsstrt;         /* vmode */
 767         u_short vsstop;         /* vmode */
 768         u_short vbstrt;         /* vmode */
 769         u_short vbstop;         /* vmode */
 770         u_short hcenter;        /* vmode */
 771
 772         /* Additional AGA Hardware Registers */
 773
 774         u_short fmode;          /* vmode */
 775 } currentpar;
 776
 777
 778 static struct fb_info fb_info = {
 779     .fix = {
 780         .id             = "Amiga ",
 781         .visual         = FB_VISUAL_PSEUDOCOLOR,
 782         .accel          = FB_ACCEL_AMIGABLITT
 783     }
 784 };
 785
 786
 787         /*
 788          *  Saved color entry 0 so we can restore it when unblanking
 789          */
 790
 791 static u_char red0, green0, blue0;
 792
 793
 794 #if defined(CONFIG_FB_AMIGA_ECS)
 795 static u_short ecs_palette[32];
 796 #endif
 797
 798
 799         /*
 800          * Latches for Display Changes during VBlank
 801          */
 802
 803 static u_short do_vmode_full = 0;       /* Change the Video Mode */
 804 static u_short do_vmode_pan = 0;        /* Update the Video Mode */
 805 static short do_blank = 0;              /* (Un)Blank the Screen (±1) */
 806 static u_short do_cursor = 0;           /* Move the Cursor */
 807
 808
 809         /*
 810          * Various Flags
 811          */
 812
 813 static u_short is_blanked = 0;          /* Screen is Blanked */
 814 static u_short is_lace = 0;             /* Screen is laced */
 815
 816         /*
 817          * Predefined Video Modes
 818          *
 819          */
 820
 821 static struct fb_videomode ami_modedb[] __initdata = {
 822
 823     /*
 824      *  AmigaOS Video Modes
 825      *
 826      *  If you change these, make sure to update DEFMODE_* as well!
 827      */
 828
 829     {
 830         /* 640x200, 15 kHz, 60 Hz (NTSC) */
 831         "ntsc", 60, 640, 200, TAG_HIRES, 106, 86, 44, 16, 76, 2,
 832         FB_SYNC_BROADCAST, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 833     }, {
 834         /* 640x400, 15 kHz, 60 Hz interlaced (NTSC) */
 835         "ntsc-lace", 60, 640, 400, TAG_HIRES, 106, 86, 88, 33, 76, 4,
 836         FB_SYNC_BROADCAST, FB_VMODE_INTERLACED | FB_VMODE_YWRAP
 837     }, {
 838         /* 640x256, 15 kHz, 50 Hz (PAL) */
 839         "pal", 50, 640, 256, TAG_HIRES, 106, 86, 40, 14, 76, 2,
 840         FB_SYNC_BROADCAST, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 841     }, {
 842         /* 640x512, 15 kHz, 50 Hz interlaced (PAL) */
 843         "pal-lace", 50, 640, 512, TAG_HIRES, 106, 86, 80, 29, 76, 4,
 844         FB_SYNC_BROADCAST, FB_VMODE_INTERLACED | FB_VMODE_YWRAP
 845     }, {
 846         /* 640x480, 29 kHz, 57 Hz */
 847         "multiscan", 57, 640, 480, TAG_SHRES, 96, 112, 29, 8, 72, 8,
 848         0, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 849     }, {
 850         /* 640x960, 29 kHz, 57 Hz interlaced */
 851         "multiscan-lace", 57, 640, 960, TAG_SHRES, 96, 112, 58, 16, 72, 16,
 852         0, FB_VMODE_INTERLACED | FB_VMODE_YWRAP
 853     }, {
 854         /* 640x200, 15 kHz, 72 Hz */
 855         "euro36", 72, 640, 200, TAG_HIRES, 92, 124, 6, 6, 52, 5,
 856         0, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 857     }, {
 858         /* 640x400, 15 kHz, 72 Hz interlaced */
 859         "euro36-lace", 72, 640, 400, TAG_HIRES, 92, 124, 12, 12, 52, 10,
 860         0, FB_VMODE_INTERLACED | FB_VMODE_YWRAP
 861     }, {
 862         /* 640x400, 29 kHz, 68 Hz */
 863         "euro72", 68, 640, 400, TAG_SHRES, 164, 92, 9, 9, 80, 8,
 864         0, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 865     }, {
 866         /* 640x800, 29 kHz, 68 Hz interlaced */
 867         "euro72-lace", 68, 640, 800, TAG_SHRES, 164, 92, 18, 18, 80, 16,
 868         0, FB_VMODE_INTERLACED | FB_VMODE_YWRAP
 869     }, {
 870         /* 800x300, 23 kHz, 70 Hz */
 871         "super72", 70, 800, 300, TAG_SHRES, 212, 140, 10, 11, 80, 7,
 872         0, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 873     }, {
 874         /* 800x600, 23 kHz, 70 Hz interlaced */
 875         "super72-lace", 70, 800, 600, TAG_SHRES, 212, 140, 20, 22, 80, 14,
 876         0, FB_VMODE_INTERLACED | FB_VMODE_YWRAP
 877     }, {
 878         /* 640x200, 27 kHz, 57 Hz doublescan */
 879         "dblntsc", 57, 640, 200, TAG_SHRES, 196, 124, 18, 17, 80, 4,
 880         0, FB_VMODE_DOUBLE | FB_VMODE_YWRAP
 881     }, {
 882         /* 640x400, 27 kHz, 57 Hz */
 883         "dblntsc-ff", 57, 640, 400, TAG_SHRES, 196, 124, 36, 35, 80, 7,
 884         0, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 885     }, {
 886         /* 640x800, 27 kHz, 57 Hz interlaced */
 887         "dblntsc-lace", 57, 640, 800, TAG_SHRES, 196, 124, 72, 70, 80, 14,
 888         0, FB_VMODE_INTERLACED | FB_VMODE_YWRAP
 889     }, {
 890         /* 640x256, 27 kHz, 47 Hz doublescan */
 891         "dblpal", 47, 640, 256, TAG_SHRES, 196, 124, 14, 13, 80, 4,
 892         0, FB_VMODE_DOUBLE | FB_VMODE_YWRAP
 893     }, {
 894         /* 640x512, 27 kHz, 47 Hz */
 895         "dblpal-ff", 47, 640, 512, TAG_SHRES, 196, 124, 28, 27, 80, 7,
 896         0, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 897     }, {
 898         /* 640x1024, 27 kHz, 47 Hz interlaced */
 899         "dblpal-lace", 47, 640, 1024, TAG_SHRES, 196, 124, 56, 54, 80, 14,
 900         0, FB_VMODE_INTERLACED | FB_VMODE_YWRAP
 901     },
 902
 903     /*
 904      *  VGA Video Modes
 905      */
 906
 907     {
 908         /* 640x480, 31 kHz, 60 Hz (VGA) */
 909         "vga", 60, 640, 480, TAG_SHRES, 64, 96, 30, 9, 112, 2,
 910         0, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 911     }, {
 912         /* 640x400, 31 kHz, 70 Hz (VGA) */
 913         "vga70", 70, 640, 400, TAG_SHRES, 64, 96, 35, 12, 112, 2,
 914         FB_SYNC_VERT_HIGH_ACT | FB_SYNC_COMP_HIGH_ACT, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 915     },
 916
 917 #if 0
 918
 919     /*
 920      *  A2024 video modes
 921      *  These modes don't work yet because there's no A2024 driver.
 922      */
 923
 924     {
 925         /* 1024x800, 10 Hz */
 926         "a2024-10", 10, 1024, 800, TAG_HIRES, 0, 0, 0, 0, 0, 0,
 927         0, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 928     }, {
 929         /* 1024x800, 15 Hz */
 930         "a2024-15", 15, 1024, 800, TAG_HIRES, 0, 0, 0, 0, 0, 0,
 931         0, FB_VMODE_NONINTERLACED | FB_VMODE_YWRAP
 932     }
 933 #endif
 934 };
 935
 936 #define NUM_TOTAL_MODES  ARRAY_SIZE(ami_modedb)
 937
 938 static char *mode_option __initdata = NULL;
 939 static int round_down_bpp = 1;  /* for mode probing */
 940
 941         /*
 942          * Some default modes
 943          */
 944
 945
 946 #define DEFMODE_PAL         2   /* "pal" for PAL OCS/ECS */
 947 #define DEFMODE_NTSC        0   /* "ntsc" for NTSC OCS/ECS */
 948 #define DEFMODE_AMBER_PAL   3   /* "pal-lace" for flicker fixed PAL (A3000) */
 949 #define DEFMODE_AMBER_NTSC  1   /* "ntsc-lace" for flicker fixed NTSC (A3000) */
 950 #define DEFMODE_AGA         19  /* "vga70" for AGA */
 951
 952
 953 static int amifb_ilbm = 0;      /* interleaved or normal bitplanes */
 954 static int amifb_inverse = 0;
 955
 956
 957         /*
 958          * Macros for the conversion from real world values to hardware register
 959          * values
 960          *
 961          * This helps us to keep our attention on the real stuff...
 962          *
 963          * Hardware limits for AGA:
 964          *
 965          *      parameter  min    max  step
 966          *      ---------  ---   ----  ----
 967          *      diwstrt_h    0   2047     1
 968          *      diwstrt_v    0   2047     1
 969          *      diwstop_h    0   4095     1
 970          *      diwstop_v    0   4095     1
 971          *
 972          *      ddfstrt      0   2032    16
 973          *      ddfstop      0   2032    16
 974          *
 975          *      htotal       8   2048     8
 976          *      hsstrt       0   2040     8
 977          *      hsstop       0   2040     8
 978          *      vtotal       1   4096     1
 979          *      vsstrt       0   4095     1
 980          *      vsstop       0   4095     1
 981          *      hcenter      0   2040     8
 982          *
 983          *      hbstrt       0   2047     1
 984          *      hbstop       0   2047     1
 985          *      vbstrt       0   4095     1
 986          *      vbstop       0   4095     1
 987          *
 988          * Horizontal values are in 35 ns (SHRES) pixels
 989          * Vertical values are in half scanlines
 990          */
 991
 992 /* bplcon1 (smooth scrolling) */
 993
 994 #define hscroll2hw(hscroll) \
 995         (((hscroll)<<12 & 0x3000) | ((hscroll)<<8 & 0xc300) | \
 996          ((hscroll)<<4 & 0x0c00) | ((hscroll)<<2 & 0x00f0) | ((hscroll)>>2 & 0x000f))
 997
 998 /* diwstrt/diwstop/diwhigh (visible display window) */
 999
1000 #define diwstrt2hw(diwstrt_h, diwstrt_v) \
1001         (((diwstrt_v)<<7 & 0xff00) | ((diwstrt_h)>>2 & 0x00ff))
1002 #define diwstop2hw(diwstop_h, diwstop_v) \
1003         (((diwstop_v)<<7 & 0xff00) | ((diwstop_h)>>2 & 0x00ff))
1004 #define diwhigh2hw(diwstrt_h, diwstrt_v, diwstop_h, diwstop_v) \
1005         (((diwstop_h)<<3 & 0x2000) | ((diwstop_h)<<11 & 0x1800) | \
1006          ((diwstop_v)>>1 & 0x0700) | ((diwstrt_h)>>5 & 0x0020) | \
1007          ((diwstrt_h)<<3 & 0x0018) | ((diwstrt_v)>>9 & 0x0007))
1008
1009 /* ddfstrt/ddfstop (display DMA) */
1010
1011 #define ddfstrt2hw(ddfstrt)     div8(ddfstrt)
1012 #define ddfstop2hw(ddfstop)     div8(ddfstop)
1013
1014 /* hsstrt/hsstop/htotal/vsstrt/vsstop/vtotal/hcenter (sync timings) */
1015
1016 #define hsstrt2hw(hsstrt)       (div8(hsstrt))
1017 #define hsstop2hw(hsstop)       (div8(hsstop))
1018 #define htotal2hw(htotal)       (div8(htotal)-1)
1019 #define vsstrt2hw(vsstrt)       (div2(vsstrt))
1020 #define vsstop2hw(vsstop)       (div2(vsstop))
1021 #define vtotal2hw(vtotal)       (div2(vtotal)-1)
1022 #define hcenter2hw(htotal)      (div8(htotal))
1023
1024 /* hbstrt/hbstop/vbstrt/vbstop (blanking timings) */
1025
1026 #define hbstrt2hw(hbstrt)       (((hbstrt)<<8 & 0x0700) | ((hbstrt)>>3 & 0x00ff))
1027 #define hbstop2hw(hbstop)       (((hbstop)<<8 & 0x0700) | ((hbstop)>>3 & 0x00ff))
1028 #define vbstrt2hw(vbstrt)       (div2(vbstrt))
1029 #define vbstop2hw(vbstop)       (div2(vbstop))
1030
1031 /* colour */
1032
1033 #define rgb2hw8_high(red, green, blue) \
1034         (((red & 0xf0)<<4) | (green & 0xf0) | ((blue & 0xf0)>>4))
1035 #define rgb2hw8_low(red, green, blue) \
1036         (((red & 0x0f)<<8) | ((green & 0x0f)<<4) | (blue & 0x0f))
1037 #define rgb2hw4(red, green, blue) \
1038         (((red & 0xf0)<<4) | (green & 0xf0) | ((blue & 0xf0)>>4))
1039 #define rgb2hw2(red, green, blue) \
1040         (((red & 0xc0)<<4) | (green & 0xc0) | ((blue & 0xc0)>>4))
1041
1042 /* sprpos/sprctl (sprite positioning) */
1043
1044 #define spr2hw_pos(start_v, start_h) \
1045         (((start_v)<<7&0xff00) | ((start_h)>>3&0x00ff))
1046 #define spr2hw_ctl(start_v, start_h, stop_v) \
1047         (((stop_v)<<7&0xff00) | ((start_v)>>4&0x0040) | ((stop_v)>>5&0x0020) | \
1048          ((start_h)<<3&0x0018) | ((start_v)>>7&0x0004) | ((stop_v)>>8&0x0002) | \
1049          ((start_h)>>2&0x0001))
1050
1051 /* get current vertical position of beam */
1052 #define get_vbpos()     ((u_short)((*(u_long volatile *)&custom.vposr >> 7) & 0xffe))
1053
1054         /*
1055          * Copper Initialisation List
1056          */
1057
1058 #define COPINITSIZE (sizeof(copins)*40)
1059
1060 enum {
1061         cip_bplcon0
1062 };
1063
1064         /*
1065          * Long Frame/Short Frame Copper List
1066          * Don't change the order, build_copper()/rebuild_copper() rely on this
1067          */
1068
1069 #define COPLISTSIZE (sizeof(copins)*64)
1070
1071 enum {
1072         cop_wait, cop_bplcon0,
1073         cop_spr0ptrh, cop_spr0ptrl,
1074         cop_diwstrt, cop_diwstop,
1075         cop_diwhigh,
1076 };
1077
1078         /*
1079          * Pixel modes for Bitplanes and Sprites
1080          */
1081
1082 static u_short bplpixmode[3] = {
1083         BPC0_SHRES,                     /*  35 ns */
1084         BPC0_HIRES,                     /*  70 ns */
1085         0                               /* 140 ns */
1086 };
1087
1088 static u_short sprpixmode[3] = {
1089         BPC3_SPRES1 | BPC3_SPRES0,      /*  35 ns */
1090         BPC3_SPRES1,                    /*  70 ns */
1091         BPC3_SPRES0                     /* 140 ns */
1092 };
1093
1094         /*
1095          * Fetch modes for Bitplanes and Sprites
1096          */
1097
1098 static u_short bplfetchmode[3] = {
1099         0,                              /* 1x */
1100         FMODE_BPL32,                    /* 2x */
1101         FMODE_BPAGEM | FMODE_BPL32      /* 4x */
1102 };
1103
1104 static u_short sprfetchmode[3] = {
1105         0,                              /* 1x */
1106         FMODE_SPR32,                    /* 2x */
1107         FMODE_SPAGEM | FMODE_SPR32      /* 4x */
1108 };
1109
1110
1111         /*
1112          * Interface used by the world
1113          */
1114
1115 int amifb_setup(char*);
1116
1117 static int amifb_check_var(struct fb_var_screeninfo *var,
1118                            struct fb_info *info);
1119 static int amifb_set_par(struct fb_info *info);
1120 static int amifb_setcolreg(unsigned regno, unsigned red, unsigned green,
1121                            unsigned blue, unsigned transp,
1122                            struct fb_info *info);
1123 static int amifb_blank(int blank, struct fb_info *info);
1124 static int amifb_pan_display(struct fb_var_screeninfo *var,
1125                              struct fb_info *info);
1126 static void amifb_fillrect(struct fb_info *info,
1127                            const struct fb_fillrect *rect);
1128 static void amifb_copyarea(struct fb_info *info,
1129                            const struct fb_copyarea *region);
1130 static void amifb_imageblit(struct fb_info *info,
1131                             const struct fb_image *image);
1132 static int amifb_ioctl(struct fb_info *info, unsigned int cmd, unsigned long arg);
1133
1134
1135         /*
1136          * Interface to the low level console driver
1137          */
1138
1139 int amifb_init(void);
1140 static void amifb_deinit(void);
1141
1142         /*
1143          * Internal routines
1144          */
1145
1146 static int flash_cursor(void);
1147 static irqreturn_t amifb_interrupt(int irq, void *dev_id);
1148 static u_long chipalloc(u_long size);
1149 static void chipfree(void);
1150
1151         /*
1152          * Hardware routines
1153          */
1154
1155 static int ami_decode_var(struct fb_var_screeninfo *var,
1156                           struct amifb_par *par);
1157 static int ami_encode_var(struct fb_var_screeninfo *var,
1158                           struct amifb_par *par);
1159 static void ami_pan_var(struct fb_var_screeninfo *var);
1160 static int ami_update_par(void);
1161 static void ami_update_display(void);
1162 static void ami_init_display(void);
1163 static void ami_do_blank(void);
1164 static int ami_get_fix_cursorinfo(struct fb_fix_cursorinfo *fix);
1165 static int ami_get_var_cursorinfo(struct fb_var_cursorinfo *var, u_char __user *data);
1166 static int ami_set_var_cursorinfo(struct fb_var_cursorinfo *var, u_char __user *data);
1167 static int ami_get_cursorstate(struct fb_cursorstate *state);
1168 static int ami_set_cursorstate(struct fb_cursorstate *state);
1169 static void ami_set_sprite(void);
1170 static void ami_init_copper(void);
1171 static void ami_reinit_copper(void);
1172 static void ami_build_copper(void);
1173 static void ami_rebuild_copper(void);
1174
1175
1176 static struct fb_ops amifb_ops = {
1177         .owner          = THIS_MODULE,
1178         .fb_check_var   = amifb_check_var,
1179         .fb_set_par     = amifb_set_par,
1180         .fb_setcolreg   = amifb_setcolreg,
1181         .fb_blank       = amifb_blank,
1182         .fb_pan_display = amifb_pan_display,
1183         .fb_fillrect    = amifb_fillrect,
1184         .fb_copyarea    = amifb_copyarea,
1185         .fb_imageblit   = amifb_imageblit,
1186         .fb_ioctl       = amifb_ioctl,
1187 };
1188
1189 static void __init amifb_setup_mcap(char *spec)
1190 {
1191         char *p;
1192         int vmin, vmax, hmin, hmax;
1193
1194         /* Format for monitor capabilities is: <Vmin>;<Vmax>;<Hmin>;<Hmax>
1195          * <V*> vertical freq. in Hz
1196          * <H*> horizontal freq. in kHz
1197          */
1198
1199         if (!(p = strsep(&spec, ";")) || !*p)
1200                 return;
1201         vmin = simple_strtoul(p, NULL, 10);
1202         if (vmin <= 0)
1203                 return;
1204         if (!(p = strsep(&spec, ";")) || !*p)
1205                 return;
1206         vmax = simple_strtoul(p, NULL, 10);
1207         if (vmax <= 0 || vmax <= vmin)
1208                 return;
1209         if (!(p = strsep(&spec, ";")) || !*p)
1210                 return;
1211         hmin = 1000 * simple_strtoul(p, NULL, 10);
1212         if (hmin <= 0)
1213                 return;
1214         if (!(p = strsep(&spec, "")) || !*p)
1215                 return;
1216         hmax = 1000 * simple_strtoul(p, NULL, 10);
1217         if (hmax <= 0 || hmax <= hmin)
1218                 return;
1219
1220         fb_info.monspecs.vfmin = vmin;
1221         fb_info.monspecs.vfmax = vmax;
1222         fb_info.monspecs.hfmin = hmin;
1223         fb_info.monspecs.hfmax = hmax;
1224 }
1225
1226 int __init amifb_setup(char *options)
1227 {
1228         char *this_opt;
1229
1230         if (!options || !*options)
1231                 return 0;
1232
1233         while ((this_opt = strsep(&options, ",")) != NULL) {
1234                 if (!*this_opt)
1235                         continue;
1236                 if (!strcmp(this_opt, "inverse")) {
1237                         amifb_inverse = 1;
1238                         fb_invert_cmaps();
1239                 } else if (!strcmp(this_opt, "ilbm"))
1240                         amifb_ilbm = 1;
1241                 else if (!strncmp(this_opt, "monitorcap:", 11))
1242                         amifb_setup_mcap(this_opt+11);
1243                 else if (!strncmp(this_opt, "fstart:", 7))
1244                         min_fstrt = simple_strtoul(this_opt+7, NULL, 0);
1245                 else
1246                         mode_option = this_opt;
1247         }
1248
1249         if (min_fstrt < 48)
1250                 min_fstrt = 48;
1251
1252         return 0;
1253 }
1254
1255
1256 static int amifb_check_var(struct fb_var_screeninfo *var,
1257                            struct fb_info *info)
1258 {
1259         int err;
1260         struct amifb_par par;
1261
1262         /* Validate wanted screen parameters */
1263         if ((err = ami_decode_var(var, &par)))
1264                 return err;
1265
1266         /* Encode (possibly rounded) screen parameters */
1267         ami_encode_var(var, &par);
1268         return 0;
1269 }
1270
1271
1272 static int amifb_set_par(struct fb_info *info)
1273 {
1274         struct amifb_par *par = (struct amifb_par *)info->par;
1275
1276         do_vmode_pan = 0;
1277         do_vmode_full = 0;
1278
1279         /* Decode wanted screen parameters */
1280         ami_decode_var(&info->var, par);
1281
1282         /* Set new videomode */
1283         ami_build_copper();
1284
1285         /* Set VBlank trigger */
1286         do_vmode_full = 1;
1287
1288         /* Update fix for new screen parameters */
1289         if (par->bpp == 1) {
1290                 info->fix.type = FB_TYPE_PACKED_PIXELS;
1291                 info->fix.type_aux = 0;
1292         } else if (amifb_ilbm) {
1293                 info->fix.type = FB_TYPE_INTERLEAVED_PLANES;
1294                 info->fix.type_aux = par->next_line;
1295         } else {
1296                 info->fix.type = FB_TYPE_PLANES;
1297                 info->fix.type_aux = 0;
1298         }
1299         info->fix.line_length = div8(upx(16<<maxfmode, par->vxres));
1300
1301         if (par->vmode & FB_VMODE_YWRAP) {
1302                 info->fix.ywrapstep = 1;
1303                 info->fix.xpanstep = 0;
1304                 info->fix.ypanstep = 0;
1305                 info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YWRAP |
1306                     FBINFO_READS_FAST; /* override SCROLL_REDRAW */
1307         } else {
1308                 info->fix.ywrapstep = 0;
1309                 if (par->vmode & FB_VMODE_SMOOTH_XPAN)
1310                         info->fix.xpanstep = 1;
1311                 else
1312                         info->fix.xpanstep = 16<<maxfmode;
1313                 info->fix.ypanstep = 1;
1314                 info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN;
1315         }
1316         return 0;
1317 }
1318
1319
1320         /*
1321          * Pan or Wrap the Display
1322          *
1323          * This call looks only at xoffset, yoffset and the FB_VMODE_YWRAP flag
1324          */
1325
1326 static int amifb_pan_display(struct fb_var_screeninfo *var,
1327                              struct fb_info *info)
1328 {
1329         if (var->vmode & FB_VMODE_YWRAP) {
1330                 if (var->yoffset < 0 ||
1331                     var->yoffset >= info->var.yres_virtual || var->xoffset)
1332                         return -EINVAL;
1333         } else {
1334                 /*
1335                  * TODO: There will be problems when xpan!=1, so some columns
1336                  * on the right side will never be seen
1337                  */
1338                 if (var->xoffset+info->var.xres > upx(16<<maxfmode, info->var.xres_virtual) ||
1339                     var->yoffset+info->var.yres > info->var.yres_virtual)
1340                         return -EINVAL;
1341         }
1342         ami_pan_var(var);
1343         info->var.xoffset = var->xoffset;
1344         info->var.yoffset = var->yoffset;
1345         if (var->vmode & FB_VMODE_YWRAP)
1346                 info->var.vmode |= FB_VMODE_YWRAP;
1347         else
1348                 info->var.vmode &= ~FB_VMODE_YWRAP;
1349         return 0;
1350 }
1351
1352
1353 #if BITS_PER_LONG == 32
1354 #define BYTES_PER_LONG  4
1355 #define SHIFT_PER_LONG  5
1356 #elif BITS_PER_LONG == 64
1357 #define BYTES_PER_LONG  8
1358 #define SHIFT_PER_LONG  6
1359 #else
1360 #define Please update me
1361 #endif
1362
1363
1364     /*
1365      *  Compose two values, using a bitmask as decision value
1366      *  This is equivalent to (a & mask) | (b & ~mask)
1367      */
1368
1369 static inline unsigned long comp(unsigned long a, unsigned long b,
1370                                  unsigned long mask)
1371 {
1372         return ((a ^ b) & mask) ^ b;
1373 }
1374
1375
1376 static inline unsigned long xor(unsigned long a, unsigned long b,
1377                                 unsigned long mask)
1378 {
1379         return (a & mask) ^ b;
1380 }
1381
1382
1383     /*
1384      *  Unaligned forward bit copy using 32-bit or 64-bit memory accesses
1385      */
1386
1387 static void bitcpy(unsigned long *dst, int dst_idx, const unsigned long *src,
1388                    int src_idx, u32 n)
1389 {
1390         unsigned long first, last;
1391         int shift = dst_idx-src_idx, left, right;
1392         unsigned long d0, d1;
1393         int m;
1394
1395         if (!n)
1396                 return;
1397
1398         shift = dst_idx-src_idx;
1399         first = ~0UL >> dst_idx;
1400         last = ~(~0UL >> ((dst_idx+n) % BITS_PER_LONG));
1401
1402         if (!shift) {
1403                 // Same alignment for source and dest
1404
1405                 if (dst_idx+n <= BITS_PER_LONG) {
1406                         // Single word
1407                         if (last)
1408                                 first &= last;
1409                         *dst = comp(*src, *dst, first);
1410                 } else {
1411                         // Multiple destination words
1412                         // Leading bits
1413                         if (first) {
1414                                 *dst = comp(*src, *dst, first);
1415                                 dst++;
1416                                 src++;
1417                                 n -= BITS_PER_LONG-dst_idx;
1418                         }
1419
1420                         // Main chunk
1421                         n /= BITS_PER_LONG;
1422                         while (n >= 8) {
1423                                 *dst++ = *src++;
1424                                 *dst++ = *src++;
1425                                 *dst++ = *src++;
1426                                 *dst++ = *src++;
1427                                 *dst++ = *src++;
1428                                 *dst++ = *src++;
1429                                 *dst++ = *src++;
1430                                 *dst++ = *src++;
1431                                 n -= 8;
1432                         }
1433                         while (n--)
1434                                 *dst++ = *src++;
1435
1436                         // Trailing bits
1437                         if (last)
1438                                 *dst = comp(*src, *dst, last);
1439                 }
1440         } else {
1441                 // Different alignment for source and dest
1442
1443                 right = shift & (BITS_PER_LONG-1);
1444                 left = -shift & (BITS_PER_LONG-1);
1445
1446                 if (dst_idx+n <= BITS_PER_LONG) {
1447                         // Single destination word
1448                         if (last)
1449                                 first &= last;
1450                         if (shift > 0) {
1451                                 // Single source word
1452                                 *dst = comp(*src >> right, *dst, first);
1453                         } else if (src_idx+n <= BITS_PER_LONG) {
1454                                 // Single source word
1455                                 *dst = comp(*src << left, *dst, first);
1456                         } else {
1457                                 // 2 source words
1458                                 d0 = *src++;
1459                                 d1 = *src;
1460                                 *dst = comp(d0 << left | d1 >> right, *dst,
1461                                             first);
1462                         }
1463                 } else {
1464                         // Multiple destination words
1465                         d0 = *src++;
1466                         // Leading bits
1467                         if (shift > 0) {
1468                                 // Single source word
1469                                 *dst = comp(d0 >> right, *dst, first);
1470                                 dst++;
1471                                 n -= BITS_PER_LONG-dst_idx;
1472                         } else {
1473                                 // 2 source words
1474                                 d1 = *src++;
1475                                 *dst = comp(d0 << left | d1 >> right, *dst,
1476                                             first);
1477                                 d0 = d1;
1478                                 dst++;
1479                                 n -= BITS_PER_LONG-dst_idx;
1480                         }
1481
1482                         // Main chunk
1483                         m = n % BITS_PER_LONG;
1484                         n /= BITS_PER_LONG;
1485                         while (n >= 4) {
1486                                 d1 = *src++;
1487                                 *dst++ = d0 << left | d1 >> right;
1488                                 d0 = d1;
1489                                 d1 = *src++;
1490                                 *dst++ = d0 << left | d1 >> right;
1491                                 d0 = d1;
1492                                 d1 = *src++;
1493                                 *dst++ = d0 << left | d1 >> right;
1494                                 d0 = d1;
1495                                 d1 = *src++;
1496                                 *dst++ = d0 << left | d1 >> right;
1497                                 d0 = d1;
1498                                 n -= 4;
1499                         }
1500                         while (n--) {
1501                                 d1 = *src++;
1502                                 *dst++ = d0 << left | d1 >> right;
1503                                 d0 = d1;
1504                         }
1505
1506                         // Trailing bits
1507                         if (last) {
1508                                 if (m <= right) {
1509                                         // Single source word
1510                                         *dst = comp(d0 << left, *dst, last);
1511                                 } else {
1512                                         // 2 source words
1513                                         d1 = *src;
1514                                         *dst = comp(d0 << left | d1 >> right,
1515                                                     *dst, last);
1516                                 }
1517                         }
1518                 }
1519         }
1520 }
1521
1522
1523     /*
1524      *  Unaligned reverse bit copy using 32-bit or 64-bit memory accesses
1525      */
1526
1527 static void bitcpy_rev(unsigned long *dst, int dst_idx,
1528                        const unsigned long *src, int src_idx, u32 n)
1529 {
1530         unsigned long first, last;
1531         int shift = dst_idx-src_idx, left, right;
1532         unsigned long d0, d1;
1533         int m;
1534
1535         if (!n)
1536                 return;
1537
1538         dst += (n-1)/BITS_PER_LONG;
1539         src += (n-1)/BITS_PER_LONG;
1540         if ((n-1) % BITS_PER_LONG) {
1541                 dst_idx += (n-1) % BITS_PER_LONG;
1542                 dst += dst_idx >> SHIFT_PER_LONG;
1543                 dst_idx &= BITS_PER_LONG-1;
1544                 src_idx += (n-1) % BITS_PER_LONG;
1545                 src += src_idx >> SHIFT_PER_LONG;
1546                 src_idx &= BITS_PER_LONG-1;
1547         }
1548
1549         shift = dst_idx-src_idx;
1550         first = ~0UL << (BITS_PER_LONG-1-dst_idx);
1551         last = ~(~0UL << (BITS_PER_LONG-1-((dst_idx-n) % BITS_PER_LONG)));
1552
1553         if (!shift) {
1554                 // Same alignment for source and dest
1555
1556                 if ((unsigned long)dst_idx+1 >= n) {
1557                         // Single word
1558                         if (last)
1559                                 first &= last;
1560                         *dst = comp(*src, *dst, first);
1561                 } else {
1562                         // Multiple destination words
1563                         // Leading bits
1564                         if (first) {
1565                                 *dst = comp(*src, *dst, first);
1566                                 dst--;
1567                                 src--;
1568                                 n -= dst_idx+1;
1569                         }
1570
1571                         // Main chunk
1572                         n /= BITS_PER_LONG;
1573                         while (n >= 8) {
1574                                 *dst-- = *src--;
1575                                 *dst-- = *src--;
1576                                 *dst-- = *src--;
1577                                 *dst-- = *src--;
1578                                 *dst-- = *src--;
1579                                 *dst-- = *src--;
1580                                 *dst-- = *src--;
1581                                 *dst-- = *src--;
1582                                 n -= 8;
1583                         }
1584                         while (n--)
1585                                 *dst-- = *src--;
1586
1587                         // Trailing bits
1588                         if (last)
1589                                 *dst = comp(*src, *dst, last);
1590                 }
1591         } else {
1592                 // Different alignment for source and dest
1593
1594                 right = shift & (BITS_PER_LONG-1);
1595                 left = -shift & (BITS_PER_LONG-1);
1596
1597                 if ((unsigned long)dst_idx+1 >= n) {
1598                         // Single destination word
1599                         if (last)
1600                                 first &= last;
1601                         if (shift < 0) {
1602                                 // Single source word
1603                                 *dst = comp(*src << left, *dst, first);
1604                         } else if (1+(unsigned long)src_idx >= n) {
1605                                 // Single source word
1606                                 *dst = comp(*src >> right, *dst, first);
1607                         } else {
1608                                 // 2 source words
1609                                 d0 = *src--;
1610                                 d1 = *src;
1611                                 *dst = comp(d0 >> right | d1 << left, *dst,
1612                                             first);
1613                         }
1614                 } else {
1615                         // Multiple destination words
1616                         d0 = *src--;
1617                         // Leading bits
1618                         if (shift < 0) {
1619                                 // Single source word
1620                                 *dst = comp(d0 << left, *dst, first);
1621                                 dst--;
1622                                 n -= dst_idx+1;
1623                         } else {
1624                                 // 2 source words
1625                                 d1 = *src--;
1626                                 *dst = comp(d0 >> right | d1 << left, *dst,
1627                                             first);
1628                                 d0 = d1;
1629                                 dst--;
1630                                 n -= dst_idx+1;
1631                         }
1632
1633                         // Main chunk
1634                         m = n % BITS_PER_LONG;
1635                         n /= BITS_PER_LONG;
1636                         while (n >= 4) {
1637                                 d1 = *src--;
1638                                 *dst-- = d0 >> right | d1 << left;
1639                                 d0 = d1;
1640                                 d1 = *src--;
1641                                 *dst-- = d0 >> right | d1 << left;
1642                                 d0 = d1;
1643                                 d1 = *src--;
1644                                 *dst-- = d0 >> right | d1 << left;
1645                                 d0 = d1;
1646                                 d1 = *src--;
1647                                 *dst-- = d0 >> right | d1 << left;
1648                                 d0 = d1;
1649                                 n -= 4;
1650                         }
1651                         while (n--) {
1652                                 d1 = *src--;
1653                                 *dst-- = d0 >> right | d1 << left;
1654                                 d0 = d1;
1655                         }
1656
1657                         // Trailing bits
1658                         if (last) {
1659                                 if (m <= left) {
1660                                         // Single source word
1661                                         *dst = comp(d0 >> right, *dst, last);
1662                                 } else {
1663                                         // 2 source words
1664                                         d1 = *src;
1665                                         *dst = comp(d0 >> right | d1 << left,
1666                                                     *dst, last);
1667                                 }
1668                         }
1669                 }
1670         }
1671 }
1672
1673
1674     /*
1675      *  Unaligned forward inverting bit copy using 32-bit or 64-bit memory
1676      *  accesses
1677      */
1678
1679 static void bitcpy_not(unsigned long *dst, int dst_idx,
1680                        const unsigned long *src, int src_idx, u32 n)
1681 {
1682         unsigned long first, last;
1683         int shift = dst_idx-src_idx, left, right;
1684         unsigned long d0, d1;
1685         int m;
1686
1687         if (!n)
1688                 return;
1689
1690         shift = dst_idx-src_idx;
1691         first = ~0UL >> dst_idx;
1692         last = ~(~0UL >> ((dst_idx+n) % BITS_PER_LONG));
1693
1694         if (!shift) {
1695                 // Same alignment for source and dest
1696
1697                 if (dst_idx+n <= BITS_PER_LONG) {
1698                         // Single word
1699                         if (last)
1700                                 first &= last;
1701                         *dst = comp(~*src, *dst, first);
1702                 } else {
1703                         // Multiple destination words
1704                         // Leading bits
1705                         if (first) {
1706                                 *dst = comp(~*src, *dst, first);
1707                                 dst++;
1708                                 src++;
1709                                 n -= BITS_PER_LONG-dst_idx;
1710                         }
1711
1712                         // Main chunk
1713                         n /= BITS_PER_LONG;
1714                         while (n >= 8) {
1715                                 *dst++ = ~*src++;
1716                                 *dst++ = ~*src++;
1717                                 *dst++ = ~*src++;
1718                                 *dst++ = ~*src++;
1719                                 *dst++ = ~*src++;
1720                                 *dst++ = ~*src++;
1721                                 *dst++ = ~*src++;
1722                                 *dst++ = ~*src++;
1723                                 n -= 8;
1724                         }
1725                         while (n--)
1726                                 *dst++ = ~*src++;
1727
1728                         // Trailing bits
1729                         if (last)
1730                                 *dst = comp(~*src, *dst, last);
1731                 }
1732         } else {
1733                 // Different alignment for source and dest
1734
1735                 right = shift & (BITS_PER_LONG-1);
1736                 left = -shift & (BITS_PER_LONG-1);
1737
1738                 if (dst_idx+n <= BITS_PER_LONG) {
1739                         // Single destination word
1740                         if (last)
1741                                 first &= last;
1742                         if (shift > 0) {
1743                                 // Single source word
1744                                 *dst = comp(~*src >> right, *dst, first);
1745                         } else if (src_idx+n <= BITS_PER_LONG) {
1746                                 // Single source word
1747                                 *dst = comp(~*src << left, *dst, first);
1748                         } else {
1749                                 // 2 source words
1750                                 d0 = ~*src++;
1751                                 d1 = ~*src;
1752                                 *dst = comp(d0 << left | d1 >> right, *dst,
1753                                             first);
1754                         }
1755                 } else {
1756                         // Multiple destination words
1757                         d0 = ~*src++;
1758                         // Leading bits
1759                         if (shift > 0) {
1760                                 // Single source word
1761                                 *dst = comp(d0 >> right, *dst, first);
1762                                 dst++;
1763                                 n -= BITS_PER_LONG-dst_idx;
1764                         } else {
1765                                 // 2 source words
1766                                 d1 = ~*src++;
1767                                 *dst = comp(d0 << left | d1 >> right, *dst,
1768                                             first);
1769                                 d0 = d1;
1770                                 dst++;
1771                                 n -= BITS_PER_LONG-dst_idx;
1772                         }
1773
1774                         // Main chunk
1775                         m = n % BITS_PER_LONG;
1776                         n /= BITS_PER_LONG;
1777                         while (n >= 4) {
1778                                 d1 = ~*src++;
1779                                 *dst++ = d0 << left | d1 >> right;
1780                                 d0 = d1;
1781                                 d1 = ~*src++;
1782                                 *dst++ = d0 << left | d1 >> right;
1783                                 d0 = d1;
1784                                 d1 = ~*src++;
1785                                 *dst++ = d0 << left | d1 >> right;
1786                                 d0 = d1;
1787                                 d1 = ~*src++;
1788                                 *dst++ = d0 << left | d1 >> right;
1789                                 d0 = d1;
1790                                 n -= 4;
1791                         }
1792                         while (n--) {
1793                                 d1 = ~*src++;
1794                                 *dst++ = d0 << left | d1 >> right;
1795                                 d0 = d1;
1796                         }
1797
1798                         // Trailing bits
1799                         if (last) {
1800                                 if (m <= right) {
1801                                         // Single source word
1802                                         *dst = comp(d0 << left, *dst, last);
1803                                 } else {
1804                                         // 2 source words
1805                                         d1 = ~*src;
1806                                         *dst = comp(d0 << left | d1 >> right,
1807                                                     *dst, last);
1808                                 }
1809                         }
1810                 }
1811         }
1812 }
1813
1814
1815     /*
1816      *  Unaligned 32-bit pattern fill using 32/64-bit memory accesses
1817      */
1818
1819 static void bitfill32(unsigned long *dst, int dst_idx, u32 pat, u32 n)
1820 {
1821         unsigned long val = pat;
1822         unsigned long first, last;
1823
1824         if (!n)
1825                 return;
1826
1827 #if BITS_PER_LONG == 64
1828         val |= val << 32;
1829 #endif
1830
1831         first = ~0UL >> dst_idx;
1832         last = ~(~0UL >> ((dst_idx+n) % BITS_PER_LONG));
1833
1834         if (dst_idx+n <= BITS_PER_LONG) {
1835                 // Single word
1836                 if (last)
1837                         first &= last;
1838                 *dst = comp(val, *dst, first);
1839         } else {
1840                 // Multiple destination words
1841                 // Leading bits
1842                 if (first) {
1843                         *dst = comp(val, *dst, first);
1844                         dst++;
1845                         n -= BITS_PER_LONG-dst_idx;
1846                 }
1847
1848                 // Main chunk
1849                 n /= BITS_PER_LONG;
1850                 while (n >= 8) {
1851                         *dst++ = val;
1852                         *dst++ = val;
1853                         *dst++ = val;
1854                         *dst++ = val;
1855                         *dst++ = val;
1856                         *dst++ = val;
1857                         *dst++ = val;
1858                         *dst++ = val;
1859                         n -= 8;
1860                 }
1861                 while (n--)
1862                         *dst++ = val;
1863
1864                 // Trailing bits
1865                 if (last)
1866                         *dst = comp(val, *dst, last);
1867         }
1868 }
1869
1870
1871     /*
1872      *  Unaligned 32-bit pattern xor using 32/64-bit memory accesses
1873      */
1874
1875 static void bitxor32(unsigned long *dst, int dst_idx, u32 pat, u32 n)
1876 {
1877         unsigned long val = pat;
1878         unsigned long first, last;
1879
1880         if (!n)
1881                 return;
1882
1883 #if BITS_PER_LONG == 64
1884         val |= val << 32;
1885 #endif
1886
1887         first = ~0UL >> dst_idx;
1888         last = ~(~0UL >> ((dst_idx+n) % BITS_PER_LONG));
1889
1890         if (dst_idx+n <= BITS_PER_LONG) {
1891                 // Single word
1892                 if (last)
1893                         first &= last;
1894                 *dst = xor(val, *dst, first);
1895         } else {
1896                 // Multiple destination words
1897                 // Leading bits
1898                 if (first) {
1899                         *dst = xor(val, *dst, first);
1900                         dst++;
1901                         n -= BITS_PER_LONG-dst_idx;
1902                 }
1903
1904                 // Main chunk
1905                 n /= BITS_PER_LONG;
1906                 while (n >= 4) {
1907                         *dst++ ^= val;
1908                         *dst++ ^= val;
1909                         *dst++ ^= val;
1910                         *dst++ ^= val;
1911                         n -= 4;
1912                 }
1913                 while (n--)
1914                         *dst++ ^= val;
1915
1916                 // Trailing bits
1917                 if (last)
1918                         *dst = xor(val, *dst, last);
1919         }
1920 }
1921
1922 static inline void fill_one_line(int bpp, unsigned long next_plane,
1923                                  unsigned long *dst, int dst_idx, u32 n,
1924                                  u32 color)
1925 {
1926         while (1) {
1927                 dst += dst_idx >> SHIFT_PER_LONG;
1928                 dst_idx &= (BITS_PER_LONG-1);
1929                 bitfill32(dst, dst_idx, color & 1 ? ~0 : 0, n);
1930                 if (!--bpp)
1931                         break;
1932                 color >>= 1;
1933                 dst_idx += next_plane*8;
1934         }
1935 }
1936
1937 static inline void xor_one_line(int bpp, unsigned long next_plane,
1938                                 unsigned long *dst, int dst_idx, u32 n,
1939                                 u32 color)
1940 {
1941         while (color) {
1942                 dst += dst_idx >> SHIFT_PER_LONG;
1943                 dst_idx &= (BITS_PER_LONG-1);
1944                 bitxor32(dst, dst_idx, color & 1 ? ~0 : 0, n);
1945                 if (!--bpp)
1946                         break;
1947                 color >>= 1;
1948                 dst_idx += next_plane*8;
1949         }
1950 }
1951
1952
1953 static void amifb_fillrect(struct fb_info *info,
1954                            const struct fb_fillrect *rect)
1955 {
1956         struct amifb_par *par = (struct amifb_par *)info->par;
1957         int dst_idx, x2, y2;
1958         unsigned long *dst;
1959         u32 width, height;
1960
1961         if (!rect->width || !rect->height)
1962                 return;
1963
1964         /*
1965          * We could use hardware clipping but on many cards you get around
1966          * hardware clipping by writing to framebuffer directly.
1967          * */
1968         x2 = rect->dx + rect->width;
1969         y2 = rect->dy + rect->height;
1970         x2 = x2 < info->var.xres_virtual ? x2 : info->var.xres_virtual;
1971         y2 = y2 < info->var.yres_virtual ? y2 : info->var.yres_virtual;
1972         width = x2 - rect->dx;
1973         height = y2 - rect->dy;
1974
1975         dst = (unsigned long *)
1976                 ((unsigned long)info->screen_base & ~(BYTES_PER_LONG-1));
1977         dst_idx = ((unsigned long)info->screen_base & (BYTES_PER_LONG-1))*8;
1978         dst_idx += rect->dy*par->next_line*8+rect->dx;
1979         while (height--) {
1980                 switch (rect->rop) {
1981                     case ROP_COPY:
1982                         fill_one_line(info->var.bits_per_pixel,
1983                                       par->next_plane, dst, dst_idx, width,
1984                                       rect->color);
1985                         break;
1986
1987                     case ROP_XOR:
1988                         xor_one_line(info->var.bits_per_pixel, par->next_plane,
1989                                      dst, dst_idx, width, rect->color);
1990                         break;
1991                 }
1992                 dst_idx += par->next_line*8;
1993         }
1994 }
1995
1996 static inline void copy_one_line(int bpp, unsigned long next_plane,
1997                                  unsigned long *dst, int dst_idx,
1998                                  unsigned long *src, int src_idx, u32 n)
1999 {
2000         while (1) {
2001                 dst += dst_idx >> SHIFT_PER_LONG;
2002                 dst_idx &= (BITS_PER_LONG-1);
2003                 src += src_idx >> SHIFT_PER_LONG;
2004                 src_idx &= (BITS_PER_LONG-1);
2005                 bitcpy(dst, dst_idx, src, src_idx, n);
2006                 if (!--bpp)
2007                         break;
2008                 dst_idx += next_plane*8;
2009                 src_idx += next_plane*8;
2010         }
2011 }
2012
2013 static inline void copy_one_line_rev(int bpp, unsigned long next_plane,
2014                                      unsigned long *dst, int dst_idx,
2015                                      unsigned long *src, int src_idx, u32 n)
2016 {
2017         while (1) {
2018                 dst += dst_idx >> SHIFT_PER_LONG;
2019                 dst_idx &= (BITS_PER_LONG-1);
2020                 src += src_idx >> SHIFT_PER_LONG;
2021                 src_idx &= (BITS_PER_LONG-1);
2022                 bitcpy_rev(dst, dst_idx, src, src_idx, n);
2023                 if (!--bpp)
2024                         break;
2025                 dst_idx += next_plane*8;
2026                 src_idx += next_plane*8;
2027         }
2028 }
2029
2030
2031 static void amifb_copyarea(struct fb_info *info,
2032                            const struct fb_copyarea *area)
2033 {
2034         struct amifb_par *par = (struct amifb_par *)info->par;
2035         int x2, y2;
2036         u32 dx, dy, sx, sy, width, height;
2037         unsigned long *dst, *src;
2038         int dst_idx, src_idx;
2039         int rev_copy = 0;
2040
2041         /* clip the destination */
2042         x2 = area->dx + area->width;
2043         y2 = area->dy + area->height;
2044         dx = area->dx > 0 ? area->dx : 0;
2045         dy = area->dy > 0 ? area->dy : 0;
2046         x2 = x2 < info->var.xres_virtual ? x2 : info->var.xres_virtual;
2047         y2 = y2 < info->var.yres_virtual ? y2 : info->var.yres_virtual;
2048         width = x2 - dx;
2049         height = y2 - dy;
2050
2051         if (area->sx + dx < area->dx || area->sy + dy < area->dy)
2052                 return;
2053
2054         /* update sx,sy */
2055         sx = area->sx + (dx - area->dx);
2056         sy = area->sy + (dy - area->dy);
2057
2058         /* the source must be completely inside the virtual screen */
2059         if (sx + width > info->var.xres_virtual ||
2060                         sy + height > info->var.yres_virtual)
2061                 return;
2062
2063         if (dy > sy || (dy == sy && dx > sx)) {
2064                 dy += height;
2065                 sy += height;
2066                 rev_copy = 1;
2067         }
2068         dst = (unsigned long *)
2069                 ((unsigned long)info->screen_base & ~(BYTES_PER_LONG-1));
2070         src = dst;
2071         dst_idx = ((unsigned long)info->screen_base & (BYTES_PER_LONG-1))*8;
2072         src_idx = dst_idx;
2073         dst_idx += dy*par->next_line*8+dx;
2074         src_idx += sy*par->next_line*8+sx;
2075         if (rev_copy) {
2076                 while (height--) {
2077                         dst_idx -= par->next_line*8;
2078                         src_idx -= par->next_line*8;
2079                         copy_one_line_rev(info->var.bits_per_pixel,
2080                                           par->next_plane, dst, dst_idx, src,
2081                                           src_idx, width);
2082                 }
2083         } else {
2084                 while (height--) {
2085                         copy_one_line(info->var.bits_per_pixel,
2086                                       par->next_plane, dst, dst_idx, src,
2087                                       src_idx, width);
2088                         dst_idx += par->next_line*8;
2089                         src_idx += par->next_line*8;
2090                 }
2091         }
2092 }
2093
2094
2095 static inline void expand_one_line(int bpp, unsigned long next_plane,
2096                                    unsigned long *dst, int dst_idx, u32 n,
2097                                    const u8 *data, u32 bgcolor, u32 fgcolor)
2098 {
2099     const unsigned long *src;
2100     int src_idx;
2101
2102     while (1) {
2103         dst += dst_idx >> SHIFT_PER_LONG;
2104         dst_idx &= (BITS_PER_LONG-1);
2105         if ((bgcolor ^ fgcolor) & 1) {
2106             src = (unsigned long *)((unsigned long)data & ~(BYTES_PER_LONG-1));
2107             src_idx = ((unsigned long)data & (BYTES_PER_LONG-1))*8;
2108             if (fgcolor & 1)
2109                 bitcpy(dst, dst_idx, src, src_idx, n);
2110             else
2111                 bitcpy_not(dst, dst_idx, src, src_idx, n);
2112             /* set or clear */
2113         } else
2114             bitfill32(dst, dst_idx, fgcolor & 1 ? ~0 : 0, n);
2115         if (!--bpp)
2116             break;
2117         bgcolor >>= 1;
2118         fgcolor >>= 1;
2119         dst_idx += next_plane*8;
2120     }
2121 }
2122
2123
2124 static void amifb_imageblit(struct fb_info *info, const struct fb_image *image)
2125 {
2126         struct amifb_par *par = (struct amifb_par *)info->par;
2127         int x2, y2;
2128         unsigned long *dst;
2129         int dst_idx;
2130         const char *src;
2131         u32 dx, dy, width, height, pitch;
2132
2133         /*
2134          * We could use hardware clipping but on many cards you get around
2135          * hardware clipping by writing to framebuffer directly like we are
2136          * doing here.
2137          */
2138         x2 = image->dx + image->width;
2139         y2 = image->dy + image->height;
2140         dx = image->dx;
2141         dy = image->dy;
2142         x2 = x2 < info->var.xres_virtual ? x2 : info->var.xres_virtual;
2143         y2 = y2 < info->var.yres_virtual ? y2 : info->var.yres_virtual;
2144         width  = x2 - dx;
2145         height = y2 - dy;
2146
2147         if (image->depth == 1) {
2148                 dst = (unsigned long *)
2149                         ((unsigned long)info->screen_base & ~(BYTES_PER_LONG-1));
2150                 dst_idx = ((unsigned long)info->screen_base & (BYTES_PER_LONG-1))*8;
2151                 dst_idx += dy*par->next_line*8+dx;
2152                 src = image->data;
2153                 pitch = (image->width+7)/8;
2154                 while (height--) {
2155                         expand_one_line(info->var.bits_per_pixel,
2156                                         par->next_plane, dst, dst_idx, width,
2157                                         src, image->bg_color,
2158                                         image->fg_color);
2159                         dst_idx += par->next_line*8;
2160                         src += pitch;
2161                 }
2162         } else {
2163                 c2p(info->screen_base, image->data, dx, dy, width, height,
2164                     par->next_line, par->next_plane, image->width,
2165                     info->var.bits_per_pixel);
2166         }
2167 }
2168
2169
2170         /*
2171          * Amiga Frame Buffer Specific ioctls
2172          */
2173
2174 static int amifb_ioctl(struct fb_info *info,
2175                        unsigned int cmd, unsigned long arg)
2176 {
2177         union {
2178                 struct fb_fix_cursorinfo fix;
2179                 struct fb_var_cursorinfo var;
2180                 struct fb_cursorstate state;
2181         } crsr;
2182         void __user *argp = (void __user *)arg;
2183         int i;
2184
2185         switch (cmd) {
2186                 case FBIOGET_FCURSORINFO:
2187                         i = ami_get_fix_cursorinfo(&crsr.fix);
2188                         if (i)
2189                                 return i;
2190                         return copy_to_user(argp, &crsr.fix,
2191                                             sizeof(crsr.fix)) ? -EFAULT : 0;
2192
2193                 case FBIOGET_VCURSORINFO:
2194                         i = ami_get_var_cursorinfo(&crsr.var,
2195                                 ((struct fb_var_cursorinfo __user *)arg)->data);
2196                         if (i)
2197                                 return i;
2198                         return copy_to_user(argp, &crsr.var,
2199                                             sizeof(crsr.var)) ? -EFAULT : 0;
2200
2201                 case FBIOPUT_VCURSORINFO:
2202                         if (copy_from_user(&crsr.var, argp, sizeof(crsr.var)))
2203                                 return -EFAULT;
2204                         return ami_set_var_cursorinfo(&crsr.var,
2205                                 ((struct fb_var_cursorinfo __user *)arg)->data);
2206
2207                 case FBIOGET_CURSORSTATE:
2208                         i = ami_get_cursorstate(&crsr.state);
2209                         if (i)
2210                                 return i;
2211                         return copy_to_user(argp, &crsr.state,
2212                                             sizeof(crsr.state)) ? -EFAULT : 0;
2213
2214                 case FBIOPUT_CURSORSTATE:
2215                         if (copy_from_user(&crsr.state, argp,
2216                                            sizeof(crsr.state)))
2217                                 return -EFAULT;
2218                         return ami_set_cursorstate(&crsr.state);
2219         }
2220         return -EINVAL;
2221 }
2222
2223
2224         /*
2225          * Allocate, Clear and Align a Block of Chip Memory
2226          */
2227
2228 static u_long unaligned_chipptr = 0;
2229
2230 static inline u_long __init chipalloc(u_long size)
2231 {
2232         size += PAGE_SIZE-1;
2233         if (!(unaligned_chipptr = (u_long)amiga_chip_alloc(size,
2234                                                            "amifb [RAM]")))
2235                 panic("No Chip RAM for frame buffer");
2236         memset((void *)unaligned_chipptr, 0, size);
2237         return PAGE_ALIGN(unaligned_chipptr);
2238 }
2239
2240 static inline void chipfree(void)
2241 {
2242         if (unaligned_chipptr)
2243                 amiga_chip_free((void *)unaligned_chipptr);
2244 }
2245
2246
2247         /*
2248          * Initialisation
2249          */
2250
2251 int __init amifb_init(void)
2252 {
2253         int tag, i, err = 0;
2254         u_long chipptr;
2255         u_int defmode;
2256
2257 #ifndef MODULE
2258         char *option = NULL;
2259
2260         if (fb_get_options("amifb", &option)) {
2261                 amifb_video_off();
2262                 return -ENODEV;
2263         }
2264         amifb_setup(option);
2265 #endif
2266         if (!MACH_IS_AMIGA || !AMIGAHW_PRESENT(AMI_VIDEO))
2267                 return -ENODEV;
2268
2269         /*
2270          * We request all registers starting from bplpt[0]
2271          */
2272         if (!request_mem_region(CUSTOM_PHYSADDR+0xe0, 0x120,
2273                                 "amifb [Denise/Lisa]"))
2274                 return -EBUSY;
2275
2276         custom.dmacon = DMAF_ALL | DMAF_MASTER;
2277
2278         switch (amiga_chipset) {
2279 #ifdef CONFIG_FB_AMIGA_OCS
2280                 case CS_OCS:
2281                         strcat(fb_info.fix.id, "OCS");
2282 default_chipset:
2283                         chipset = TAG_OCS;
2284                         maxdepth[TAG_SHRES] = 0;        /* OCS means no SHRES */
2285                         maxdepth[TAG_HIRES] = 4;
2286                         maxdepth[TAG_LORES] = 6;
2287                         maxfmode = TAG_FMODE_1;
2288                         defmode = amiga_vblank == 50 ? DEFMODE_PAL
2289                                                      : DEFMODE_NTSC;
2290                         fb_info.fix.smem_len = VIDEOMEMSIZE_OCS;
2291                         break;
2292 #endif /* CONFIG_FB_AMIGA_OCS */
2293
2294 #ifdef CONFIG_FB_AMIGA_ECS
2295                 case CS_ECS:
2296                         strcat(fb_info.fix.id, "ECS");
2297                         chipset = TAG_ECS;
2298                         maxdepth[TAG_SHRES] = 2;
2299                         maxdepth[TAG_HIRES] = 4;
2300                         maxdepth[TAG_LORES] = 6;
2301                         maxfmode = TAG_FMODE_1;
2302                         if (AMIGAHW_PRESENT(AMBER_FF))
2303                             defmode = amiga_vblank == 50 ? DEFMODE_AMBER_PAL
2304                                                          : DEFMODE_AMBER_NTSC;
2305                         else
2306                             defmode = amiga_vblank == 50 ? DEFMODE_PAL
2307                                                          : DEFMODE_NTSC;
2308                         if (amiga_chip_avail()-CHIPRAM_SAFETY_LIMIT >
2309                             VIDEOMEMSIZE_ECS_1M)
2310                                 fb_info.fix.smem_len = VIDEOMEMSIZE_ECS_2M;
2311                         else
2312                                 fb_info.fix.smem_len = VIDEOMEMSIZE_ECS_1M;
2313                         break;
2314 #endif /* CONFIG_FB_AMIGA_ECS */
2315
2316 #ifdef CONFIG_FB_AMIGA_AGA
2317                 case CS_AGA:
2318                         strcat(fb_info.fix.id, "AGA");
2319                         chipset = TAG_AGA;
2320                         maxdepth[TAG_SHRES] = 8;
2321                         maxdepth[TAG_HIRES] = 8;
2322                         maxdepth[TAG_LORES] = 8;
2323                         maxfmode = TAG_FMODE_4;
2324                         defmode = DEFMODE_AGA;
2325                         if (amiga_chip_avail()-CHIPRAM_SAFETY_LIMIT >
2326                             VIDEOMEMSIZE_AGA_1M)
2327                                 fb_info.fix.smem_len = VIDEOMEMSIZE_AGA_2M;
2328                         else
2329                                 fb_info.fix.smem_len = VIDEOMEMSIZE_AGA_1M;
2330                         break;
2331 #endif /* CONFIG_FB_AMIGA_AGA */
2332
2333                 default:
2334 #ifdef CONFIG_FB_AMIGA_OCS
2335                         printk("Unknown graphics chipset, defaulting to OCS\n");
2336                         strcat(fb_info.fix.id, "Unknown");
2337                         goto default_chipset;
2338 #else /* CONFIG_FB_AMIGA_OCS */
2339                         err = -ENODEV;
2340                         goto amifb_error;
2341 #endif /* CONFIG_FB_AMIGA_OCS */
2342                         break;
2343         }
2344
2345         /*
2346          * Calculate the Pixel Clock Values for this Machine
2347          */
2348
2349         {
2350         u_long tmp = DIVUL(200000000000ULL, amiga_eclock);
2351
2352         pixclock[TAG_SHRES] = (tmp + 4) / 8;    /* SHRES:  35 ns / 28 MHz */
2353         pixclock[TAG_HIRES] = (tmp + 2) / 4;    /* HIRES:  70 ns / 14 MHz */
2354         pixclock[TAG_LORES] = (tmp + 1) / 2;    /* LORES: 140 ns /  7 MHz */
2355         }
2356
2357         /*
2358          * Replace the Tag Values with the Real Pixel Clock Values
2359          */
2360
2361         for (i = 0; i < NUM_TOTAL_MODES; i++) {
2362                 struct fb_videomode *mode = &ami_modedb[i];
2363                 tag = mode->pixclock;
2364                 if (tag == TAG_SHRES || tag == TAG_HIRES || tag == TAG_LORES) {
2365                         mode->pixclock = pixclock[tag];
2366                 }
2367         }
2368
2369         /*
2370          *  These monitor specs are for a typical Amiga monitor (e.g. A1960)
2371          */
2372         if (fb_info.monspecs.hfmin == 0) {
2373             fb_info.monspecs.hfmin = 15000;
2374             fb_info.monspecs.hfmax = 38000;
2375             fb_info.monspecs.vfmin = 49;
2376             fb_info.monspecs.vfmax = 90;
2377         }
2378
2379         fb_info.fbops = &amifb_ops;
2380         fb_info.par = &currentpar;
2381         fb_info.flags = FBINFO_DEFAULT;
2382
2383         if (!fb_find_mode(&fb_info.var, &fb_info, mode_option, ami_modedb,
2384                           NUM_TOTAL_MODES, &ami_modedb[defmode], 4)) {
2385                 err = -EINVAL;
2386                 goto amifb_error;
2387         }
2388
2389         fb_videomode_to_modelist(ami_modedb, NUM_TOTAL_MODES,
2390                                  &fb_info.modelist);
2391
2392         round_down_bpp = 0;
2393         chipptr = chipalloc(fb_info.fix.smem_len+
2394                             SPRITEMEMSIZE+
2395                             DUMMYSPRITEMEMSIZE+
2396                             COPINITSIZE+
2397                             4*COPLISTSIZE);
2398
2399         assignchunk(videomemory, u_long, chipptr, fb_info.fix.smem_len);
2400         assignchunk(spritememory, u_long, chipptr, SPRITEMEMSIZE);
2401         assignchunk(dummysprite, u_short *, chipptr, DUMMYSPRITEMEMSIZE);
2402         assignchunk(copdisplay.init, copins *, chipptr, COPINITSIZE);
2403         assignchunk(copdisplay.list[0][0], copins *, chipptr, COPLISTSIZE);
2404         assignchunk(copdisplay.list[0][1], copins *, chipptr, COPLISTSIZE);
2405         assignchunk(copdisplay.list[1][0], copins *, chipptr, COPLISTSIZE);
2406         assignchunk(copdisplay.list[1][1], copins *, chipptr, COPLISTSIZE);
2407
2408         /*
2409          * access the videomem with writethrough cache
2410          */
2411         fb_info.fix.smem_start = (u_long)ZTWO_PADDR(videomemory);
2412         videomemory = (u_long)ioremap_writethrough(fb_info.fix.smem_start,
2413                                                    fb_info.fix.smem_len);
2414         if (!videomemory) {
2415                 printk("amifb: WARNING! unable to map videomem cached writethrough\n");
2416                 fb_info.screen_base = (char *)ZTWO_VADDR(fb_info.fix.smem_start);
2417         } else
2418                 fb_info.screen_base = (char *)videomemory;
2419
2420         memset(dummysprite, 0, DUMMYSPRITEMEMSIZE);
2421
2422         /*
2423          * Enable Display DMA
2424          */
2425
2426         custom.dmacon = DMAF_SETCLR | DMAF_MASTER | DMAF_RASTER | DMAF_COPPER |
2427                         DMAF_BLITTER | DMAF_SPRITE;
2428
2429         /*
2430          * Make sure the Copper has something to do
2431          */
2432
2433         ami_init_copper();
2434
2435         if (request_irq(IRQ_AMIGA_COPPER, amifb_interrupt, 0,
2436                         "fb vertb handler", &currentpar)) {
2437                 err = -EBUSY;
2438                 goto amifb_error;
2439         }
2440
2441         fb_alloc_cmap(&fb_info.cmap, 1<<fb_info.var.bits_per_pixel, 0);
2442
2443         if (register_framebuffer(&fb_info) < 0) {
2444                 err = -EINVAL;
2445                 goto amifb_error;
2446         }
2447
2448         printk("fb%d: %s frame buffer device, using %dK of video memory\n",
2449                fb_info.node, fb_info.fix.id, fb_info.fix.smem_len>>10);
2450
2451         return 0;
2452
2453 amifb_error:
2454         amifb_deinit();
2455         return err;
2456 }
2457
2458 static void amifb_deinit(void)
2459 {
2460         fb_dealloc_cmap(&fb_info.cmap);
2461         chipfree();
2462         if (videomemory)
2463                 iounmap((void*)videomemory);
2464         release_mem_region(CUSTOM_PHYSADDR+0xe0, 0x120);
2465         custom.dmacon = DMAF_ALL | DMAF_MASTER;
2466 }
2467
2468
2469         /*
2470          * Blank the display.
2471          */
2472
2473 static int amifb_blank(int blank, struct fb_info *info)
2474 {
2475         do_blank = blank ? blank : -1;
2476
2477         return 0;
2478 }
2479
2480         /*
2481          * Flash the cursor (called by VBlank interrupt)
2482          */
2483
2484 static int flash_cursor(void)
2485 {
2486         static int cursorcount = 1;
2487
2488         if (cursormode == FB_CURSOR_FLASH) {
2489                 if (!--cursorcount) {
2490                         cursorstate = -cursorstate;
2491                         cursorcount = cursorrate;
2492                         if (!is_blanked)
2493                                 return 1;
2494                 }
2495         }
2496         return 0;
2497 }
2498
2499         /*
2500          * VBlank Display Interrupt
2501          */
2502
2503 static irqreturn_t amifb_interrupt(int irq, void *dev_id)
2504 {
2505         if (do_vmode_pan || do_vmode_full)
2506                 ami_update_display();
2507
2508         if (do_vmode_full)
2509                 ami_init_display();
2510
2511         if (do_vmode_pan) {
2512                 flash_cursor();
2513                 ami_rebuild_copper();
2514                 do_cursor = do_vmode_pan = 0;
2515         } else if (do_cursor) {
2516                 flash_cursor();
2517                 ami_set_sprite();
2518                 do_cursor = 0;
2519         } else {
2520                 if (flash_cursor())
2521                         ami_set_sprite();
2522         }
2523
2524         if (do_blank) {
2525                 ami_do_blank();
2526                 do_blank = 0;
2527         }
2528
2529         if (do_vmode_full) {
2530                 ami_reinit_copper();
2531                 do_vmode_full = 0;
2532         }
2533         return IRQ_HANDLED;
2534 }
2535
2536 /* --------------------------- Hardware routines --------------------------- */
2537
2538         /*
2539          * Get the video params out of `var'. If a value doesn't fit, round
2540          * it up, if it's too big, return -EINVAL.
2541          */
2542
2543 static int ami_decode_var(struct fb_var_screeninfo *var,
2544                           struct amifb_par *par)
2545 {
2546         u_short clk_shift, line_shift;
2547         u_long maxfetchstop, fstrt, fsize, fconst, xres_n, yres_n;
2548         u_int htotal, vtotal;
2549
2550         /*
2551          * Find a matching Pixel Clock
2552          */
2553
2554         for (clk_shift = TAG_SHRES; clk_shift <= TAG_LORES; clk_shift++)
2555                 if (var->pixclock <= pixclock[clk_shift])
2556                         break;
2557         if (clk_shift > TAG_LORES) {
2558                 DPRINTK("pixclock too high\n");
2559                 return -EINVAL;
2560         }
2561         par->clk_shift = clk_shift;
2562
2563         /*
2564          * Check the Geometry Values
2565          */
2566
2567         if ((par->xres = var->xres) < 64)
2568                 par->xres = 64;
2569         if ((par->yres = var->yres) < 64)
2570                 par->yres = 64;
2571         if ((par->vxres = var->xres_virtual) < par->xres)
2572                 par->vxres = par->xres;
2573         if ((par->vyres = var->yres_virtual) < par->yres)
2574                 par->vyres = par->yres;
2575
2576         par->bpp = var->bits_per_pixel;
2577         if (!var->nonstd) {
2578                 if (par->bpp < 1)
2579                         par->bpp = 1;
2580                 if (par->bpp > maxdepth[clk_shift]) {
2581                         if (round_down_bpp && maxdepth[clk_shift])
2582                                 par->bpp = maxdepth[clk_shift];
2583                         else {
2584                                 DPRINTK("invalid bpp\n");
2585                                 return -EINVAL;
2586                         }
2587                 }
2588         } else if (var->nonstd == FB_NONSTD_HAM) {
2589                 if (par->bpp < 6)
2590                         par->bpp = 6;
2591                 if (par->bpp != 6) {
2592                         if (par->bpp < 8)
2593                                 par->bpp = 8;
2594                         if (par->bpp != 8 || !IS_AGA) {
2595                                 DPRINTK("invalid bpp for ham mode\n");
2596                                 return -EINVAL;
2597                         }
2598                 }
2599         } else {
2600                 DPRINTK("unknown nonstd mode\n");
2601                 return -EINVAL;
2602         }
2603
2604         /*
2605          * FB_VMODE_SMOOTH_XPAN will be cleared, if one of the folloing
2606          * checks failed and smooth scrolling is not possible
2607          */
2608
2609         par->vmode = var->vmode | FB_VMODE_SMOOTH_XPAN;
2610         switch (par->vmode & FB_VMODE_MASK) {
2611                 case FB_VMODE_INTERLACED:
2612                         line_shift = 0;
2613                         break;
2614                 case FB_VMODE_NONINTERLACED:
2615                         line_shift = 1;
2616                         break;
2617                 case FB_VMODE_DOUBLE:
2618                         if (!IS_AGA) {
2619                                 DPRINTK("double mode only possible with aga\n");
2620                                 return -EINVAL;
2621                         }
2622                         line_shift = 2;
2623                         break;
2624                 default:
2625                         DPRINTK("unknown video mode\n");
2626                         return -EINVAL;
2627                         break;
2628         }
2629         par->line_shift = line_shift;
2630
2631         /*
2632          * Vertical and Horizontal Timings
2633          */
2634
2635         xres_n = par->xres<<clk_shift;
2636         yres_n = par->yres<<line_shift;
2637         par->htotal = down8((var->left_margin+par->xres+var->right_margin+var->hsync_len)<<clk_shift);
2638         par->vtotal = down2(((var->upper_margin+par->yres+var->lower_margin+var->vsync_len)<<line_shift)+1);
2639
2640         if (IS_AGA)
2641                 par->bplcon3 = sprpixmode[clk_shift];
2642         else
2643                 par->bplcon3 = 0;
2644         if (var->sync & FB_SYNC_BROADCAST) {
2645                 par->diwstop_h = par->htotal-((var->right_margin-var->hsync_len)<<clk_shift);
2646                 if (IS_AGA)
2647                         par->diwstop_h += mod4(var->hsync_len);
2648                 else
2649                         par->diwstop_h = down4(par->diwstop_h);
2650
2651                 par->diwstrt_h = par->diwstop_h - xres_n;
2652                 par->diwstop_v = par->vtotal-((var->lower_margin-var->vsync_len)<<line_shift);
2653                 par->diwstrt_v = par->diwstop_v - yres_n;
2654                 if (par->diwstop_h >= par->htotal+8) {
2655                         DPRINTK("invalid diwstop_h\n");
2656                         return -EINVAL;
2657                 }
2658                 if (par->diwstop_v > par->vtotal) {
2659                         DPRINTK("invalid diwstop_v\n");
2660                         return -EINVAL;
2661                 }
2662
2663                 if (!IS_OCS) {
2664                         /* Initialize sync with some reasonable values for pwrsave */
2665                         par->hsstrt = 160;
2666                         par->hsstop = 320;
2667                         par->vsstrt = 30;
2668                         par->vsstop = 34;
2669                 } else {
2670                         par->hsstrt = 0;
2671                         par->hsstop = 0;
2672                         par->vsstrt = 0;
2673                         par->vsstop = 0;
2674                 }
2675                 if (par->vtotal > (PAL_VTOTAL+NTSC_VTOTAL)/2) {
2676                         /* PAL video mode */
2677                         if (par->htotal != PAL_HTOTAL) {
2678                                 DPRINTK("htotal invalid for pal\n");
2679                                 return -EINVAL;
2680                         }
2681                         if (par->diwstrt_h < PAL_DIWSTRT_H) {
2682                                 DPRINTK("diwstrt_h too low for pal\n");
2683                                 return -EINVAL;
2684                         }
2685                         if (par->diwstrt_v < PAL_DIWSTRT_V) {
2686                                 DPRINTK("diwstrt_v too low for pal\n");
2687                                 return -EINVAL;
2688                         }
2689                         htotal = PAL_HTOTAL>>clk_shift;
2690                         vtotal = PAL_VTOTAL>>1;
2691                         if (!IS_OCS) {
2692                                 par->beamcon0 = BMC0_PAL;
2693                                 par->bplcon3 |= BPC3_BRDRBLNK;
2694                         } else if (AMIGAHW_PRESENT(AGNUS_HR_PAL) ||
2695                                    AMIGAHW_PRESENT(AGNUS_HR_NTSC)) {
2696                                 par->beamcon0 = BMC0_PAL;
2697                                 par->hsstop = 1;
2698                         } else if (amiga_vblank != 50) {
2699                                 DPRINTK("pal not supported by this chipset\n");
2700                                 return -EINVAL;
2701                         }
2702                 } else {
2703                         /* NTSC video mode
2704                          * In the AGA chipset seems to be hardware bug with BPC3_BRDRBLNK
2705                          * and NTSC activated, so than better let diwstop_h <= 1812
2706                          */
2707                         if (par->htotal != NTSC_HTOTAL) {
2708                                 DPRINTK("htotal invalid for ntsc\n");
2709                                 return -EINVAL;
2710                         }
2711                         if (par->diwstrt_h < NTSC_DIWSTRT_H) {
2712                                 DPRINTK("diwstrt_h too low for ntsc\n");
2713                                 return -EINVAL;
2714                         }
2715                         if (par->diwstrt_v < NTSC_DIWSTRT_V) {
2716                                 DPRINTK("diwstrt_v too low for ntsc\n");
2717                                 return -EINVAL;
2718                         }
2719                         htotal = NTSC_HTOTAL>>clk_shift;
2720                         vtotal = NTSC_VTOTAL>>1;
2721                         if (!IS_OCS) {
2722                                 par->beamcon0 = 0;
2723                                 par->bplcon3 |= BPC3_BRDRBLNK;
2724                         } else if (AMIGAHW_PRESENT(AGNUS_HR_PAL) ||
2725                                    AMIGAHW_PRESENT(AGNUS_HR_NTSC)) {
2726                                 par->beamcon0 = 0;
2727                                 par->hsstop = 1;
2728                         } else if (amiga_vblank != 60) {
2729                                 DPRINTK("ntsc not supported by this chipset\n");
2730                                 return -EINVAL;
2731                         }
2732                 }
2733                 if (IS_OCS) {
2734                         if (par->diwstrt_h >= 1024 || par->diwstop_h < 1024 ||
2735                             par->diwstrt_v >=  512 || par->diwstop_v <  256) {
2736                                 DPRINTK("invalid position for display on ocs\n");
2737                                 return -EINVAL;
2738                         }
2739                 }
2740         } else if (!IS_OCS) {
2741                 /* Programmable video mode */
2742                 par->hsstrt = var->right_margin<<clk_shift;
2743                 par->hsstop = (var->right_margin+var->hsync_len)<<clk_shift;
2744                 par->diwstop_h = par->htotal - mod8(par->hsstrt) + 8 - (1 << clk_shift);
2745                 if (!IS_AGA)
2746                         par->diwstop_h = down4(par->diwstop_h) - 16;
2747                 par->diwstrt_h = par->diwstop_h - xres_n;
2748                 par->hbstop = par->diwstrt_h + 4;
2749                 par->hbstrt = par->diwstop_h + 4;
2750                 if (par->hbstrt >= par->htotal + 8)
2751                         par->hbstrt -= par->htotal;
2752                 par->hcenter = par->hsstrt + (par->htotal >> 1);
2753                 par->vsstrt = var->lower_margin<<line_shift;
2754                 par->vsstop = (var->lower_margin+var->vsync_len)<<line_shift;
2755                 par->diwstop_v = par->vtotal;
2756                 if ((par->vmode & FB_VMODE_MASK) == FB_VMODE_INTERLACED)
2757                         par->diwstop_v -= 2;
2758                 par->diwstrt_v = par->diwstop_v - yres_n;
2759                 par->vbstop = par->diwstrt_v - 2;
2760                 par->vbstrt = par->diwstop_v - 2;
2761                 if (par->vtotal > 2048) {
2762                         DPRINTK("vtotal too high\n");
2763                         return -EINVAL;
2764                 }
2765                 if (par->htotal > 2048) {
2766                         DPRINTK("htotal too high\n");
2767                         return -EINVAL;
2768                 }
2769                 par->bplcon3 |= BPC3_EXTBLKEN;
2770                 par->beamcon0 = BMC0_HARDDIS | BMC0_VARVBEN | BMC0_LOLDIS |
2771                                 BMC0_VARVSYEN | BMC0_VARHSYEN | BMC0_VARBEAMEN |
2772                                 BMC0_PAL | BMC0_VARCSYEN;
2773                 if (var->sync & FB_SYNC_HOR_HIGH_ACT)
2774                         par->beamcon0 |= BMC0_HSYTRUE;
2775                 if (var->sync & FB_SYNC_VERT_HIGH_ACT)
2776                         par->beamcon0 |= BMC0_VSYTRUE;
2777                 if (var->sync & FB_SYNC_COMP_HIGH_ACT)
2778                         par->beamcon0 |= BMC0_CSYTRUE;
2779                 htotal = par->htotal>>clk_shift;
2780                 vtotal = par->vtotal>>1;
2781         } else {
2782                 DPRINTK("only broadcast modes possible for ocs\n");
2783                 return -EINVAL;
2784         }
2785
2786         /*
2787          * Checking the DMA timing
2788          */
2789
2790         fconst = 16<<maxfmode<<clk_shift;
2791
2792         /*
2793          * smallest window start value without turn off other dma cycles
2794          * than sprite1-7, unless you change min_fstrt
2795          */
2796
2797
2798         fsize = ((maxfmode+clk_shift <= 1) ? fconst : 64);
2799         fstrt = downx(fconst, par->diwstrt_h-4) - fsize;
2800         if (fstrt < min_fstrt) {
2801                 DPRINTK("fetch start too low\n");
2802                 return -EINVAL;
2803         }
2804
2805         /*
2806          * smallest window start value where smooth scrolling is possible
2807          */
2808
2809         fstrt = downx(fconst, par->diwstrt_h-fconst+(1<<clk_shift)-4) - fsize;
2810         if (fstrt < min_fstrt)
2811                 par->vmode &= ~FB_VMODE_SMOOTH_XPAN;
2812
2813         maxfetchstop = down16(par->htotal - 80);
2814
2815         fstrt = downx(fconst, par->diwstrt_h-4) - 64 - fconst;
2816         fsize = upx(fconst, xres_n + modx(fconst, downx(1<<clk_shift, par->diwstrt_h-4)));
2817         if (fstrt + fsize > maxfetchstop)
2818                 par->vmode &= ~FB_VMODE_SMOOTH_XPAN;
2819
2820         fsize = upx(fconst, xres_n);
2821         if (fstrt + fsize > maxfetchstop) {
2822                 DPRINTK("fetch stop too high\n");
2823                 return -EINVAL;
2824         }
2825
2826         if (maxfmode + clk_shift <= 1) {
2827                 fsize = up64(xres_n + fconst - 1);
2828                 if (min_fstrt + fsize - 64 > maxfetchstop)
2829                         par->vmode &= ~FB_VMODE_SMOOTH_XPAN;
2830
2831                 fsize = up64(xres_n);
2832                 if (min_fstrt + fsize - 64 > maxfetchstop) {
2833                         DPRINTK("fetch size too high\n");
2834                         return -EINVAL;
2835                 }
2836
2837                 fsize -= 64;
2838         } else
2839                 fsize -= fconst;
2840
2841         /*
2842          * Check if there is enough time to update the bitplane pointers for ywrap
2843          */
2844
2845         if (par->htotal-fsize-64 < par->bpp*64)
2846                 par->vmode &= ~FB_VMODE_YWRAP;
2847
2848         /*
2849          * Bitplane calculations and check the Memory Requirements
2850          */
2851
2852         if (amifb_ilbm) {
2853                 par->next_plane = div8(upx(16<<maxfmode, par->vxres));
2854                 par->next_line = par->bpp*par->next_plane;
2855                 if (par->next_line * par->vyres > fb_info.fix.smem_len) {
2856                         DPRINTK("too few video mem\n");
2857                         return -EINVAL;
2858                 }
2859         } else {
2860                 par->next_line = div8(upx(16<<maxfmode, par->vxres));
2861                 par->next_plane = par->vyres*par->next_line;
2862                 if (par->next_plane * par->bpp > fb_info.fix.smem_len) {
2863                         DPRINTK("too few video mem\n");
2864                         return -EINVAL;
2865                 }
2866         }
2867
2868         /*
2869          * Hardware Register Values
2870          */
2871
2872         par->bplcon0 = BPC0_COLOR | bplpixmode[clk_shift];
2873         if (!IS_OCS)
2874                 par->bplcon0 |= BPC0_ECSENA;
2875         if (par->bpp == 8)
2876                 par->bplcon0 |= BPC0_BPU3;
2877         else
2878                 par->bplcon0 |= par->bpp<<12;
2879         if (var->nonstd == FB_NONSTD_HAM)
2880                 par->bplcon0 |= BPC0_HAM;
2881         if (var->sync & FB_SYNC_EXT)
2882                 par->bplcon0 |= BPC0_ERSY;
2883
2884         if (IS_AGA)
2885                 par->fmode = bplfetchmode[maxfmode];
2886
2887         switch (par->vmode & FB_VMODE_MASK) {
2888                 case FB_VMODE_INTERLACED:
2889                         par->bplcon0 |= BPC0_LACE;
2890                         break;
2891                 case FB_VMODE_DOUBLE:
2892                         if (IS_AGA)
2893                                 par->fmode |= FMODE_SSCAN2 | FMODE_BSCAN2;
2894                         break;
2895         }
2896
2897         if (!((par->vmode ^ var->vmode) & FB_VMODE_YWRAP)) {
2898                 par->xoffset = var->xoffset;
2899                 par->yoffset = var->yoffset;
2900                 if (par->vmode & FB_VMODE_YWRAP) {
2901                         if (par->xoffset || par->yoffset < 0 || par->yoffset >= par->vyres)
2902                                 par->xoffset = par->yoffset = 0;
2903                 } else {
2904                         if (par->xoffset < 0 || par->xoffset > upx(16<<maxfmode, par->vxres-par->xres) ||
2905                             par->yoffset < 0 || par->yoffset > par->vyres-par->yres)
2906                                 par->xoffset = par->yoffset = 0;
2907                 }
2908         } else
2909                 par->xoffset = par->yoffset = 0;
2910
2911         par->crsr.crsr_x = par->crsr.crsr_y = 0;
2912         par->crsr.spot_x = par->crsr.spot_y = 0;
2913         par->crsr.height = par->crsr.width = 0;
2914
2915         return 0;
2916 }
2917
2918         /*
2919          * Fill the `var' structure based on the values in `par' and maybe
2920          * other values read out of the hardware.
2921          */
2922
2923 static int ami_encode_var(struct fb_var_screeninfo *var,
2924                           struct amifb_par *par)
2925 {
2926         u_short clk_shift, line_shift;
2927
2928         memset(var, 0, sizeof(struct fb_var_screeninfo));
2929
2930         clk_shift = par->clk_shift;
2931         line_shift = par->line_shift;
2932
2933         var->xres = par->xres;
2934         var->yres = par->yres;
2935         var->xres_virtual = par->vxres;
2936         var->yres_virtual = par->vyres;
2937         var->xoffset = par->xoffset;
2938         var->yoffset = par->yoffset;
2939
2940         var->bits_per_pixel = par->bpp;
2941         var->grayscale = 0;
2942
2943         var->red.offset = 0;
2944         var->red.msb_right = 0;
2945         var->red.length = par->bpp;
2946         if (par->bplcon0 & BPC0_HAM)
2947             var->red.length -= 2;
2948         var->blue = var->green = var->red;
2949         var->transp.offset = 0;
2950         var->transp.length = 0;
2951         var->transp.msb_right = 0;
2952
2953         if (par->bplcon0 & BPC0_HAM)
2954                 var->nonstd = FB_NONSTD_HAM;
2955         else
2956                 var->nonstd = 0;
2957         var->activate = 0;
2958
2959         var->height = -1;
2960         var->width = -1;
2961
2962         var->pixclock = pixclock[clk_shift];
2963
2964         if (IS_AGA && par->fmode & FMODE_BSCAN2)
2965                 var->vmode = FB_VMODE_DOUBLE;
2966         else if (par->bplcon0 & BPC0_LACE)
2967                 var->vmode = FB_VMODE_INTERLACED;
2968         else
2969                 var->vmode = FB_VMODE_NONINTERLACED;
2970
2971         if (!IS_OCS && par->beamcon0 & BMC0_VARBEAMEN) {
2972                 var->hsync_len = (par->hsstop-par->hsstrt)>>clk_shift;
2973                 var->right_margin = par->hsstrt>>clk_shift;
2974                 var->left_margin = (par->htotal>>clk_shift) - var->xres - var->right_margin - var->hsync_len;
2975                 var->vsync_len = (par->vsstop-par->vsstrt)>>line_shift;
2976                 var->lower_margin = par->vsstrt>>line_shift;
2977                 var->upper_margin = (par->vtotal>>line_shift) - var->yres - var->lower_margin - var->vsync_len;
2978                 var->sync = 0;
2979                 if (par->beamcon0 & BMC0_HSYTRUE)
2980                         var->sync |= FB_SYNC_HOR_HIGH_ACT;
2981                 if (par->beamcon0 & BMC0_VSYTRUE)
2982                         var->sync |= FB_SYNC_VERT_HIGH_ACT;
2983                 if (par->beamcon0 & BMC0_CSYTRUE)
2984                         var->sync |= FB_SYNC_COMP_HIGH_ACT;
2985         } else {
2986                 var->sync = FB_SYNC_BROADCAST;
2987                 var->hsync_len = (152>>clk_shift) + mod4(par->diwstop_h);
2988                 var->right_margin = ((par->htotal - down4(par->diwstop_h))>>clk_shift) + var->hsync_len;
2989                 var->left_margin = (par->htotal>>clk_shift) - var->xres - var->right_margin - var->hsync_len;
2990                 var->vsync_len = 4>>line_shift;
2991                 var->lower_margin = ((par->vtotal - par->diwstop_v)>>line_shift) + var->vsync_len;
2992                 var->upper_margin = (((par->vtotal - 2)>>line_shift) + 1) - var->yres -
2993                                     var->lower_margin - var->vsync_len;
2994         }
2995
2996         if (par->bplcon0 & BPC0_ERSY)
2997                 var->sync |= FB_SYNC_EXT;
2998         if (par->vmode & FB_VMODE_YWRAP)
2999                 var->vmode |= FB_VMODE_YWRAP;
3000
3001         return 0;
3002 }
3003
3004
3005         /*
3006          * Pan or Wrap the Display
3007          *
3008          * This call looks only at xoffset, yoffset and the FB_VMODE_YWRAP flag
3009          * in `var'.
3010          */
3011
3012 static void ami_pan_var(struct fb_var_screeninfo *var)
3013 {
3014         struct amifb_par *par = &currentpar;
3015
3016         par->xoffset = var->xoffset;
3017         par->yoffset = var->yoffset;
3018         if (var->vmode & FB_VMODE_YWRAP)
3019                 par->vmode |= FB_VMODE_YWRAP;
3020         else
3021                 par->vmode &= ~FB_VMODE_YWRAP;
3022
3023         do_vmode_pan = 0;
3024         ami_update_par();
3025         do_vmode_pan = 1;
3026 }
3027
3028         /*
3029          * Update hardware
3030          */
3031
3032 static int ami_update_par(void)
3033 {
3034         struct amifb_par *par = &currentpar;
3035         short clk_shift, vshift, fstrt, fsize, fstop, fconst,  shift, move, mod;
3036
3037         clk_shift = par->clk_shift;
3038
3039         if (!(par->vmode & FB_VMODE_SMOOTH_XPAN))
3040                 par->xoffset = upx(16<<maxfmode, par->xoffset);
3041
3042         fconst = 16<<maxfmode<<clk_shift;
3043         vshift = modx(16<<maxfmode, par->xoffset);
3044         fstrt = par->diwstrt_h - (vshift<<clk_shift) - 4;
3045         fsize = (par->xres+vshift)<<clk_shift;
3046         shift = modx(fconst, fstrt);
3047         move = downx(2<<maxfmode, div8(par->xoffset));
3048         if (maxfmode + clk_shift > 1) {
3049                 fstrt = downx(fconst, fstrt) - 64;
3050                 fsize = upx(fconst, fsize);
3051                 fstop = fstrt + fsize - fconst;
3052         } else {
3053                 mod = fstrt = downx(fconst, fstrt) - fconst;
3054                 fstop = fstrt + upx(fconst, fsize) - 64;
3055                 fsize = up64(fsize);
3056                 fstrt = fstop - fsize + 64;
3057                 if (fstrt < min_fstrt) {
3058                         fstop += min_fstrt - fstrt;
3059                         fstrt = min_fstrt;
3060                 }
3061                 move = move - div8((mod-fstrt)>>clk_shift);
3062         }
3063         mod = par->next_line - div8(fsize>>clk_shift);
3064         par->ddfstrt = fstrt;
3065         par->ddfstop = fstop;
3066         par->bplcon1 = hscroll2hw(shift);
3067         par->bpl2mod = mod;
3068         if (par->bplcon0 & BPC0_LACE)
3069                 par->bpl2mod += par->next_line;
3070         if (IS_AGA && (par->fmode & FMODE_BSCAN2))
3071                 par->bpl1mod = -div8(fsize>>clk_shift);
3072         else
3073                 par->bpl1mod = par->bpl2mod;
3074
3075         if (par->yoffset) {
3076                 par->bplpt0 = fb_info.fix.smem_start + par->next_line*par->yoffset + move;
3077                 if (par->vmode & FB_VMODE_YWRAP) {
3078                         if (par->yoffset > par->vyres-par->yres) {
3079                                 par->bplpt0wrap = fb_info.fix.smem_start + move;
3080                                 if (par->bplcon0 & BPC0_LACE && mod2(par->diwstrt_v+par->vyres-par->yoffset))
3081                                         par->bplpt0wrap += par->next_line;
3082                         }
3083                 }
3084         } else
3085                 par->bplpt0 = fb_info.fix.smem_start + move;
3086
3087         if (par->bplcon0 & BPC0_LACE && mod2(par->diwstrt_v))
3088                 par->bplpt0 += par->next_line;
3089
3090         return 0;
3091 }
3092
3093
3094         /*
3095          * Set a single color register. The values supplied are already
3096          * rounded down to the hardware's capabilities (according to the
3097          * entries in the var structure). Return != 0 for invalid regno.
3098          */
3099
3100 static int amifb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
3101                            u_int transp, struct fb_info *info)
3102 {
3103         if (IS_AGA) {
3104                 if (regno > 255)
3105                         return 1;
3106         } else if (currentpar.bplcon0 & BPC0_SHRES) {
3107                 if (regno > 3)
3108                         return 1;
3109         } else {
3110                 if (regno > 31)
3111                         return 1;
3112         }
3113         red >>= 8;
3114         green >>= 8;
3115         blue >>= 8;
3116         if (!regno) {
3117                 red0 = red;
3118                 green0 = green;
3119                 blue0 = blue;
3120         }
3121
3122         /*
3123          * Update the corresponding Hardware Color Register, unless it's Color
3124          * Register 0 and the screen is blanked.
3125          *
3126          * VBlank is switched off to protect bplcon3 or ecs_palette[] from
3127          * being changed by ami_do_blank() during the VBlank.
3128          */
3129
3130         if (regno || !is_blanked) {
3131 #if defined(CONFIG_FB_AMIGA_AGA)
3132                 if (IS_AGA) {
3133                         u_short bplcon3 = currentpar.bplcon3;
3134                         VBlankOff();
3135                         custom.bplcon3 = bplcon3 | (regno<<8 & 0xe000);
3136                         custom.color[regno&31] = rgb2hw8_high(red, green, blue);
3137                         custom.bplcon3 = bplcon3 | (regno<<8 & 0xe000) | BPC3_LOCT;
3138                         custom.color[regno&31] = rgb2hw8_low(red, green, blue);
3139                         custom.bplcon3 = bplcon3;
3140                         VBlankOn();
3141                 } else
3142 #endif
3143 #if defined(CONFIG_FB_AMIGA_ECS)
3144                 if (currentpar.bplcon0 & BPC0_SHRES) {
3145                         u_short color, mask;
3146                         int i;
3147
3148                         mask = 0x3333;
3149                         color = rgb2hw2(red, green, blue);
3150                         VBlankOff();
3151                         for (i = regno+12; i >= (int)regno; i -= 4)
3152                                 custom.color[i] = ecs_palette[i] = (ecs_palette[i] & mask) | color;
3153                         mask <<=2; color >>= 2;
3154                         regno = down16(regno)+mul4(mod4(regno));
3155                         for (i = regno+3; i >= (int)regno; i--)
3156                                 custom.color[i] = ecs_palette[i] = (ecs_palette[i] & mask) | color;
3157                         VBlankOn();
3158                 } else
3159 #endif
3160                         custom.color[regno] = rgb2hw4(red, green, blue);
3161         }
3162         return 0;
3163 }
3164
3165 static void ami_update_display(void)
3166 {
3167         struct amifb_par *par = &currentpar;
3168
3169         custom.bplcon1 = par->bplcon1;
3170         custom.bpl1mod = par->bpl1mod;
3171         custom.bpl2mod = par->bpl2mod;
3172         custom.ddfstrt = ddfstrt2hw(par->ddfstrt);
3173         custom.ddfstop = ddfstop2hw(par->ddfstop);
3174 }
3175
3176         /*
3177          * Change the video mode (called by VBlank interrupt)
3178          */
3179
3180 static void ami_init_display(void)
3181 {
3182         struct amifb_par *par = &currentpar;
3183         int i;
3184
3185         custom.bplcon0 = par->bplcon0 & ~BPC0_LACE;
3186         custom.bplcon2 = (IS_OCS ? 0 : BPC2_KILLEHB) | BPC2_PF2P2 | BPC2_PF1P2;
3187         if (!IS_OCS) {
3188                 custom.bplcon3 = par->bplcon3;
3189                 if (IS_AGA)
3190                         custom.bplcon4 = BPC4_ESPRM4 | BPC4_OSPRM4;
3191                 if (par->beamcon0 & BMC0_VARBEAMEN) {
3192                         custom.htotal = htotal2hw(par->htotal);
3193                         custom.hbstrt = hbstrt2hw(par->hbstrt);
3194                         custom.hbstop = hbstop2hw(par->hbstop);
3195                         custom.hsstrt = hsstrt2hw(par->hsstrt);
3196                         custom.hsstop = hsstop2hw(par->hsstop);
3197                         custom.hcenter = hcenter2hw(par->hcenter);
3198                         custom.vtotal = vtotal2hw(par->vtotal);
3199                         custom.vbstrt = vbstrt2hw(par->vbstrt);
3200                         custom.vbstop = vbstop2hw(par->vbstop);
3201                         custom.vsstrt = vsstrt2hw(par->vsstrt);
3202                         custom.vsstop = vsstop2hw(par->vsstop);
3203                 }
3204         }
3205         if (!IS_OCS || par->hsstop)
3206                 custom.beamcon0 = par->beamcon0;
3207         if (IS_AGA)
3208                 custom.fmode = par->fmode;
3209
3210         /*
3211          * The minimum period for audio depends on htotal
3212          */
3213
3214         amiga_audio_min_period = div16(par->htotal);
3215
3216         is_lace = par->bplcon0 & BPC0_LACE ? 1 : 0;
3217 #if 1
3218         if (is_lace) {
3219                 i = custom.vposr >> 15;
3220         } else {
3221                 custom.vposw = custom.vposr | 0x8000;
3222                 i = 1;
3223         }
3224 #else
3225         i = 1;
3226         custom.vposw = custom.vposr | 0x8000;
3227 #endif
3228         custom.cop2lc = (u_short *)ZTWO_PADDR(copdisplay.list[currentcop][i]);
3229 }
3230
3231         /*
3232          * (Un)Blank the screen (called by VBlank interrupt)
3233          */
3234
3235 static void ami_do_blank(void)
3236 {
3237         struct amifb_par *par = &currentpar;
3238 #if defined(CONFIG_FB_AMIGA_AGA)
3239         u_short bplcon3 = par->bplcon3;
3240 #endif
3241         u_char red, green, blue;
3242
3243         if (do_blank > 0) {
3244                 custom.dmacon = DMAF_RASTER | DMAF_SPRITE;
3245                 red = green = blue = 0;
3246                 if (!IS_OCS && do_blank > 1) {
3247                         switch (do_blank) {
3248                                 case FB_BLANK_VSYNC_SUSPEND:
3249                                         custom.hsstrt = hsstrt2hw(par->hsstrt);
3250                                         custom.hsstop = hsstop2hw(par->hsstop);
3251                                         custom.vsstrt = vsstrt2hw(par->vtotal+4);
3252                                         custom.vsstop = vsstop2hw(par->vtotal+4);
3253                                         break;
3254                                 case FB_BLANK_HSYNC_SUSPEND:
3255                                         custom.hsstrt = hsstrt2hw(par->htotal+16);
3256                                         custom.hsstop = hsstop2hw(par->htotal+16);
3257                                         custom.vsstrt = vsstrt2hw(par->vsstrt);
3258                                         custom.vsstop = vsstrt2hw(par->vsstop);
3259                                         break;
3260                                 case FB_BLANK_POWERDOWN:
3261                                         custom.hsstrt = hsstrt2hw(par->htotal+16);
3262                                         custom.hsstop = hsstop2hw(par->htotal+16);
3263                                         custom.vsstrt = vsstrt2hw(par->vtotal+4);
3264                                         custom.vsstop = vsstop2hw(par->vtotal+4);
3265                                         break;
3266                         }
3267                         if (!(par->beamcon0 & BMC0_VARBEAMEN)) {
3268                                 custom.htotal = htotal2hw(par->htotal);
3269                                 custom.vtotal = vtotal2hw(par->vtotal);
3270                                 custom.beamcon0 = BMC0_HARDDIS | BMC0_VARBEAMEN |
3271                                                   BMC0_VARVSYEN | BMC0_VARHSYEN | BMC0_VARCSYEN;
3272                         }
3273                 }
3274         } else {
3275                 custom.dmacon = DMAF_SETCLR | DMAF_RASTER | DMAF_SPRITE;
3276                 red = red0;
3277                 green = green0;
3278                 blue = blue0;
3279                 if (!IS_OCS) {
3280                         custom.hsstrt = hsstrt2hw(par->hsstrt);
3281                         custom.hsstop = hsstop2hw(par->hsstop);
3282                         custom.vsstrt = vsstrt2hw(par->vsstrt);
3283                         custom.vsstop = vsstop2hw(par->vsstop);
3284                         custom.beamcon0 = par->beamcon0;
3285                 }
3286         }
3287 #if defined(CONFIG_FB_AMIGA_AGA)
3288         if (IS_AGA) {
3289                 custom.bplcon3 = bplcon3;
3290                 custom.color[0] = rgb2hw8_high(red, green, blue);
3291                 custom.bplcon3 = bplcon3 | BPC3_LOCT;
3292                 custom.color[0] = rgb2hw8_low(red, green, blue);
3293                 custom.bplcon3 = bplcon3;
3294         } else
3295 #endif
3296 #if defined(CONFIG_FB_AMIGA_ECS)
3297         if (par->bplcon0 & BPC0_SHRES) {
3298                 u_short color, mask;
3299                 int i;
3300
3301                 mask = 0x3333;
3302                 color = rgb2hw2(red, green, blue);
3303                 for (i = 12; i >= 0; i -= 4)
3304                         custom.color[i] = ecs_palette[i] = (ecs_palette[i] & mask) | color;
3305                 mask <<=2; color >>= 2;
3306                 for (i = 3; i >= 0; i--)
3307                         custom.color[i] = ecs_palette[i] = (ecs_palette[i] & mask) | color;
3308         } else
3309 #endif
3310                 custom.color[0] = rgb2hw4(red, green, blue);
3311         is_blanked = do_blank > 0 ? do_blank : 0;
3312 }
3313
3314 static int ami_get_fix_cursorinfo(struct fb_fix_cursorinfo *fix)
3315 {
3316         struct amifb_par *par = &currentpar;
3317
3318         fix->crsr_width = fix->crsr_xsize = par->crsr.width;
3319         fix->crsr_height = fix->crsr_ysize = par->crsr.height;
3320         fix->crsr_color1 = 17;
3321         fix->crsr_color2 = 18;
3322         return 0;
3323 }
3324
3325 static int ami_get_var_cursorinfo(struct fb_var_cursorinfo *var, u_char __user *data)
3326 {
3327         struct amifb_par *par = &currentpar;
3328         register u_short *lspr, *sspr;
3329 #ifdef __mc68000__
3330         register u_long datawords asm ("d2");
3331 #else
3332         register u_long datawords;
3333 #endif
3334         register short delta;
3335         register u_char color;
3336         short height, width, bits, words;
3337         int size, alloc;
3338
3339         size = par->crsr.height*par->crsr.width;
3340         alloc = var->height*var->width;
3341         var->height = par->crsr.height;
3342         var->width = par->crsr.width;
3343         var->xspot = par->crsr.spot_x;
3344         var->yspot = par->crsr.spot_y;
3345         if (size > var->height*var->width)
3346                 return -ENAMETOOLONG;
3347         if (!access_ok(VERIFY_WRITE, data, size))
3348                 return -EFAULT;
3349         delta = 1<<par->crsr.fmode;
3350         lspr = lofsprite + (delta<<1);
3351         if (par->bplcon0 & BPC0_LACE)
3352                 sspr = shfsprite + (delta<<1);
3353         else
3354                 sspr = NULL;
3355         for (height = (short)var->height-1; height >= 0; height--) {
3356                 bits = 0; words = delta; datawords = 0;
3357                 for (width = (short)var->width-1; width >= 0; width--) {
3358                         if (bits == 0) {
3359                                 bits = 16; --words;
3360 #ifdef __mc68000__
3361                                 asm volatile ("movew %1@(%3:w:2),%0 ; swap %0 ; movew %1@+,%0"
3362                                         : "=d" (datawords), "=a" (lspr) : "1" (lspr), "d" (delta));
3363 #else
3364                                 datawords = (*(lspr+delta) << 16) | (*lspr++);
3365 #endif
3366                         }
3367                         --bits;
3368 #ifdef __mc68000__
3369                         asm volatile (
3370                                 "clrb %0 ; swap %1 ; lslw #1,%1 ; roxlb #1,%0 ; "
3371                                 "swap %1 ; lslw #1,%1 ; roxlb #1,%0"
3372                                 : "=d" (color), "=d" (datawords) : "1" (datawords));
3373 #else
3374                         color = (((datawords >> 30) & 2)
3375                                  | ((datawords >> 15) & 1));
3376                         datawords <<= 1;
3377 #endif
3378                         put_user(color, data++);
3379                 }
3380                 if (bits > 0) {
3381                         --words; ++lspr;
3382                 }
3383                 while (--words >= 0)
3384                         ++lspr;
3385 #ifdef __mc68000__
3386                 asm volatile ("lea %0@(%4:w:2),%0 ; tstl %1 ; jeq 1f ; exg %0,%1\n1:"
3387                         : "=a" (lspr), "=a" (sspr) : "0" (lspr), "1" (sspr), "d" (delta));
3388 #else
3389                 lspr += delta;
3390                 if (sspr) {
3391                         u_short *tmp = lspr;
3392                         lspr = sspr;
3393                         sspr = tmp;
3394                 }
3395 #endif
3396         }
3397         return 0;
3398 }
3399
3400 static int ami_set_var_cursorinfo(struct fb_var_cursorinfo *var, u_char __user *data)
3401 {
3402         struct amifb_par *par = &currentpar;
3403         register u_short *lspr, *sspr;
3404 #ifdef __mc68000__
3405         register u_long datawords asm ("d2");
3406 #else
3407         register u_long datawords;
3408 #endif
3409         register short delta;
3410         u_short fmode;
3411         short height, width, bits, words;
3412
3413         if (!var->width)
3414                 return -EINVAL;
3415         else if (var->width <= 16)
3416                 fmode = TAG_FMODE_1;
3417         else if (var->width <= 32)
3418                 fmode = TAG_FMODE_2;
3419         else if (var->width <= 64)
3420                 fmode = TAG_FMODE_4;
3421         else
3422                 return -EINVAL;
3423         if (fmode > maxfmode)
3424                 return -EINVAL;
3425         if (!var->height)
3426                 return -EINVAL;
3427         if (!access_ok(VERIFY_READ, data, var->width*var->height))
3428                 return -EFAULT;
3429         delta = 1<<fmode;
3430         lofsprite = shfsprite = (u_short *)spritememory;
3431         lspr = lofsprite + (delta<<1);
3432         if (par->bplcon0 & BPC0_LACE) {
3433                 if (((var->height+4)<<fmode<<2) > SPRITEMEMSIZE)
3434                         return -EINVAL;
3435                 memset(lspr, 0, (var->height+4)<<fmode<<2);
3436                 shfsprite += ((var->height+5)&-2)<<fmode;
3437                 sspr = shfsprite + (delta<<1);
3438         } else {
3439                 if (((var->height+2)<<fmode<<2) > SPRITEMEMSIZE)
3440                         return -EINVAL;
3441                 memset(lspr, 0, (var->height+2)<<fmode<<2);
3442                 sspr = NULL;
3443         }
3444         for (height = (short)var->height-1; height >= 0; height--) {
3445                 bits = 16; words = delta; datawords = 0;
3446                 for (width = (short)var->width-1; width >= 0; width--) {
3447                         unsigned long tdata = 0;
3448                         get_user(tdata, data);
3449                         data++;
3450 #ifdef __mc68000__
3451                         asm volatile (
3452                                 "lsrb #1,%2 ; roxlw #1,%0 ; swap %0 ; "
3453                                 "lsrb #1,%2 ; roxlw #1,%0 ; swap %0"
3454                                 : "=d" (datawords)
3455                                 : "0" (datawords), "d" (tdata));
3456 #else
3457                         datawords = ((datawords << 1) & 0xfffefffe);
3458                         datawords |= tdata & 1;
3459                         datawords |= (tdata & 2) << (16-1);
3460 #endif
3461                         if (--bits == 0) {
3462                                 bits = 16; --words;
3463 #ifdef __mc68000__
3464                                 asm volatile ("swap %2 ; movew %2,%0@(%3:w:2) ; swap %2 ; movew %2,%0@+"
3465                                         : "=a" (lspr) : "0" (lspr), "d" (datawords), "d" (delta));
3466 #else
3467                                 *(lspr+delta) = (u_short) (datawords >> 16);
3468                                 *lspr++ = (u_short) (datawords & 0xffff);
3469 #endif
3470                         }
3471                 }
3472                 if (bits < 16) {
3473                         --words;
3474 #ifdef __mc68000__
3475                         asm volatile (
3476                                 "swap %2 ; lslw %4,%2 ; movew %2,%0@(%3:w:2) ; "
3477                                 "swap %2 ; lslw %4,%2 ; movew %2,%0@+"
3478                                 : "=a" (lspr) : "0" (lspr), "d" (datawords), "d" (delta), "d" (bits));
3479 #else
3480                         *(lspr+delta) = (u_short) (datawords >> (16+bits));
3481                         *lspr++ = (u_short) ((datawords & 0x0000ffff) >> bits);
3482 #endif
3483                 }
3484                 while (--words >= 0) {
3485 #ifdef __mc68000__
3486                         asm volatile ("moveql #0,%%d0 ; movew %%d0,%0@(%2:w:2) ; movew %%d0,%0@+"
3487                                 : "=a" (lspr) : "0" (lspr), "d" (delta) : "d0");
3488 #else
3489                         *(lspr+delta) = 0;
3490                         *lspr++ = 0;
3491 #endif
3492                 }
3493 #ifdef __mc68000__
3494                 asm volatile ("lea %0@(%4:w:2),%0 ; tstl %1 ; jeq 1f ; exg %0,%1\n1:"
3495                         : "=a" (lspr), "=a" (sspr) : "0" (lspr), "1" (sspr), "d" (delta));
3496 #else
3497                 lspr += delta;
3498                 if (sspr) {
3499                         u_short *tmp = lspr;
3500                         lspr = sspr;
3501                         sspr = tmp;
3502                 }
3503 #endif
3504         }
3505         par->crsr.height = var->height;
3506         par->crsr.width = var->width;
3507         par->crsr.spot_x = var->xspot;
3508         par->crsr.spot_y = var->yspot;
3509         par->crsr.fmode = fmode;
3510         if (IS_AGA) {
3511                 par->fmode &= ~(FMODE_SPAGEM | FMODE_SPR32);
3512                 par->fmode |= sprfetchmode[fmode];
3513                 custom.fmode = par->fmode;
3514         }
3515         return 0;
3516 }
3517
3518 static int ami_get_cursorstate(struct fb_cursorstate *state)
3519 {
3520         struct amifb_par *par = &currentpar;
3521
3522         state->xoffset = par->crsr.crsr_x;
3523         state->yoffset = par->crsr.crsr_y;
3524         state->mode = cursormode;
3525         return 0;
3526 }
3527
3528 static int ami_set_cursorstate(struct fb_cursorstate *state)
3529 {
3530         struct amifb_par *par = &currentpar;
3531
3532         par->crsr.crsr_x = state->xoffset;
3533         par->crsr.crsr_y = state->yoffset;
3534         if ((cursormode = state->mode) == FB_CURSOR_OFF)
3535                 cursorstate = -1;
3536         do_cursor = 1;
3537         return 0;
3538 }
3539
3540 static void ami_set_sprite(void)
3541 {
3542         struct amifb_par *par = &currentpar;
3543         copins *copl, *cops;
3544         u_short hs, vs, ve;
3545         u_long pl, ps, pt;
3546         short mx, my;
3547
3548         cops = copdisplay.list[currentcop][0];
3549         copl = copdisplay.list[currentcop][1];
3550         ps = pl = ZTWO_PADDR(dummysprite);
3551         mx = par->crsr.crsr_x-par->crsr.spot_x;
3552         my = par->crsr.crsr_y-par->crsr.spot_y;
3553         if (!(par->vmode & FB_VMODE_YWRAP)) {
3554                 mx -= par->xoffset;
3555                 my -= par->yoffset;
3556         }
3557         if (!is_blanked && cursorstate > 0 && par->crsr.height > 0 &&
3558             mx > -(short)par->crsr.width && mx < par->xres &&
3559             my > -(short)par->crsr.height && my < par->yres) {
3560                 pl = ZTWO_PADDR(lofsprite);
3561                 hs = par->diwstrt_h + (mx<<par->clk_shift) - 4;
3562                 vs = par->diwstrt_v + (my<<par->line_shift);
3563                 ve = vs + (par->crsr.height<<par->line_shift);
3564                 if (par->bplcon0 & BPC0_LACE) {
3565                         ps = ZTWO_PADDR(shfsprite);
3566                         lofsprite[0] = spr2hw_pos(vs, hs);
3567                         shfsprite[0] = spr2hw_pos(vs+1, hs);
3568                         if (mod2(vs)) {
3569                                 lofsprite[1<<par->crsr.fmode] = spr2hw_ctl(vs, hs, ve);
3570                                 shfsprite[1<<par->crsr.fmode] = spr2hw_ctl(vs+1, hs, ve+1);
3571                                 pt = pl; pl = ps; ps = pt;
3572                         } else {
3573                                 lofsprite[1<<par->crsr.fmode] = spr2hw_ctl(vs, hs, ve+1);
3574                                 shfsprite[1<<par->crsr.fmode] = spr2hw_ctl(vs+1, hs, ve);
3575                         }
3576                 } else {
3577                         lofsprite[0] = spr2hw_pos(vs, hs) | (IS_AGA && (par->fmode & FMODE_BSCAN2) ? 0x80 : 0);
3578                         lofsprite[1<<par->crsr.fmode] = spr2hw_ctl(vs, hs, ve);
3579                 }
3580         }
3581         copl[cop_spr0ptrh].w[1] = highw(pl);
3582         copl[cop_spr0ptrl].w[1] = loww(pl);
3583         if (par->bplcon0 & BPC0_LACE) {
3584                 cops[cop_spr0ptrh].w[1] = highw(ps);
3585                 cops[cop_spr0ptrl].w[1] = loww(ps);
3586         }
3587 }
3588
3589
3590         /*
3591          * Initialise the Copper Initialisation List
3592          */
3593
3594 static void __init ami_init_copper(void)
3595 {
3596         copins *cop = copdisplay.init;
3597         u_long p;
3598         int i;
3599
3600         if (!IS_OCS) {
3601                 (cop++)->l = CMOVE(BPC0_COLOR | BPC0_SHRES | BPC0_ECSENA, bplcon0);
3602                 (cop++)->l = CMOVE(0x0181, diwstrt);
3603                 (cop++)->l = CMOVE(0x0281, diwstop);
3604                 (cop++)->l = CMOVE(0x0000, diwhigh);
3605         } else
3606                 (cop++)->l = CMOVE(BPC0_COLOR, bplcon0);
3607         p = ZTWO_PADDR(dummysprite);
3608         for (i = 0; i < 8; i++) {
3609                 (cop++)->l = CMOVE(0, spr[i].pos);
3610                 (cop++)->l = CMOVE(highw(p), sprpt[i]);
3611                 (cop++)->l = CMOVE2(loww(p), sprpt[i]);
3612         }
3613
3614         (cop++)->l = CMOVE(IF_SETCLR | IF_COPER, intreq);
3615         copdisplay.wait = cop;
3616         (cop++)->l = CEND;
3617         (cop++)->l = CMOVE(0, copjmp2);
3618         cop->l = CEND;
3619
3620         custom.cop1lc = (u_short *)ZTWO_PADDR(copdisplay.init);
3621         custom.copjmp1 = 0;
3622 }
3623
3624 static void ami_reinit_copper(void)
3625 {
3626         struct amifb_par *par = &currentpar;
3627
3628         copdisplay.init[cip_bplcon0].w[1] = ~(BPC0_BPU3 | BPC0_BPU2 | BPC0_BPU1 | BPC0_BPU0) & par->bplcon0;
3629         copdisplay.wait->l = CWAIT(32, par->diwstrt_v-4);
3630 }
3631
3632         /*
3633          * Build the Copper List
3634          */
3635
3636 static void ami_build_copper(void)
3637 {
3638         struct amifb_par *par = &currentpar;
3639         copins *copl, *cops;
3640         u_long p;
3641
3642         currentcop = 1 - currentcop;
3643
3644         copl = copdisplay.list[currentcop][1];
3645
3646         (copl++)->l = CWAIT(0, 10);
3647         (copl++)->l = CMOVE(par->bplcon0, bplcon0);
3648         (copl++)->l = CMOVE(0, sprpt[0]);
3649         (copl++)->l = CMOVE2(0, sprpt[0]);
3650
3651         if (par->bplcon0 & BPC0_LACE) {
3652                 cops = copdisplay.list[currentcop][0];
3653
3654                 (cops++)->l = CWAIT(0, 10);
3655                 (cops++)->l = CMOVE(par->bplcon0, bplcon0);
3656                 (cops++)->l = CMOVE(0, sprpt[0]);
3657                 (cops++)->l = CMOVE2(0, sprpt[0]);
3658
3659                 (copl++)->l = CMOVE(diwstrt2hw(par->diwstrt_h, par->diwstrt_v+1), diwstrt);
3660                 (copl++)->l = CMOVE(diwstop2hw(par->diwstop_h, par->diwstop_v+1), diwstop);
3661                 (cops++)->l = CMOVE(diwstrt2hw(par->diwstrt_h, par->diwstrt_v), diwstrt);
3662                 (cops++)->l = CMOVE(diwstop2hw(par->diwstop_h, par->diwstop_v), diwstop);
3663                 if (!IS_OCS) {
3664                         (copl++)->l = CMOVE(diwhigh2hw(par->diwstrt_h, par->diwstrt_v+1,
3665                                             par->diwstop_h, par->diwstop_v+1), diwhigh);
3666                         (cops++)->l = CMOVE(diwhigh2hw(par->diwstrt_h, par->diwstrt_v,
3667                                             par->diwstop_h, par->diwstop_v), diwhigh);
3668 #if 0
3669                         if (par->beamcon0 & BMC0_VARBEAMEN) {
3670                                 (copl++)->l = CMOVE(vtotal2hw(par->vtotal), vtotal);
3671                                 (copl++)->l = CMOVE(vbstrt2hw(par->vbstrt+1), vbstrt);
3672                                 (copl++)->l = CMOVE(vbstop2hw(par->vbstop+1), vbstop);
3673                                 (cops++)->l = CMOVE(vtotal2hw(par->vtotal), vtotal);
3674                                 (cops++)->l = CMOVE(vbstrt2hw(par->vbstrt), vbstrt);
3675                                 (cops++)->l = CMOVE(vbstop2hw(par->vbstop), vbstop);
3676                         }
3677 #endif
3678                 }
3679                 p = ZTWO_PADDR(copdisplay.list[currentcop][0]);
3680                 (copl++)->l = CMOVE(highw(p), cop2lc);
3681                 (copl++)->l = CMOVE2(loww(p), cop2lc);
3682                 p = ZTWO_PADDR(copdisplay.list[currentcop][1]);
3683                 (cops++)->l = CMOVE(highw(p), cop2lc);
3684                 (cops++)->l = CMOVE2(loww(p), cop2lc);
3685                 copdisplay.rebuild[0] = cops;
3686         } else {
3687                 (copl++)->l = CMOVE(diwstrt2hw(par->diwstrt_h, par->diwstrt_v), diwstrt);
3688                 (copl++)->l = CMOVE(diwstop2hw(par->diwstop_h, par->diwstop_v), diwstop);
3689                 if (!IS_OCS) {
3690                         (copl++)->l = CMOVE(diwhigh2hw(par->diwstrt_h, par->diwstrt_v,
3691                                             par->diwstop_h, par->diwstop_v), diwhigh);
3692 #if 0
3693                         if (par->beamcon0 & BMC0_VARBEAMEN) {
3694                                 (copl++)->l = CMOVE(vtotal2hw(par->vtotal), vtotal);
3695                                 (copl++)->l = CMOVE(vbstrt2hw(par->vbstrt), vbstrt);
3696                                 (copl++)->l = CMOVE(vbstop2hw(par->vbstop), vbstop);
3697                         }
3698 #endif
3699                 }
3700         }
3701         copdisplay.rebuild[1] = copl;
3702
3703         ami_update_par();
3704         ami_rebuild_copper();
3705 }
3706
3707         /*
3708          * Rebuild the Copper List
3709          *
3710          * We only change the things that are not static
3711          */
3712
3713 static void ami_rebuild_copper(void)
3714 {
3715         struct amifb_par *par = &currentpar;
3716         copins *copl, *cops;
3717         u_short line, h_end1, h_end2;
3718         short i;
3719         u_long p;
3720
3721         if (IS_AGA && maxfmode + par->clk_shift == 0)
3722                 h_end1 = par->diwstrt_h-64;
3723         else
3724                 h_end1 = par->htotal-32;
3725         h_end2 = par->ddfstop+64;
3726
3727         ami_set_sprite();
3728
3729         copl = copdisplay.rebuild[1];
3730         p = par->bplpt0;
3731         if (par->vmode & FB_VMODE_YWRAP) {
3732                 if ((par->vyres-par->yoffset) != 1 || !mod2(par->diwstrt_v)) {
3733                         if (par->yoffset > par->vyres-par->yres) {
3734                                 for (i = 0; i < (short)par->bpp; i++, p += par->next_plane) {
3735                                         (copl++)->l = CMOVE(highw(p), bplpt[i]);
3736                                         (copl++)->l = CMOVE2(loww(p), bplpt[i]);
3737                                 }
3738                                 line = par->diwstrt_v + ((par->vyres-par->yoffset)<<par->line_shift) - 1;
3739                                 while (line >= 512) {
3740                                         (copl++)->l = CWAIT(h_end1, 510);
3741                                         line -= 512;
3742                                 }
3743                                 if (line >= 510 && IS_AGA && maxfmode + par->clk_shift == 0)
3744                                         (copl++)->l = CWAIT(h_end1, line);
3745                                 else
3746                                         (copl++)->l = CWAIT(h_end2, line);
3747                                 p = par->bplpt0wrap;
3748                         }
3749                 } else p = par->bplpt0wrap;
3750         }
3751         for (i = 0; i < (short)par->bpp; i++, p += par->next_plane) {
3752                 (copl++)->l = CMOVE(highw(p), bplpt[i]);
3753                 (copl++)->l = CMOVE2(loww(p), bplpt[i]);
3754         }
3755         copl->l = CEND;
3756
3757         if (par->bplcon0 & BPC0_LACE) {
3758                 cops = copdisplay.rebuild[0];
3759                 p = par->bplpt0;
3760                 if (mod2(par->diwstrt_v))
3761                         p -= par->next_line;
3762                 else
3763                         p += par->next_line;
3764                 if (par->vmode & FB_VMODE_YWRAP) {
3765                         if ((par->vyres-par->yoffset) != 1 || mod2(par->diwstrt_v)) {
3766                                 if (par->yoffset > par->vyres-par->yres+1) {
3767                                         for (i = 0; i < (short)par->bpp; i++, p += par->next_plane) {
3768                                                 (cops++)->l = CMOVE(highw(p), bplpt[i]);
3769                                                 (cops++)->l = CMOVE2(loww(p), bplpt[i]);
3770                                         }
3771                                         line = par->diwstrt_v + ((par->vyres-par->yoffset)<<par->line_shift) - 2;
3772                                         while (line >= 512) {
3773                                                 (cops++)->l = CWAIT(h_end1, 510);
3774                                                 line -= 512;
3775                                         }
3776                                         if (line > 510 && IS_AGA && maxfmode + par->clk_shift == 0)
3777                                                 (cops++)->l = CWAIT(h_end1, line);
3778                                         else
3779                                                 (cops++)->l = CWAIT(h_end2, line);
3780                                         p = par->bplpt0wrap;
3781                                         if (mod2(par->diwstrt_v+par->vyres-par->yoffset))
3782                                                 p -= par->next_line;
3783                                         else
3784                                                 p += par->next_line;
3785                                 }
3786                         } else p = par->bplpt0wrap - par->next_line;
3787                 }
3788                 for (i = 0; i < (short)par->bpp; i++, p += par->next_plane) {
3789                         (cops++)->l = CMOVE(highw(p), bplpt[i]);
3790                         (cops++)->l = CMOVE2(loww(p), bplpt[i]);
3791                 }
3792                 cops->l = CEND;
3793         }
3794 }
3795
3796
3797 module_init(amifb_init);
3798
3799 #ifdef MODULE
3800 MODULE_LICENSE("GPL");
3801
3802 void cleanup_module(void)
3803 {
3804         unregister_framebuffer(&fb_info);
3805         amifb_deinit();
3806         amifb_video_off();
3807 }
3808 #endif /* MODULE */