diff options
Diffstat (limited to 'xorg-server/hw/kdrive/pm2/pm2.c')
| -rw-r--r-- | xorg-server/hw/kdrive/pm2/pm2.c | 295 |
1 files changed, 295 insertions, 0 deletions
diff --git a/xorg-server/hw/kdrive/pm2/pm2.c b/xorg-server/hw/kdrive/pm2/pm2.c new file mode 100644 index 000000000..148f03abd --- /dev/null +++ b/xorg-server/hw/kdrive/pm2/pm2.c @@ -0,0 +1,295 @@ +#ifdef HAVE_CONFIG_H +#include <kdrive-config.h> +#endif +#include "kdrive.h" +#include "kaa.h" + +#include "pm2.h" + +#define PARTPROD(a,b,c) (((a)<<6) | ((b)<<3) | (c)) + +char bppand[4] = { 0x03, /* 8bpp */ + 0x01, /* 16bpp */ + 0x00, /* 24bpp */ + 0x00 /* 32bpp */}; + +int partprodPermedia[] = { + -1, + PARTPROD(0,0,1), PARTPROD(0,1,1), PARTPROD(1,1,1), PARTPROD(1,1,2), + PARTPROD(1,2,2), PARTPROD(2,2,2), PARTPROD(1,2,3), PARTPROD(2,2,3), + PARTPROD(1,3,3), PARTPROD(2,3,3), PARTPROD(1,2,4), PARTPROD(3,3,3), + PARTPROD(1,3,4), PARTPROD(2,3,4), -1, PARTPROD(3,3,4), + PARTPROD(1,4,4), PARTPROD(2,4,4), -1, PARTPROD(3,4,4), + -1, PARTPROD(2,3,5), -1, PARTPROD(4,4,4), + PARTPROD(1,4,5), PARTPROD(2,4,5), PARTPROD(3,4,5), -1, + -1, -1, -1, PARTPROD(4,4,5), + PARTPROD(1,5,5), PARTPROD(2,5,5), -1, PARTPROD(3,5,5), + -1, -1, -1, PARTPROD(4,5,5), + -1, -1, -1, PARTPROD(3,4,6), + -1, -1, -1, PARTPROD(5,5,5), + PARTPROD(1,5,6), PARTPROD(2,5,6), -1, PARTPROD(3,5,6), + -1, -1, -1, PARTPROD(4,5,6), + -1, -1, -1, -1, + -1, -1, -1, PARTPROD(5,5,6), + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + -1, -1, -1, -1, + 0}; + +static Bool +pmMapReg(KdCardInfo *card, PM2CardInfo *pm2c) +{ + pm2c->reg_base = (CARD8 *)KdMapDevice(PM2_REG_BASE(card), + PM2_REG_SIZE(card)); + + if (pm2c->reg_base == NULL) + return FALSE; + + KdSetMappedMode(PM2_REG_BASE(card), PM2_REG_SIZE(card), + KD_MAPPED_MODE_REGISTERS); + + return TRUE; +} + +static void +pmUnmapReg(KdCardInfo *card, PM2CardInfo *pm2c) +{ + if (pm2c->reg_base) { + KdResetMappedMode(PM2_REG_BASE(card), PM2_REG_SIZE(card), + KD_MAPPED_MODE_REGISTERS); + KdUnmapDevice((void *)pm2c->reg_base, PM2_REG_SIZE(card)); + pm2c->reg_base = 0; + } +} + +Bool +pmCardInit (KdCardInfo *card) +{ + PM2CardInfo *pm2c; + + pm2c = (PM2CardInfo *) xalloc (sizeof (PM2CardInfo)); + if (!pm2c) + return FALSE; + memset (pm2c, '\0', sizeof (PM2CardInfo)); + + (void) pmMapReg (card, pm2c); + + if (!vesaInitialize (card, &pm2c->vesa)) + { + xfree (pm2c); + return FALSE; + } + + pm2c->InFifoSpace = 0; + + card->driver = pm2c; + + return TRUE; +} + +static void +pmCardFini (KdCardInfo *card) +{ + PM2CardInfo *pm2c = (PM2CardInfo *) card->driver; + + pmUnmapReg (card, pm2c); + vesaCardFini (card); +} + +Bool +pmScreenInit (KdScreenInfo *screen) +{ + PM2CardInfo *pm2c = screen->card->driver; + PM2ScreenInfo *pm2s; + int screen_size, memory; + + pm2s = (PM2ScreenInfo *) xalloc (sizeof (PM2ScreenInfo)); + if (!pm2s) + return FALSE; + memset (pm2s, '\0', sizeof (PM2ScreenInfo)); + + if (!vesaScreenInitialize (screen, &pm2s->vesa)) + { + xfree (pm2s); + return FALSE; + } + + pm2c->pprod = partprodPermedia[screen->width >> 5]; + pm2c->bppalign = bppand[(screen->fb[0].bitsPerPixel>>3)-1]; + + pm2s->screen = pm2s->vesa.fb; + memory = pm2s->vesa.fb_size; + + screen_size = screen->fb[0].byteStride * screen->height; + + if (pm2s->screen && memory >= screen_size + 2048) + { + memory -= 2048; + pm2s->cursor_base = pm2s->screen + memory - 2048; + } + else + pm2s->cursor_base = 0; + memory -= screen_size; + if (memory > screen->fb[0].byteStride) + { + pm2s->off_screen = pm2s->screen + screen_size; + pm2s->off_screen_size = memory; + } + else + { + pm2s->off_screen = 0; + pm2s->off_screen_size = 0; + } + + switch (screen->fb[0].bitsPerPixel) { + case 8: + pm2c->BppShift = 2; + break; + case 16: + pm2c->BppShift = 1; + break; + case 24: + pm2c->BppShift = 2; + break; + case 32: + pm2c->BppShift = 0; + break; + } + + screen->driver = pm2s; + + return TRUE; +} + +static void +pmScreenFini (KdScreenInfo *screen) +{ + PM2ScreenInfo *pm2s = (PM2ScreenInfo *) screen->driver; + + vesaScreenFini (screen); + xfree (pm2s); + screen->driver = 0; +} + +static Bool +pmInitScreen (ScreenPtr pScreen) +{ + return vesaInitScreen (pScreen); +} + +#ifdef RANDR +static Bool +pmRandRSetConfig (ScreenPtr pScreen, + Rotation rotation, + int rate, + RRScreenSizePtr pSize) +{ + kaaWaitSync (pScreen); + + if (!vesaRandRSetConfig (pScreen, rotation, rate, pSize)) + return FALSE; + + return TRUE; +} + +static void +pmRandRInit (ScreenPtr pScreen) +{ + rrScrPriv(pScreen); + + pScrPriv->rrSetConfig = pmRandRSetConfig; +} +#endif + +static Bool +pmFinishInitScreen (ScreenPtr pScreen) +{ + Bool ret; + ret = vesaFinishInitScreen (pScreen); +#ifdef RANDR + pmRandRInit (pScreen); +#endif + return ret; +} + +static void +pmPreserve(KdCardInfo *card) +{ + vesaPreserve(card); +} + +static void +pmRestore(KdCardInfo *card) +{ + vesaRestore (card); +} + +static Bool +pmEnable (ScreenPtr pScreen) +{ + if (!vesaEnable (pScreen)) + return FALSE; + +#ifdef XV + KdXVEnable (pScreen); +#endif + + return TRUE; +} + +static void +pmDisable(ScreenPtr pScreen) +{ +#ifdef XV + KdXVDisable (pScreen); +#endif + vesaDisable (pScreen); +} + +static Bool +pmDPMS(ScreenPtr pScreen, int mode) +{ + return vesaDPMS (pScreen, mode); +} + +KdCardFuncs PM2Funcs = { + pmCardInit, /* cardinit */ + pmScreenInit, /* scrinit */ + pmInitScreen, /* initScreen */ + pmFinishInitScreen, /* finishInitScreen */ + vesaCreateResources, /* createRes */ + pmPreserve, /* preserve */ + pmEnable, /* enable */ + pmDPMS, /* dpms */ + pmDisable, /* disable */ + pmRestore, /* restore */ + pmScreenFini, /* scrfini */ + pmCardFini, /* cardfini */ + + 0, /* initCursor */ + 0, /* enableCursor */ + 0, /* disableCursor */ + 0, /* finiCursor */ + NULL, /* recolorCursor */ + + pmDrawInit, /* initAccel */ + pmDrawEnable, /* enableAccel */ + pmDrawDisable, /* disableAccel */ + pmDrawFini, /* finiAccel */ + + vesaGetColors, /* getColors */ + vesaPutColors, /* putColors */ +}; |