/*** $Id: fblin16.c,v 1.21 2003/09/04 02:57:09 weiym Exp $**** fblin16.c: 16bpp Linear Video Driver for MiniGUI**** Copyright (C) 2003 Feynman Software.** Copyright (C) 2000 Song Lixin and Wei Yongming.** ** 2000/10/20: Created by Song Lixin.**** 2003/07/11: Cleanup by Wei Yongming.*//*** This program is free software; you can redistribute it and/or modify** it under the terms of the GNU General Public License as published by** the Free Software Foundation; either version 2 of the License, or** (at your option) any later version.**** This program is distributed in the hope that it will be useful,** but WITHOUT ANY WARRANTY; without even the implied warranty of** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the** GNU General Public License for more details.**** You should have received a copy of the GNU General Public License** along with this program; if not, write to the Free Software** Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA*/#include <stdlib.h>#include <string.h>#include <linux/fb.h>#include "native.h"#include "fb.h"#ifdef _FBLIN16_SUPPORTstatic int linear16_init (PSD psd){    if (!psd->size) {        psd->size = psd->yres * psd->linelen;        /* convert linelen from byte to pixel len for bpp 16, 24, 32*/        psd->linelen /= 2;    }    return 1;}/* Set pixel at x, y, to gal_pixel c*/static void linear16_drawpixel (PSD psd, int x, int y, gal_pixel c){    gal_uint16  * addr = (gal_uint16 *) psd->addr;    if (psd->gr_mode == MODE_XOR)        addr[x + y * psd->linelen] ^= (gal_uint16) c;     else        addr[x + y * psd->linelen] = (gal_uint16) c;}/* Read pixel at x, y*/static gal_pixel linear16_readpixel (PSD psd, int x, int y){    gal_uint16    *addr = (gal_uint16 *) psd->addr;    return (gal_pixel) addr[x + y * psd->linelen];}/* Draw horizontal line from x1,y to x2,y including final point*/static void linear16_drawhline (PSD psd, int x, int y, int w, gal_pixel c){    gal_uint16    *dst;    dst = (gal_uint16 *)(psd->addr) + y * psd->linelen + x;    if (psd->gr_mode == MODE_XOR) {        while (w --)            *dst++ ^= (gal_uint16)c;    }    else {        while (w --)            *dst++ = (gal_uint16)c;    }}static void linear16_drawvline(PSD psd, int x, int y, int h, gal_pixel c){    gal_uint16    *dst;    int    linelen = psd->linelen;    dst = (gal_uint16 *)(psd->addr) + y * psd->linelen + x;    if (psd->gr_mode == MODE_XOR) {        while (h --) {            *dst^= (gal_uint16)c;            dst+= linelen;        }    }    else {        while (h --) {            *dst = (gal_uint16)c;            dst+= linelen;        }    }}/* srccopy bitblt, not do clip*/static void linear16_blit (PSD dstpsd, int dstx, int dsty, int w, int h,    PSD srcpsd, int srcx, int srcy){    gal_uint16    *dst = (gal_uint16 *) dstpsd->addr;    gal_uint16    *src = (gal_uint16 *) srcpsd->addr;    int    dlinelen = dstpsd->linelen;    int    slinelen = srcpsd->linelen;    dst += dstx + dsty * dlinelen;    src += srcx + srcy * slinelen;    while(--h >= 0) {        /* a _fast_ memcpy is a _must_ in this routine*/        memcpy (dst, src, w<<1);        dst += dlinelen;        src += slinelen;    }}/* do clip */static void linear16_putbox ( PSD psd, int x, int y, int w, int h, void *buf){    gal_uint16    *src = (gal_uint16*) buf;    int srcwidth = w;    gal_uint8 *dst;    int dstwidth = psd->linelen << 1;    int oldx = x;    if (psd->doclip) {            if (y < psd->clipminy) {            h -= psd->clipminy - y;            src += (psd->clipminy - y) * srcwidth;            y = psd->clipminy;        }        if (x < psd->clipminx) {            w -= psd->clipminx - x;            src += psd->clipminx - x;            x = psd->clipminx;        }                if (y + h - 1 >= psd->clipmaxy)             h =  psd->clipmaxy- y;        if (x + w - 1 >= psd->clipmaxx)             w =  psd->clipmaxx- x;    }    else {        if ( y < 0 ) {            h += y;            src -= y * srcwidth;            y = 0;        }        if ( x < 0 ) {            w += x;            src -= x;            x = 0;        }                if ( y + h  -1 >= psd->yres)             h = psd->yres - y ;        if ( x + w  -1 >= psd->xres)             w = psd->xres - x ;    }    dst = (gal_uint8 *)(psd->addr) + (y*dstwidth + (x << 1));    if (w <= 0 || h<=0) return;    /* Width should be in bytes */    w <<= 1;    if (w == dstwidth && psd->linelen == srcwidth && oldx == 0 && psd->clipminx == 0) {        memcpy (dst, src, w*h);        return;    }    while (h > 0) {        memcpy(dst, src, w);        dst += dstwidth;        src += srcwidth;        h--;    }}/* clip to screen */static void linear16_getbox ( PSD psd, int x, int y, int w, int h, void* buf ){    gal_uint16 *dst = (gal_uint16*) buf;    int dstwidth = w;    gal_uint8 *src;    int srcwidth = psd->linelen << 1;    int oldx = x;    if ( y < 0 ) {        h += y;        dst -= y * dstwidth;        y = 0;    }    if ( x < 0 ) {        w += x;        dst -= x;        x = 0;    }            if ( y + h  -1 >= psd->yres)         h = psd->yres - y ;    if ( x + w  -1 >= psd->xres)         w = psd->xres - x ;    src = (gal_uint8 *)(psd->addr) + (y*srcwidth + (x << 1));    w <<= 1;        if (w <= 0 || h<=0) return;    if (w == dstwidth && psd->linelen == srcwidth && oldx == 0 && psd->clipminx == 0) {        memcpy (dst, src, w*h);        return;    }    while (h-- > 0) {        memcpy(dst, src, w);        dst += dstwidth;        src += srcwidth;    }}static void linear16_putboxmask ( PSD psd, int x, int y, int w, int h, void *buf, gal_pixel cxx){    gal_uint16 *src= (gal_uint16*) buf;    gal_uint8 *endoflinesrc;    gal_uint8 *src1;    gal_uint8 *dst;    int i;    int srcwidth =  w;    int dstwidth = psd->linelen << 1;    if (psd->doclip) {            if (y < psd->clipminy) {            h -= psd->clipminy - y;            src += (psd->clipminy - y) * srcwidth;            y = psd->clipminy;        }        if (x < psd->clipminx) {            w -= psd->clipminx - x;            src += psd->clipminx - x;            x = psd->clipminx;        }                if (y + h - 1 >= psd->clipmaxy)             h =  psd->clipmaxy- y;        if (x + w - 1 >= psd->clipmaxx)             w =  psd->clipmaxx- x;    }    else {        if ( y < 0 ) {            h += y;            src -= y * srcwidth;            y = 0;        }        if ( x < 0 ) {            w += x;            src -= x;            x = 0;        }                if ( y + h  -1 >= psd->yres)             h = psd->yres - y ;        if ( x + w  -1 >= psd->xres)             w = psd->xres - x ;    }    if (w <= 0 || h <= 0) return;    dst = (gal_uint8 *)(psd->addr) + (y*dstwidth + x*2);    for (i = 0; i < h; i++) {        src1 = (gal_uint8*)src ;         endoflinesrc = (gal_uint8*)(src +  w);        while (src1 < endoflinesrc - 7) {            gal_uint32 c2 = *(gal_uint32 *) src1;            if ((c2 & 0xffff) != cxx)            *(gal_uint16 *) dst = (gal_uint16) c2;            c2 >>= 16;            if (c2 != cxx)            *(gal_uint16 *) (dst + 2) = (gal_uint16) c2;                        c2 = *(gal_uint32 *) (src1 + 4);            if ((c2 & 0xffff) != cxx)            *(gal_uint16 *) (dst + 4) = (gal_uint16) c2;            c2 >>= 16;            if (c2 != cxx)            *(gal_uint16 *) (dst + 6) = (gal_uint16) c2;            src1 += 8;            dst += 8;        }        while (src1 < endoflinesrc) {            gal_uint16 c = *(gal_uint16 *) src1;            if (c != cxx)                *(gal_uint16 *) dst = c;            src1 += 2;            dst += 2;        }        dst += psd->linelen * 2 - w * 2;        src += srcwidth;    }}static void linear16_copybox (PSD psd, int x1, int y1, int w, int h, int x2, int y2){    gal_uint16 *svp, *dvp;    if (y1 >= y2) {        if (y1 == y2 && x2 >= x1) {    /* tricky */            int i;            if (x1 == x2)                return;            /* use a temporary buffer to store a line */            /* using reversed movs would be much faster */            svp = (gal_uint16 *) psd->addr + y1 * psd->linelen + x1;            dvp = (gal_uint16 *) psd->addr + y2 * psd->linelen + x2;            for (i = 0; i < h; i++) {                gal_uint8 linebuf[2048];                memcpy (linebuf, svp, w<<1);                memcpy (dvp, linebuf, w<<1);                svp += psd->linelen;                dvp += psd->linelen;            }        } else {        /* copy from top to bottom */            int i;            svp = (gal_uint16 *) psd->addr + y1 * psd->linelen + x1;            dvp = (gal_uint16 *) psd->addr + y2 * psd->linelen + x2;            for (i = 0; i < h; i++) {                memcpy(dvp, svp, w<<1);                svp += psd->linelen;                dvp += psd->linelen;            }        }    } else {            /* copy from bottom to top */        int i;        svp = (gal_uint16 *) psd->addr + (y1 + h) * psd->linelen + x1;        dvp = (gal_uint16 *) psd->addr + (y2 + h) * psd->linelen + x2;        for (i = 0; i < h; i++) {            svp -= psd->linelen;            dvp -= psd->linelen;            memcpy (dvp, svp, w<<1);        }    }}SUBDRIVER fblinear16 = {    linear16_init,    linear16_drawpixel,    linear16_readpixel,    linear16_drawhline,    linear16_drawvline,    linear16_blit,    linear16_putbox,    linear16_getbox,    linear16_putboxmask,    linear16_copybox};#endif /* _FBLIN16_SUPPORT */